added failing test
added failing test case and fixed diagonal pathfinding
removed useless condition