Tests- Added IR coding

little clean up on the rest of the code (removed extra lines)
added Code for IR, haven't got the IR sensor with me, so will have to
check later if it works - Haven't added it Main loop yet