Teleop Update

Added code for servos (assuming they get added to the robot) and updated
pragmas and lift code