Fixed Variable Name Bug and Initial Servo Angles