new version of my rover robot

have you tried the Servo library?