Colony

#include "firefly+_lib.h"

#include <wireless.h>

#include <wl_token_ring.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

                wl_do();

                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;

}