Team DIANA / Mbed OS Arm_dynamixel_can_procedurale

FOrk

Dependencies:   Servo AX12_final MX106_not_working comunication_1

Diff: main.cpp

Revision:
15:d058877eb501
Parent:
14:c51c4e0f3bc9
Child:
16:5454456b36f7
--- a/main.cpp	Fri Feb 08 19:24:15 2019 +0000
+++ b/main.cpp	Fri Feb 08 19:31:04 2019 +0000
@@ -56,7 +56,7 @@
             else if (pose==100)
             {
                
-                motor_1.setSpeed(0);
+                motor_1.setSpeed(SPEED);
                 printf("Dynamixel 1 Position : %f \n\r ", motor_1.getPosition());
                 
             }
@@ -80,7 +80,7 @@
             else if (pose==100)
             {
                
-                motor_2.setSpeed(0);
+                motor_2.setSpeed(SPEED);
                 printf("Dynamixel 2 Position : %f \n\r ", motor_2.getPosition());
                 if (motor_2.getPosition()>90) motor_2.setSpeed(0);
             }
@@ -104,7 +104,7 @@
             else if (pose==100)
             {
                
-                motor_3.setSpeed(0);
+                motor_3.setSpeed(SPEED);
                 printf("Dynamixel 3 Position : %f \n\r ", motor_3.getPosition());
                 
             }
@@ -128,7 +128,7 @@
             else if (pose==100)
             {
                
-                motor_1.setSpeed(0);
+                motor_1.setSpeed(SPEED);
                 printf("Dynamixel 4 Position : %f \n\r ", motor_4.getPosition());
                 
             }