【四旋翼无人飞行器姿态解算方法概述1600字】

导论无人飞行器的姿态解算是通过MEMS传感器和姿态转换坐标系进行联立求解的，在进行姿态解算前需要对原始的传感器数据进行滤波处理，减小传感误差带来的测量偏差。将同轴向采集数据进行密集时间点分布和区域数据采集，设置一定比例采样值的数据集合，对数据集合中的传感器数值进行均值滤波处理，依次将传感器采集值和区域均值数值进行偏差判断，将绝对值最大的采集数据剔除区域数据集合，最终得到符合本区域的标准值，即为区域滤波处理后的精确采集值信息，通常初始采集频率可设置为10ms，而操作指令频率可设置为200ms，因此一个相对区域数据集合包含20个相关采集信息，姿态解算数值即为处理后的标准数值，计算公式如下所示。（4-21）（4-22）式中，即为同轴向中区域数据集的采集值，则为依次进行循环对比后的数值偏差最大值，与其对应的采集值将作为每次剔除数据，不再进行下一次循环对比，通过迭代次后即可的得到此区域的标准采集值，可作为后续姿态解算数据。同理，可对9轴传感器数据依次进行迭代滤波，减少由于采集突变和误差引起的控制姿态变化，可有效提高飞行器的控制稳定度和姿态平滑度，从数据源头减小了控制误差。本文采用四元数解算方法对姿态信息进行计算，四元数的本质是计算系统状态方程的过程参数，根据数据转换关系进行下一时刻状态估计，从而对检测得到的姿态信息进行变换计算，本文采用四元数状态方程作为系统坐标转换的计算方程，计算可得载体坐标系下的三轴姿态信息。四元数算法的本质是通过三轴方位和旋转运动对当前物理状态进行角度计算，其中三个参数表示三轴方位的旋转幅值，而另一个参数则表示三轴方位的旋转角度，通过四元数方位矩阵可解算姿态变化的滚转角roll、俯仰角pitch和偏航角yaw，其部分代码如下所示：/*****************/@brief四元数姿态解算函数/*****************/voidQuaternion::posture(floatroll,floatpitch,floatyaw){floatR =roll *radian*90;floatR =pitch*radian*90;floatY =yaw *radian*90;floatsinP=sin(P);floatsinY=sin(Y);floatsinR=sin(R);floatcosP=cos(P);floatcosY=cos(Y);floatcosR=cos(R);Q(q0)=sin(R)*cos(P)*cos(Y)-cos(R)*sin(P)*sin(Y);Q(q1)=cos(R)*sin(P)*cos(Y)+sin(R)*cos(P)*sin(Y);Q(q2)=cos(R)*cos(P)*sin(Y)-sin(R)*sin(P)*cos(Y);Q(q3)=cos(R)*cos(P)*cos(Y)+sin(R)*sin(P)*sin(Y);normalize();}如上代码所示，四元数解算是本文计算无人飞行器姿态信息的方法，通过飞行器运行时MEMS传感器的角速度和加速度信息，通过四元数转换矩阵可计算出飞行器载体坐标系下的滚转角、俯仰角和航向角数值，在无人飞行器的姿态计算过程中，包含数据采集、数据滤波、数据控制和数据转换等步骤，以四元数转换和复合控制算法为基础的无人飞行器姿态解算流程如图4-17所示。图4-17无人飞行器姿态解算流程示意图Fig.4-17SchematicdiagramofattitudesolutionprocessofUAV如上图所示，无人飞行器姿态解算流程主要分为四个步骤：首先，通过无人飞行器相对平面上的MEMS传感器测量陀螺的角速度信息和加速度计的加速度信息，通过卡尔曼滤波算法对数据进行滤波融合，通过四元数转换矩阵得到无人飞行器的姿态数值；其次，将计算得到的姿态信息作为实际值输入，将控制数据作为期望值输入，通过复合控制算法对角度环的PID控制器进行调整；再次，将控制器结果和陀螺角速度采集值进行联立得到角速度环的PID控制参数；最后，将PID控制变量传送给无人飞行器四轴向无刷电机，通过PWM占空比控制螺旋桨的转动速度和无人飞行器升力。同理，无人飞行器通过气压计敏感高度数值，与期望高度进行复合控制的PID算法解析，输出响应的高度差，并将数值传递给四轴向无刷电机，从而改变无人飞行器的实际高度。在无人飞行器控制流程中，四元数作为姿态解算方法，可对当前角度、速度和高度偏差值进行计算，和实际的操作期望值一同作为复合控制算法的输入量，对PID控制器进行修正，并将先验信息作为下一时刻的推理内容进行数据调控，因此，本文设计的复合控制算法和四元数姿态计算方法共同组成了无人飞行器的反馈调节系统，控制其稳定飞行和目标飞行。对MEMS传感器采集的三轴加速度Ax、Ay、Az数据和三轴陀螺Gx、Gy、Gz数据进行四元数坐标转换，可得到同一端方位的三轴向滚转角roll、俯仰角pitch和航向角yaw的