[发明专利]一种可倾转三旋翼无人机的控制方法

说明书

本发明公开了一种可倾转三旋翼无人机的控制方法，包括：获取无人机的实时状态数据；获取无人机的任务指令；基于所述实时状态数据和所述任务指令进行双回路控制解算，生成伪控制指令；基于所述伪控制指令进行控制分配计算并生成三旋翼的电机油门和舵机偏转角度指令。本发明通过基于状态数据和任务指令进行双回路控制解算后进行分配计算，生成三旋翼的电机油门和舵机偏转角度指令，实现了俯仰姿态控制与前飞控制的解耦及无人机固定倾角前飞的控制模式，解决了传统的多旋翼无人机的飞行控制方法存在的控制模式较为单一、调节效果有限的问题。

技术领域

本发明涉及多旋翼无人机技术领域，具体涉及一种可倾转三旋翼无人机的控制方法。

背景技术

近年来，多旋翼无人机在航测、安防监控、电力巡检、农业与应急搜救等领域得到了广泛的应用。可倾转三旋翼无人机属于多旋翼无人机的一种，相对于传统多旋翼无人机，可倾转三旋翼无人机具备结构更紧凑、能效更高的特点，但同时，可倾转三旋翼具有静不稳定、强耦合、强非线性等动力学特点，控制的难度较高。

具体的，传统的多旋翼无人机的飞行控制方法将俯仰姿态与前飞运动耦合，无法实现前飞与俯仰姿态的自由搭配飞行，降低了任务载荷使用的灵活性，提高了对任务载荷设备自身调节能力的要求，降低了系统整体效能。

综上所述，传统的多旋翼无人机的飞行控制方法存在控制模式较为单一、调节效果有限的问题。

发明内容

有鉴于此，本发明提供一种可倾转三旋翼无人机的控制方法，通过改进控制解算和控制分配方法，解决了传统的多旋翼无人机的飞行控制方法存在的控制模式较为单一、调节效果有限的问题。

为解决以上问题，本发明的技术方案为采用一种可倾转三旋翼无人机的控制方法，包括：获取无人机的实时状态数据；获取无人机的任务指令；基于所述实时状态数据和所述任务指令进行双回路控制解算，生成伪控制指令；基于所述伪控制指令进行控制分配计算并生成三旋翼的电机油门和舵机偏转角度指令。

可选地，基于所述实时状态数据和所述任务指令进行双回路控制解算，包括：在外回路中，基于所述实时状态数据中的速度及位置数据和所述任务指令中的目标速度及目标位置指令进行控制解算，生成前飞直接力伪控制指令、高度控制直接力伪控制指令和滚转姿态指令；在内回路中，基于所述实时状态数据中的姿态及角速率数据、所述滚转姿态指令和所述任务指令中的俯仰姿态指令及偏航姿态指令进行控制解算，生成滚转力矩伪控制指令、偏航力矩伪控制指令和俯仰力矩伪控制指令。

可选地，基于所述实时状态数据中的速度及位置数据和所述任务指令中的目标速度及目标位置指令进行控制解算，包括：基于所述速度及位置数据中的前飞速度及轴向位置和所述目标速度及目标位置指令进行控制解算，生成所述前飞直接力伪控制指令；基于所述速度及位置数据中的侧向速度及侧向位置和所述目标速度及目标位置指令进行控制解算，生成所述滚转姿态指令；基于所述速度及位置数据中的天向速度及高度和所述目标速度及目标位置指令进行控制解算，生成所述高度控制直接力伪控制指令。

可选地，基于所述实时状态数据中的姿态及角速率数据、所述滚转姿态指令和所述任务指令中的俯仰姿态指令及偏航姿态指令进行控制解算，包括：基于所述姿态及角速率数据中的滚转角、滚转角速率和所述滚转姿态指令进行控制解算，生成所述滚转力矩伪控制指令；基于所述姿态及角速率数据中的偏航角、偏航角速率和所述偏航姿态指令进行控制解算，生成所述偏航力矩伪控制指令；基于所述姿态及角速率数据中的俯仰角、俯仰角速率和所述俯仰姿态指令进行控制解算，生成所述俯仰力矩伪控制指令。

可选地，基于所述伪控制指令进行控制分配计算并生成三旋翼的电机油门和舵机偏转角度指令，包括：将待控制的舵机的偏转参数等效为直接力的力学关系矩阵；基于所述伪控制指令和所述直接力的力学关系矩阵计算得到直接力控制量；基于所述直接力控制量反算生成所述三旋翼的电机油门和舵机偏转角度指令。