Robosub controller

Dependencies:   IMU MODSERIAL Servo mbed

Fork of RTOS_Controller by Marco Rubio

Revision:
3:5ffe7e9c0bb3
Parent:
2:aabc14a9a8c8
Child:
4:b37fd183e46a
--- a/main.cpp	Sat May 21 00:06:43 2016 +0000
+++ b/main.cpp	Mon Jul 04 18:56:23 2016 +0000
@@ -1,18 +1,13 @@
- // Continuously sweep the servo through it's full range
- #include "mbed.h"
- #include "Servo.h"
- 
- Servo myservo(led1);
- 
- int main() {
-     while(1) {
-         for(int i=0; i<100; i++) {
-             myservo = i/100.0;
-             wait(0.01);
-         }
-         for(int i=100; i>0; i--) {
-             myservo = i/100.0;
-             wait(0.01);
-         }
-     }
- }
\ No newline at end of file
+// Continuously sweep the servo through it's full range
+#include "mbed.h"
+#include "vessel.h"
+
+int main()
+{  
+    Vessel seagoat; //Starts the seagoat
+    seagoat.SetYawPID(1,1,1);    
+    seagoat.SetRollPID(1,1,1);    
+    seagoat.SetPitchPID(1,1,1);    
+    
+    while(1) {}
+}
\ No newline at end of file