Adding testing of pathfinding
Add close route function in LocationManager
Fix some errors from previos changes