Colony

#include <dragonfly_lib.h>

#include "lineDrive.h"

#include "validTurns.h"

#ifdef TEST_VALIDTURNS

int main(){

/*barcode should be written as crosstype, crosspos. 5 bit integers*/

/*barcode should be three bits of intersection type and 2 of entrypoint*/

dragonfly_init(ALL_ON);

orb1_set_color(YELLOW);

int barcode1 = (DOUBLE_C<<2)+(TMIDDLE);

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

delay_ms(100);

orb1_set_color(PINK);

delay_ms(50);

int barcode2 = (DOUBLE_C<<2)+(TMIDDLE);

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

delay_ms(100);

orb1_set_color(RED);

delay_ms(50);

int barcode3 = (DOUBLE_T<<2)+(TMIDDLE);

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

delay_ms(100);

orb1_set_color(PURPLE);

delay_ms(50);

int barcode4 = (DOUBLE_T<<2)+(TMIDDLE);

if (validateTurn(barcode4, ISTRAIGHT)==IUTURN) orb1_set_color(GREEN);

while (1){}

}

#endif TEST_VALIDTURNS