resgate

// resgate.c - Criado pelo studio UNO 2.3
// 25 April 2016 7:32:35 pm
 
#include <uno.h>
 
 
// Declaracao das Variaveis
unsigned int tempo;
 
// Prototipos
void retinho(void); 
void freio(void); 
 
//Funcoes do Usuario
void retinho(void) 
{
     if ((__EncoderGetValue(1) > __EncoderGetValue(2))) {
         __motor_curso(__LEFT_TURN);
     }
     if ((__EncoderGetValue(2) > __EncoderGetValue(1))) {
         __motor_curso(__RIGHT_TURN);
     }
     if ((__EncoderGetValue(2) == __EncoderGetValue(1))) {
         __motor_curso(__FORWARD);
     }
 
}
 
void freio(void) 
{
     __motor_curso(__REVERSE);
     __delay(30);
     __motor_curso(__STOP);
}
 
//Funcao Principal
void main(void)
{
     __inicializa;
     __SmartSensorCmd(1, 1, 8, 0);
     for (int __i0 = 0; __i0 < 1; ++__i0) {
         __SmartSensorCmd(1, 1, 9, 0);
         __SmartSensorCmd(1, 2, 9, 0);
         while((__EncoderGetValue(1) < 64)) {
             retinho();
             __delay(4);
         }
         freio();
     }
 
     while(TRUE) { }
}