Diff: main.c

Revision:

8:12d780f7443e

Parent:

7:6e5cc24e1ce7

Child:

9:3a0433c391cb

--- a/main.c	Thu Nov 13 05:02:37 2014 +0000
+++ b/main.c	Thu Nov 13 07:12:31 2014 +0000
@@ -20,7 +20,6 @@
 DigitalOut  pin19(p19);
 DigitalOut  pin20(p20);
 
-
 /**
  * @brief Entry point. Main loop.
  */
@@ -39,3 +38,40 @@
     // Our code should NEVER reach this point. 
     return EXIT_FAILURE;
 }
+
+int forward(float amt, float spd)
+{
+    if(amt > 1) { spd = 1; }
+    pi.forward(spd);
+    wait(amt);
+    return EXIT_SUCCESS;
+}
+
+int backward(float amt, float spd)
+{
+    if(amt > 1) { spd = 1; }
+    pi.backward(spd);
+    wait(amt);
+    return EXIT_SUCCESS;
+}
+
+int right(float deg)
+{
+    pi.right(TURN_SPEED);
+    wait(deg/360);
+    return EXIT_SUCCESS;
+}
+
+int left(float deg)
+{
+    pi.left(TURN_SPEED);
+    wait(deg/360);
+    return EXIT_SUCCESS;
+}
+
+void pretty_print(char* msg)
+{
+    pi.locate(0,1);
+    pi.printf(msg);
+}
+