Final Project files for mBed development.

Dependencies:   m3pi mbed

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?

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"
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 }