Andrew Olguin / Mbed 2 deprecated RTOS_Controller_v2

Robosub controller

Dependencies:   IMU MODSERIAL Servo mbed

Fork of RTOS_Controller by Marco Rubio

main.cpp@6:b45b74fd6a07, 2016-07-27 (annotated)

Committer:
aolgu003
Date:
Wed Jul 27 02:45:45 2016 +0000
Revision:
6:b45b74fd6a07
Parent:
5:07bbe020eb65
Child:
7:396fa2a8648d
Added command parsing

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gelmes 3:5ffe7e9c0bb3 1 // Continuously sweep the servo through it's full range
gelmes 3:5ffe7e9c0bb3 2 #include "mbed.h"
gelmes 3:5ffe7e9c0bb3 3 #include "vessel.h"
gelmes 3:5ffe7e9c0bb3 4
aolgu003 6:b45b74fd6a07 5
gelmes 3:5ffe7e9c0bb3 6 int main()
gelmes 3:5ffe7e9c0bb3 7 {
gelmes 5:07bbe020eb65 8 Timer t;
gelmes 5:07bbe020eb65 9 wait(3);
gelmes 3:5ffe7e9c0bb3 10 Vessel seagoat; //Starts the seagoat
gelmes 5:07bbe020eb65 11 seagoat.SetYawPID(4,0,0);
gelmes 5:07bbe020eb65 12 seagoat.SetRollPID(4,0,0);
gelmes 5:07bbe020eb65 13 seagoat.SetPitchPID(4,0,0);
gelmes 5:07bbe020eb65 14 seagoat.SetXPID(0,0,0);
gelmes 5:07bbe020eb65 15 seagoat.SetYPID(0,0,0);
gelmes 5:07bbe020eb65 16 seagoat.SetZPID(0,0,0);
gelmes 5:07bbe020eb65 17
gelmes 5:07bbe020eb65 18 t.start();
gelmes 5:07bbe020eb65 19 while(t.read() < 5){
gelmes 5:07bbe020eb65 20 seagoat.calibrate();
gelmes 5:07bbe020eb65 21
gelmes 5:07bbe020eb65 22 //pc.printf("%f \n", t.read());
gelmes 5:07bbe020eb65 23 }
gelmes 5:07bbe020eb65 24 t.stop();
gelmes 5:07bbe020eb65 25 pc.printf("Seagoat Ready to Go\n\r");
gelmes 5:07bbe020eb65 26 //seagoat.motorTest();
gelmes 3:5ffe7e9c0bb3 27
gelmes 4:b37fd183e46a 28 while(1) {
gelmes 5:07bbe020eb65 29
gelmes 5:07bbe020eb65 30 //seagoat.motorTest();
gelmes 4:b37fd183e46a 31 seagoat.update();
aolgu003 6:b45b74fd6a07 32 seagoat.updateCommand();
gelmes 5:07bbe020eb65 33 wait(0.01);
gelmes 4:b37fd183e46a 34 }
gelmes 3:5ffe7e9c0bb3 35 }