Colony

#include <stdlib.h>

#include <stdio.h>

#include <unistd.h>

#include "wireless.h"

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

unsigned char bom_responded_flag;

int main(void){

  wl_set_com_port("/dev/cu.usbserial-A1000Qu6");

  wl_init();

  PacketGroupHandler* pgh = malloc(sizeof(PacketGroupHandler));

  pgh->groupCode=12;

  pgh->timeout_handler=NULL;

  pgh->handle_response=NULL;

  pgh->handle_receive=handle_receive;

  pgh->unregister=NULL;

  wl_register_packet_group(pgh);

  int i;

  while(1){

    wl_send_robot_to_robot_global_packet (12, 0, NULL, 0, 9, 0);

    printf("Sending robot to robot global packet.\n");

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

         wl_do();

         usleep(100);

    }

  }

  return -1;

}

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

    printf("Received the callback!\n");

}