Ejemplo n.º 1
0
        public HefnyCopterSerial()
        {
            mRxDataType = ENUM_RxDataType.Undefined;
            mSerialPort = new System.IO.Ports.SerialPort();
            mSerialPort.DataBits = 8;
            mSerialPort.DiscardNull = false;
            mSerialPort.Parity = Parity.None;
            mSerialPort.RtsEnable = true;
            mSerialPort.DataReceived += new System.IO.Ports.SerialDataReceivedEventHandler(DataReceived);

            //vArray = new byte[20];
            cArray = new byte[400];

        }
Ejemplo n.º 2
0
        /// <summary>
        /// Sensor Protocol:
        /// S,GX,GY,GZ,AccX,AccY,AccZ,Bat,M1,M2,M3,M4,E
        /// Settings Protocol:
        /// C,.......................................,E
        /// </summary>
        /// <param name="sender"></param>
        /// <param name="e"></param>
        private void DataReceived(object sender, SerialDataReceivedEventArgs e)
        {
            
            string RxString;
            RxString = (mSerialPort.ReadExisting());

            byte[] array = new byte[8000]; 

            array = Encoding.Unicode.GetBytes(RxString);


            for (int i = 0; i < array.Length; ++i) // j; ++i)
            {
                // Sensors Start Tag .... Data of Gyros & Acc readinsg while flying is being recived.
                if ((!bStartCopy) && (array[i] == 'I'))
                {
                    mRxDataType = ENUM_RxDataType.IMU;
                    bStartCopy = true;
                    Command = 0;
                    Idx = 0;
                    continue;
                } 
                if ((!bStartCopy) && (array[i] == 'S'))
                {
                    mRxDataType = ENUM_RxDataType.Sensors;
                    bStartCopy = true;
                    Command = 0;
                    Idx = 0;
                    continue;
                }
                // Configuration Start Tag .... Data of Config structure is being received
                if ((!bStartCopy) && (array[i] == 'C'))
                {
                    mRxDataType = ENUM_RxDataType.Settings;
                    bStartCopy = true;
                    CommandLength = 999;

                    Idx = 0;
                    continue;
                }
                // End Tag
                if ((!bStartCopy) && (array[i] == 'E'))
                {
                    if (ExpectEOF == true) // message correct then copy
                    {
                        SerialPacket SP = new SerialPacket();
                        SP.DataType = mRxDataType;
                        SP.Array = cArray;
                        SP.Command = Command;
                        SP.CommandLength = CommandLength - 2;
                        CopyData(SP);
                    }
                    mRxDataType = ENUM_RxDataType.Undefined;
                                      
                    ExpectEOF = false;
                    continue;
                }
                // Incoming Data Copying
                if (bStartCopy)
                {
                    switch (mRxDataType)
                    {
                        case ENUM_RxDataType.IMU:
                            if (Idx == 32)
                            {
                                Idx = 0;
                                bStartCopy = false;
                                ExpectEOF = true;
                                i -= 1; // stepback to check for 'E'
                                continue;
                            }
                            cArray[Idx] = array[i];
                            break;
                        case ENUM_RxDataType.Sensors:
                            if (Idx == 32)
                            {
                                Idx = 0;
                                bStartCopy = false;
                                ExpectEOF = true;
                                i -= 1; // stepback to check for 'E'
                                continue;
                            }
                            cArray[Idx] = array[i];
                            break;

                        case ENUM_RxDataType.Settings:
                            if (Idx == 1)
                            {
                                Command = (ENUM_SerialCommands)cArray[Idx-1];
                            }
                            if (Idx == 2)
                            {
                                CommandLength = cArray[Idx - 1] + cArray[Idx] * 0xff  +2 ;
                                // verify data is OK
                                if (array[i] == CONST_FIRMWARE_SIGNATURE)
                                { // signature is OK 
                                }
                            }

                            if (Idx == CommandLength)
                            {
                                Idx = 0;
                                bStartCopy = false;
                                ExpectEOF = true;
                               // i -= 1; // stepback to check for 'E'
                                continue;
                            }
                            cArray[Idx] = array[i];
                            break;
                   }
                    Idx += 1;
                }
               ExpectEOF = false;
            }
        //   Idx += 1; // FIX bug when DataMisalignedException comes CONST_FIRMWARE_SIGNATURE two chunks cArray was shifted by one.
        }