Fixed the no path found bug - now the planner doesn't give a path if an obstacle is really close, also, the walkability test is working as per expectation now.