Пример #1
0
        public static MAVLink.mavlink_sys_status_t to_mavlink_sys_status_t(BattStatus bStatus) 
        {
            MAVLink.mavlink_sys_status_t c = new MAVLink.mavlink_sys_status_t() 
            {
                current_battery = (short)bStatus.ptotalcurrent,
                voltage_battery = (ushort)bStatus.pavgvoltage,
                

            };
            return c;
        }
Пример #2
0
        public void translate(byte[] bytes)
        {
            myMsg = new IPMsg(bytes);

            switch ((MsgType)myMsg.header.msgtype)
            {

                case MsgType.LBL_SEND_2D:
                    if (myMsg.msgbyte.Length != 28)
                        break;
                    myLBLSend2D = new LBLSend2D(myMsg.msgbyte);
                    break;

                case MsgType.PRS_SEND:
                    if (myMsg.msgbyte.Length != 10)
                        break;
                    myPrsSend = new PrsSend(myMsg.msgbyte);
                    break;

                case MsgType.BATT_STATUS:
                    if (myMsg.msgbyte.Length != 36)
                        break;
                    myBattStatus = new BattStatus(myMsg.msgbyte);
                    break;

                case MsgType.NAV_SEND_REL_STATUS:
                    if (myMsg.msgbyte.Length != 96)
                        break;
                    myNavSendRelStatus = new NavSendRelStatus(myMsg.msgbyte);
                    break;

                case MsgType.CPS_SEND:
                    if (myMsg.msgbyte.Length != 62)
                        break;
                    myCpsSend = new CpsSend(myMsg.msgbyte);
                    break;

                case MsgType.CPS_MTI:
                    if (myMsg.msgbyte.Length != 80)
                        break;
                    myCpsMti = new CpsMti(myMsg.msgbyte);
                    break;

                case MsgType.GPS_SEND_2D:
                    if (myMsg.msgbyte.Length != 24)
                        break;
                    myGPSSend2D = new GPSSend2D(myMsg.msgbyte);
                    break;

                case MsgType.GPS_SEND_3D:
                    if (myMsg.msgbyte.Length != 72)
                        break;
                    myGPSSend3D = new GPSSend3D(myMsg.msgbyte);
                    break;

                case MsgType.NAV_SEND_ABS_STATUS:
                    if (myMsg.msgbyte.Length != 96)
                        break;
                    myNavSendAbsStatus = new NavSendAbsStatus(myMsg.msgbyte);
                    break;

                case MsgType.ALTIMETER_DATA:
                    if (myMsg.msgbyte.Length != 20)
                        break;
                    myAltimeterData = new AltimeterData(myMsg.msgbyte);
                    break;

                case MsgType.CTD_SEND:
                    if (myMsg.msgbyte.Length != 40)
                        break;
                    myCtdSend = new CtdSend(myMsg.msgbyte);
                    break;

                case MsgType.SUPERVISION_LEAK:
                    if (myMsg.msgbyte.Length != 4)
                        break;
                    mySupervisionLeak = new SupervisionLeak(myMsg.msgbyte);
                    break;

                case MsgType.PRS_SET_SURF:
                    if (myMsg.msgbyte.Length != 8)
                        break;
                    mytSurf = new tSurf(myMsg.msgbyte);
                    break;

                case MsgType.MOTION_REF:
                    if (myMsg.msgbyte.Length != 60)
                        break;
                    myMotionRef = new MotionRef(myMsg.msgbyte);
                    break;

                case MsgType.SYS_ACK:
                    if (myMsg.msgbyte.Length != 2)
                        break;
                    mySysAck = new SysAck(myMsg.msgbyte);
                    break;

                case MsgType.KLM_SET_POS:
                    if (myMsg.msgbyte.Length != 32)
                        break;
                    myKlmSetPos = new KlmSetPos(myMsg.msgbyte);
                    break;

                case MsgType.KLM_DEAD_RECK:
                    if (myMsg.msgbyte.Length != 16)
                        break;
                    myKlmDeadReck = new KlmDeadReck(myMsg.msgbyte);
                    break;

                case MsgType.KLM_RNG_CRT:
                    if (myMsg.msgbyte.Length != 36)
                        break;
                    myKlmRngCrt = new KlmRngCrt(myMsg.msgbyte);
                    break;

                case MsgType.KLM_MOB_INITIATE:
                    if (myMsg.msgbyte.Length != 56)
                        break;
                    myKlmMobInitiate = new KlmMobInitiate(myMsg.msgbyte);
                    break;

                case MsgType.KLM_MOB_SET_POS:
                    if (myMsg.msgbyte.Length != 24)
                        break;
                    myKlmMobSetPos = new KlmMobSetPos(myMsg.msgbyte);
                    break;

                case MsgType.KLM_MOB_SET_NETWORK:
                    if (myMsg.msgbyte.Length != 32)
                        break;
                    myKlmMobSetNetwork = new KlmMobSetNetwork(myMsg.msgbyte);
                    break;

                case MsgType.LBL_SET_BUOYPOS:
                    if (myMsg.msgbyte.Length != 26)
                        break;
                    myLBLSetBuoyPos = new LBLSetBuoyPos(myMsg.msgbyte);
                    break;

                case MsgType.MIS_START:
                    if (myMsg.msgbyte.Length != 8)
                        break;
                    myMisStart = new MisStart(myMsg.msgbyte);
                    break;

                default:
                    break;

            }

        }