added overclock param - for calling the planner thread more frequently
added support in the header for overclocking the planner thread and new goal handling
added over clocking and better handling of new goals
removed prints