3/18 翼端操舵

Dependencies:   ADXL345_I2C Control_Yokutan_CANver1 mbed

Fork of ControlYokutan02 by albatross

Revision:
15:1db5ee4fe7ce
Parent:
14:1f6dd929d7de
Child:
16:82310bf7c326
--- a/main.cpp	Sat Feb 27 11:36:09 2016 +0000
+++ b/main.cpp	Mon Mar 07 13:43:18 2016 +0000
@@ -11,15 +11,15 @@
 #define ADXL_MEAN_NUM 10
 #define SEND_DATAS_LOOP_TIME 0.1
 
-#define ERURON_MOVE_DEG_INI_R 55
+#define ERURON_MOVE_DEG_INI_R -12
 #define DRUG_MOVE_DEG_INI_R 96
-#define ERURON_TRIM_INI_R 41
+#define ERURON_TRIM_INI_R 99
 #define DRUG_TRIM_INI_R 3
 
-#define ERURON_MOVE_DEG_INI_L 29
+#define ERURON_MOVE_DEG_INI_L 12
 #define DRUG_MOVE_DEG_INI_L 87
-#define ERURON_TRIM_INI_L 79
-#define DRUG_TRIM_INI_L 92
+#define ERURON_TRIM_INI_L 101
+#define DRUG_TRIM_INI_L 12
 
 CAN can(p30,p29);
 CANMessage recmsg;
@@ -95,7 +95,7 @@
 }
 
 void init(){
-    if(LRstatePin){
+    if(!LRstatePin){
         eruronTrim = ERURON_TRIM_INI_L;
         drugTrim = DRUG_TRIM_INI_L;
         eruronMoveDeg = ERURON_MOVE_DEG_INI_L;