Get result of planning asynchronously in footstep_marker

in order for footstep_marker to not drop the result of the planninp, use goalCallback in the actionlib client
to the planning interface.