EE149
/
FinalProject
Final Project files for mBed development.
control.c@5:01882c3de2dc, 2014-11-12 (annotated)
- Committer:
- John Wilkey
- Date:
- Wed Nov 12 23:48:26 2014 -0500
- Revision:
- 5:01882c3de2dc
- Parent:
- 4:13c13a098d2b
- Child:
- 6:00b7198f0b51
Small additions to skeleton code
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" |
John Wilkey |
5:01882c3de2dc | 8 | extern pi; |
John Wilkey |
5:01882c3de2dc | 9 | extern out_pins; |
John Wilkey |
5:01882c3de2dc | 10 | |
John Wilkey |
5:01882c3de2dc | 11 | int forward(float amt, float spd) |
John Wilkey |
5:01882c3de2dc | 12 | { |
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 |
5:01882c3de2dc | 20 | pi.backward(spd); |
John Wilkey |
5:01882c3de2dc | 21 | wait(amt); |
John Wilkey |
5:01882c3de2dc | 22 | return EXIT_SUCCESS; |
John Wilkey |
5:01882c3de2dc | 23 | } |
John Wilkey |
5:01882c3de2dc | 24 | |
John Wilkey |
5:01882c3de2dc | 25 | int right(float deg) |
John Wilkey |
5:01882c3de2dc | 26 | { |
John Wilkey |
5:01882c3de2dc | 27 | pi.right(TURN_SPEED); |
John Wilkey |
5:01882c3de2dc | 28 | wait(deg/360); |
John Wilkey |
5:01882c3de2dc | 29 | return EXIT_SUCCESS; |
John Wilkey |
5:01882c3de2dc | 30 | } |
John Wilkey |
5:01882c3de2dc | 31 | |
John Wilkey |
5:01882c3de2dc | 32 | int left(float deg) |
John Wilkey |
5:01882c3de2dc | 33 | { |
John Wilkey |
5:01882c3de2dc | 34 | pi.left(TURN_SPEED); |
John Wilkey |
5:01882c3de2dc | 35 | wait(deg/360); |
John Wilkey |
5:01882c3de2dc | 36 | return EXIT_SUCCESS; |
John Wilkey |
5:01882c3de2dc | 37 | } |
John Wilkey |
5:01882c3de2dc | 38 | |
John Wilkey |
5:01882c3de2dc | 39 | void pretty_print(char* msg) |
John Wilkey |
5:01882c3de2dc | 40 | { |
John Wilkey |
5:01882c3de2dc | 41 | pi.locate(0,1); |
John Wilkey |
5:01882c3de2dc | 42 | pi.printf(msg); |
John Wilkey |
5:01882c3de2dc | 43 | } |