test servo

Dependencies:   mbed

main.cpp

Committer:
hayashiisme
Date:
2014-01-14
Revision:
0:6d8bbd43c8e8

File content as of revision 0:6d8bbd43c8e8:

#include "mbed.h"

PwmOut servo1(p21);
PwmOut servo2(p22);

#define waitsec 0.04
#define start 900
#define end 190

int main(){
    servo1.period_ms(20);          // servo requires a 20ms period
    servo2.period_ms(20);          // servo requires a 20ms period
    for(int i=0; i < 5; i++){
        for(int i = start; i < end; i += 10) {
            servo1.pulsewidth_us(i); // servo position determined by a pulsewidth between 1-2ms
            servo2.pulsewidth_us(i); // servo position determined by a pulsewidth between 1-2ms
            wait(waitsec);
        }
        for(int i = end; i > start; i -= 10) {
            servo1.pulsewidth_us(i); // servo position determined by a pulsewidth between 1-2ms
            servo2.pulsewidth_us(i); // servo position determined by a pulsewidth between 1-2ms
            wait(waitsec);
        }
    }
}