group14 - k9
/
servo_test
servoding
main.cpp@0:952a13a3eb5c, 2015-10-02 (annotated)
- Committer:
- S1lverEagle
- Date:
- Fri Oct 02 12:50:45 2015 +0000
- Revision:
- 0:952a13a3eb5c
- Child:
- 1:c6e4257722b9
Eerste werkende versie
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
S1lverEagle | 0:952a13a3eb5c | 1 | #include "mbed.h" |
S1lverEagle | 0:952a13a3eb5c | 2 | |
S1lverEagle | 0:952a13a3eb5c | 3 | //servo ranges from .6ms to 2.7ms duty cycle in 20ms pwm period |
S1lverEagle | 0:952a13a3eb5c | 4 | |
S1lverEagle | 0:952a13a3eb5c | 5 | PwmOut servoPwm(D5); |
S1lverEagle | 0:952a13a3eb5c | 6 | DigitalIn button1(SW2); |
S1lverEagle | 0:952a13a3eb5c | 7 | DigitalIn button2(SW3); |
S1lverEagle | 0:952a13a3eb5c | 8 | |
S1lverEagle | 0:952a13a3eb5c | 9 | int main() |
S1lverEagle | 0:952a13a3eb5c | 10 | { |
S1lverEagle | 0:952a13a3eb5c | 11 | servoPwm.period(0.020); |
S1lverEagle | 0:952a13a3eb5c | 12 | while(1) { |
S1lverEagle | 0:952a13a3eb5c | 13 | if (button1 == 0) { |
S1lverEagle | 0:952a13a3eb5c | 14 | servoPwm.pulsewidth(0.0027); |
S1lverEagle | 0:952a13a3eb5c | 15 | } else if (button2 == 0) { |
S1lverEagle | 0:952a13a3eb5c | 16 | servoPwm.pulsewidth(0.0006); |
S1lverEagle | 0:952a13a3eb5c | 17 | } else { |
S1lverEagle | 0:952a13a3eb5c | 18 | servoPwm.pulsewidth(0.00165); |
S1lverEagle | 0:952a13a3eb5c | 19 | } |
S1lverEagle | 0:952a13a3eb5c | 20 | } |
S1lverEagle | 0:952a13a3eb5c | 21 | } |