一种基于椭圆约束的机器人路径规划方法和装置制造方法及图纸

本发明专利技术为使机器人能够在环境障碍物形状、位置未知的情况下进行避障，提供一种基于椭圆约束的机器人路径规划方法，包括以下步骤，获取机器人运动信息、障碍物信息、目标环境信息；确定机器人与障碍物发生碰撞的条件；针对机器人与障碍物发生碰撞的条件，建立基于椭圆约束的运动避障模型；该椭圆满足的约束条件为：机器人在椭圆内、所检测到的障碍物点在椭圆外、最终目标点在椭圆边界上或者在椭圆外；采用Bug路径规划算法进行全局路径规划。达到规划机器人行进最短路径，实现实时性避障的目的。

【技术实现步骤摘要】
一种基于椭圆约束的机器人路径规划方法和装置
本专利技术属于机器人路径规划领域，具体涉及一种基于椭圆约束的机器人路径规划方法及装置。技术背景随着我国现代化技术的不断发展，机器人技术得到了迅速发展，机器人的应用也越来越广泛。路径规划作为移动机器人技术的一个重要分支，在机器人的相关技术研究中显得尤为重要。移动机器人路径规划是指在障碍物存在的环境下，机器人按照一定的优化准则，寻找一条从起始位置到目标位置的安全无碰撞路径。现有技术中的路径规划方法，根据对环境信息的掌握程度不同可分为:全局路径规划方法和局部路径规划方法。全局路径规划是要求环境信息已知的一种移动机器人路径规划，典型方法有:栅格法、可视图法和结构空间法等。该类方法的缺点在于不能实时解决环境中障碍物发生变化的问题，可用性差。局部路径规划是依据作业环境信息部分或完全未知的一种路径规划，常用方法有:人工势场法、模糊逻辑算法、遗传算法等。该方法缺点为:只能对局部路径进行规划，不能对全局规划路径进行优化。现有全局路径规划法是针对避免机器人与形状、位置已知障碍物发生碰撞时所采取的规划策略，不能实时解决环境中障碍物发生变化的问题，没有对障碍物进行主动的避障预防。
技术实现思路
本专利技术为实现机器人针对形状、位置未知的障碍物进行主动预防避障，提供一种基于椭圆约束的机器人路径规划方法。本专利技术为实现专利技术目的所采取的技术方案为，该基于椭圆约束的机器人路径规划方法包括如下步骤:获取机器人运动信息、障碍物信息、目标环境信息；确定机器人与障碍物发生碰撞的条件；针对机器人与障碍物发生碰撞的条件，建立基于椭圆约束的运动避障模型，该椭圆应满足的约束条件为，机器人在椭圆内、所检测到的障碍物点在椭圆外、最终目标点在椭圆边界上或者在椭圆外；采用Bug路径规划算法进行全局路径规划，机器人沿连接起点和最终目标点的直线路径前进，在遇到障碍物时建立基于椭圆约束的运动避障模型，当最终目标点在椭圆边界上时，无需再设置中间目标点，机器人沿当前位置向最终目标点运动；当最终目标点在椭圆边界外时，设置中间目标点；机器人沿当前位置与所述中间目标点之间的直线路径运动到所述中间目标点；机器人避障后再次沿连接所述中间目标点和最终目标点的直线路径前进，到达最终目标点。机器人从起始点出发，没有遇到障碍物时，沿起点与最终目标点之间的直线路径前进，当遇到第一个障碍物时，建立基于椭圆约束的运动避障模型。根据椭圆应满足的约束条件求得椭圆方程。当最终目标点在所建立的椭圆的边界上时，机器人直接沿当前位置运动到最终目标点。当最终目标点在所建立的椭圆的边界外时，选择该次模型中的中间目标点(第一中间目标点)，机器人沿直线从起始点运动到第一中间目标点，然后开始沿第一中间目标点与最终目标点之间的直线路径运动；当遇到第二个障碍物时，通过建立运动避障模型，选择该次模型中的中间目标点(第二中间目标点)，从机器人的当前位置，沿直线运动到第二中间目标点，然后开始沿第二中间目标点与最终目标点之间的直线路径运动。以此类推，最终通过机器人多次自主避障，达到最终目标点。建立运动避障模型的过程为，在机器人、障碍物和机器人要到达的最终目标点的位置已经确定的条件下，建立一个椭圆，使椭圆满足:机器人在椭圆内、所检测到的障碍物点在椭圆外、最终目标点在椭圆边界上或者在椭圆外。如果此时最终目标点在椭圆边界上，则机器人直接从当前位置向最终目标点沿直线运动，无需选择中间目标点。如果此时最终目标点在椭圆边界外，则此时需要选择各中间目标点，通过避障运动到达最终目标点。本专利技术方法中，所述机器人运动信息包括机器人运动方向、运动速度、运动坐标位置信息及机器人可获取环境信息范围的最大距离r和最大角度Θ ;所述障碍物信息包括每个障碍物的坐标位置信息；所述目标环境信息包括指定目标位置全局坐标信息。所述机器人与障碍物发生碰撞的条件为:d I Sina |〈Rsafed ^ r (I)0< α < Θ其中:d表示机器人与检测到的障碍物之间的距离，α表示机器人与障碍物之间距离向量和机器人运动方向的夹角，Rsafe表示机器人与障碍物不发生碰撞的最小安全距离，r表示机器人可获取环境信息范围的最大距离，Θ表示机器人可获取环境信息范围的最大角度。当机器人到障碍物距离沿机器人运动方向的距离分量大于安全距离Rsafe时，机器人运动路线不变，继续沿原直线路径运动，当机器人到障碍物距离沿机器人运动方向的距离分量小于安全距离Rsafe时，通过建立起基于椭圆约束的运动避障模型，进行避障运动。本专利技术方法中，所述建立基于椭圆约束的运动避障模型所述的椭圆方程表示为Φ1 (P, q, r) = {x I xVx+xV+rt ≤ 0},即椭圆内部满足 inti?1 = {x I Ot (P, q, r)〈0},椭圆边界值满足Ot(X) = χΤρ^+χ、1+:^ = O,其中t为运动的任一时刻，x为所规划椭圆上任意一点坐标，P表示二维正定矩阵，q表示2行I列实数矩阵，r为实数。T代表对矩阵进行转置运算。所述建立基于椭圆约束的运动避障模型过程具体为，椭圆约束模型:本文档来自技高网...

