imu rev1

Dependencies:   IMUfilter mbed

Fork of AIviate by UCLA IEEE

control.cpp

Committer:
teamgoat
Date:
2013-10-30
Revision:
0:0c627ff4c5ed
Child:
1:1abb115c2005

File content as of revision 0:0c627ff4c5ed:

#include "control.h"
#include "sensor.h"
#include "steps.h"
#include "mbed.h"

#define MAXPROC 15

process procs[MAXPROC] = {0};

void schedule();
void init_procs();


int main()
{
    init_procs();
    while (true)
    {
        get_sensor_data();
        schedule();
    }
}

void init_procs()
{
    procs[0].status = READY;
    procs[0].start = &get_sensor_data;
    return;
}

void schedule()
{
    for (int i=0; i<MAXPROC; i++)
    {
        process proc = procs[i];
        if(proc.status == READY)
        {
            proc.start();
            return;
        }
     }
}