Added Servo Position on other code

For Autonomous.c previous commit was for ramp-start.c