servo_test Nucleo-f303K8

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include "mbed.h"
00002 
00003 DigitalOut myled(LED1);
00004 PwmOut     servo_DOWN(p21);
00005 PwmOut     servo_UP(p25);
00006 DigitalIn  signal(p30);
00007 
00008 #define ROCK_DOWN 0.0015
00009 #define OPEN_DOWN 0.0024
00010 
00011 #define ROCK_UP 0.0015
00012 #define OPEN_UP 0.0006
00013 
00014 int main(){
00015     while(1){
00016         servo_DOWN.pulsewidth(ROCK_DOWN);
00017         servo_UP.pulsewidth(ROCK_UP);
00018         while(signal == 1){
00019             servo_DOWN.pulsewidth(OPEN_DOWN);
00020             servo_UP.pulsewidth(OPEN_UP);
00021             myled = 1;
00022         }
00023         myled = 0;
00024     }
00025     return 0;
00026 }