ライブラリ化を行った後

Dependencies:   QEI accelerator bit_test cyclic_io cyclic_var cylinder event_var limit mbed mecanum motor_drive pid pid_encoder rs422_put sbdbt servo

Fork of 17robo_Practice1 by kusano kiyoshige

Revision:
43:605e5b0b9106
Parent:
42:63aedf71f4d1
Child:
44:7410d8356f58
--- a/main.cpp	Fri Sep 08 05:27:30 2017 +0000
+++ b/main.cpp	Sun Sep 10 11:30:26 2017 +0000
@@ -51,7 +51,7 @@
 #define pin_interrupt_sholderleft_min   p8
 #define pin_servo p21
 #define servo_reload_time 1.0
-#define pin_cylinder_reload LED1
+#define pin_cylinder_reload p15
 //#define pin_servo_reload p29 //
 //#define pin_interrupt_reload p30 //
 
@@ -298,13 +298,8 @@
         cylinder_origin_flag = 1;
     }
     
-    if(sbdbt.left) {
-        cylinder_origin();
-    }
+    cylinder_reload.cyclic(sbdbt.left);
     
-    cylinder_reload.cyclic(sbdbt.right);
-    
-
     static int counter;
     int id[nucleo_num] = {n1_id, n2_id, n3_id, n4_id, n5_id, n6_id};
     switch (counter) {