Colony

#include <dragonfly_lib.h>

#include <wireless.h>

#include <wl_token_ring.h>

#include <xbee.h>

#define TEST_PACKET_GROUP_ID 15

void handle_receive(char type, int source, unsigned char* packet, int length)

{

  wl_send_robot_to_robot_global_packet(TEST_PACKET_GROUP_ID, type, (char *)packet, length, source, 0);

}

int main(void)

{

        //usb_puts("Turned on.\n");

        dragonfly_init(ALL_ON);

        usb_puts("Dragonfly initialized.\n");

        wl_init();

        usb_puts("Wireless initialized.\n");

        PacketGroupHandler pgh = { TEST_PACKET_GROUP_ID, NULL, NULL, handle_receive, NULL };

        wl_register_packet_group(&pgh);

        wl_set_channel(0xF);

        usb_puts("Wireless channel set.\n");

        wl_token_ring_register();

        usb_puts("Token ring initialized.\n");

        wl_token_ring_join();

        usb_puts("Token ring joined.\n");

        while (1)

        {

                wl_do();

        }

}