Colony

/** driver for orbit code

        execute orbit behavior

*/

#include <dragonfly_lib.h>

#include <wireless.h>

#include <wl_token_ring.h>

#include "orbit_fsm.h"

int main(void) {

  // enable everything

  dragonfly_init(ALL_ON);

  orb_enable();

  orb_init();

  orb_set_color(PURPLE);

  wl_init();

  wl_set_channel("O");

  wl_token_ring_register();

  wl_token_ring_join(); // join token ring

  /*int robot = -1;

  wl_token_iterator_begin();

  while(wl_token_iterator_has_next() && robot == -1) {

    robot = wl_token_iterator_next();

    if (robot == wl_get_xbee_id())

      robot = -1; // can't orbit ourself

    else

      break;

  }*/

  orbit_init(1);//robot);

  while(1) {

    orbit_fsm(); // do orbit

  }

  return 0;

}