Colony

#include <dragonfly_lib.h>

#include <i2c.h>

volatile uint32_t byte;

volatile short code, next;

void recv(char i2c_byte){

    static char str[8];

    if(code){

        if(next==0){

            byte = i2c_byte<<8; //get first byte in int

            next = 1;

        }

        else{

            byte |= i2c_byte; //get second byte in int

            itoa(byte,str,10);

            usb_puts(str);

            usb_putc('\t');

            if(code==2)

                usb_puts("\r\n"); //newline for easy to read output

            byte=0;

            code=0;

            next=0;

        }

    }

    else {

        //if the byte is a debug control then set code to 1, otherwise, print it

        switch(i2c_byte){

            case 'C':

            case 'P':

            case 'I':

            case 'V':

                code = 1;

                break;

            case 'T':

                code = 2; //T is last, put a newline after it

                break;

            default:

                usb_putc(i2c_byte);

                break;

        }

    }

}

int main( void ){

        dragonfly_init(ALL_ON);

        sei();

    code = 0;

    byte = 0;

    next = 0;

        i2c_init(0x01, NULL, recv, NULL);

        usb_puts("init'd everything.\r\n");

        while(1) {

                delay_ms(2000);

        }

}