Colony

#include <dragonfly_lib.h>

#include <wireless.h>

#include <wl_token_ring.h>

//#include <xbee.h>

//#define SWARM_PACKET_GROUP_ID 0x8

//static PacketGroupHandler swarm_pgh;

//static void swarm_handle_receive(char type, int wl_source, unsigned char* packet, int length);

int main(void)

{

    dragonfly_init(ALL_ON);

    wl_init();

    wl_set_channel(0xF);

    /*swarm_pgh.groupCode = SWARM_PACKET_GROUP_ID;

    swarm_pgh.timeout_handler = NULL;

    swarm_pgh.handle_response = NULL;

    swarm_pgh.handle_receive = swarm_handle_receive;

    swarm_pgh.unregister = NULL;

    wl_register_packet_group(&swarm_pgh);*/

    wl_token_ring_register();

    wl_token_ring_join();

    usb_puts("initialized\r\n");

    /*char packet[] = { 0x0, 0x1, 0x0, 0x3, 0x4, 0x0, 0x6, 0x7, 0x8, 0x0, 0xa, 0xb, 0xc, 0xd, 0x0, 0xf, 0x0 };

    int length = 17;

    int num = 0;*/

    while (1)

    {

            wl_do();

        /*packet[16] = num;

        wl_send_global_packet(SWARM_PACKET_GROUP_ID, 0, packet, length, 0);

        usb_puts("sent ");

        usb_puti(num);

        usb_puts("\r\n");

        num++;

        delay_ms(50);*/

    }

}

/*static void swarm_handle_receive(char type, int wl_source, unsigned char* packet, int length)

{

    //wl_send_robot_to_robot_packet(SWARM_PACKET_GROUP_ID, type, packet, length, wl_source, 0);

    char buf[40];

    int i;

    for (i = 0; i < length; i++) {

        sprintf(buf, "%d: %d ", i, packet[i]);

        usb_puts(buf);

    }

    usb_puts("\r\n");

}*/