Added an Enable service to joint_position_controller.py that can enable/disable a servo so that it ignores position requests