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

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