Astar problems
Moves AStarPlanner interrupt point outside of conditional.
This fixes the never-joining thread problem.
Sets replanRequested to false in AStarPlanner.
Removes debugging printouts.
All astar tests pass consistently, fixed timeout on a few of them
Merge branch 'astar'