Colony

#include "dump_station.h"

#include "hardware.h"

void dump_station_dynamos (void)

{

        int16_t left, right;

        char c;

        dynamos_reset ();

        // TODO implement resetting the dynamos (r key, for example)

        while (usb_getc_nb (&c)==-1)

        {

                dynamos_read (&left, &right);

                usb_puts ("Left: "); usb_puti (left ); usb_puts (NL);

                usb_puts ("Right:"); usb_puti (right); usb_puts (NL);

                usb_puts (NL NL);

                delay_ms (100);

        }

}

void dump_station_turntable (void)

{

        uint16_t turntable;

        char c;

        while (usb_getc_nb (&c)==-1)

        {

                turntable=turntable_get_position ();

                usb_puti (turntable);

                usb_puts (NL);

                delay_ms (100);

        }

}

void dump_station_wall (void)

{

        uint16_t wall;

        char c;

        while (usb_getc_nb (&c)==-1)

        {

                wall=turntable_get_position ();

                usb_puti (wall);

                usb_puts (NL);

                delay_ms (100);

        }

}

void dump_station_ibom (void)

{

        uint16_t top, left, right;

        char c;

        while (usb_getc_nb (&c)==-1)

        {

                ibom_update ();

                ibom_read (&top, &left, &right);

                usb_puts ("Top:   "); usb_puti (top  ); usb_puts (NL);

                usb_puts ("Left:  "); usb_puti (left ); usb_puts (NL);

                usb_puts ("Right: "); usb_puti (right); usb_puts (NL);

                usb_puts (NL NL);

                delay_ms (100);

        }

}

void dump_station_adc (uint8_t startPort, uint8_t endPort, uint16_t delay)

{

        char c;

        while (usb_getc_nb (&c)==-1)

        {

                for (uint8_t i=startPort; i<=endPort; ++i)

                {

                        if (i<10) usb_puts (" ");

                        usb_puti (i);

                        usb_puts (": ");

                        usb_puti (analog10 (i));

                        usb_puts (NL);

                }

                usb_puts(NL NL);

                delay_ms (delay);

        }

}