add: configured config.yaml measurement_device_1 positions

robot_control/config/config.yaml

@@ -1,8 +1,8 @@
 measurement_devices:
   - id: device_1
-    position: [1, 802, 70]
+    position: [13, 802, 66]
     slots:
-      - position: [5, 802, 65]
+      - position: [0, 0, 0]
         occupied: False
         slot_id: 0
       - position: [21, 0, 0]
@@ -11,19 +11,19 @@ measurement_devices:
       - position: [42, 0, 0]
         occupied: False
         slot_id: 2
-      - position: [65, 0, 0]
+      - position: [63, 0, 0]
         occupied: False
         slot_id: 3
-      - position: [88, 0, 0]
+      - position: [86, 0, 0]
         occupied: False
         slot_id: 4
-      - position: [110, 0, 0]
+      - position: [107, 0, 0]
         occupied: False
         slot_id: 5
-      - position: [132, 0, 0]
+      - position: [129, 0, 0]
         occupied: False
         slot_id: 6
-      - position: [155, 0, 0]
+      - position: [151, 0, 0]
         occupied: False
         slot_id: 7
 

robot_control/src/robot/controller.py

@@ -465,8 +465,8 @@ class RobotController:
         """
         io_conf = self.config.gpio
         while not self.next_cell_id:
-            self.next_cell_id = self.vision.read_datamatrix() # commented out for test purposes Y
-            # self.next_cell_id = 1
+            #self.next_cell_id = self.vision.read_datamatrix() # commented out for test purposes Y
+            self.next_cell_id = 1
             if not self.next_cell_id:
                 logger.debug("No cell detected")
                 return False  # No cell detected