【技术保护点】
一种基于椭圆约束的机器人路径规划方法，其特征在于，包括如下步骤：获取机器人运动信息、障碍物信息、目标环境信息；确定机器人与障碍物发生碰撞的条件；针对机器人与障碍物发生碰撞的条件，建立基于椭圆约束的运动避障模型；该椭圆应满足的约束条件为：机器人在椭圆内、所检测到的障碍物点在椭圆外、最终目标点在椭圆边界上或者在椭圆外；采用Bug路径规划算法进行全局路径规划：机器人沿连接起点和最终目标点的直线路径前进，在遇到障碍物时建立基于椭圆约束的运动避障模型，当最终目标点在椭圆边界上时，无需再设置中间目标点，机器人沿当前位置向最终目标点运动；当最终目标点在椭圆边界外时，设置中间目标点；机器人沿当前位置与所述中间目标点之间的直线路径运动到所述中间目标点；机器人避障后再次沿连接所述中间目标点和最终目标点的直线路径前进，到达最终目标点。

【技术特征摘要】
1.一种基于椭圆约束的机器人路径规划方法，其特征在于，包括如下步骤:获取机器人运动信息、障碍物信息、目标环境信息； 确定机器人与障碍物发生碰撞的条件； 针对机器人与障碍物发生碰撞的条件，建立基于椭圆约束的运动避障模型；该椭圆应满足的约束条件为:机器人在椭圆内、所检测到的障碍物点在椭圆外、最终目标点在椭圆边界上或者在椭圆外； 采用Bug路径规划算法进行全局路径规划:机器人沿连接起点和最终目标点的直线路径前进，在遇到障碍物时建立基于椭圆约束的运动避障模型，当最终目标点在椭圆边界上时，无需再设置中间目标点，机器人 沿当前位置向最终目标点运动；当最终目标点在椭圆边界外时，设置中间目标点；机器人沿当前位置与所述中间目标点之间的直线路径运动到所述中间目标点；机器人避障后再次沿连接所述中间目标点和最终目标点的直线路径前进，到达最终目标点。2.根据权利要求1所述的基于椭圆约束的机器人路径规划方法，其特征在于: 所述机器人运动信息包括机器人运动方向、运动速度、运动坐标位置信息及机器人可获取环境信息范围的最大距离r和最大角度Θ ;所述障碍物信息包括每个障碍物的坐标位置信息；所述目标环境信息包括指定目标位置全局坐标信息。3.根据权利要求1所述的基于椭圆约束的机器人路径规划方法，其特征在于，所述机器人与障碍物发生碰撞的条件为 d I sina <Rsafe d < r (I)0〈α〈 Θ 其中:d表示机器人与检测到的障碍物之间的距离， α表示机器人与障碍物之间距离向量和机器人运动方向的夹角， Rsafe表示机器人与障碍物不发生碰撞的最小安全距离， r表示机器人可获取环境信息范围的最大距离， Θ表示机器人可获取环境信息范围的最大角度。4.根据权利要求1或2或3所述的基于椭圆约束的机器人路径规划方法， 其特征在于， 所述运动避障模型基于椭圆约束的椭圆方程表示为: Φ1 (P, q, r) = {x I xVx+xV+rt ≤ 0},即椭圆内部满足 ?η?Φ' = &|0’，110〈0}，椭圆边界值满足(^00 = xVx+xV+rt = 0，其中 t 为运动的任一时刻，X为所规划椭圆上任意一点坐标，P表示二维正定矩阵，q表示2行I列实数矩阵，r为实数，...

【专利技术属性】
技术研发人员：吴怀宇，张琴丽，罗欢，陈洋，周致富，滕雄，李威凌，
申请(专利权)人：武汉科技大学，
类型：发明
国别省市：湖北;42