Colony

#include <dragonfly_lib.h>

#include <wireless.h>

#include <wl_token_ring.h>

#include <rangefinder.h>

#include "smart_run_around_fsm.h"

#include "recharge.h"

void do_nothing2(void) {}

int get_nothing2(void) {return 0;}

int main(void)

{

        dragonfly_init(ALL_ON);

        range_init();

        orb_enable();

        usb_puts("Turned on!\n");

        wl_init();

        usb_puts("Wireless initialized!\n");

        wl_set_channel(0xE);

        wl_token_ring_register();

        wl_token_ring_join();

        recharge_init();

        usb_puts("Recharging initialized.\n");

        run_around_init();

        while (1)

        {

                wl_do();

                int charging = recharge_do();

                if (!charging)

                {

                        run_around_FSM();

                }

        }

        return 0;

}