YOZAKURAのARMプログラム(ver.1)

Dependencies:   Dynamixel EthernetInterface MEMS_Thermal_Sensor mbed-rtos SerialHalfDuplex mbed

Revision:
9:65c76b58e5b7
Parent:
8:dd338c66211d
Child:
10:ffe65600fba2
diff -r dd338c66211d -r 65c76b58e5b7 main.cpp
--- a/main.cpp	Wed Apr 08 08:06:38 2015 +0000
+++ b/main.cpp	Wed Apr 08 08:16:14 2015 +0000
@@ -166,20 +166,23 @@
 
                 //目標角度へ動かす
                 myled2=1;
+                linear_goal=lP;
                 switch(linear_mode){
-                    case 0: linear_goal=lP; break;
+                    case 0: break;
                     case 1: linear_goal++; break;
                     case 2: linear_goal--; break;
                 }    
                 linear.SetGoal(linear_goal);
+                pitch_goal=pP;
                 switch(pitch_mode){
-                    case 0: pitch_goal=lP; break;
+                    case 0: break;
                     case 1: pitch_goal++; break;
                     case 2: pitch_goal--; break;
                 }    
                 pitch.SetGoal(pitch_goal);
+                yaw_goal=yP;
                 switch(yaw_mode){
-                    case 0: yaw_goal=lP; break;
+                    case 0: break;
                     case 1: yaw_goal++; break;
                     case 2: yaw_goal--; break;
                 }