用Matlab编写的轨迹发生器，输入初始的位置速度，姿态角，姿态变化等信息，模拟得到陀螺仪输出和加速度计的输出-Written with the Matlab path generator, enter the initial position, velocity, attitude, attitude changes and other information, the simulated gyro output and the output of the accelerometer

该程序包括了飞行器轨迹计算、陀螺和加速度计的采样输入、以及由四元素解算出的飞行器姿态、位置、速度-The program includes the aircraft trajectory calculation, the sampling gyro and accelerometer input, and the solution calculated by the four elements of aircraft attitude, position, velocity

在磁力计、重力加速度、机体加速度计模型基础上计算姿态角参数-In the magnetometer, gravity, body accelerometer attitude angle calculated based on the model parameters

采用加速度计和陀螺仪互补滤波获得载体三维姿态。-Using accelerometer and gyroscope carrier complementary filter to get 3 d pose.

两种基于互补滤波的姿态算法，对陀螺仪和加速度计进行数据融合，解算姿态。一种使用了梯度下降算法，另一种使用反馈修正和李雅普诺夫分析。-Two algorithms for attitude estimate based on complementary filtering. Data form Gyroscope and Accelerometer are fused. One is based on gradient descent algorithm while the other is ba