Colony

    if (parse_request_bom_matrix(connection_pool, pool_index)) {

      return -1;

  } else if (second_token == REQUEST_XBEE_IDS) {

    if (parse_request_xbee_ids(connection_pool, pool_index)) {

      return -1;

    }

  } else {

    char * my_current_message = "Hi, how are you?\n";

    printf("Sending %s\n", my_current_message);

    connection_pool->write_to_client(pool_index, my_current_message, strlen(my_current_message));

  }

  return 0;

}

int Command::parse_request_bom_matrix(ConnectionPool * connection_pool, int pool_index) {

  //TODO: rename to indicate its actually the response message

  char bom_matrix_buffer[MAX_RESPONSE_LEN];

  char temp_bom_matrix_buffer[MAX_RESPONSE_LEN];

  //TODO: change after we start keeping track of bom matrix

  int number_robots = rand()%10;

  int bom_matrix[number_robots][number_robots];

  for (int ii = 0; ii < number_robots; ii++) {

    for (int j = 0; j < number_robots; j++) {

      //do this to generate some -1 values which mean they can't see each other

      int matrix_value = rand()%(number_robots+1)-1;

      bom_matrix[ii][j] = matrix_value;

  }

  printf("number of robots is %d\n", number_robots);

  //TODO: separate parameters with spaces

  //TODO: make this better

  //TODO: make sure I don't need to do MAX_RESPONSE_LENGTH-1

  snprintf(bom_matrix_buffer,MAX_RESPONSE_LEN, "%d %d %d", RESPONSE_TO_CLIENT_REQUEST, REQUEST_BOM_MATRIX, number_robots);

  for (int ii = 0; ii < number_robots; ii++) {

    for (int j = 0; j < number_robots; j++) {

      //TODO: don't use strcpy

      strcpy(temp_bom_matrix_buffer, bom_matrix_buffer);

      strcat(temp_bom_matrix_buffer," %d");

      snprintf(bom_matrix_buffer, MAX_RESPONSE_LEN, temp_bom_matrix_buffer, bom_matrix[ii][j]);

  strcat(bom_matrix_buffer,"\n");

  connection_pool->write_to_client(pool_index, bom_matrix_buffer, strlen(bom_matrix_buffer));

  printf("Sending %s", bom_matrix_buffer);

int Command::parse_request_xbee_ids(ConnectionPool * connection_pool, int pool_index) {

  //TODO: make this better

  int number_robots = rand() % 10;

  char xbee_id_buffer[MAX_RESPONSE_LEN];

  char temp_xbee_id_buffer[MAX_RESPONSE_LEN];

  snprintf(xbee_id_buffer, MAX_RESPONSE_LEN, "%d %d %d", RESPONSE_TO_CLIENT_REQUEST, REQUEST_XBEE_IDS, number_robots);

  printf("number of robots is %d\n", number_robots);

  for (int ii = 0; ii < number_robots; ii++) {

    strcpy(temp_xbee_id_buffer, xbee_id_buffer);

    //TODO: put length checking in here so array doesn't go out of bounds

    //TODO: maybe use strncat?

    strcat(temp_xbee_id_buffer, " %d");

    snprintf(xbee_id_buffer, MAX_RESPONSE_LEN, temp_xbee_id_buffer, ii);

  }

  strcat(xbee_id_buffer, "\n");

  connection_pool->write_to_client(pool_index, xbee_id_buffer, strlen(xbee_id_buffer));

  printf("Sending %s", xbee_id_buffer);

  return 0;

}