Colony

#include <dragonfly_lib.h>

#include "spi.h"

#include "encoders.h"

#define MODE 0

#define TEST 0

extern char spi_status;

int testencoders(void)

{

        usb_init();

        encoders_init();

        int encoder_left,encoder_right;

        while(1){

                encoder_left = encoder_read(LEFT);

                encoder_right = encoder_read(RIGHT);

                usb_puts("Encoder values (left, right): ");

                usb_puti(encoder_left); 

                usb_puts(", ");

                usb_puti(encoder_right); 

                usb_puts("\n\r");

                delay_ms(500);

        }

        return 0;

}