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

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