Тлен / Mbed 2 deprecated ROVtest

Dependencies:   mbed

main.cpp

Committer:
spin7ion
Date:
2015-11-17
Revision:
4:0b614835f104
Parent:
3:c5a79dbed82b
Child:
5:d4e53f381e99

File content as of revision 4:0b614835f104:

#include "mbed.h"

PwmOut servo(PB_3);
PwmOut servo2(PB_4);

DigitalOut myled(LED1);

int main() {
    int servopulsewidth=1500;
    int signer=1;
    
    servo.period_us(20000);          // servo requires a 20ms period
    servo2.period_us(20000);          // servo requires a 20ms period
    servo.pulsewidth_us(servopulsewidth);
    servo2.pulsewidth_us(servopulsewidth);
    wait(2);
    while (1) {
        servopulsewidth+=signer;
        
        if(signer>0 && servopulsewidth>1990){
            signer=-1;
        }else if(signer<0 && servopulsewidth<10){
            signer=1;
        }
        servo.pulsewidth_us(servopulsewidth);
        servo2.pulsewidth_us(servopulsewidth);
        wait(0.05);
    }
}