Colony

#include <firefly+_lib.h>

#include <rangefinder.h>

void button_test ( void);

void motor_test (void);

void serial_test( void );

void lcd_test(void);

void orb_test( void );

void batt_test(void);

void pullup_test(void);

void ranger_test(void);

/*

int main( void ) {

//        orb_init();

        //motors_init();

        tlc5940test();

        //ranger_test();

        //pullup_test();

        //serial_test();

        //lcd_test();

 orb_set_num(2, 255,0,0);

        motor_test();

 orb_set_num(3, 255,0,0);

        return 0;

}*/

void ranger_test( void )

{

        lcd_init();

        while(1) {

                lcd_clear_screen();

                lcd_putint(linearize_distance(read_distance(PIN_C0)));

                delay_ms(100);

        }

}

void button_test ( void) 

{

        lcd_init();

        while(1) {

                if(button1_read())

                        lcd_putchar('1');

                if(button2_read())

                        lcd_putchar('2');

                delay_ms(100);

        }

}

void motor_test (void) {

        motors_init();

        //led_init();

        motor1_set(1, 255);

        motor2_set(1, 255);

        delay_ms(10000);

        motors_off();

        led_user(1);

        while(1);

}

void orb_test( void ) {

        int orbs[13] = { ORB_OFF, RED, ORANGE, YELLOW, LIME, GREEN, CYAN, BLUE, PURPLE, PINK, PURPLE, MAGENTA, WHITE };

        int orb_select = 0;

        orb_init();

        while(1) {

                orb_set_color(orbs[orb_select]);

                delay_ms(1000);

                orb_select++;

                if(orb_select == 14)

                        orb_select = 0;

        }

        return;

}

void lcd_test(void) {

        int i;

        lcd_init();

        for(i = 32; i <= 126; i++) {

                lcd_putchar(i);

                delay_ms(250);

        }

        return;

}

/*

prints all printable characters to the serial

baud rate is 115200

*/

void serial_test( void ) {

        int i;

        serial1_init(BAUD115200);

        fdevopen(&serial1_putchar,&serial1_getchar);

        for(i = 32; i <= 126; i++) {

                printf("%d",i);

                delay_ms(250);

        }

        return;

}

void pullup_test()

{

        lcd_init();

        lcd_putstr("pullup test");

        delay_ms(100);

        digital_pull_up(PIN_A4);

        digital_pull_up(PIN_A5);

        digital_pull_up(PIN_A6);

        digital_pull_up(PIN_A7);

        while(1){

                lcd_clear_screen();

                if(!digital_input(PIN_A4))

                        lcd_putchar('0');

                else

                        lcd_putchar(' ');

                if(!digital_input(PIN_A5))

                        lcd_putchar('1');

                else

                        lcd_putchar(' ');

                if(!digital_input(PIN_A6))

                        lcd_putchar('2');

                else

                        lcd_putchar(' ');

                if(!digital_input(PIN_A7))

                        lcd_putchar('3');

                else

                        lcd_putchar(' ');

                delay_ms(100);

        }

}

void batt_test()

{

        lcd_init();

        analog_init();

        while(1){

                lcd_clear_screen();

                lcd_putint(battery());

                delay_ms(1000);

        }

}