Servo motor kontrol sorunu

[pars]

Merhaba aşağıdaki  verdiğim ,ödevim de kullanacağım servo devresini bir türlü çalıştıramadım . devrenin resimlerini videosunu ve kodlarını yükledim.İlginize şimdiden teşekkürler.
resim



video
VID 20140513 165010

kod;
define  servo2  portb.rb7
#define  buton1  porta.ra0
#define  buton2  porta.ra1


   unsigned short pozisyon =1;

   void init()
   {
   CMCON |=0X07 ;
   trisb.rb7=0;
   servo2=0;
   trisa=0xff;
   porta=0x00;

   }


void main()
{
init();
while(1)
{
   if(buton1)
   {
        pozisyon++;
        if(pozisyon>3)
             {
                  pozisyon=3;

             }
         while(buton1);

    }
    if(buton2)
   {
        pozisyon--;
        if(pozisyon<1)
             {
                  pozisyon=1;

             }
         while(buton2);

    }
    if(pozisyon==1)  //temel pozisyon

    {
      servo2=1;
      delay_us(500);
      servo2=0;
      delay_ms(19);
      delay_us(500);




    }
    if(pozisyon==2)  //alış

    {
      servo2=1;
      delay_us(1500);
      servo2=0;
      delay_ms(18);
      delay_us(500);

    }

    if(pozisyon==3)  //ağız kapama

    {
      servo2=1;
      delay_us(3000);
      servo2=0;
      delay_ms(17);


    }

   
}

}

COFIGLER;