Haruki Sashida
/
servo_test
servo_test Nucleo-f303K8
main.cpp@1:2e6087aa66e3, 2019-11-30 (annotated)
- Committer:
- sashida_h
- Date:
- Sat Nov 30 16:35:52 2019 +0000
- Revision:
- 1:2e6087aa66e3
- Parent:
- 0:7da591ec2935
first commit
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
sashida_h | 0:7da591ec2935 | 1 | #include "mbed.h" |
sashida_h | 0:7da591ec2935 | 2 | |
sashida_h | 1:2e6087aa66e3 | 3 | DigitalOut myled(LED1); |
sashida_h | 1:2e6087aa66e3 | 4 | PwmOut servo_DOWN(p21); |
sashida_h | 1:2e6087aa66e3 | 5 | PwmOut servo_UP(p25); |
sashida_h | 1:2e6087aa66e3 | 6 | DigitalIn signal(p30); |
sashida_h | 1:2e6087aa66e3 | 7 | |
sashida_h | 1:2e6087aa66e3 | 8 | #define ROCK_DOWN 0.0015 |
sashida_h | 1:2e6087aa66e3 | 9 | #define OPEN_DOWN 0.0024 |
sashida_h | 1:2e6087aa66e3 | 10 | |
sashida_h | 1:2e6087aa66e3 | 11 | #define ROCK_UP 0.0015 |
sashida_h | 1:2e6087aa66e3 | 12 | #define OPEN_UP 0.0006 |
sashida_h | 0:7da591ec2935 | 13 | |
sashida_h | 0:7da591ec2935 | 14 | int main(){ |
sashida_h | 0:7da591ec2935 | 15 | while(1){ |
sashida_h | 1:2e6087aa66e3 | 16 | servo_DOWN.pulsewidth(ROCK_DOWN); |
sashida_h | 1:2e6087aa66e3 | 17 | servo_UP.pulsewidth(ROCK_UP); |
sashida_h | 1:2e6087aa66e3 | 18 | while(signal == 1){ |
sashida_h | 1:2e6087aa66e3 | 19 | servo_DOWN.pulsewidth(OPEN_DOWN); |
sashida_h | 1:2e6087aa66e3 | 20 | servo_UP.pulsewidth(OPEN_UP); |
sashida_h | 1:2e6087aa66e3 | 21 | myled = 1; |
sashida_h | 1:2e6087aa66e3 | 22 | } |
sashida_h | 1:2e6087aa66e3 | 23 | myled = 0; |
sashida_h | 1:2e6087aa66e3 | 24 | } |
sashida_h | 1:2e6087aa66e3 | 25 | return 0; |
sashida_h | 1:2e6087aa66e3 | 26 | } |