finishing merging need to integrate imu