Colony

#include <dragonfly_lib.h>

#include "intersectData.h"

#include "validTurns.h"

#include "lineDrive.h"

//#define TEST_VALIDTURNS

#ifdef TEST_VALIDTURNS

int main(){

        dragonfly_init(ALL_ON);

        orb1_set_color(YELLOW);

        initializeData();        

        if (getTurnIntType(INTERSECTION_DOUBLE_C) == DOUBLE) orb1_set_color(GREEN);

        delay_ms(500);

        orb1_set_color(PINK);

        delay_ms(500);

        if (getTurnIntType(INTERSECTION_DOUBLE_T) == DOUBLE) orb1_set_color(GREEN);

        delay_ms(500);

        orb1_set_color(BLUE);

        delay_ms(500);

        if (getTurnIntType(INTERSECTION_SINGLE) == SINGLE) orb1_set_color(GREEN);

        delay_ms(500);

        orb1_set_color(PINK);

        delay_ms(500);

        if (getTurnIntType(INTERSECTION_ON_RAMP) == ON_RAMP) orb1_set_color(GREEN);

        delay_ms(500);

        orb1_set_color(BLUE);

        delay_ms(500);

        if( getTurnIntType(getIntersectType(0)) == DOUBLE) orb1_set_color(GREEN);

        delay_ms(500);

        orb1_set_color(PINK);

        delay_ms(500);

/*****************************TEST FOR validTurns.c

        int barcode = 0;

        if (validateTurn(barcode, ILEFT)==ILEFT) orb1_set_color(GREEN);

        delay_ms(100);

        orb1_set_color(PINK);

        delay_ms(50);

        if (validateTurn(barcode, IUTURN)==IUTURN) orb1_set_color(GREEN);

        delay_ms(100);

        orb1_set_color(RED);

        delay_ms(50);

*/

        while (1){}

}

#endif