Added removeObj() to heap, pathfinding almost done.