added option to score the heading of the rotate in place trajectories - this should help with the weird rotate in place behavior that happens sometimes - also minor printout change in the move base
Merge pull request #22 from bosch-ros-pkg/trajectory_planner_heading_cost

added option to score the heading of the rotate in place trajectories - ...