添加INS，添加舵机指令，修正舵机位置

App/CommandBox/CommandBox.h

@@ -1,4 +1,4 @@
-#ifndef COMMANDBOX_H
+#ifndef COMMANDBOX_H
 #define COMMANDBOX_H
 
 #include <QWidget>
@@ -49,12 +49,16 @@ public slots:
                            float param1, float param2, float param3, float param4,
                                float param5, float param6, float param7,
                                uint16_t command, uint8_t confirmation);
+   void on_paramClicked(uint8_t sysid, uint8_t compid , QString id, uint8_t type, float value);
+
+   void addVehicles(int sysid, int compid);
 
 signals:
     void showMessage(const QString &message,int TimeOut = 0);
     void cmd_int(float param1, float param2, float param3, float param4, int x, int y, float z);
     void cmd_long( float param1,float param2,float param3,float param4,float param5,float param6,float param7,uint16_t command,uint8_t confirmation);
 
+    void WriteCmd(uint8_t m_sysid, uint8_t m_compid , const char *id, uint8_t type, float value);
 
 private slots:
     void on_pushButton_Servo_Check_clicked();
@@ -89,6 +93,10 @@ private slots:
 
     void on_pushButton_Cancel_clicked();
 
+    void on_pushButton_IMU_clicked();
+
+    void on_pushButton_ServoSet_clicked();
+
 private:
 
     QWidget *m_parent;
@@ -110,6 +118,16 @@ private:
     uint8_t m_confirm = 10;
 
 
+    uint8_t m_sysid;
+    uint8_t m_compid;
+    QString m_id;
+    uint8_t m_type;
+    float m_value;
+
+
+    uint32_t cmdType = 0;//0 cmd 1 param
+
+
 };
 
 #endif // COMMANDBOX_H