Colony

#include "firefly+_lib.h"

#include "bays.h"

int main(void) {

  //lcd, orb, all that good stuff

    analog_init();

    led_init();

    orb_init();

    buzzer_init();

    usb_init(BAUD115200);

    xbee_init(BAUD9600);

    usb_puts("Beginning.\n");

    wl_init();

    usb_puts("Done initializing.\n");

    wl_token_ring_register();

    wl_token_ring_join();

    bays_init();

    orb_set_color(GREEN);

	lbom_off();

	while(1)

	{

		//this needs to happen continuously -- it handles the packet

		do_consistency_checks();

		if(button1_click())

		{

			print_bays_debug();

		}

	if(button2_click())

		{

			if(bayStates[1] == 255)

      {

        bayStates[1] = 50;

        usb_puts("\n**filled bay 1 with bogus robot (50)**\n");

        print_bays_debug();

        orb_set_color(RED);

      }

      else if(bayStates[1] == 50)

      {

        bayStates[1] = 255;

       	usb_puts("\n**freed bogus robot (50) from bay 1 bay 1**\n");

        print_bays_debug();

        orb_set_color(BLUE);

      }

      else

      {

        usb_puts("\n**bay 1 already in use by legitimate robot**\n");

        print_bays_debug();

        orb_set_color(GREEN);

      }

		}

	}

  return 0;