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

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