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

This reverts commit 40b452b6bfc901091462aa738ad31ce2790d190e.
Rebase from 'upstream'
Trimmed the branch to only the forward_command_controller sub directory