#include <stdio.h>
#include <unistd.h>

#include "brick.h"
#include "ev3.h"
#include "ev3_sensor.h" // e.g.: ~/robot/ev3dev-c/eg/sensor/sensor.c

#include "ir.h"

#include "button.h"

uint8_t ir;
int prox;

int ir_init() {
  if (ev3_search_sensor(LEGO_EV3_IR, &ir, 0)) {
    printf("IR found\n");
    return 0;
  } else {
    fprintf(stderr, "IR NOT found\n");
    return 1;
  }
}

int ir_get() {
  get_sensor_value(IR_CHANNEL, ir, &prox);
  return prox;
}

void ir_test() {
  while (!button_pressed()) {
    ir_get();
    printf("IR proximity: %d\n", prox);
    sleep(1);
  }
}