Colony

#include "stdlib.h"

#include "stdio.h"

#include "../lib/wireless.h"

#include "../lib/wl_error_group.h"

#include "../lib/wl_token_ring.h"

//#include "../lib/xbee.h"

#include <time.h>

void usage (void);

int main(int argc, char** argv)

{

        if (argc != 3) {

                usage();

                return -1;

        }

        char c = argv[1][0];

        int robot = atoi(argv[2]);

        wl_set_com_port("/dev/ttyUSB0");

        wl_init();

        wl_set_channel(0xE);

        printf("Wireless initialized.\n");

        printf("Packet groups initialized.\n");

        if (c == 'g') { //command robot to requet charge

            wl_send_robot_to_robot_global_packet(3, 9, NULL, 0, robot, 0);

        }

        if (c == 'd') { // command robot to depart station

        wl_send_robot_to_robot_global_packet(3, 10, NULL, 0, robot, 0);

        }

        wl_terminate();

        return 0;

}

void usage (void) {

        printf("Usage: test [g|d] [robot]\n\tg sends charge\n\td sends depart\n\trobot is the ID of the desired robot\n");

}