control YOZAKURA ARM with keyboard

Dependencies:   Dynamixel MEMS_Thermal_Sensor SerialHalfDuplex mbed

Files at this revision

API Documentation at this revision

Comitter:
yusuke_kyo
Date:
Wed Apr 22 18:10:04 2015 +0000
Parent:
1:604074771dbc
Child:
3:7a30251664f0
Commit message:
delite Dyna_homeposition etc.

Changed in this revision

main.cpp Show annotated file Show diff for this revision Revisions of this file
--- a/main.cpp	Wed Apr 22 18:08:31 2015 +0000
+++ b/main.cpp	Wed Apr 22 18:10:04 2015 +0000
@@ -73,26 +73,6 @@
     }
     yaw.SetGoal(yaw_goal);
 }
-
-void Dyna_home_position() {
-    float lp;
-    linear.SetGoal(linear_Init);
-    lp=linear.GetPosition();
-    if(lp > linear_MAX - 30) {  //ある程度縮んだら
-        pitch.SetGoal(pitch_Init);
-        yaw.SetGoal(yaw_Init);
-    }
-}
-
-void Dyna_reset() {
-    RelaySwitch = 0;
-    wait_ms(10);
-    RelaySwitch = 1;
-}
-
-void Dyna_end() {
-    RelaySwitch = 0;
-}
 /*--Dynamixel:end-----------------------------------------------------------------------------------------*/