// mostra garra.c - Criado pelo Studio UNO 2.11
// 14 December 2012 4:15:42 pm
#include <uno.h>
// Declaracao das Variaveis
unsigned int calib;
// Prototipos
void pega(void);
//Funcoes do Usuario
void pega(void)
{
__motor_curso(__STOP);
bitset(__TRIS_PWM, __DIGITAL1);
__PWM1 = 40;
__delay(1500);
__PWM1 = 180;
__delay(1500);
bitclr(__TRIS_PWM, __DIGITAL1);
}
//Funcao Principal
void main(void)
{
__inicializa;
bitset(__TRIS_PWM, __DIGITAL1);
__PWM1 = 180;
__delay(750);
calib = (__analog_in(0) + 50);
bitclr(__TRIS_PWM, __DIGITAL1);
while(TRUE) {
if (__UP_KEY) {
__motor_curso(__FORWARD);
}
if (__LEFT_KEY) {
__motor_curso(__LEFT_TURN);
}
if (__ENTER_KEY) {
__motor_curso(__STOP);
}
if (__RIGHT_KEY) {
__motor_curso(__RIGHT_TURN);
}
if (__BOTTOM_KEY) {
__motor_curso(__BACKWARD);
}
if ((__analog_in(0) > calib)) {
pega();
}
}
while(TRUE) { }
}