Revert "Trimmed the branch to only the yocs_waypoints_navi sub directory"

This reverts commit 79b704cd3e68a2c92cde909a0edac373e95d4dfd.
Rebase from 'upstream'
Trimmed the branch to only the yocs_waypoints_navi sub directory