Testing of reflection sensor query
Dependencies: Test_motor mbed
Diff: main.cpp
- Revision:
- 0:fb7117213e54
diff -r 000000000000 -r fb7117213e54 main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue May 20 13:12:44 2014 +0000 @@ -0,0 +1,72 @@ +#include "mbed.h" +#include "m3pi_ng.h" + +DigitalOut myled(LED1); + +m3pi george; + +int main() { + + //MOTOR TEST + + //left motor test + for(int i = 0; i < 1000; ++i){ + george.left_motor(0.3); + } + george.stop(); + wait(3); + + for(int i = 0; i < 1000; ++i){ + george.left_motor(-0.3); + } + george.stop(); + wait(3); + + + //right motor test + for(int i = 0; i < 1000; ++i){ + george.right_motor(0.3); + } + george.stop(); + wait(3); + + for(int i = 0; i < 1000; ++i){ + george.right_motor(-0.3); + } + george.stop(); + wait(3); + //testing limits + + //left motor test + + for(int i = 0; i < 1000; ++i){ + george.left_motor(1); + } + george.stop(); + wait(3); + + for(int i = 0; i < 1000; ++i){ + george.left_motor(-1); + } + george.stop(); + wait(3); + + //right motor test + for(int i = 0; i < 1000; ++i){ + george.right_motor(1); + } + george.stop(); + wait(3); + + for(int i = 0; i < 1000; ++i){ + george.right_motor(-1); + } + george.stop(); + wait(3); + + for(int i = 0; i < 1000; ++i){ + george.right_motor(0); + } + george.stop(); + wait(3); +} \ No newline at end of file