AStarPathFinder: Separate relax step into own method
Save and load start and goal points as well
BinaryMinHeapTest: Make tests more exhaustive
Rename "end" to "goal"
Ensure that the start and goal points stay within the visible area