Olá pessoal quem estiver vendo essa minha mensagem, vcs poderiam verificar meu projeto da Interface de controle de chaves com servo motor no microcontrolador 8051 em linguagem C. Estou com dificuldade com as duas chaves , se puderem verificar fico muito grato !

// Programa C para interface de servo motor com microcontrolador 8051// Programa C para interface de servo motor com microcontrolador 8051#include <REGX51.H>
void Delay_servo(int unsigned);
sbit control_pin=P2^0;sbit CHV1=P0^0;sbit CHV2=P0^1;

void main()
{ P0=0x07; // porta de entrada control_pin=0;   // pino de saída {
if(CHV1==1)
{        // Gira para 90 graus             control_pin=1;             Delay_servo(1218);             control_pin=0;}

 if (CHV2==1)
  {                     // Gira para 180 graus            control_pin=1;            Delay_servo(1470);            control_pin=0;
            }
}while(1);
}
void Delay_servo(unsigned int d)
  {
  TMOD &=0xF0; // Limpa campo de 4 bits para Timer0
  TMOD|=0x01; // Define timer0 em mode1, 16bit

  TH0=0xFF - (d>>8)&0xFF; // Carregar valores de atraso Timer 0 + Deslocamento à direita bit a bit[c][d]a >> b
  TL0=0xFF- d&0xFF;              

  ET0=1; //Habilita interrupções do timer0
  EA=0; // Interrupção Global

  TR0=1; // Inicia o cronômetro 0

  while(TF0==0); // Espera estouro

  TR0=0; //Parar timer0
 
  TF0=0; // Limpar sinalizador
}