Important MEM-leak fixes. Stops planner from segfaulting on reset.

Conflicts:

	monolithic_pr2_planner/src/Heuristics/BFS2DHeuristic.cpp