Colony

#include <dragonfly_lib.h>

#include "odometry.h"

int main(void)

{

        dragonfly_init(ALL_ON);

        odometry_init();

        char buf[100];

        while(1){

                sprintf(buf,"X: %i, Y: %i, Theta: %f\n\r",odometry_dx(),odometry_dy(),odometry_angle());

                usb_puts(buf);

                delay_ms(500);

        }

        return 0;

}