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

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