Crude navigation

Dependencies:   GPS L3GD20 LSM303DLHC mbed PID

Revision:
0:e79311aae7ed
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/move.h	Sat Feb 21 01:14:46 2015 +0000
@@ -0,0 +1,57 @@
+//L298n connections
+DigitalOut pinI1(D5);
+DigitalOut pinI2(D6);
+DigitalOut pinI3(D10);
+DigitalOut pinI4(D11);
+PwmOut ENA(D12);    //Left
+PwmOut ENB(D13);    //Right
+
+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;
+}