[yocs_waypoint_provider] : fix timestamping so rviz will always display
them (http://wiki.ros.org/rviz/DisplayTypes/Marker)