Haruki Sashida
/
servo_test
servo_test Nucleo-f303K8
main.cpp@0:7da591ec2935, 2019-03-09 (annotated)
- Committer:
- sashida_h
- Date:
- Sat Mar 09 12:27:52 2019 +0000
- Revision:
- 0:7da591ec2935
- Child:
- 1:2e6087aa66e3
2019_0309;
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 | 0:7da591ec2935 | 3 | //DigitalOut myled(LED1); |
sashida_h | 0:7da591ec2935 | 4 | //DigitalIn sw(p11); |
sashida_h | 0:7da591ec2935 | 5 | PwmOut servo1(PB_4); |
sashida_h | 0:7da591ec2935 | 6 | PwmOut servo2(PB_5); |
sashida_h | 0:7da591ec2935 | 7 | DigitalOut servo1_signal(PA_0); |
sashida_h | 0:7da591ec2935 | 8 | DigitalOut servo2_signal(PA_1); |
sashida_h | 0:7da591ec2935 | 9 | Serial pc(PA_2, PA_3); |
sashida_h | 0:7da591ec2935 | 10 | bool sw_tf = true; |
sashida_h | 0:7da591ec2935 | 11 | |
sashida_h | 0:7da591ec2935 | 12 | int main(){ |
sashida_h | 0:7da591ec2935 | 13 | pc.baud(38400); |
sashida_h | 0:7da591ec2935 | 14 | wait(2.0); |
sashida_h | 0:7da591ec2935 | 15 | pc.printf("Hello world\r\n"); |
sashida_h | 0:7da591ec2935 | 16 | servo1_signal = 0; |
sashida_h | 0:7da591ec2935 | 17 | servo2_signal = 0; |
sashida_h | 0:7da591ec2935 | 18 | while(1){ |
sashida_h | 0:7da591ec2935 | 19 | wait(2); |
sashida_h | 0:7da591ec2935 | 20 | servo2.pulsewidth(0.0015); |
sashida_h | 0:7da591ec2935 | 21 | servo1.pulsewidth(0.0024); |
sashida_h | 0:7da591ec2935 | 22 | pc.printf("1\r\n"); |
sashida_h | 0:7da591ec2935 | 23 | wait(2); |
sashida_h | 0:7da591ec2935 | 24 | servo2.pulsewidth(0.0024); |
sashida_h | 0:7da591ec2935 | 25 | servo1.pulsewidth(0.0006); |
sashida_h | 0:7da591ec2935 | 26 | pc.printf("2\r\n"); |
sashida_h | 0:7da591ec2935 | 27 | wait(2); |
sashida_h | 0:7da591ec2935 | 28 | servo2.pulsewidth(0.0006); |
sashida_h | 0:7da591ec2935 | 29 | servo1.pulsewidth(0.0015); |
sashida_h | 0:7da591ec2935 | 30 | pc.printf("3\r\n"); |
sashida_h | 0:7da591ec2935 | 31 | |
sashida_h | 0:7da591ec2935 | 32 | } |
sashida_h | 0:7da591ec2935 | 33 | return 0; |
sashida_h | 0:7da591ec2935 | 34 | } |