3m

Dependencies:   mbed

Fork of hudo by albatross

Committer:
YusukeWakuta
Date:
Wed Nov 23 07:53:46 2016 +0000
Revision:
1:28852d0667a9
Parent:
0:a15561fab2ac
Child:
2:e1b3f635701b
3m;

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);
YusukeWakuta 0:a15561fab2ac 7
YusukeWakuta 0:a15561fab2ac 8 double calcPulse(int deg){
YusukeWakuta 0:a15561fab2ac 9 return (0.0006+(deg/180.0)*(0.00235-0.00045));
YusukeWakuta 0:a15561fab2ac 10 }
YusukeWakuta 0:a15561fab2ac 11
YusukeWakuta 0:a15561fab2ac 12 int main() {
YusukeWakuta 0:a15561fab2ac 13 while(1){
YusukeWakuta 1:28852d0667a9 14 servo.pulsewidth(calcPulse(71.0 + SERVODEG - MaxDeg));//calcPulse = 90の時がニュートラル
YusukeWakuta 0:a15561fab2ac 15 wait(1);
YusukeWakuta 0:a15561fab2ac 16 }
YusukeWakuta 0:a15561fab2ac 17 }