mavlink to gazebo devtest 02

src/unitdev01/unitdev01/mavlink.py

@@ -94,23 +94,23 @@ class MAVLinkWorker(QThread):
 
     def arm(self, namespace, arm):
         sysid = int(namespace[-1])
-        self.connection.mav.command_long_send(
-            sysid,
-            1,  # Component ID
-            mavutil.mavlink.MAV_CMD_COMPONENT_ARM_DISARM,
-            0,  # Confirmation
-            1 if arm else 0,
-            0, 0, 0, 0, 0, 0
-        )
         # self.connection.mav.command_long_send(
         #     sysid,
         #     1,  # Component ID
-        #     mavutil.mavlink.MAV_CMD_SET_MESSAGE_INTERVAL,
-        #     0,
-        #     33,
-        #     -1, 
-        #     0, 0, 0, 0, 0
+        #     mavutil.mavlink.MAV_CMD_COMPONENT_ARM_DISARM,
+        #     0,  # Confirmation
+        #     1 if arm else 0,
+        #     0, 0, 0, 0, 0, 0
         # )
+        self.connection.mav.command_long_send(
+            sysid,
+            1,  # Component ID
+            mavutil.mavlink.MAV_CMD_SET_MESSAGE_INTERVAL,
+            0,
+            33,
+            1000000, 
+            0, 0, 0, 0, 0
+        )
 
     def takeoff(self, namespace, altitude):
         sysid = int(namespace[-1])