2018年度用翼端mbedプログラム
Dependencies: Control_Yokutan_CANver1 XBusServo mbed mbed-rtos
Fork of ControlYokutan2017_2 by
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));