Add yocs_waypoints_navi package