albatross / Mbed 2 deprecated hudo3m

3m

Dependencies:   mbed

Fork of hudo by albatross

main.cpp@2:e1b3f635701b, 2016-11-23 (annotated)

Committer:
tsumagari
Date:
Wed Nov 23 11:31:48 2016 +0000
Revision:
2:e1b3f635701b
Parent:
1:28852d0667a9 
???????????????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
YusukeWakuta 0:a15561fab2ac 1 #include "mbed.h"
YusukeWakuta 0:a15561fab2ac 2
YusukeWakuta 1:28852d0667a9 3 #define SERVODEG 0.0
YusukeWakuta 1:28852d0667a9 4 #define MaxDeg 25.0
YusukeWakuta 0:a15561fab2ac 5
YusukeWakuta 0:a15561fab2ac 6 PwmOut servo(p21);
tsumagari 2:e1b3f635701b 7 AnalogIn input(p20);
tsumagari 2:e1b3f635701b 8 double bairitu;
YusukeWakuta 0:a15561fab2ac 9
YusukeWakuta 0:a15561fab2ac 10 double calcPulse(int deg){
YusukeWakuta 0:a15561fab2ac 11 return (0.0006+(deg/180.0)*(0.00235-0.00045));
YusukeWakuta 0:a15561fab2ac 12 }
YusukeWakuta 0:a15561fab2ac 13
YusukeWakuta 0:a15561fab2ac 14 int main() {
YusukeWakuta 0:a15561fab2ac 15 while(1){
tsumagari 2:e1b3f635701b 16 bairitu = (input-0.5)*2;
tsumagari 2:e1b3f635701b 17 servo.pulsewidth(calcPulse(71.0 + SERVODEG + bairitu*MaxDeg));//calcPulse = 90の時がニュートラル
tsumagari 2:e1b3f635701b 18 wait(0.1);
YusukeWakuta 0:a15561fab2ac 19 }
YusukeWakuta 0:a15561fab2ac 20 }