Colony

#include <dragonfly_lib.h>

#include "odometry.h"

int main(void)

{

        dragonfly_init(ALL_ON);

        odometry_init();

        int angle;

        while(1){

                usb_puts("X: ");

                usb_puti(odometry_dx());        

                usb_puts(" Y: ");

                usb_puti(odometry_dy());        

                usb_puts(" Theta: ");

                angle = (int)(odometry_angle()*150.0);        

                usb_puti(angle);        

                usb_puts("\n\r");

                delay_ms(500);

        }

        return 0;

}