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

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