Colony

/**

 * Driver for testing vision library.

 */

#include <vision.h>

#include <stdio.h>

#include <stdlib.h>

int main(int argc, char** argv) {

  if (vision_init() != 0) {

    fprintf(stderr, "vision_init failed.\n");

    return -1;

  } else {

    fprintf(stderr, "vision_init succeeded.\n");

  }

  while(getchar()!=27)

  {

    VisionPosition* positions;

    int num_positions = vision_get_robot_positions(&positions);

    if (num_positions == -1) {

      fprintf(stderr, "vision_get_robot_positions failed.\n");

      return 1;

    }

    printf("Got %d positions.\n", num_positions);

    int i;

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

      printf("%d,%d\n", positions[i].x, positions[i].y);

    }

    free(positions);

  }

  vision_close();

  return 0;

}