mantemdistancia

// mantemdistancia.c - Criado pelo studio UNO 2.3
// 4 November 2015 9:51:29 am
 
#include <uno.h>
 
 
// Declaracao das Variaveis
unsigned int distancia;
 
// Prototipos
void freio(void); 
 
//Funcoes do Usuario
void freio(void) 
{
     __motor_curso(__REVERSE);
     __delay(30);
     __motor_curso(__STOP);
}
 
//Funcao Principal
void main(void)
{
     __inicializa;
     while(TRUE) {
         distancia = __UltrasonicGetValueMM(1);
         if ((distancia > 250)) {
             __motor_curso(__FORWARD);
         }
         else {
             if ((distancia < 150)) {
                 __motor_curso(__BACKWARD);
             }
             else {
                 freio();
             }
         }
         __delay(5);
     }
 
     while(TRUE) { }
}