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

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