fixed IR Sensor for Teleop

fixed various issues for Teleop with IR sensors