yocs_waypoints_navi: adds minor fixes and improvements