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

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