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

This reverts commit 70600d9d840fe0bc98baa4d7b19e7226ed66172e.
Rebase from 'upstream'
Trimmed the branch to only the strands_human_aware_navigation sub directory