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

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