一种可倾转三旋翼无人机的控制方法技术

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

【技术实现步骤摘要】
一种可倾转三旋翼无人机的控制方法


[0001]本专利技术涉及多旋翼无人机
，具体涉及一种可倾转三旋翼无人机的控制方法。

技术介绍

[0002]近年来，多旋翼无人机在航测、安防监控、电力巡检、农业与应急搜救等领域得到了广泛的应用。可倾转三旋翼无人机属于多旋翼无人机的一种，相对于传统多旋翼无人机，可倾转三旋翼无人机具备结构更紧凑、能效更高的特点，但同时，可倾转三旋翼具有静不稳定、强耦合、强非线性等动力学特点，控制的难度较高。
[0003]具体的，传统的多旋翼无人机的飞行控制方法将俯仰姿态与前飞运动耦合，无法实现前飞与俯仰姿态的自由搭配飞行，降低了任务载荷使用的灵活性，提高了对任务载荷设备自身调节能力的要求，降低了系统整体效能。
[0004]综上所述，传统的多旋翼无人机的飞行控制方法存在控制模式较为单一、调节效果有限的问题。

技术实现思路

[0005]有鉴于此，本专利技术提供一种可倾转三旋翼无人机的控制方法，通过改进控制解算和控制分配方法，解决了传统的多旋翼无人机的飞行控制方法存在的控制模式较为单一、调节效果有限的问题。
[0006]为解决以上问题，本专利技术的技术方案为采用一种可倾转三旋翼无人机的控制方法，包括：获取无人机的实时状态数据；获取无人机的任务指令；基于所述实时状态数据和所述任务指令进行双回路控制解算，生成伪控制指令；基于所述伪控制指令进行控制分配计算并生成三旋翼的电机油门和舵机偏转角度指令。
[0007]可选地，基于所述实时状态数据和所述任务指令进行双回路控制解算，包括：在外回路中，基于所述实时状态数据中的速度及位置数据和所述任务指令中的目标速度及目标位置指令进行控制解算，生成前飞直接力伪控制指令、高度控制直接力伪控制指令和滚转姿态指令；在内回路中，基于所述实时状态数据中的姿态及角速率数据、所述滚转姿态指令和所述任务指令中的俯仰姿态指令及偏航姿态指令进行控制解算，生成滚转力矩伪控制指令、偏航力矩伪控制指令和俯仰力矩伪控制指令。
[0008]可选地，基于所述实时状态数据中的速度及位置数据和所述任务指令中的目标速度及目标位置指令进行控制解算，包括：基于所述速度及位置数据中的前飞速度及轴向位置和所述目标速度及目标位置指令进行控制解算，生成所述前飞直接力伪控制指令；基于所述速度及位置数据中的侧向速度及侧向位置和所述目标速度及目标位置指令进行控制解算，生成所述滚转姿态指令；基于所述速度及位置数据中的天向速度及高度和所述目标速度及目标位置指令进行控制解算，生成所述高度控制直接力伪控制指令。
[0009]可选地，基于所述实时状态数据中的姿态及角速率数据、所述滚转姿态指令和所
述任务指令中的俯仰姿态指令及偏航姿态指令进行控制解算，包括：基于所述姿态及角速率数据中的滚转角、滚转角速率和所述滚转姿态指令进行控制解算，生成所述滚转力矩伪控制指令；基于所述姿态及角速率数据中的偏航角、偏航角速率和所述偏航姿态指令进行控制解算，生成所述偏航力矩伪控制指令；基于所述姿态及角速率数据中的俯仰角、俯仰角速率和所述俯仰姿态指令进行控制解算，生成所述俯仰力矩伪控制指令。
[0010]可选地，基于所述伪控制指令进行控制分配计算并生成三旋翼的电机油门和舵机偏转角度指令，包括：将待控制的舵机的偏转参数等效为直接力的力学关系矩阵；基于所述伪控制指令和所述直接力的力学关系矩阵计算得到直接力控制量；基于所述直接力控制量反算生成所述三旋翼的电机油门和舵机偏转角度指令。
[0011]可选地，所述控制方法还包括：预设所述伪控制指令中各类伪控制指令的优先级，在生成的所述伪控制指令中包含多类伪控制指令时，基于预设的所述伪控制指令中各类伪控制指令的优先级，按照优先级由高至低的方式依次对所述伪控制指令进行控制分配计算。
[0012]可选地，所述控制方法还包括：预设电机的工作参数区间和舵机的工作参数区间，在按照优先级由高至低的方式依次对所述伪控制指令进行控制分配计算时，若存在生成的电机油门指令不属于所述电机的工作参数区间和/或生成的舵机偏转角度指令不属于所述舵机的工作参数区间时，抑制当前已参与控制分配计算中优先级最低的伪控制指令对应的通道输出，直至生成的电机油门指令属于所述电机的工作参数区间且生成的舵机偏转角度指令属于所述舵机的工作参数区间。
[0013]可选地，所述无人机被配置为：第一旋翼的电机具备前后倾转的功能；第二旋翼的电机具备前后倾转的功能；第三旋翼的电机不具备倾转的功能。
[0014]可选地，获取无人机的任务指令，包括：获取无人机的实时遥控的任务指令；或获取无人机的离线规划任务中的任务指令；或获取无人机的在线规划任务中的任务指令。
[0015]本专利技术的首要改进之处为提供的一种可倾转三旋翼无人机的控制方法，通过基于状态数据和任务指令进行双回路控制解算后进行分配计算，生成三旋翼的电机油门和舵机偏转角度指令，实现了俯仰姿态控制与前飞控制的解耦及无人机固定倾角前飞的控制模式，解决了传统的多旋翼无人机的飞行控制方法存在的控制模式较为单一、调节效果有限的问题。
附图说明
[0016]图1是本专利技术的可倾转三旋翼无人机的控制方法的简化流程图。
具体实施方式
[0017]为了使本领域的技术人员更好地理解本专利技术的技术方案，下面结合附图和具体实施例对本专利技术作进一步的详细说明。
[0018]如图1所示，一种可倾转三旋翼无人机的控制方法，包括：
[0019]S1：获取无人机的实时状态数据。
[0020]进一步的，所述实时状态数据至少包括无人机位置、速度、姿态、过载、角速率等数据。
[0021]S2：获取无人机的任务指令。
[0022]进一步的，获取无人机的任务指令，包括：获取无人机的实时遥控的任务指令；或获取无人机的离线规划任务中的任务指令；或获取无人机的在线规划任务中的任务指令。其中，所述无人机被配置为：第一旋翼的电机具备前后倾转的功能；第二旋翼的电机具备前后倾转的功能；第三旋翼的电机不具备倾转的功能。
[0023]S3：基于所述实时状态数据和所述任务指令进行双回路控制解算，生成伪控制指令。
[0024]进一步的，基于所述实时状态数据和所述任务指令进行双回路控制解算，包括：在外回路中，基于所述实时状态数据中的速度及位置数据和所述任务指令中的目标速度及目标位置指令进行控制解算，生成前飞直接力伪控制指令、高度控制直接力伪控制指令和滚转姿态指令；在内回路中，基于所述实时状态数据中的姿态及角速率数据、所述滚转姿态指令和所述任务指令中的俯仰姿态指令及偏航姿态指令进行控制解算，生成滚转力矩伪控制指令、偏航力矩伪控制指令和俯仰力矩伪控制指令。
[0025]本专利技术通过设置双回路进行并行计算，一方面减少单个任务的等待时间的同时降低系统的响应时间，降低了无人机控制的时延，另一方面通过外回路控制无人机的速度及位置、通过内回路控制无人机的姿态，有效提升了控制模式的多样性，实现了俯仰姿态控制与前飞控制的解耦及无人机固定倾角前飞的控制模式。本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种可倾转三旋翼无人机的控制方法，其特征在于，包括：获取无人机的实时状态数据；获取无人机的任务指令；基于所述实时状态数据和所述任务指令进行双回路控制解算，生成伪控制指令；基于所述伪控制指令进行控制分配计算并生成三旋翼的电机油门和舵机偏转角度指令。2.根据权利要求1所述的控制方法，其特征在于，基于所述实时状态数据和所述任务指令进行双回路控制解算，包括：在外回路中，基于所述实时状态数据中的速度及位置数据和所述任务指令中的目标速度及目标位置指令进行控制解算，生成前飞直接力伪控制指令、高度控制直接力伪控制指令和滚转姿态指令；在内回路中，基于所述实时状态数据中的姿态及角速率数据、所述滚转姿态指令和所述任务指令中的俯仰姿态指令及偏航姿态指令进行控制解算，生成滚转力矩伪控制指令、偏航力矩伪控制指令和俯仰力矩伪控制指令。3.根据权利要求2所述的控制方法，其特征在于，基于所述实时状态数据中的速度及位置数据和所述任务指令中的目标速度及目标位置指令进行控制解算，包括：基于所述速度及位置数据中的前飞速度及轴向位置和所述目标速度及目标位置指令进行控制解算，生成所述前飞直接力伪控制指令；基于所述速度及位置数据中的侧向速度及侧向位置和所述目标速度及目标位置指令进行控制解算，生成所述滚转姿态指令；基于所述速度及位置数据中的天向速度及高度和所述目标速度及目标位置指令进行控制解算，生成所述高度控制直接力伪控制指令。4.根据权利要求2所述的控制方法，其特征在于，基于所述实时状态数据中的姿态及角速率数据、所述滚转姿态指令和所述任务指令中的俯仰姿态指令及偏航姿态指令进行控制解算，包括：基于所述姿态及角速率数据中的滚转角、滚转角速率和所述滚转姿态指令进行控制解算，生成所述滚转力矩伪控制指令；基于所述姿态及角速率数据中的偏航角、偏航角速率和所述偏航姿态指令进行控制解算...

【专利技术属性】
技术研发人员：唐汇川，饶丹，
申请(专利权)人：成都纵横大鹏无人机科技有限公司，
类型：发明
国别省市：