ikarashi kunn----- nya---
Dependencies: MotorDriverController mbed
main.cpp@0:0c5a2df4bdb6, 2017-07-13 (annotated)
- Committer:
- WAT34
- Date:
- Thu Jul 13 10:03:43 2017 +0000
- Revision:
- 0:0c5a2df4bdb6
move????;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
WAT34 | 0:0c5a2df4bdb6 | 1 | #include "mbed.h" |
WAT34 | 0:0c5a2df4bdb6 | 2 | #include "MotorDriverController.h" |
WAT34 | 0:0c5a2df4bdb6 | 3 | #include "constants.h" |
WAT34 | 0:0c5a2df4bdb6 | 4 | |
WAT34 | 0:0c5a2df4bdb6 | 5 | MDC motors[4]; |
WAT34 | 0:0c5a2df4bdb6 | 6 | |
WAT34 | 0:0c5a2df4bdb6 | 7 | int main() { |
WAT34 | 0:0c5a2df4bdb6 | 8 | for(int i = 0; i < 4;i++) |
WAT34 | 0:0c5a2df4bdb6 | 9 | { |
WAT34 | 0:0c5a2df4bdb6 | 10 | motors[i].setAddr(0,i); |
WAT34 | 0:0c5a2df4bdb6 | 11 | } |
WAT34 | 0:0c5a2df4bdb6 | 12 | while(true) { |
WAT34 | 0:0c5a2df4bdb6 | 13 | motors[0].write(0.7); |
WAT34 | 0:0c5a2df4bdb6 | 14 | motors[1].write(-0.7); |
WAT34 | 0:0c5a2df4bdb6 | 15 | motors[2].write(0); |
WAT34 | 0:0c5a2df4bdb6 | 16 | motors[3].write(0); |
WAT34 | 0:0c5a2df4bdb6 | 17 | |
WAT34 | 0:0c5a2df4bdb6 | 18 | wait(2); |
WAT34 | 0:0c5a2df4bdb6 | 19 | motors[0].write(0); |
WAT34 | 0:0c5a2df4bdb6 | 20 | motors[1].write(0); |
WAT34 | 0:0c5a2df4bdb6 | 21 | motors[2].write(0.7); |
WAT34 | 0:0c5a2df4bdb6 | 22 | motors[3].write(-0.7); |
WAT34 | 0:0c5a2df4bdb6 | 23 | |
WAT34 | 0:0c5a2df4bdb6 | 24 | wait(2); |
WAT34 | 0:0c5a2df4bdb6 | 25 | motors[0].write(0.7); |
WAT34 | 0:0c5a2df4bdb6 | 26 | motors[1].write(0.7); |
WAT34 | 0:0c5a2df4bdb6 | 27 | motors[2].write(0.7); |
WAT34 | 0:0c5a2df4bdb6 | 28 | motors[3].write(0.7); |
WAT34 | 0:0c5a2df4bdb6 | 29 | wait(2); |
WAT34 | 0:0c5a2df4bdb6 | 30 | |
WAT34 | 0:0c5a2df4bdb6 | 31 | motors[0].write(-0.7); |
WAT34 | 0:0c5a2df4bdb6 | 32 | motors[1].write(-0.7); |
WAT34 | 0:0c5a2df4bdb6 | 33 | motors[2].write(-0.7); |
WAT34 | 0:0c5a2df4bdb6 | 34 | motors[3].write(-0.7); |
WAT34 | 0:0c5a2df4bdb6 | 35 | wait(2); |
WAT34 | 0:0c5a2df4bdb6 | 36 | } |
WAT34 | 0:0c5a2df4bdb6 | 37 | } |