一种用于四旋翼飞行器的模块式控制方法

摘要

本发明属于无人机控制技术领域，涉及一种用于四旋翼飞行器的模块式控制方法：(1)电源及稳压电路为控制板各模块提供电源，控制板上电后初始化各模块，若接收到校准信号则对陀螺仪清零，否则主控模块接收来自陀螺仪模块的数据并进行Kalman滤波，利用四元数解算出倾角以得到当前飞行器的姿态，应用基于数字PID算法的四旋翼飞行器飞行控制方法，通过选择控制增益使系统实现期望性能，通过上位机软件对四旋翼飞行器的参数进行调整；(2)主控模块根据PID算法输出PWM信号通过MOS管驱动电机工作，同时陀螺仪模块继续检测当前飞行角度反馈给主控模块，无线模块接收来自遥控器的数据并送入主控模块中进行处理以执行相应的动作；该方法设计合理，原理科学。

主权项

一种用于四旋翼飞行器的模块式控制方法，其特征在于具体包括以下步骤：(1)电源及其稳压电路为控制板的各个模块的正常工作提供电源，控制板上电后初始化各模块并开启中断，此时若接收到校准信号则对陀螺仪进行清零，否则主控模块接收来自陀螺仪模块的数据并进行滤波，利用四元数解算出倾角以得到当前四旋翼飞行器的姿态，再应用基于数字PID算法的四旋翼飞行器飞行控制方法，通过选择控制增益使系统实现期望性能，通过上位机软件对四旋翼飞行器的参数进行调整以获得更好的性能；所述PID算法公式如下所示：$U_k=Kp*e_k+{\mathrm{Ki\Sigma }}_{j=0}^k{e}_j+Kd(e_k-e_{k-1})$其中Uk为系统产生的总的控制作用；e_k为当前系统偏差；e_j为系统偏差的过去值；e_k‑e_k‑1为当前系统偏差与上次系统偏差之差；Kp为比例调节系数，能加快系统的响应速度，提高系统的调节精度，克服干扰能力较强，控制及时、过渡时间短，在过渡过程终了时存在余差；Ki为积分调节系数，反映积分作用的强弱，积分作用使系统稳定性降低，在过渡过程结束时无余差；Kd为微分调节系数，反映微分作用的强弱，能改善系统的动态性能，微分作用能产生超前的控制作用，能够减少超调和调节时间，对噪声干扰有放大作用；(2)主控模块根据PID算法输出四路PWM信号并通过四个MOS管驱动四个电机工作以调整四旋翼飞行器姿态，同时陀螺仪模块继续检测当前飞行角度反馈给主控模块以实现四旋翼飞行器姿态的实时动态调整，无线模块接收来自外部独立配置的遥控器的数据并送入主控模块中进行处理以执行相应的动作，实现对四旋翼飞行器的控制。