Add Servo Bras

Author: Geoffroy Arenou

include/Hardware_Config.h

@@ -9,13 +9,18 @@ namespace Hardware_Config
         VL53Pos = 145,
         VL53Max = 290,
 
+        BrasMin = 0,
+        BrasPos = 145,
+        BrasMax = 290,
+
         Min = 0,
         Max = 290
     };
 
     enum class ServoID
     {
         VL53 = 1,           // Servo pour bouger le VL53
+        Bras = 2,           // Servo pour manger les noisettes
         BroadCast = 0xFE    // Broadcast ID pour communiquer avec tous les servos
     };
 }

src/main.cpp

@@ -30,7 +30,8 @@ void setup()
   ServoAX12::Initialisation(SERIAL_SERVO, RX_SERVO, TX_SERVO, PIN_SERVO_DIR);
   ServoAX12::AddServo(ServoID::VL53, "VL53", ServoPosition::VL53Min, ServoPosition::VL53Max);
   ServoAX12::SetServoPosition(ServoID::VL53, ServoPosition::VL53Pos);
-
+  ServoAX12::AddServo(ServoID::Bras, "Bras", ServoPosition::BrasMin, ServoPosition::BrasMax);
+  ServoAX12::SetServoPosition(ServoID::Bras, ServoPosition::BrasPos);
 
   ToF_VL53L8CX::Initialisation();