Updated teleop and Added basic IR test

bug: nxt trying to write over what im trying to write so it flickers a
lot