Crude navigation

Dependencies:   GPS2 L3GD20 LSM303DLHC2 PID mbed SDFileSystem

Fork of GPSNavigation by David Spillman

Revision:
8:c77ab7615b21
Parent:
5:40ac894e0fa7
Child:
12:273479524c71
--- a/navigation.h	Tue Apr 07 03:49:50 2015 +0000
+++ b/navigation.h	Mon Apr 27 16:49:48 2015 +0000
@@ -1,27 +1,22 @@
-/**************************************************************************************************************************************************************
+/*************************************************************************************************************************************************************/
 //  Created by: Ryan Spillman
 //
-//  Last updated 4/4/2015
+//  Last updated 4/9/2015
 //
 //  Contains function that outputs difference in compass heading(magHead) and heading required(calcHead)
-//  Also contains functions for controlling L298n H-bridge
-**************************************************************************************************************************************************************/
+/*************************************************************************************************************************************************************/
 
 #define navigation_h
 
 //Tolerance for heading actual and heading needed
 #define HEADDIFF 0.000000000000000000f
 
-//L298n connections
-DigitalOut pinI1(D10);
-DigitalOut pinI2(D11);
-DigitalOut pinI3(D12);
-DigitalOut pinI4(D13);
-PwmOut ENA(D6);    //Left
-PwmOut ENB(D7);    //Right
-
-//Outputs difference in compass heading(magHead) and heading required(calcHead)
-//negative is left and positive is right
+/*************************************************************************************************************************************************************/
+//                                                      whichWay
+//
+//  Outputs difference in compass heading(magHead) and heading required(calcHead)
+//  negative is left and positive is right
+/*************************************************************************************************************************************************************/
 float whichWay(float magHead, float calcHead)
 {
     float magDiff;
@@ -152,53 +147,3 @@
     }
     return 0;
 }
-
-void goStop(float valueOne, float valueTwo)
-{
-    pinI1 = 0;
-    pinI2 = 0;
-    pinI3 = 0;
-    pinI4 = 0;
-    ENA =  valueOne;
-    ENB = valueTwo;
-}
-
-void goForward(float valueOne, float valueTwo)
-{
-    pinI1 = 1;
-    pinI2 = 0;
-    pinI3 = 0;
-    pinI4 = 1;
-    ENA =  valueOne;
-    ENB = valueTwo;
-}
-
-void goBackward(float valueOne, float valueTwo)
-{
-    pinI1 = 0;
-    pinI2 = 1;
-    pinI3 = 1;
-    pinI4 = 0;
-    ENA =  valueOne;
-    ENB = valueTwo;
-}
-
-void goLeft(float valueOne, float valueTwo)
-{
-    pinI1 = 0;
-    pinI2 = 1;
-    pinI3 = 0;
-    pinI4 = 1;
-    ENA =  valueOne;
-    ENB = valueTwo;
-}
-
-void goRight(float valueOne, float valueTwo)
-{
-    pinI1 = 1;
-    pinI2 = 0;
-    pinI3 = 1;
-    pinI4 = 0;
-    ENA =  valueOne;
-    ENB = valueTwo;
-}