add simple integration for imu & encoder data