Robosub controller

Dependencies:   IMU MODSERIAL Servo mbed

Fork of RTOS_Controller by Marco Rubio

main.cpp

Committer:
gelmes
Date:
2016-07-09
Revision:
4:b37fd183e46a
Parent:
3:5ffe7e9c0bb3
Child:
5:07bbe020eb65

File content as of revision 4:b37fd183e46a:

// 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,0,0);    
    seagoat.SetRollPID(1,0,0);    
    seagoat.SetPitchPID(1,0,0);    
    
    while(1) {
        seagoat.update();
        wait(0.1);
    }
}