EE149 / Mbed 2 deprecated FinalProject

Final Project files for mBed development.

Dependencies:   m3pi mbed

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?

UserRevisionLine numberNew 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 }