Fixed bug in setGoal, quieted some debug output
Finished reading from namespace in planner params