Create mpu9250 gyro calibration function
Implement the "Simple Moving Average" algorithm for vector3d as a filter
Fix the memcpy address issue