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

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