Controller for Seagoat in the RoboSub competition

Dependencies:   Servo mbed

Fork of ESC by Matteo Terruzzi

Revision:
4:b37fd183e46a
Parent:
3:5ffe7e9c0bb3
Child:
5:07bbe020eb65
--- a/main.cpp	Mon Jul 04 18:56:23 2016 +0000
+++ b/main.cpp	Sat Jul 09 20:41:49 2016 +0000
@@ -5,9 +5,12 @@
 int main()
 {  
     Vessel seagoat; //Starts the seagoat
-    seagoat.SetYawPID(1,1,1);    
-    seagoat.SetRollPID(1,1,1);    
-    seagoat.SetPitchPID(1,1,1);    
+    seagoat.SetYawPID(1,0,0);    
+    seagoat.SetRollPID(1,0,0);    
+    seagoat.SetPitchPID(1,0,0);    
     
-    while(1) {}
+    while(1) {
+        seagoat.update();
+        wait(0.1);
+    }
 }
\ No newline at end of file