Reverted to working code

Went back to working version of code, added 2 side IR sensors+ logic for
sensors