Inital Hardware Servo Control