CN113084811A - 一种机械臂路径规划方法 - Google Patents
一种机械臂路径规划方法 Download PDFInfo
- Publication number
- CN113084811A CN113084811A CN202110389354.XA CN202110389354A CN113084811A CN 113084811 A CN113084811 A CN 113084811A CN 202110389354 A CN202110389354 A CN 202110389354A CN 113084811 A CN113084811 A CN 113084811A
- Authority
- CN
- China
- Prior art keywords
- path
- position point
- new
- mechanical arm
- goal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 68
- 239000012636 effector Substances 0.000 claims abstract description 11
- 238000005070 sampling Methods 0.000 claims description 14
- 238000001514 detection method Methods 0.000 claims description 12
- 101100412093 Schizosaccharomyces pombe (strain 972 / ATCC 24843) rec16 gene Proteins 0.000 claims 1
- 238000004898 kneading Methods 0.000 claims 1
- 238000000926 separation method Methods 0.000 claims 1
- 230000010415 tropism Effects 0.000 abstract description 2
- 239000013589 supplement Substances 0.000 abstract 1
- 230000033001 locomotion Effects 0.000 description 8
- 238000005457 optimization Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 206010063385 Intellectualisation Diseases 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 238000013138 pruning Methods 0.000 description 1
- 238000010200 validation analysis Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种机械臂路径规划方法,其特征在于:首先,引入目标搜索,对传统RRT算法进行改进,并使用改进后的RRT算法进行全局路径规划;其次,分别以斥力势场范围为阈值和机械臂末端执行器至末位置点影响修正引力函数和斥力函数,改进人工势场法,使用改进的人工势场法对局部路径进行优化;然后,使用三次B样条曲线对路径进行平滑处理并得到最终路径。本发明利用RRT算法的概率完备性规划全局路径,利用了人工势场法的有向性对RRT算法进行了补充,同时,RRT算法也为改进算法的避障能力提供了有效保证。总之,本发明在机械臂路径规划中能有效地获得最优路径规划,且规划效率高。
Description
技术领域
本发明涉及机器人运动规划领域,具体涉及一种机械臂路径规划方法。
背景技术
电子商务的高速发展带动了我国物流业的自动化和智能化。随着互联网电商平台订单量的大幅增长以及产品种类的多元化,对仓库中货物的拣选、货柜堆垛的时效及工作量的要求越来越高,而传统的仓储系统中,人工货柜堆垛和分拣货柜中物品已经成为仓储自动化的瓶颈,亟待解决的问题,其中货柜物品的自动货柜堆垛首先需解决机械臂的运动规划问题。
在机械臂的运动规划领域中,常用的有自由空间法、人工势场法、快速拓展随机树算法(RRT)、可视图法、栅格解耦法和拓扑法等运动规划方法。现有技术中,Mashayekhi,Reza等人提出混合RRT、Informed RRT*-Connect等算法,在算法中引入双树模型。Khan,AT提使用称为加权雅可比快速探索随机树(WJRRT)的智能算法对硬性和软性机械手的路径进行规划。Kai Mi等人提出了一种结合运动学控制和快速探索随机采样方法的运动规划算法。Sertac Karaman提出一种基于RRT*的随时算法。Gitae Kang提出了一种机械手运动规划的目标导向(GO)采样方法。陈波芝等提出基于改进RRT算法利用剪枝择优和设置目标区域的方式使算法快速收敛。王怀江等提出基于遗传算法的机械臂优化方法为机械臂规划抓取的最短路径。这方法虽能有效解决路径规划问题,但针对特定场景,并不能有效地获得最优路径规划。
发明内容
本发明的目的在于克服上述缺点而提出了一种改进RRT-人工势场法的机械臂路径规划方法,能有效地获得最优路径规划。
本发明的一种机械臂路径规划方法,其中,该方法包括以下步骤:
步骤一、初始化机械臂工作空间及工作空间中环境信息,给定机械臂移动的始位置点qinit、机械臂移动的末位置点qgoal和机械臂移动步长S;
步骤二、利用改进RRT算法为机械臂规划全局路径;
步骤三、将改进RRT规划的全局路径PATH设为当前路径,并对当前路径进行判断;若存在冗余路径,将冗余节点设为改进人工势场法的始位置点qi、改进人工势场法的末位置点qj,开始采用改进人工势场法进行局部路径规划,否则执行步骤六;
步骤四、将人工势场法的始位置点qi、末位置点qj设为当前位置点和末位置点代入公式1计算引力,公式2计算斥力,并根据公式3求得当前位置点合力;由当前位置点沿合力方向拓展步长S生成新节点qnew;同理,重复步骤四直到新节点qnew和机械臂移动的末位置点qgoal的距离小于步长S,即Dis(qnew,qgoal)<S,令qgoal为qnew;
所述公式1为:
其中,Fatt为引力,ξ为常量;ρ(q,qgoal)为当前位置到末位置的距离, D为给定的当前位置与末位置距离的阈值;
所述公式2为:
其中,Frep为斥力,Frep1(q)、Frep2(q)分别为:
η为斥力场常量;ρ(q,qobs)为当前位置到障碍物距离;ρ0斥力势场范围;
所述公式3为:
Fvec(q)=Fatt(q)+Frep(q)
其中,Fvec为合力;
步骤五、当优化路径满足目标条件时,对优化路径进行碰撞检测。若碰撞,优化失败;若无碰撞发生,生成优化路径path,并替代原局部路径;
步骤六、采用三次B样条曲线光滑路径并生成最终路径。
上述机械臂路径规划方法,其中:所述改进RRT算法,包括以下步骤:
1)将始位置点qinit设置为随机树根节点Tinit,并令新节点等于始位置点qinit;
2)生成随机采样点qrand;
3)遍历随机树,搜索随机树距离qrand最近随机树节点qnearest;
4)由qrand沿qnearest方向拓展生成新的枝叶节点qnew,且连接qrand和qnew并进行碰撞检测,若碰撞,返回步骤2),若无碰撞发生,令qnew为qnearest子节点;
5)连接qnew和末位置点qgoal,并进行碰撞检测,若碰撞,返回步骤2),若无碰撞发生,执行步骤6);
6)令qgoal为qnew子节点,由末位置点qgoal开始,根据随机树中父子关系搜索路径节点,生成路径PATH。
上述机械臂路径规划方法,其中:所述改进人工势场法,在传统的人工势场法基础上,以障碍物斥力范围作为标准给定阈值D,用于修正引力函数,防止引力远大于斥力而导致路径与障碍物发生碰撞;同时,在原有斥力场的基础上增加机械臂末端执行器与末位置距离的影响,机械臂末端执行器靠近末位置时,斥力随着位置靠近而相应减小,避免斥力远大于引力而导致目标不可达。
本发明与现有技术的相比,具有明显的有益效果,由以上方案可知,所述改进RRT算法,针对传统随机树生长方向具有无向性,随着路径采样点的增加,冗余路径也随之增加问题,本发明通过引入目标搜索对传统的 RRT算法进行改进,改进RRT算法能够有效减少随机树无用生长,减小冗余路径,提高算法规划效率。所述改进人工势场法,针对人工势场法受力不平衡和目标不可达等问题,分别使用引入斥力范围作为阈值修正引力函数、当前位置点和末位置点距离作为影响参数修正斥力函数。此外,本发明利用RRT算法的概率完备性规划全局路径,利用了人工势场法的有向性对RRT 算法进行了补充,同时,RRT算法也为改进算法的避障能力提供了有效保证。总之,本发明在机械臂路径规划中能有效地获得最优路径规划,且规划效率高。
以下通过具体实施方式,进一步说明本发明的有益效果。
附图说明
图1为本发明的流程示意图;
图2为本发明的改进RRT算法的随机树生长图;
图3为具体实施方式中四种不同末位置点qgoal路径规划仿真图。
具体实施方式
以下结合附图及较佳实施例,对依据本发明提出的一种机械臂路径规划方法的具体实施方式、特征及其功效,详细说明如后。
参见图1,本发明的一种机械臂路径规划方法,其中,该方法包括以下步骤:
步骤一、初始化机械臂工作空间及工作空间中环境信息,给定机械臂移动的始位置点qinit、机械臂移动的末位置点qgoal和机械臂移动步长S;
步骤二、利用改进RRT算法为机械臂规划全局路径;
步骤三、将改进RRT规划的全局路径PATH设为当前路径,并对当前路径进行判断;若存在冗余路径,将冗余节点设为改进人工势场法的始位置点qi、改进人工势场法的末位置点qj,开始采用改进人工势场法进行局部路径规划,否则执行步骤六;
步骤四、将人工势场法的始位置点qi、末位置点qj设为当前位置点和末位置点代入公式1计算引力,公式2计算斥力,并根据公式3求得当前位置点合力;由当前位置点沿合力方向拓展步长S生成新节点qnew;同理,重复步骤四直到新节点qnew和机械臂移动的末位置点qgoal的距离小于步长S,即Dis(qnew,qgoal)<S,令qgoal为qnew;
所述公式1为:
其中Fatt为引力,ξ为常量;ρ(q,qgoal)为当前位置到末位置的距离, D为给定的当前位置与末位置距离的阈值;
所述公式2为:
其中Frep为斥力,Frep1(q)、Frep2(q)分别为:
η为斥力场常量;ρ(q,qobs)为当前位置到障碍物距离;ρ0斥力势场范围;
所述公式3为:
Fvec(q)=Fatt(q)+Frep(q)
其中Fvec为合力;
步骤五、当优化路径满足目标条件时,对优化路径进行碰撞检测。若碰撞,优化失败;若无碰撞发生,生成优化路径path,并替代原局部路径;
步骤六、采用三次B样条曲线光滑路径并生成最终路径。
所述改进RRT算法,包括以下步骤:
1)将始位置点qinit设置为随机树根节点Tinit,并令新节点等于始位置点qinit;
2)生成随机采样点qrand;
3)遍历随机树,搜索随机树距离qrand最近随机树节点qnearest;
4)由qrand沿qnearest方向拓展生成新的枝叶节点qnew,且连接qrand和qnew并进行碰撞检测,若碰撞,返回步骤2),若无碰撞发生,令qnew为qnearest子节点;
5)连接qnew和末位置点qgoal,并进行碰撞检测,若碰撞,返回步骤2),若无碰撞发生,执行步骤6);
6)令qgoal为qnew子节点,由末位置点qgoal开始,根据随机树中父子关系搜索路径节点,生成路径PATH。
所述改进人工势场法,在传统的人工势场法基础上,以障碍物斥力范围作为标准给定阈值D,用于修正引力函数,防止引力远大于斥力而导致路径与障碍物发生碰撞;同时,在原有斥力场的基础上增加机械臂末端执行器与末位置距离的影响,机械臂末端执行器靠近末位置时,斥力随着位置靠近而相应减小,避免斥力远大于引力而导致目标不可达。
其中:
1.1传统RRT算法基本原理
快速拓展随机树算法(RRT)基本原理是将始位置点作为随机树的根位置点,然后,在工作空间内随机采样并找到随机树上距离采样点最近节点,由最近节点沿采样点方向拓展一个步长生成新的枝叶节点,直到末位置点成为随机树枝叶节点。最后,连接随机树枝叶节点生成一条连接始、末位置点的无规则路径。
1.2传统人工势场法基本原理
人工势场法最早是针对移动机器人避障规划。其算法的基本思想是将机器人转化为一个质点,将整个环境转化为一个人造势场,该势场包含末位置点对机器人的引力势场和障碍物对机器人的斥力势场,机器人受引力势场产生的引力和斥力势场产生的叠加斥力,沿引力和斥力的合力方向运动。
1.3改进RRT算法原理
针对传统随机树生长方向具有无向性,随着路径采样点的增加,冗余路径也随之增加。本发明通过引入目标搜索,该方法能够有效减少随机树无用生长,减小冗余路径,提高算法规划效率(如图2)。
具体算法描述如下:
1)将始位置点qinit设置为随机树根节点Tinit,并令qnew=qinit;
2)生成随机采样点qrand;
3)遍历随机树,搜索随机树距离qrand最近随机树节点,将其命名为 qnearest;
4)由qrand沿qnearest方向拓展生成新的枝叶节点qnew,且连接qrand和qnew并进行碰撞检测,若碰撞,返回步骤2),若无碰撞发生,令qnew为qnearest子节点,并进入下一步;
5)连接qnew和末位置点qgoal。并进行碰撞检测,若碰撞,返回步骤2),若无碰撞发生,进入下一步;
6)令qgoal为qnew子节点,由末位置点qgoal开始,根据随机树中父子关系搜索路径节点,生成路径PATH。
其中qinit是随机树始位置点,qgoal是随机树的末位置点,qnew是随机树新增枝叶节点,qnearest是随机树上距离随机采样点qrand节点最近节点,S是步长。其中qnew的计算如下:
qrand-qnearest=
((xrand-xnearest),(yrand-ynearest),(zrand-znearest))
图2是随机树生长图。黑点是RRT随机树节点和随机采样点;qinit是随机树始位置点;qgoal是随机树的末位置点;qnew是随机树新增枝叶节点;qnearest是随机树上距离随机采样点qrand节点最近节点;S是步长。
1.4改进人工势场法原理
人工势场法全部信息来源引力势场和斥力势场,当机械臂远离末位置点时:引力远大于斥力,规划路径易与障碍物发生碰撞;当障碍物靠近末位置点时:斥力远大于引力,易发生目标不可达。针对上述问题,对人工势场法进行改进,解决路径与障碍碰撞和目标不可达等问题。
人工势场主要由末位置点对机械臂末端执行器产生的引力势场和障碍物产生的斥力势场组成。故人工势场Uvec可定义为:
Uvec(q)=Uatt(q)+Urep(q)
其中,q为机械臂末端执行器当前位置点,Uatt(q)表示引力势场,Urep(q) 表示斥力势场。相应的合力Fvec为:
Fvec(q)=Fatt(q)+Frep(q)
针对当前位置与末位置距离过大而导致受力不平衡问题,以障碍物斥力范围作为标准给定阈值D,用于修正引力函数,防止引力远大于斥力而导致路径与障碍物发生碰撞。将Uatt(q)表示为:
ξ为常量;ρ(q,qgoal)为当前位置到末位置的距离;D为给定的当前位置与末位置距离的阈值;
由引力势场引发的引力相应表示为:
针对于目标不可达的问题,在原有斥力场的基础上增加机械臂末端执行器与末位置距离的影响,机械臂末端执行器靠近末位置时,斥力随着位置靠近而相应减小,避免斥力远大于引力而导致目标不可达。Urep(q)表示为:
由斥力势场引发的斥力相应表示为:
Frep1(q)、Frep2(q)分别为:
其中,η为斥力场常量;ρ(q,qobs)为当前位置到障碍物距离;ρ0斥力势场范围;
1.5非均匀B样条曲线
机械臂工作空间出现数目较多的随机障碍物时,为满足避障需求,规划路径往往会出现路径转折。在此情况下,机械臂会因为加速度突变而引起机体振动,对机体造成伤害。因此,本发明引入非均匀B样条曲线平滑路径,为机械臂在复杂的障碍环境中提供有效解决方案。
B样条曲线方程为:
其中,pi控制点,N(i,n)为n次B样条的基函数。M为区间数,n为样条曲线的次数。
B样条的基本函数Cox-deBoor递归公式定义:
从上面公式中可知,第j个控制点对应的n次B样条基数只与[tj,t(j+n+1)] 个参数参数域有关。
本发明定义的是n次n+1阶B样条曲线,既当路劲节点为m时,该样条曲线共有m+n个参数区间,其合法的定义区域为[Un,Um]。
1.6改进RRT-人工势场法混合算法
本发明提出的改进RRT-人工势场法混合算法,是利用改进RRT算法对全局路径进行规划,当RRT规划存在冗余路径时,使用人工势场法对局部进行优化,并用优化路径取代冗余路径。其具体流程如图1所示。
算法描述如下:
1)初始化机械臂工作空间及工作空间中环境信息,给定机械臂移动的始、末位置点qinit、qgoal和机械臂移动步长S;
2)利用改进RRT算法为机械臂规划全局路径,其具体流程如改进RRT 算法描述所示;
3)将改进RRT规划全局路径PATH设为当前路径,并对当前路径进行判断。若存在冗余路径,将冗余节点设为人工势场法始、末位置点qi、qj,开始改进人工势场法局部路径规划;否则执行步骤6);
4)将始、末位置点qi、qj为当前位置点和末位置点代入计算引力公式、计算斥力公式,并求得当前位置点合力大小及方向。由当前位置点沿合力方向拓展步长S生成新节点qnew。同理,重复上述步骤直到Dis(qnew,qgoal)<S,令qgoal为qnew;
5)当优化路径满足目标条件时,对优化路径进行碰撞检测。若碰撞,优化失败;若无碰撞发生,生成优化路径path,并替代原局部路径;
6)使用三次B样条曲线光滑路径并生成最终路径;
实验验证分析
为了验证改进RRT-人工势场法混合算法的有效性和可行性,在Python 上对改进算法进行比较和仿真实验。所有实验均在16G内存的Intel i7-9750H DELL Y7000计算机上进行。
将改进RRT-人工势场法算法同人工势场法、RRT和Bi-RRT算法进行对比分析。实验进行在地图大小为100×100×100,障碍物数目N为50的随机障碍场景中,始位置点为(0,0,0),末位置点为(100,100,100)。
当N=30,40,50时,对该算法实验50次。实验结果如表1所示,随着环境复杂程度增加,其平均路径长度无明显变化。由此可知,改进RRT- 人工势场法混合算法不受复杂程度发生变化,且该算法能够稳定有效为机械臂规划出一条无碰撞的光滑路径。
表1障碍物数量不同时各算法数据分析
为验证本文所提出的算法是否能够有效为机械臂在工作空间中规划路径,故使用Python中模拟机械臂实验场景。该场景中,包含一个模拟传送带AABB包围盒和由若干AABB包围盒组成的立式货架,其具体如图3所示。图3(a)-(d)为四种不同末位置点路径规划图,始位置点位于传送带上,且坐标为(10,25,11)。结果表明,本发明提出的改进RRT-人工势场法混合算法能够为机械臂规划出由传送带至货架任意格子的无碰光滑路径。
以上所述,仅是本发明的较佳实施例而已,并非对本发明作任何形式上的限制,任何未脱离本发明技术方案内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化与修饰,均仍属于本发明技术方案的范围内。
Claims (3)
1.一种机械臂路径规划方法,其特征在于:该方法包括以下步骤:
步骤一、初始化机械臂工作空间及工作空间中障碍物环境信息,给定机械臂移动的始位置点q init 、机械臂移动的末位置点q goal 和机械臂移动步长S;
步骤二、利用改进快速拓展随机树算法RRT为机械臂规划全局路径;
步骤三、将改进RRT规划的全局路径PATH设为当前路径,并对当前路径进行判断;若存在冗余路径,将冗余节点设为改进人工势场法的始位置点q i 、改进人工势场法的末位置点q j ,开始采用改进人工势场法进行局部路径规划,否则执行步骤六;
步骤四、将改进人工势场法的始位置点q i 、末位置点q j 设为当前位置点和末位置点代入公式1计算引力、公式2计算斥力,并根据公式3求得当前位置点合力及方向;由当前位置点沿合力方向拓展步长S生成新节点q new ;判断新节点q new 和机械臂移动的末位置点q goal 的距离是否小于步长S,若大于和等于,即Dis(q new ,q goal )S,则执行步骤四;若小于,即Dis(q new , q goal )<S,若令q goal 为q new ,执行步骤五;
所述公式1为:
所述公式2为:
η为斥力场常量;ρ(q,q obs )为当前位置点到障碍物距离;ρ 0 斥力势场范围;
所述公式3为:
步骤五、进行碰撞检测,若碰撞,优化失败;若无碰撞发生,生成优化路径path,并替代原局部路径;
步骤六、采用三次B样条曲线光滑路径并生成最终路径。
2.如权利要求1所述的机械臂路径规划方法,其特征在于:所述改进RRT算法,包括以下步骤:
将始位置点q init 设置为随机树根节点T init ,并令新节点等于始位置点q init ;
生成随机采样点q rand ;
遍历随机树,搜索随机树中离q rand 最近随机树节点q nearest ;
由q rand 沿q nearest 方向拓展生成新的枝叶节点q new ,且连接q rand 和q new 并进行碰撞检测,若碰撞,返回步骤2);若无碰撞发生,令q new 为q nearest 子节点;
连接q new 和末位置点q goal ,并进行碰撞检测,若碰撞,返回步骤2);若无碰撞发生,执行步骤6);
令q goal 为q new 子节点,由末位置点q goal 开始,根据随机树中父子关系搜索路径节点,生成路径PATH。
3.如权利要求1或2所述的机械臂路径规划方法,其特征在于:所述改进人工势场法,在传统的人工势场法基础上,以障碍物斥力范围作为标准给定阈值D,用于修正引力函数,防止引力远大于斥力而导致路径与障碍物发生碰撞;在原有斥力场的基础上增加机械臂末端执行器与末位置点q goal 距离的影响,机械臂末端执行器靠近末位置点q goal 时,斥力随着位置靠近而相应减小,避免斥力远大于引力而导致目标不可达。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110389354.XA CN113084811B (zh) | 2021-04-12 | 2021-04-12 | 一种机械臂路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110389354.XA CN113084811B (zh) | 2021-04-12 | 2021-04-12 | 一种机械臂路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113084811A true CN113084811A (zh) | 2021-07-09 |
CN113084811B CN113084811B (zh) | 2022-12-13 |
Family
ID=76677841
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110389354.XA Active CN113084811B (zh) | 2021-04-12 | 2021-04-12 | 一种机械臂路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113084811B (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113771035A (zh) * | 2021-09-24 | 2021-12-10 | 河北工业大学 | 基于rrt*算法的冗余多自由度机械臂避障路径优化方法 |
CN113858210A (zh) * | 2021-11-01 | 2021-12-31 | 贵州大学 | 基于混合算法的机械臂路径规划方法 |
CN113885535A (zh) * | 2021-11-25 | 2022-01-04 | 长春工业大学 | 一种冲击约束的机器人避障和时间最优轨迹规划方法 |
CN113906908A (zh) * | 2021-11-24 | 2022-01-11 | 镇江大全现代农业发展有限公司 | 一种适用于采摘机器人的无碰撞运动规划方法及装置 |
CN114161416A (zh) * | 2021-12-06 | 2022-03-11 | 贵州大学 | 基于势函数的机器人路径规划方法 |
CN114200931A (zh) * | 2021-12-01 | 2022-03-18 | 浙江大学 | 一种基于b样条曲线优化的移动机器人路径平滑方法 |
CN114564009A (zh) * | 2022-01-21 | 2022-05-31 | 首都医科大学 | 一种手术机器人路径规划方法及系统 |
CN114610026A (zh) * | 2022-03-04 | 2022-06-10 | 广东电网有限责任公司广州供电局 | 集中式汽车充电站接入配电网的线路规划方法、系统及介质 |
CN115229772A (zh) * | 2022-08-23 | 2022-10-25 | 深圳市越疆科技有限公司 | 机器人及其控制方法、装置、设备、存储介质、机械臂 |
CN115502960A (zh) * | 2022-10-28 | 2022-12-23 | 深圳市深科达智能装备股份有限公司 | 末端组件、作业装置及其控制方法 |
CN115570566A (zh) * | 2022-09-28 | 2023-01-06 | 长春工业大学 | 一种改进apf-rrt算法的机器人避障路径规划方法 |
CN115946117A (zh) * | 2022-12-16 | 2023-04-11 | 昆明理工大学 | 一种三维空间路径规划方法 |
CN116872212A (zh) * | 2023-08-14 | 2023-10-13 | 山东工商学院 | 一种基于A-Star算法和改进人工势场法的双机械臂避障规划方法 |
CN117124335A (zh) * | 2023-10-25 | 2023-11-28 | 山东工商学院 | 一种基于路径标记回溯策略的改进式rrt路径规划方法 |
CN117841006A (zh) * | 2024-03-06 | 2024-04-09 | 中建三局集团有限公司 | 抓取机械手多优化目标的轨迹优化方法及装置 |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005043742A2 (en) * | 2003-10-30 | 2005-05-12 | The Regents Of The University Of California | Universal three phase controllers for power converters |
JP2009211571A (ja) * | 2008-03-06 | 2009-09-17 | Sony Corp | 軌道計画装置及び軌道計画方法、並びにコンピュータ・プログラム |
KR20110048330A (ko) * | 2009-11-02 | 2011-05-11 | 삼성전자주식회사 | 로봇의 경로 계획 장치 및 그 방법 |
CN102591332A (zh) * | 2011-01-13 | 2012-07-18 | 同济大学 | 用于无人驾驶汽车局部路径规划的装置及方法 |
JP2013242777A (ja) * | 2012-05-22 | 2013-12-05 | Tokyo Univ Of Agriculture & Technology | 植物栽培方法と植物栽培システム |
CN105867365A (zh) * | 2016-03-11 | 2016-08-17 | 中国矿业大学(北京) | 基于改进人工势场法的路径规划导航系统及方法 |
CN109434836A (zh) * | 2018-12-14 | 2019-03-08 | 浙江大学 | 一种结合球树模型的机械手人工势场空间路径规划方法 |
CN109491389A (zh) * | 2018-11-23 | 2019-03-19 | 河海大学常州校区 | 一种具有速度约束的机器人轨迹跟踪方法 |
CN110228069A (zh) * | 2019-07-17 | 2019-09-13 | 东北大学 | 一种机械臂在线避障运动规划方法 |
CN110285802A (zh) * | 2019-06-11 | 2019-09-27 | 安徽理工大学 | 快速扩展随机树路径光滑方法 |
CN110471429A (zh) * | 2019-09-19 | 2019-11-19 | 华南农业大学 | 基于改进人工势场法的割草机器人实时避障方法 |
CN110497403A (zh) * | 2019-08-05 | 2019-11-26 | 上海大学 | 一种改进双向rrt算法的机械臂运动规划方法 |
CN110962130A (zh) * | 2019-12-24 | 2020-04-07 | 中国人民解放军海军工程大学 | 基于目标偏向寻优的启发式rrt机械臂运动规划方法 |
CN112549016A (zh) * | 2020-10-21 | 2021-03-26 | 西安工程大学 | 一种机械臂运动规划方法 |
-
2021
- 2021-04-12 CN CN202110389354.XA patent/CN113084811B/zh active Active
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2005043742A2 (en) * | 2003-10-30 | 2005-05-12 | The Regents Of The University Of California | Universal three phase controllers for power converters |
JP2009211571A (ja) * | 2008-03-06 | 2009-09-17 | Sony Corp | 軌道計画装置及び軌道計画方法、並びにコンピュータ・プログラム |
KR20110048330A (ko) * | 2009-11-02 | 2011-05-11 | 삼성전자주식회사 | 로봇의 경로 계획 장치 및 그 방법 |
CN102591332A (zh) * | 2011-01-13 | 2012-07-18 | 同济大学 | 用于无人驾驶汽车局部路径规划的装置及方法 |
JP2013242777A (ja) * | 2012-05-22 | 2013-12-05 | Tokyo Univ Of Agriculture & Technology | 植物栽培方法と植物栽培システム |
CN105867365A (zh) * | 2016-03-11 | 2016-08-17 | 中国矿业大学(北京) | 基于改进人工势场法的路径规划导航系统及方法 |
CN109491389A (zh) * | 2018-11-23 | 2019-03-19 | 河海大学常州校区 | 一种具有速度约束的机器人轨迹跟踪方法 |
CN109434836A (zh) * | 2018-12-14 | 2019-03-08 | 浙江大学 | 一种结合球树模型的机械手人工势场空间路径规划方法 |
CN110285802A (zh) * | 2019-06-11 | 2019-09-27 | 安徽理工大学 | 快速扩展随机树路径光滑方法 |
CN110228069A (zh) * | 2019-07-17 | 2019-09-13 | 东北大学 | 一种机械臂在线避障运动规划方法 |
CN110497403A (zh) * | 2019-08-05 | 2019-11-26 | 上海大学 | 一种改进双向rrt算法的机械臂运动规划方法 |
CN110471429A (zh) * | 2019-09-19 | 2019-11-19 | 华南农业大学 | 基于改进人工势场法的割草机器人实时避障方法 |
CN110962130A (zh) * | 2019-12-24 | 2020-04-07 | 中国人民解放军海军工程大学 | 基于目标偏向寻优的启发式rrt机械臂运动规划方法 |
CN112549016A (zh) * | 2020-10-21 | 2021-03-26 | 西安工程大学 | 一种机械臂运动规划方法 |
Non-Patent Citations (4)
Title |
---|
LU YAFEI等: "An Improved UAV Path Planning method Based on RRT-APF Hybrid strategy", 《2020 5TH INTERNATIONAL CONFERENCE ON AUTOMATION, CONTROL AND ROBOTICS ENGINEERING (CACRE)》 * |
QQ_45957970: "机器人学强化训练,适用动态避障,采用算法为RRT做全局规划,人工势场法作为局部规划", 《CSDN》 * |
刘冰雁等: "基于改进人工势场的无人地面车辆路径规避算法", 《中国惯性技术学报》 * |
黄鑫等: "基于改进RRT算法的线缆路径规划研究", 《计算机仿真》 * |
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113771035A (zh) * | 2021-09-24 | 2021-12-10 | 河北工业大学 | 基于rrt*算法的冗余多自由度机械臂避障路径优化方法 |
CN113858210B (zh) * | 2021-11-01 | 2023-04-25 | 贵州大学 | 基于混合算法的机械臂路径规划方法 |
CN113858210A (zh) * | 2021-11-01 | 2021-12-31 | 贵州大学 | 基于混合算法的机械臂路径规划方法 |
CN113906908A (zh) * | 2021-11-24 | 2022-01-11 | 镇江大全现代农业发展有限公司 | 一种适用于采摘机器人的无碰撞运动规划方法及装置 |
CN113885535A (zh) * | 2021-11-25 | 2022-01-04 | 长春工业大学 | 一种冲击约束的机器人避障和时间最优轨迹规划方法 |
CN113885535B (zh) * | 2021-11-25 | 2023-09-12 | 长春工业大学 | 一种冲击约束的机器人避障和时间最优轨迹规划方法 |
CN114200931A (zh) * | 2021-12-01 | 2022-03-18 | 浙江大学 | 一种基于b样条曲线优化的移动机器人路径平滑方法 |
CN114200931B (zh) * | 2021-12-01 | 2023-06-13 | 浙江大学 | 一种基于b样条曲线优化的移动机器人路径平滑方法 |
CN114161416A (zh) * | 2021-12-06 | 2022-03-11 | 贵州大学 | 基于势函数的机器人路径规划方法 |
CN114564009A (zh) * | 2022-01-21 | 2022-05-31 | 首都医科大学 | 一种手术机器人路径规划方法及系统 |
CN114610026A (zh) * | 2022-03-04 | 2022-06-10 | 广东电网有限责任公司广州供电局 | 集中式汽车充电站接入配电网的线路规划方法、系统及介质 |
CN115229772A (zh) * | 2022-08-23 | 2022-10-25 | 深圳市越疆科技有限公司 | 机器人及其控制方法、装置、设备、存储介质、机械臂 |
CN115229772B (zh) * | 2022-08-23 | 2023-07-18 | 深圳市越疆科技股份有限公司 | 机器人及其控制方法、装置、设备、存储介质、机械臂 |
CN115570566A (zh) * | 2022-09-28 | 2023-01-06 | 长春工业大学 | 一种改进apf-rrt算法的机器人避障路径规划方法 |
CN115570566B (zh) * | 2022-09-28 | 2024-08-30 | 长春工业大学 | 一种改进apf-rrt算法的机器人避障路径规划方法 |
CN115502960A (zh) * | 2022-10-28 | 2022-12-23 | 深圳市深科达智能装备股份有限公司 | 末端组件、作业装置及其控制方法 |
CN115502960B (zh) * | 2022-10-28 | 2023-08-08 | 深圳市深科达智能装备股份有限公司 | 末端组件、作业装置及其控制方法 |
CN115946117A (zh) * | 2022-12-16 | 2023-04-11 | 昆明理工大学 | 一种三维空间路径规划方法 |
CN115946117B (zh) * | 2022-12-16 | 2024-06-11 | 昆明理工大学 | 一种三维空间路径规划方法 |
CN116872212A (zh) * | 2023-08-14 | 2023-10-13 | 山东工商学院 | 一种基于A-Star算法和改进人工势场法的双机械臂避障规划方法 |
CN117124335A (zh) * | 2023-10-25 | 2023-11-28 | 山东工商学院 | 一种基于路径标记回溯策略的改进式rrt路径规划方法 |
CN117124335B (zh) * | 2023-10-25 | 2024-01-05 | 山东工商学院 | 一种基于路径标记回溯策略的改进式rrt路径规划方法 |
CN117841006A (zh) * | 2024-03-06 | 2024-04-09 | 中建三局集团有限公司 | 抓取机械手多优化目标的轨迹优化方法及装置 |
CN117841006B (zh) * | 2024-03-06 | 2024-05-28 | 中建三局集团有限公司 | 抓取机械手多优化目标的轨迹优化方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN113084811B (zh) | 2022-12-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113084811B (zh) | 一种机械臂路径规划方法 | |
CN110228069B (zh) | 一种机械臂在线避障运动规划方法 | |
Bency et al. | Neural path planning: Fixed time, near-optimal path generation via oracle imitation | |
CN106166750B (zh) | 一种改进型d*机械臂动态避障路径规划方法 | |
Jordan et al. | Optimal bidirectional rapidly-exploring random trees | |
Perez et al. | Asymptotically-optimal path planning for manipulation using incremental sampling-based algorithms | |
CN109571466A (zh) | 一种基于快速随机搜索树的七自由度冗余机械臂动态避障路径规划方法 | |
Cao et al. | Improved PRM for path planning in narrow passages | |
Short et al. | Recent progress on sampling based dynamic motion planning algorithms | |
CN112539750B (zh) | 一种智能运输车路径规划方法 | |
Curtis et al. | Efficient and effective grasping of novel objects through learning and adapting a knowledge base | |
Kanehiro et al. | Efficient reaching motion planning and execution for exploration by humanoid robots | |
Dai et al. | Novel potential guided bidirectional RRT* with direct connection strategy for path planning of redundant robot manipulators in joint space | |
Nam et al. | Fast and resilient manipulation planning for object retrieval in cluttered and confined environments | |
CN115716264A (zh) | 一种基于机器人轨迹优化的涂装生产线优化方法 | |
Zhuang et al. | Obstacle avoidance path planning for apple picking robotic arm incorporating artificial potential field and a* algorithm | |
BAYGIN et al. | PSO based path planning approach for multi service robots in dynamic environments | |
Mousa et al. | Path planning for a 6 DoF robotic arm based on whale optimization algorithm and genetic algorithm | |
Vonásek et al. | Motion planning with motion primitives for industrial bin picking | |
CN115946117B (zh) | 一种三维空间路径规划方法 | |
Han et al. | RRT based obstacle avoidance path planning for 6-DOF manipulator | |
CN116872212A (zh) | 一种基于A-Star算法和改进人工势场法的双机械臂避障规划方法 | |
Medellin et al. | Automatic generation of robot and manual assembly plans using octrees | |
Imtiaz et al. | Implementing Robotic Pick and Place with Non-visual Sensing Using Reinforcement Learning | |
Rodriguez et al. | Multi-agent push behaviors for large sets of passive objects |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |