Marco Rubio / Mbed 2 deprecated RTOS_Controller_v3

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   IMU MODSERIAL Servo mbed

Fork of RTOS_Controller_v2 by Andrew Olguin

main.cpp

Committer:
aolgu003
Date:
2016-07-29
Revision:
7:396fa2a8648d
Parent:
6:b45b74fd6a07
Child:
9:9aaa7f0c8960

File content as of revision 7:396fa2a8648d:

// Continuously sweep the servo through it's full range
#include "mbed.h"
#include "vessel.h"
//#include "MS5803.h"
//MS5803 big_sensor = MS5803(I2C_SDA, I2C_SCL, ms5803_addrCH);

int main()
{  
    Timer t;
    wait(3);
    Vessel seagoat; //Starts the seagoat
    seagoat.SetYawPID(1,0,0);  
    seagoat.SetRollPID(1,0,0);    
    seagoat.SetPitchPID(1,0,0);    
    seagoat.SetXPID(0,0,0);    
    seagoat.SetYPID(0,0,0);    
    seagoat.SetZPID(0,0,0);    
    
    t.start();
    while(t.read() < 4){
         seagoat.calibrate();
         
         //pc.printf("%f \n", t.read());
    }
    t.stop();
    pc.printf("Seagoat Ready to Go\n\r");
    //seagoat.motorTest();
    float depth = 0;
    while(1) {
        //seagoat.motorTest();
        seagoat.update();
        seagoat.updateCommand();
        wait(0.01);
    }
}