2018年度用翼端mbedプログラム

Dependencies:   Control_Yokutan_CANver1 XBusServo mbed mbed-rtos

Fork of ControlYokutan2017_2 by albatross

Branch:
mpu????????
Revision:
53:3eeaafa49707
Parent:
51:eafff055a3f4
Child:
54:113656a959b7
--- a/main.cpp	Fri Mar 31 08:08:37 2017 +0000
+++ b/main.cpp	Fri Mar 31 13:45:21 2017 +0000
@@ -17,17 +17,17 @@
 #define MPU_DELT_MIN 250
 
 #define ERURON_MOVE_DEG_INI_R 0.45
-#define DRUG_MOVE_DEG_INI_R -0.07
+#define DRUG_MOVE_DEG_INI_R 0.49
 #define ERURON_TRIM_INI_R 0.41
-#define DRUG_TRIM_INI_R 0.62
+#define DRUG_TRIM_INI_R 0.37
 
-#define ERURON_MOVE_DEG_INI_L 0.35
-#define DRUG_MOVE_DEG_INI_L -0.10
-#define ERURON_TRIM_INI_L 0.4
+#define ERURON_MOVE_DEG_INI_L 0.45
+#define DRUG_MOVE_DEG_INI_L -0.44
+#define ERURON_TRIM_INI_L 0.48  // 値をお大きいくすると頭上げ
 #define DRUG_TRIM_INI_L 0.68//値を小さくすると開く側
 
-#define PHASE_NUM 13.0 //奇数にしてください。そしてメインコードと必ず同じ値にしてください
-#define NEUTRAL_PHASE 7.0
+#define PHASE_NUM 15.0 //奇数にしてください。そしてメインコードと必ず同じ値にしてください
+#define NEUTRAL_PHASE 8.0
 
 /*ドラッグラダー
 初期値 0.65
@@ -236,14 +236,15 @@
 
 double calcPulse(float analog)
 {
-    double min = 0.0006;
-    double max = 0.00240;
-    if(analog >= max)
-        analog = max;
-    else if(analog <= min)
-        analog = min;
-        
-    return (min+(analog)*(max-min));
+    return (0.0006 + (analog)*(0.00240-0.00060) );
+//    double min = 0.0006;
+//    double max = 0.00240;
+//    if(analog >= max)
+//        analog = max;
+//    else if(analog <= min)
+//        analog = min;
+//        
+//    return (min+(analog)*(max-min));
     /*
         int start=510, end=2390;
     while(1) {