Colony

/**

 * Driver for testing vision library.

 */

#include <vision.h>

#include <stdio.h>

#include <stdlib.h>

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

  char* filename = (argc == 2) ? argv[1] : (char*)"colonet.jpg";

  printf("vision_init(%s)\n", filename);

  if (vision_init(filename) != 0) {

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

    return -1;

  } else {

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

  }

  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);

  return 0;

}