Colony

#include <dragonfly_lib.h>

#include <wl_basic.h>

int main(void)

{

  char *packet;

  int length, byte;

        /* initialize components, set wireless channel */

        dragonfly_init(ALL_ON);

  wl_basic_init_default();

  //REMEMBER to change this to whatever channel your program uses

  wl_set_channel(15);

  while(1){

    packet = wl_basic_do_default(&length);

    if(length > 0){

      usb_puts("\r\n");

      orb1_set_color(BLUE);

      usb_puti(length);

      usb_puts(" bytes: ");

    }

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

      usb_puti(packet[byte]);

      usb_putc(' ');

    }

    orb1_set_color(ORB_OFF);

    length = 0;

  }

        return 0;

}

/* Copy this function into your program whever you want to report the status of the robot

 * Edit the parameters to contain all the variables you want to send from your program

 */

void send_status(char var1, char var2){

  int length = 3;//Set this to the number of bytes you want to report

  char buffer[length];

  //Copy all variables into the buffer

  buffer[0] = get_robotid();

  buffer[1] = var1;

  buffer[2] = var2;

  wl_basic_send_global_packet(42, buffer, length);

}