Removed Extraneous Servo and Optics code