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

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