伊藤 百花
/
servos_test
Hoooooooooo!!!!!!!!!!!!!!!!!!!!!!!!!!!
main.cpp@0:2ef155ddb58d, 2020-03-17 (annotated)
- Committer:
- momoka0419
- Date:
- Tue Mar 17 13:55:49 2020 +0000
- Revision:
- 0:2ef155ddb58d
heeeeeeeeeeeeeeeeeeeeeeeey!!!!!!!!!!!!!!!!!!!
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
momoka0419 | 0:2ef155ddb58d | 1 | #include "mbed.h" |
momoka0419 | 0:2ef155ddb58d | 2 | |
momoka0419 | 0:2ef155ddb58d | 3 | PwmOut servo90(p23); //サーボSG90 |
momoka0419 | 0:2ef155ddb58d | 4 | PwmOut servo92(p24); //サーボSR92 |
momoka0419 | 0:2ef155ddb58d | 5 | |
momoka0419 | 0:2ef155ddb58d | 6 | int main() { |
momoka0419 | 0:2ef155ddb58d | 7 | servo92.period_ms(20); |
momoka0419 | 0:2ef155ddb58d | 8 | servo90.period_ms(20); |
momoka0419 | 0:2ef155ddb58d | 9 | wait(1); |
momoka0419 | 0:2ef155ddb58d | 10 | float ang = 1000; |
momoka0419 | 0:2ef155ddb58d | 11 | float kaku = 1300; |
momoka0419 | 0:2ef155ddb58d | 12 | while(1) { |
momoka0419 | 0:2ef155ddb58d | 13 | |
momoka0419 | 0:2ef155ddb58d | 14 | for(ang = 1000; ang <= 1900; ang += 1){ |
momoka0419 | 0:2ef155ddb58d | 15 | servo92.pulsewidth_us(ang); |
momoka0419 | 0:2ef155ddb58d | 16 | wait(0.001); // 1 ms |
momoka0419 | 0:2ef155ddb58d | 17 | } |
momoka0419 | 0:2ef155ddb58d | 18 | |
momoka0419 | 0:2ef155ddb58d | 19 | for(kaku = 1300; kaku <= 1600; kaku += 1){ |
momoka0419 | 0:2ef155ddb58d | 20 | servo90.pulsewidth_us(kaku); |
momoka0419 | 0:2ef155ddb58d | 21 | wait(0.001); // 1 ms |
momoka0419 | 0:2ef155ddb58d | 22 | } |
momoka0419 | 0:2ef155ddb58d | 23 | |
momoka0419 | 0:2ef155ddb58d | 24 | for(ang = 1900; ang >= 1000; ang -= 1){ |
momoka0419 | 0:2ef155ddb58d | 25 | servo92.pulsewidth_us(ang); |
momoka0419 | 0:2ef155ddb58d | 26 | wait(0.001); // 1 ms |
momoka0419 | 0:2ef155ddb58d | 27 | } |
momoka0419 | 0:2ef155ddb58d | 28 | |
momoka0419 | 0:2ef155ddb58d | 29 | for(kaku = 1600; kaku >= 1300; kaku -= 1){ |
momoka0419 | 0:2ef155ddb58d | 30 | servo90.pulsewidth_us(kaku); |
momoka0419 | 0:2ef155ddb58d | 31 | wait(0.001); // 1 ms |
momoka0419 | 0:2ef155ddb58d | 32 | } |
momoka0419 | 0:2ef155ddb58d | 33 | } |
momoka0419 | 0:2ef155ddb58d | 34 | } |