Colony

#include <stdint.h>

#include <dragonfly_lib.h>

#include <wl_basic.h>

#include <stdlib.h>

int main (void) {

        Vector v;

        int i;

        int bomVals[16];

        dragonfly_init(ALL_ON);

        xbee_init();

        encoders_init();

        orbs_set_color(BLUE, GREEN);

        delay_ms(1000);

        orbs_set_color(GREEN, BLUE);

        delay_ms(1000);

        orbs_set_color(RED, RED);

        while (1) {

                bom_refresh(BOM_ALL);

                for (i = 0; i < 16; i++) {

                        bomVals[i] = bom_get(i);

                }

                bom_print_usb(bomVals);

                bom_get_norm_vector(&v, bomVals);

                usb_puts("x: ");        

                usb_puti(v.x);

                usb_puts("\ty: ");

                usb_puti(v.y);

                usb_puts("\n");

                delay_ms(50);

        }

        while(1);

}