yocs_waypoints_navi: minimal improvement
Merge branch 'waypoints_update' of https://github.com/yujinrobot/yujin_ocs into waypoints_update