refactored A* to be a bit cleaner
modularized planners to make metric gathering easier...
merged master