I made two more funcitons to check if the robot is close to the wall. I had the code in main, I just put it in the .c file.