Diff: main.cpp

Revision:

1:2759fc78aa04

Parent:

0:23b97841e8dc

Child:

2:f07401343541

--- a/main.cpp	Wed Aug 29 09:45:32 2018 +0000
+++ b/main.cpp	Fri Aug 31 10:45:30 2018 +0000
@@ -11,35 +11,12 @@
 int main()
 {
     AX12 servo1(PC_6, PC_7, PC_8, id1, 1000000); // tx, rx, tx_enable, servo ID, baud rate
-    AX12 servo2(PC_6, PC_7, PC_8, id2, 1000000);
+//    AX12 servo2(PC_6, PC_7, PC_8, id2, 1000000);
+    
     while (1) 
     {        
-        for (int i = 1; i <= 30; i += 1)
-        {
-            deg1 = i*10;
-            deg2 = (deg1+10) % 300;
-            servo1.SetGoal(deg1);
-            servo2.SetGoal(deg2);
-//            servo1.MultSetGoal( deg1, 1, 
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1,
-//                                deg1, 1);
-            pc.printf("1: %d %d 2: %d %d\n", id1, deg1, id2, deg2);
-            wait(3);
-        }
+       servo1.SetTorqueEnable(0);
+       pc.printf("TEst \n");
+       wait(0.5);
     }    
 }
\ No newline at end of file