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

This reverts commit 4f46a492b6eecda20473c3084720730b8013249c.
Rebase from 'upstream'
Trimmed the branch to only the robot_pose_ekf sub directory