//-------------------------------------------------------------------------------------------
// Ejercicio 3: Sensores
//
// Comportamiento: Cada vez que presionemos el sensor de toque, 
//                               el sentido de giro de las ruedas cambia
//
//-------------------------------------------------------------------------------------------


#include <conio.h>
#include <unistd.h>
#include <tm.h>

#include <dmotor.h>
#include <dsensor.h>

int main(int arg, char *argv[]){

  static int adelante;
  motor_a_dir(fwd);
  
  while(1)
    {
      while(SENSOR_1 > 0xf000);

      //En C no tenemos el toggle de NQC
      if(adelante)
	motor_a_dir(fwd);
      else
	motor_a_dir(rev);	
      adelante = !adelante;
      
      while(SENSOR_1 < 0xf000);
    }
  
  return 0;
}