PD6 ist kein Ausgang:

DDRC |= IO_PD6;

Drehbereich von 0,5 bis 2,2 Millisekunden erscheint mir zuviel für ein RS2-Servo.