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, Y: %ld, Theta: %lf\n\r", odometry_dx(), odometry_dy(), odometry_angle());

                usb_puts(buf);

                delay_ms(500);

        }

        return 0;

}