servo_test Nucleo-f303K8

Dependencies:   mbed

main.cpp

Committer:
sashida_h
Date:
2019-11-30
Revision:
1:2e6087aa66e3
Parent:
0:7da591ec2935

File content as of revision 1:2e6087aa66e3:

#include "mbed.h"

DigitalOut myled(LED1);
PwmOut     servo_DOWN(p21);
PwmOut     servo_UP(p25);
DigitalIn  signal(p30);

#define ROCK_DOWN 0.0015
#define OPEN_DOWN 0.0024

#define ROCK_UP 0.0015
#define OPEN_UP 0.0006

int main(){
    while(1){
        servo_DOWN.pulsewidth(ROCK_DOWN);
        servo_UP.pulsewidth(ROCK_UP);
        while(signal == 1){
            servo_DOWN.pulsewidth(OPEN_DOWN);
            servo_UP.pulsewidth(OPEN_UP);
            myled = 1;
        }
        myled = 0;
    }
    return 0;
}