Made the goal duration margin and scaling optional rosparameters

Useful for a robot who's controllers take longer to find a steady state