Updated version with comments
Dependencies: IMU MODSERIAL Servo mbed
Fork of RTOS_Controller_v3 by
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?
User | Revision | Line number | New 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 | } |