updated IMU_odom.cpp to be on par with icp_odom.cpp