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

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