EE149
/
FinalProject
Final Project files for mBed development.
control.c@7:6e5cc24e1ce7, 2014-11-13 (annotated)
- Committer:
- lsaristo
- Date:
- Thu Nov 13 05:02:37 2014 +0000
- Revision:
- 7:6e5cc24e1ce7
- Parent:
- 6:00b7198f0b51
Fixed bugs from previous changes
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
lsaristo | 4:13c13a098d2b | 1 | /** |
lsaristo | 4:13c13a098d2b | 2 | * @file control.c |
John Wilkey |
5:01882c3de2dc | 3 | * @brief Motor control functions implemented from project.h |
John Wilkey |
5:01882c3de2dc | 4 | * @author John Wilkey |
John Wilkey |
5:01882c3de2dc | 5 | */ |
John Wilkey |
5:01882c3de2dc | 6 | |
John Wilkey |
5:01882c3de2dc | 7 | #include "project.h" |
lsaristo | 7:6e5cc24e1ce7 | 8 | extern m3pi pi; |
John Wilkey |
5:01882c3de2dc | 9 | |
John Wilkey |
5:01882c3de2dc | 10 | int forward(float amt, float spd) |
John Wilkey |
5:01882c3de2dc | 11 | { |
John Wilkey |
6:00b7198f0b51 | 12 | if(amt > 1) { spd = 1; } |
John Wilkey |
5:01882c3de2dc | 13 | pi.forward(spd); |
John Wilkey |
5:01882c3de2dc | 14 | wait(amt); |
John Wilkey |
5:01882c3de2dc | 15 | return EXIT_SUCCESS; |
John Wilkey |
5:01882c3de2dc | 16 | } |
John Wilkey |
5:01882c3de2dc | 17 | |
John Wilkey |
5:01882c3de2dc | 18 | int backward(float amt, float spd) |
John Wilkey |
5:01882c3de2dc | 19 | { |
John Wilkey |
6:00b7198f0b51 | 20 | if(amt > 1) { spd = 1; } |
John Wilkey |
5:01882c3de2dc | 21 | pi.backward(spd); |
John Wilkey |
5:01882c3de2dc | 22 | wait(amt); |
John Wilkey |
5:01882c3de2dc | 23 | return EXIT_SUCCESS; |
John Wilkey |
5:01882c3de2dc | 24 | } |
John Wilkey |
5:01882c3de2dc | 25 | |
John Wilkey |
5:01882c3de2dc | 26 | int right(float deg) |
John Wilkey |
5:01882c3de2dc | 27 | { |
John Wilkey |
5:01882c3de2dc | 28 | pi.right(TURN_SPEED); |
John Wilkey |
5:01882c3de2dc | 29 | wait(deg/360); |
John Wilkey |
5:01882c3de2dc | 30 | return EXIT_SUCCESS; |
John Wilkey |
5:01882c3de2dc | 31 | } |
John Wilkey |
5:01882c3de2dc | 32 | |
John Wilkey |
5:01882c3de2dc | 33 | int left(float deg) |
John Wilkey |
5:01882c3de2dc | 34 | { |
John Wilkey |
5:01882c3de2dc | 35 | pi.left(TURN_SPEED); |
John Wilkey |
5:01882c3de2dc | 36 | wait(deg/360); |
John Wilkey |
5:01882c3de2dc | 37 | return EXIT_SUCCESS; |
John Wilkey |
5:01882c3de2dc | 38 | } |
John Wilkey |
5:01882c3de2dc | 39 | |
John Wilkey |
5:01882c3de2dc | 40 | void pretty_print(char* msg) |
John Wilkey |
5:01882c3de2dc | 41 | { |
John Wilkey |
5:01882c3de2dc | 42 | pi.locate(0,1); |
John Wilkey |
5:01882c3de2dc | 43 | pi.printf(msg); |
John Wilkey |
5:01882c3de2dc | 44 | } |