albatross / Mbed 2 deprecated ControlYokutan2018

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

Dependencies:   Control_Yokutan_CANver1 XBusServo mbed mbed-rtos

Fork of ControlYokutan2017_2 by albatross

Diff: main.cpp

Branch:
mpu????????
Revision:
50:b3a8f8e88c50
Parent:
49:8522856fe0cd
Child:
51:eafff055a3f4
--- a/main.cpp	Wed Mar 29 04:37:27 2017 +0000
+++ b/main.cpp	Wed Mar 29 04:52:00 2017 +0000
@@ -235,7 +235,14 @@
 
 double calcPulse(float analog)
 {
-    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) {
@@ -259,7 +266,7 @@
     led2 =  1;
     if(EDstatePin) {
         eruronTrim = eruronAna.read();
-    eruronServo.pulsewidth(calcPulse(eruronTrim));
+        eruronServo.pulsewidth(calcPulse(eruronTrim));
     } else {
         drugTrim = drugAna.read();
         drugServo.pulsewidth(calcPulse(drugTrim));