Register plan done cb to footstep marker

https://github.com/jsk-ros-pkg/jsk_visualization/pull/111 misses to register the callback function to the marker.