Haruki Sashida
/
servo_test
servo_test Nucleo-f303K8
Revision 1:2e6087aa66e3, committed 2019-11-30
- Comitter:
- sashida_h
- Date:
- Sat Nov 30 16:35:52 2019 +0000
- Parent:
- 0:7da591ec2935
- Commit message:
- first commit
Changed in this revision
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
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