Colony

#include <dragonfly_lib.h>

#include "odometry.h"

#include <math.h>

int main(void)

{

        dragonfly_init(ALL_ON);

        odometry_init();

        char buf[100];

        while(1){

                //sprintf(buf,"X: %ld mm, Y: %ld mm, Theta: %lf rad Velocity: %ld mm/s\n\r", 

                                //odometry_dx(), odometry_dy(), odometry_angle(), odometry_velocity());

                //usb_puts(buf);

                delay_ms(500);

        }

        return 0;

}