Attiny2313 control Parallax Standard Servo Motor

Dear all Sir/Madam,

I have facing a problem when used Attiny2313 control my Parallax Standard Servo Motor. I used 16MHZ Crystal and below are my code. Can anyone tell me what went wrong when i try to simulate it my motor only full speed turn CW…

#include <avr/io.h>

#include <util/delay.h>

//Simple Wait Function

void Wait()

{

uint8_t i;

for(i=0;i<50;i++)

{

_delay_loop_2(0);

_delay_loop_2(0);

_delay_loop_2(0);

}

}

void main()

{

//Configure TIMER1

TCCR1A|=(1<<COM1A1)|(1<<COM1B1)|(1<<WGM11); //NON Inverted PWM

TCCR1B|=(1<<WGM13)|(1<<WGM12)|(1<<CS11)|(1<<CS10); //PRESCALER=64 MODE 14(FAST PWM)

ICR1=4999; //fPWM=50Hz (Period = 20ms Standard).

DDRD|=(1<<PD4)|(1<<PD5); //PWM Pins as Out

while(1)

{

OCR1A=375; //0 degree

Wait();

OCR1A=325; //90 degree

Wait();

OCR1A=425; //180 degree

Wait();

}

}