Control de Motor servo utilizando el Microcontroller PIC16F877A (5 / 6 paso)

Paso 5: Código para el PIC 16F877A

PR2 = 0XFA;                 oxFA 250 (permite configurar el período de tiempo)
CCPR2L = 125;               (utilizado para establecer el ciclo de trabajo)
CCP2CON | = (1 << 2) | (1 << 3);            seleccionar para el modo PWM
T2CON | = (1 << 2) | (1 << 1);              habilitar el timer 2, prescalar 16

while(1)
{

if(PORTC. F3 == 1) / / adelante
{
x = x + 1
CCPR2L = 250 + 125;               (utilizado para establecer el ciclo de trabajo)
T2CON | = (1 << 2) | (1 << 1);              habilitar el timer 2, prescalar 16
}
if(PORTC. F4 == 1) / / sala trasera
{
x = x-1
CCPR2L = 250-245;               (utilizado para establecer el ciclo de trabajo)
T2CON | = (1 << 2) | (1 << 1);              habilitar el timer 2, prescalar 16
}
delay_ms(100);
}
}