Chnanged the PWM frequency to create a signal that is more friendly to the Lego servo.
PWM now jumps in steps compatible with the Lego servo's 7 positions on either side of center.