Colony

#include "comm_interactive.h"

#include <dragonfly_lib.h>

#include "global.h"

#include "tests.h"

#include "self_test.h"

#define ESC 27

/*

Main menu: (t)ests, (s)tation sensors, (r)obot sensors

Tests menu: (b)om, (r)angefindrs, (e)ncoders, (m)otors

Station sensors menu: (e)ncoders, (w)all, (t)urntable

Robot sensors menu: (e)ncoders, (b)om, (r)angefinders

*/

void station_sensors_menu (void)

{

        while (1)

        {

                usb_puts ("# Station sensors menu: (e)ncoders" NL);

                char choice = usb_getc ();

                switch (choice) {

                        case 'e': case 'E': /*dump_station_encoders ()*/; break;

                        case ESC: return;

                        default: break;

                }

        }

}

void robot_sensors_menu (void)

{

        while (1)

        {

                usb_puts ("# Robot sensors menu: (e)ncoders" NL);

                char choice = usb_getc ();

                switch (choice) {

                        case 'e': case 'E': /*dump_robot_encoders ()*/; break;

                        case ESC: return;

                        default: break;

                }

        }

}

void tests_menu (void)

{

        while (1)

        {

                usb_puts ("# Tests menu: (a)ll, (c)omm, (b)om, (r)angefinders, (m)otors, (e)ncoders" NL);

                char choice = usb_getc ();

                switch (choice) {

                        case 'a': case 'A': test_all ();                                    break; // test_all will test comm itself

                        case 'c': case 'C': test_comm ();                                   break;

                        case 'b': case 'B': if (require_comm ()) test_bom_all (true, true); break;

                        case 'r': case 'R': if (require_comm ()) test_rangefinder_all ();   break;

                        case 'm': case 'M': if (require_comm ()) test_motor_all ();         break;

                        case 'e': case 'E': if (require_comm ()) test_encoder_all ();       break;

                        case ESC: return;

                        default: break;

                }

        }

}

void main_menu (void)

{

        while (1)

        {

                usb_puts ("# Main menu: (t)ests, (s)tation sensors, (r)obot sensors" NL);

                char choice = usb_getc ();

                switch (choice) {

                        case 't': tests_menu ();           break;

                        case 's': station_sensors_menu (); break;

                        case 'r': robot_sensors_menu ();   break;

                        case ESC: return;

                }

        }

}

void interactive_main (void)

{

        while (1)

        {

                // Set the orbs to green/green

                orbs_set (0,255,0, 0,255,0);

                usb_puts (NL);

                usb_puts ("# Diagnostic station interactive mode" NL);

                main_menu ();

        }

}