Colony

#include <dragonfly_lib.h>

int main(void);

void test_rangefinders(void);

void test_BOM(void);

void test_motors(void);

int main(void)

{

        /* initialize components */

        dragonfly_init(ALL_ON);

        usb_init();

        usb_puts("Waiting for instructions");

        usb_putc('\0');

        while(1){

                char c;

                if(usb_getc_nb(&c) != -1){

                        switch( c ){

                        case 'r' : test_rangefinders();

                        case 'b' : test_BOM();

                        case 'm' : test_motors();

                     }

                }

        }

        return 0;

}

/*

 * Change these later, of course

 */

void test_rangefinders(void){

        usb_puts("Instructed to test rangefinders");

        usb_putc('\0' );

}

void test_BOM(void){

        usb_puts("Instructed to test BOM");

        usb_putc('\0' );

}

void test_motors(void){

        usb_puts("Instructed to test motor");

        usb_putc('\0' );

}