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

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