Ignore worm servo from flash

iory · Jan 11, 2024 · 257bc91 · 257bc91
1 parent df31a12
commit 257bc91
Showing 1 changed file with 3 additions and 1 deletion.
diff --git a/rcb4/armh7interface.py b/rcb4/armh7interface.py
@@ -546,7 +546,9 @@ def search_worm_ids(self):
         for idx in range(max_sensor_num):
             worm = self.memory_cstruct(WormmoduleStruct, idx)
             if worm.module_type == 1:
-                indices.append(idx)
+                servo = self.memory_cstruct(ServoStruct, worm.servo_id)
+                if servo.rotation == 1:
+                    indices.append(idx)
         self.worm_sorted_ids = indices
         return indices