Modified Phase B Smart Code

- Added IR Unit Test to Smart Code
- Made the robot stop driving forward if there is a wall
- Made the robot stop driving forward if it has travelled one cell