该matlab程序使用粗对准的方式对IMU 的初始姿态进行了解算