Working copy of altimeter and IMU accelerometer sensor fusion for increased accuracy and speed