3m
Dependencies: mbed
Fork of hudo by
main.cpp@1:28852d0667a9, 2016-11-23 (annotated)
- 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?
User | Revision | Line number | New 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 | } |