team10 team10 / AIviate1

imu rev1

Dependencies:   IMUfilter mbed

Fork of AIviate by UCLA IEEE

control.cpp@1:1abb115c2005, 2013-10-30 (annotated)

Committer:
teamgoat
Date:
Wed Oct 30 22:51:33 2013 +0000
Revision:
1:1abb115c2005
Parent:
0:0c627ff4c5ed
Child:
2:452dd766d212
minor updates; ;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
teamgoat 0:0c627ff4c5ed 1 #include "control.h"
teamgoat 0:0c627ff4c5ed 2 #include "sensor.h"
teamgoat 0:0c627ff4c5ed 3 #include "steps.h"
teamgoat 0:0c627ff4c5ed 4 #include "mbed.h"
teamgoat 0:0c627ff4c5ed 5
teamgoat 0:0c627ff4c5ed 6 #define MAXPROC 15
teamgoat 0:0c627ff4c5ed 7
teamgoat 0:0c627ff4c5ed 8 process procs[MAXPROC] = {0};
teamgoat 0:0c627ff4c5ed 9
teamgoat 0:0c627ff4c5ed 10 void schedule();
teamgoat 0:0c627ff4c5ed 11 void init_procs();
teamgoat 0:0c627ff4c5ed 12
teamgoat 0:0c627ff4c5ed 13
teamgoat 0:0c627ff4c5ed 14 int main()
teamgoat 0:0c627ff4c5ed 15 {
teamgoat 1:1abb115c2005 16 /*init_procs();
teamgoat 0:0c627ff4c5ed 17 while (true)
teamgoat 0:0c627ff4c5ed 18 {
teamgoat 0:0c627ff4c5ed 19 get_sensor_data();
teamgoat 0:0c627ff4c5ed 20 schedule();
teamgoat 1:1abb115c2005 21 }*/
teamgoat 1:1abb115c2005 22 get_sensor_data();
teamgoat 0:0c627ff4c5ed 23 }
teamgoat 0:0c627ff4c5ed 24
teamgoat 0:0c627ff4c5ed 25 void init_procs()
teamgoat 0:0c627ff4c5ed 26 {
teamgoat 0:0c627ff4c5ed 27 procs[0].status = READY;
teamgoat 0:0c627ff4c5ed 28 procs[0].start = &get_sensor_data;
teamgoat 0:0c627ff4c5ed 29 return;
teamgoat 0:0c627ff4c5ed 30 }
teamgoat 0:0c627ff4c5ed 31
teamgoat 0:0c627ff4c5ed 32 void schedule()
teamgoat 0:0c627ff4c5ed 33 {
teamgoat 0:0c627ff4c5ed 34 for (int i=0; i<MAXPROC; i++)
teamgoat 0:0c627ff4c5ed 35 {
teamgoat 0:0c627ff4c5ed 36 process proc = procs[i];
teamgoat 0:0c627ff4c5ed 37 if(proc.status == READY)
teamgoat 0:0c627ff4c5ed 38 {
teamgoat 0:0c627ff4c5ed 39 proc.start();
teamgoat 0:0c627ff4c5ed 40 return;
teamgoat 0:0c627ff4c5ed 41 }
teamgoat 0:0c627ff4c5ed 42 }
teamgoat 0:0c627ff4c5ed 43 }
teamgoat 0:0c627ff4c5ed 44