Dependencies:   PID Serialservo TCS3200 XQ_servo encoder encoder2 mbed moter

Fork of nhk_2018_undercarry_test09 by ケンタ ミヤザキ

Revision:
7:f1a924244b76
Parent:
6:ff7fd6556a81
Child:
8:91a72648f312
--- a/config.h	Sun Apr 01 11:58:23 2018 +0000
+++ b/config.h	Fri Apr 06 08:22:03 2018 +0000
@@ -10,8 +10,10 @@
 #define LP 0.024
 #define LI 0.0
 #define LD 0.00000
-#define X_STOP_DIST 1.2
-#define Y_STOP_DIST 1.2
+#define X_STOP_DIST   1.2
+#define X_STOP_DIST_2 7.5
+#define X_STOP_DIST_3 4.0
+#define Y_STOP_DIST   1.2
 #define addr1 0x24
 #define addr2 0x10
 #define addr3 0x64
@@ -19,11 +21,14 @@
 
 #define koshi_uke_degree 152
 #define koshi_nage_degree 62
+#define koshi_red _nage_degree 62
+#define koshi_blue_nage_degree 62
+
 #define hiji_uke_degree 225
 #define hiji_tsukami_degree 230
 #define hiji_nage_degree 260
-#define hand_uke_degree 0.999
-#define hand_tsukami_degree 0.001
+#define hand_uke_degree 1.0
+#define hand_tsukami_degree 0.0
 
 
 #define STRAIGHT        1