无人机避障方法及系统、无人机集群避障方法及系统.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN113625762A(43)申请公布日2021.11.09(21)申请号202111001691.3(22)申请日2021.08.30(71)申请人吉林大学地址130000吉林省长春市朝阳区前进大街2699号(72)发明人杨光马海旭周宁曲东明陈冠宇杨云瑞金雪莹(74)专利代理机构北京高沃律师事务所11569代理人董领逊(51)Int.Cl.G05D1/10(2006.01)权利要求书2页说明书12页附图4页(54)发明名称无人机避障方法及系统、无人机集群避障方法及系统(57)摘要本发明提供了一种无人机避障方法及系统、无人机集群避障方法及系统，主要包括：获取动态障碍物的位置信息；基于所述位置信息和拟线性变参模型，反演预测所述动态障碍物的飞行轨迹；基于所述飞行轨迹，确定无人机与所述动态障碍物之间的碰撞时间区间；基于所述碰撞时间区间，确定所述无人机是否进入碰撞区域，并当所述无人机进入所述碰撞区域时，根据所述无人机与所述动态障碍物之间的相对位置，选择相应的避障方案。本发明无需建模，只需要根据基于位置信息和拟线性变参模型，就能够反演预测动态障碍物的飞行轨迹，达到精准预测动态障碍物的移动轨迹，精准避障的目的。CN113625762ACN113625762A权利要求书1/2页1.一种无人机避障方法，其特征在于，包括：获取动态障碍物的位置信息；基于所述位置信息和拟线性变参模型，反演预测所述动态障碍物的飞行轨迹；基于所述飞行轨迹，确定无人机与所述动态障碍物之间的碰撞时间区间；基于所述碰撞时间区间，确定所述无人机是否进入碰撞区域，并当所述无人机进入所述碰撞区域时，根据所述无人机与所述动态障碍物之间的相对位置，选择相应的避障方案。2.根据权利要求1所述的一种无人机避障方法，其特征在于，所述获取动态障碍物的位置信息，具体包括：基于激光雷达和双目相机共同获取动态障碍物的位置信息。3.根据权利要求1所述的一种无人机避障方法，其特征在于，所述基于所述位置信息和拟线性变参模型，反演预测所述动态障碍物的飞行轨迹，具体包括：基于拟线性变参模型确定动态障碍物飞行轨迹所满足的状态方程；基于所述位置信息计算动态障碍物加速度和动态障碍物速度；所述位置信息至少包括连续采集的5个位置点信息；根据所述状态方程、所述动态障碍物加速度和所述动态障碍物速度，计算所述动态障碍物的系统参数和推力加速度；根据所述动态障碍物的系统参数和推力加速度，反演预测所述动态障碍物的飞行轨迹。4.根据权利要求1所述的一种无人机避障方法，其特征在于，所述基于所述飞行轨迹，确定无人机与所述动态障碍物之间的碰撞时间区间，具体包括：基于所述飞行轨迹，计算全局任一维度下无人机与所述动态障碍物的动态距离；在标定维度下，将所述动态距离小于碰撞区距离的时间区间确定为局部时间区间；所述标定维度为任一维度；将所有所述局部时间区间进行并集操作，构成碰撞时间区间。5.根据权利要求4所述的一种无人机避障方法，其特征在于，所述基于所述碰撞时间区间，确定所述无人机是否进入碰撞区域，具体包括：判断不同维度下的所述局部时间区间之间是否有交集；若是，则所述无人机进入碰撞区域；若否，则所述无人机未进入碰撞区域。6.根据权利要求4所述的一种无人机避障方法，其特征在于，所述当所述无人机进入所述碰撞区域时，根据所述无人机与所述动态障碍物之间的相对位置，选择相应的避障方案，具体包括：当所述无人机相对于所述动态障碍物的飞行路径为在水平正前方向且在±45度区间范围内时，在地球坐标系下选择的避障方案为所述无人机增大Z轴正方向的推力；当所述无人机相对于所述动态障碍物的飞行路径为左侧方向且±45度区间范围内时，在地球坐标系下选择的避障方案为所述无人机增大X轴负方向的推力；当所述无人机相对于所述动态障碍物的飞行路径为右侧方向且±45度区间范围内时，在地球坐标系下选择的避障方案为所述无人机增大Y轴负方向放入推力；当所述无人机相对于所述动态障碍物的飞行路径为水平正后方向且±45度区间范围2CN113625762A权利要求书2/2页内时，在地球坐标系下选择的避障方案为所述无人机增大原始方向推力。7.根据权利要求6所述的一种无人机避障方法，其特征在于，在地球坐标系下选择的避障方案为前半程加速后半程减速的平滑轨迹移动方案。8.一种无人机避障系统，其特征在于，包括：位置信息获取模块，用于获取动态障碍物的位置信息；反演预测模块，用于基于所述位置信息和拟线性变参模型，反演预测所述动态障碍物的飞行轨迹；碰撞时间区间确定模块，用于基于所述飞行轨迹，确定无人机与所述动态障碍物之间的碰撞时间区间；避障方案选择模块，用于基于所述碰撞时间区间，确定所述无人机是否进入碰撞区域，并当所述无人机进入所述碰撞区域时，