Colony

#include "hardware_rbom.h"

static void pDataDump(int startPort, int stopPort, unsigned int delay);

static void pUsr(int startPort, int stopPort, unsigned int delay);

void rbom_init (void)

{

        // FIXME implement

}

void rbom_set (bool on)

{

        if (on)

        {

                usb_puts ("# Turning RBOM light on" NL);

                // FIXME implement

        }

        else

        {

                usb_puts ("# Turning RBOM light off" NL);

                // FIXME implement

        }

}

void rbom_read (uint16_t *top, uint16_t *left, uint16_t *right)

{

        usb_puts ("# Reading RBOM" NL);

        // FIXME implement

        *top=0;

        *left=0;

        *right=0;

}

void rbom_update (void)

{

        // FIXME implement

}

void rbom_debug (void)

{

        usb_puts("# Debugging RBOM\n");

        while(1) {

                pUsr(0x0, 0x10, 500);

        }

        exit(1);        /* Control should never reach here */

}

static void pDataDump(int startPort, int stopPort, unsigned int delay) {

        char buf[16];

        int i;

        usb_puts("# port:\t\tval:\n\n");

        for (i = startPort; i <= stopPort; i++) {

                usb_puts(itoa(analog10(i), buf, 10));

                usb_puts("\n");        

        }

        delay_ms(delay);

}

static void pUsr(int startPort, int stopPort, unsigned int delay) {

        char buf[16];

        int i;

        usb_puts("# port:\t\tval:\n\n");

        for (i = startPort; i <= stopPort; i++) {

                usb_puts(itoa(i, buf, 10));

                usb_puts("\t\t");

                usb_puts(itoa(analog10(i), buf, 10));

                usb_puts("\n");

        }

        delay_ms(delay);

}