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

This reverts commit f5d50ec18792436eddd61d5ce1ca7fb867f3b719.
Rebase from 'upstream'
Trimmed the branch to only the odometry_to_motion_matrix sub directory