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

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