Colony

#include "dump_station.h"

#include "hardware.h"

void dump_station_encoders (void)

{

        int16_t left, right;

        char c;

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

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

        {

                encoders_read (&left, &right);

                usb_puti (left);

                usb_puts (" ");

                usb_puti (right);

                usb_puts (NL);

        }

}

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);

        }

}

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);

        }

}

void dump_station_rbom (void)

{

        uint16_t top, left, right;

        char c;

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

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

        {

                rbom_update ();

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

                usb_puti (top);

                usb_puts (" ");

                usb_puti (left);

                usb_puts (" ");

                usb_puti (right);

                usb_puts (NL);

        }

}