imu rev1

Dependencies:   IMUfilter mbed

Fork of AIviate by UCLA IEEE

control.cpp

Committer:
teamgoat
Date:
2013-11-01
Revision:
2:452dd766d212
Parent:
1:1abb115c2005
Child:
4:44a5b1e8fd27

File content as of revision 2:452dd766d212:

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

#define MAXPROC 15

process procs[MAXPROC] = {0};

int main()
{
    init();
    while (true)
    {
        schedule();
    }
}

void init()
{
    // initialize i2c sensors
    init_sensors();
    // set initial processes
    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;
        }
     }
}