Ayuda con el control de unos servomotores

Hola gente soy nuevo en el foro y pues aun no se como subir imagenes y esas cosas de forma correcta.

Tengo un proyecto, necesito hacer un radar en X con dos servomotores, un servo tendra el sensor y el otro tendra un apuntador, el caso es que cuando el sensor detecte un objeto, el segundo servomotor debe de apuntar al objeto. Mi problema es que al hacer mi programa en CCS y simularlo en proteus funciona perfectamente tal y como lo quiero, pero a la hora de conectarlo en fisico pues nada mas no sirve.

//******************************************************************
#include <main.h>
#include <LCD.C>

int i, A;
void main()
{
setup_timer_2(T2_DIV_BY_16,255,1); //4.0 ms overflow, 4.0 ms interrupt

setup_ccp1(CCP_PWM);
setup_ccp2(CCP_PWM);
set_pwm1_duty((int16)0);
set_pwm2_duty((int16)0);
setup_comparator(NC_NC_NC_NC);
lcd_init();

while(TRUE)
{
for(i=0; i < 255; i++)
{
set_pwm1_duty(i);
delay_ms(10);

if(input(PIN_A0)==1)
{
for(A=0; A<=50; A++)
{
set_pwm2_duty(i);
delay_ms(5);
}
}
}

for(i = 255; i > 0; i--)
{
set_pwm1_duty(i);
delay_ms(10);

if(input(PIN_A0)==1)
{
for(A=0; A<=50; A++)
{
set_pwm2_duty(i);
delay_ms(5);
}
}
}
}

}
//********************************************************************

La frecuencia del duty a puse en 50hz, y utilizo una fuente de computadora.

Espero puedan ayudarme que no se cual es el problema en mi programa.
 
Atrás
Arriba