2,0 acelaramento

// 2,0 acelaramento .c - Criado pelo studio UNO 2.3
// 17 September 2015 1:00:44 pm
 
#include <uno.h>
 
 
// Declaracao das Variaveis
unsigned char ace_x;
unsigned char ace_y;
unsigned char ace_z;
int enc_dir;
int enc_esq;
unsigned char joy_c;
unsigned char joy_x;
unsigned char joy_y;
unsigned char joy_z;
 
// Prototipos
void freio(void); 
void gira_esq_90(void); 
void le_joy(void); 
void inicia(void); 
void le_enconder(void); 
void frente(void); 
 
//Funcoes do Usuario
void freio(void) 
{
     __motor_curso(__REVERSE);
     __delay(10);
     __motor_curso(__STOP);
}
 
void gira_esq_90(void) 
{
     __motor_curso(__LEFT_TURN);
     while((enc_dir < 34)) {
         le_enconder();
         while(!(enc_dir > 34)) { __delay(10); }
     }
     freio();
}
 
void le_joy(void) 
{
     ace_x = __ControllerGetAccelerometer_X(1);
     __delay(10);
     ace_y = __ControllerGetAccelerometer_Y(1);
     __delay(10);
     ace_z = __ControllerGetAccelerometer_Z(1);
     __delay(10);
     joy_x = __ControllerGetJoystick_X(1);
     __delay(10);
     joy_y = __ControllerGetJoystick_Y(1);
     __delay(10);
     joy_c = __ControllerGetButton_C(1);
     __delay(10);
     joy_z = __ControllerGetButton_Z(1);
     __delay(10);
}
 
void inicia(void) 
{
     enc_esq = 0;
     enc_dir = 0;
     __SmartSensorCmd(1, 1, 8, 0);
     __SmartSensorCmd(1, 1, 9, 0);
     __SmartSensorCmd(1, 2, 9, 0);
}
 
void le_enconder(void) 
{
     enc_esq = __EncoderGetValue(1);
     __delay(10);
     enc_dir = __EncoderGetValue(2);
     __delay(10);
}
 
void frente(void) 
{
     while(((enc_esq < 324) || (enc_dir < 324))) {
         le_enconder();
         if ((enc_esq > enc_dir)) {
             __motor_curso(__LEFT_TURN);
         }
         if ((enc_esq < enc_dir)) {
             __motor_curso(__RIGHT_TURN);
         }
         if ((enc_esq == enc_dir)) {
             __motor_curso(__FORWARD);
         }
     }
     freio();
}
 
//Funcao Principal
void main(void)
{
     __inicializa;
     inicia();
     gira_esq_90();
     while(TRUE) { }
}