Updated pathfining and object detection

Made some changes to manhattan to better suit our purpose.
Simulation of front and rear sensors for object detection