申请/专利权人：西北工业大学

申请日：2022-06-06

公开（公告）日：2024-04-16

公开（公告）号：CN115202387B

主分类号：G05D1/46

分类号：G05D1/46;G05D1/622

优先权：

专利状态码：有效-授权

法律状态：2024.04.16#授权;2022.11.04#实质审查的生效;2022.10.18#公开

摘要：本发明公开了一种基于仿鸟类趋光性的固定翼无人机避障控制方法，搭建固定翼无人机模型，并将该模型转化为基于位置、速度控制的二阶模型；基于鸟类趋光飞行特性，建立固定翼无人机趋光性避障模型，并结合固定翼无人机飞行约束等特性，设计相应的固定翼无人机避障策略及流程；设计安全、稳定的固定翼无人机避障控制律，实现固定翼无人机的可靠飞行。本发明对解决固定翼无人机避障控制问题具有很好的改善效果，增强了固定翼无人机飞行的安全性和鲁棒性，在无人系统控制领域具有很好的应用前景。

主权项：1.一种基于仿鸟类趋光性的固定翼无人机避障控制方法，其特征在于，包括如下步骤：步骤1：搭建固定翼无人机模型，并将固定翼无人机模型转化为基于速度、位置控制的二阶模型；固定翼无人机的二阶动力学模型表示为： 其中，x,y为固定翼无人机在惯性坐标系中的位置；ψ为固定翼无人机的航向角；v为固定翼无人机的前向速度；nv和nψ为均为系统控制输入；经过模型转换，固定翼无人机基于速度、位置控制的二阶模型为： 其中，q＝[x,y]T表示固定翼无人机的位置；p为固定翼无人机在惯性坐标系下三轴方向的速度；u为固定翼无人机的控制输入；步骤2：根据鸟类基于趋光性避障的特性，建立固定翼无人机趋光性避障模型；将无人机飞行过程中遇到的障碍物情形分为“单个障碍物”、“两个障碍物”以及“两个以上障碍物”三种进行趋光性建模；步骤2-1：在单个障碍物情形下，固定翼无人机U可飞行空域的角度大小为：AU＝2π-∠B1′UB2′3其中，∠B1′UB2′为受障碍物影响固定翼无人机不可飞行的空域角度；步骤2-2：在两个障碍物情形下，固定翼无人机U可飞行空域的角度大小为：AU＝∠B1UB2+π-∠B1UB1′-∠B2UB2′4其中，∠B1UB′1和∠B2UB′2为受障碍物影响固定翼无人机不可飞行的空域角度；∠B1UB2为固定翼无人机在两个障碍物间的可飞行空域；步骤2-3：在两个以上障碍物情形下，固定翼无人机U可飞行空域的角度大小为： 其中，为固定翼无人机在两个以上障碍物情况下的飞行空域；步骤2-4：将趋光性的大小用固定翼无人机进入可飞行区域的概率来衡量，且该概率服从[0,2π]上的均匀分布，因此候选趋光性模型表示为： 步骤2-5：为防止固定翼无人机在基于趋光性避障中受局部趋光影响而造成飞行碰撞，在式6所示的候选趋光性模型中引入距离因子，表示为：ξ＝eδ·Δr7其中，e为指数函数；δ为距离因子的权重系数；Δr是固定翼无人机到障碍物的距离；步骤2-6：固定翼无人机趋光性避障模型最终表示为： 其中，N为固定翼无人机检测到的障碍物总个数；步骤3：基于步骤2中所建立的趋光性避障模型，结合固定翼无人机飞行约束，设计固定翼无人机避障策略及流程；步骤3-1：建立固定翼无人机的飞行约束模型，具体表示为： 其中，vmin和vmax分别表示固定翼无人机的最小、最大飞行速度；w为固定翼无人机的航向角速度；wmax为最大航向角速度；R为转弯半径；Rmin为固定翼无人机的最小转弯半径；步骤3-2：根据步骤3-1中固定翼无人机的飞行特性，将固定翼无人机在飞行过程中遇到障碍物的情形分为情形1、情形2和情形3，并设计相应的飞行方案：a情形1：两个障碍物间的间距大于固定翼无人机的最小转弯半径，此时无人机能以任意入射方向通过障碍区域；b情形2：两个障碍物间的间距小于固定翼无人机的最小转弯半径，此时要保证无人机无碰撞的通过障碍区域，其入射方向θ满足约束范围θ∈[θ2,θ1]，其中，θ1和θ2为保证固定翼无人机无碰撞情况下与两个障碍物的临界入射方向；c情形3：对于存在两个以上障碍物的情况，当存在两个相同趋光大小的可飞行空域，固定翼无人机依照航迹飞行油耗最少的原则，选择最优可飞行路径；步骤4：将步骤2中所建立的趋光性避障模型与人工势场法相结合，设计固定翼无人机控制律，保证固定翼无人机无碰撞飞行；步骤4-1：搭建基于人工势场法的固定翼无人机避障模型，其中，飞行目标对固定翼无人机的引力函数表示为： 其中，qg为飞行目标的位置；λ为引力系数；障碍物对无人机的斥力函数表示为： 其中，di为无人机与探测到的第i个障碍物的间距；d0为障碍物对无人机的最大排斥距离；η为斥力系数；步骤4-2：将所设计的趋光性避障模型引入步骤4-1中的人工势场法避障模型中，引入后的引力函数表示为： 其中，ka为引力函数中的趋光模型权重系数；引入后的斥力函数表示为： 其中，kr为斥力函数中的趋光模型权重系数；步骤4-3：基于步骤4-2中的避障模型式12，设计固定翼无人机控制律，具体表示为： 其中，为第i个障碍物的位置；c1和c2均为控制系数；步骤4-4：将所设计的控制律作用于固定翼无人机，保证固定翼无人机的无碰撞飞行。

全文数据：

权利要求：

百度查询： 西北工业大学 一种基于仿鸟类趋光性的固定翼无人机避障控制方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD