![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
servo_test Nucleo-f303K8
Diff: main.cpp
- Revision:
- 1:2e6087aa66e3
- Parent:
- 0:7da591ec2935
diff -r 7da591ec2935 -r 2e6087aa66e3 main.cpp --- a/main.cpp Sat Mar 09 12:27:52 2019 +0000 +++ b/main.cpp Sat Nov 30 16:35:52 2019 +0000 @@ -1,34 +1,26 @@ #include "mbed.h" -//DigitalOut myled(LED1); -//DigitalIn sw(p11); -PwmOut servo1(PB_4); -PwmOut servo2(PB_5); -DigitalOut servo1_signal(PA_0); -DigitalOut servo2_signal(PA_1); -Serial pc(PA_2, PA_3); -bool sw_tf = true; +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(){ - pc.baud(38400); - wait(2.0); - pc.printf("Hello world\r\n"); - servo1_signal = 0; - servo2_signal = 0; while(1){ - wait(2); - servo2.pulsewidth(0.0015); - servo1.pulsewidth(0.0024); - pc.printf("1\r\n"); - wait(2); - servo2.pulsewidth(0.0024); - servo1.pulsewidth(0.0006); - pc.printf("2\r\n"); - wait(2); - servo2.pulsewidth(0.0006); - servo1.pulsewidth(0.0015); - pc.printf("3\r\n"); - - } - return 0; -} + 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; +} \ No newline at end of file