无人机项目跟踪记录四十四---姿态解算模块详解(1)
姿态解算模块中的函数,static void NonlinearSO3AHRSupdate(float gx, float gy, float gz, float ax, float ay, float az, float mx, float my, float mz, float twoKp, float twoKi, float dt),详解如下:此函数作用是对采集的数据进行数据处理以及四元素的自适应的互补滤波。 float recipNorm;