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

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