CN114147708B - 基于改进的天牛须搜索算法的机械臂避障路径规划方法 - Google Patents
基于改进的天牛须搜索算法的机械臂避障路径规划方法 Download PDFInfo
- Publication number
- CN114147708B CN114147708B CN202111424954.1A CN202111424954A CN114147708B CN 114147708 B CN114147708 B CN 114147708B CN 202111424954 A CN202111424954 A CN 202111424954A CN 114147708 B CN114147708 B CN 114147708B
- Authority
- CN
- China
- Prior art keywords
- path
- mechanical arm
- point
- joint
- search
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 241000254173 Coleoptera Species 0.000 title claims abstract description 11
- 238000010845 search algorithm Methods 0.000 title claims abstract description 11
- 238000005457 optimization Methods 0.000 claims abstract description 22
- 238000001514 detection method Methods 0.000 claims abstract description 17
- 238000013210 evaluation model Methods 0.000 claims abstract description 9
- 238000004458 analytical method Methods 0.000 claims abstract description 4
- 239000013598 vector Substances 0.000 claims description 19
- 239000012636 effector Substances 0.000 claims description 14
- 239000011159 matrix material Substances 0.000 claims description 10
- 238000005070 sampling Methods 0.000 claims description 8
- 238000011156 evaluation Methods 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000013138 pruning Methods 0.000 claims description 4
- 230000002238 attenuated effect Effects 0.000 claims description 3
- 238000009499 grossing Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 6
- 238000011160 research Methods 0.000 description 5
- 238000012360 testing method Methods 0.000 description 5
- 241000283690 Bos taurus Species 0.000 description 2
- 241001481710 Cerambycidae Species 0.000 description 2
- 241000254158 Lampyridae Species 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000002068 genetic effect Effects 0.000 description 2
- 238000009776 industrial production Methods 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 239000002245 particle Substances 0.000 description 2
- 241000519996 Teucrium chamaedrys Species 0.000 description 1
- 244000273928 Zingiber officinale Species 0.000 description 1
- 235000006886 Zingiber officinale Nutrition 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 235000013305 food Nutrition 0.000 description 1
- 235000008397 ginger Nutrition 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000003016 pheromone Substances 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 230000022542 predatory behavior Effects 0.000 description 1
- 238000009966 trimming Methods 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
- B25J9/1666—Avoiding collision or forbidden zones
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J18/00—Arms
-
- 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/1674—Programme controls characterised by safety, monitoring, diagnostic
- B25J9/1676—Avoiding collision or forbidden zones
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明涉及自动控制技术领域,具体涉及一种机械臂避障路径规划方法。基于改进的BAS算法的机械臂避障轨迹规划方法,包括以下步骤:建立姿态规划结果的优化评估模型;获取机械臂末端起点和终点位姿,利用逆运动学解析法求解起点关节角和终点关节角,确定机械臂在空间中的位置;建立机械臂和障碍物碰撞检测模型;根据碰撞检测结果,结合优化评估模型,利用BAS4‑AO算法生成机械臂避障路径。本发明提供的基于改进的天牛须搜索算法的机械臂避障路径规划方法,可以有效简化初始路径,消除路径中的抖动,确保机械臂运行过程的安全性。
Description
发明内容
本发明涉及自动控制技术领域,具体涉及一种机械臂避障路径规划方法。
背景技术
近年来,随着科技的进步,我国制造业掀起了以机器人为核心的智能化、无人化的研究热潮。根据发展需要,很多情况下要求机器人能够根据复杂环境情况自主避障,这给机器人避障路径规划技术带来了广泛的应用前景。
将现有路径规划算法改进甚至结合成更高效的复合算法以适应更加复杂的路径规划任务,是目前的主流研究方向。目前用于路径规划优化的智能算法包括萤火虫算法(Firefly Algorithm,FA)、粒子群算法(Particle Swarm optimization,PSO)、遗传算法(Genetic Algorithm,GA)、人工蜂群算法(Artificial Bee Colony,ABC)、快速探索随机树算法(RRT)、蚁群算法(ACO)等。姜向远在模仿自然界中天牛捕食行为的基础上,提出了一种元启发式、高随机性、快速收敛的优化算法——天牛须搜索算法(Beetle AntennaeSearch,BAS)。如图3所示,在自然界中,天牛的捕食主要依靠头部两侧的触角,触角内的气味细胞能够感知空气中分散的信息素的浓度。由于不同触角上的气味细胞感知到两个方向上的浓度差异,天牛就会向浓度更大的一侧移动,从而不断更新位置,最终找到食物。根据天牛捕食行为,BAS算法的搜索过程主要由方向和步长两个参数控制。通过设置随机方向和减小搜索步长,可以保证在较大的搜索范围内进行优化,并在优化结束时快速收敛。同时,由于姿态随机性强,步长自衰减的限制,初始参数设置对优化结果影响较大,在机器人姿态规划领域应用时需要进行调整和改进。
六自由度机械臂在工业生产中有着非常广泛的应用,具有较大的研究价值。但目前使用的路径规划算法大多以随机采样的路径规划算法为主,虽然可以成功找到合适的运动路径,但由于进行了大范围的随机搜索,导致算法运算效率不高。
发明内容
本发明的目的是提供一种基于改进的BAS算法的机械臂避障轨迹规划方法,有效提高了算法在三维姿态规划中的路径探索和避障能力。
为实现上述目的,本发明采用的技术方案是:基于改进的天牛须搜索算法的机械臂避障路径规划方法,包括以下几个步骤:
建立姿态规划结果的优化评估模型;
获取机械臂末端起点和终点位姿,利用逆运动学解析法求解起点关节角和终点关节角,确定机械臂在空间中的位置;
建立机械臂和障碍物碰撞检测模型;
根据碰撞检测获得的试验参数,结合优化评估模型,利用改进后的BAS4-AO算法生成机械臂避障路径。
进一步地,优化评估模型包括用于优化机械臂关节角度的函数,其表达式为:
其中,θ(θt)为机械臂关节经过N次搜索迭代后的角度差之和;变量θi t表示在路径点i上采样时刻t处的关节角度;M表示路径规划过程中所有路径点的总数。
进一步地,优化评估模型包括用于优化运行路径长度的函数,其表达式为:
式中,L(P)表示机械臂末端执行器在空间中的移动距离,变量Pi t表示在路径点i上采样时刻t处的机械手端点位置;k表示路径中包含的路径点个数。
进一步地,算法完成的时间优化函数表达式为:
T=Tend-Tstart
进一步地,碰撞检测模型中,使用凸包简化模型作为机械臂模型,使用轴体包络模型作为障碍物模型。
进一步地,利用改进的BAS4-AO算法生成机械臂避障路径包含以下几个步骤:
(1)、初始化各项参数;
(2)、生成两个相互正交的路径点搜索方向,其中搜索方向的计算公式如下:
(3)、路径点空间位置生成
进行第t时刻迭代时,围绕空间坐标P的四个判断点的空间位置坐标为:
其中,搜索步长δ*是一个动态调整因子,随着搜索迭代循环衰减;
然后,生成下一次迭代的位姿信息:
Rt+1=Rt+δ**(Rg-Rt)*λ2
其中,L(P)作为四个判断点的适应度评价标准,符号函数min(·)是用于提取四个判断点中适应度函数值最小的点;矩阵Rg为目标点的旋转矩阵,Rt为当前点的旋转矩阵,以λ2作为匹配系数,δ*作为Rg到Rt的逼近步长;
(4)、碰撞检测及搜索步长调整
进行机械臂轴体与障碍物的碰撞检验,若无碰撞,则直接转入步骤(2)执行下一次迭代循环;若发生碰撞,则须衰减全局搜索步长,清除此次路径点信息并再次搜索新的路径点。
碰撞检测过程是将机械臂凸包简化模型和障碍物模型在三个坐标平面上投影,通过判断投影是否重合来确定是否发生碰撞。
(5)、进行关节角度寻优判断
根据机械臂末端执行器空间坐标求解机械臂关节角度,判断当前机械臂末端执行器关节角度θt和目标点关节角度θg之间的角度差是否小于阈值τ,若不小于阈值τ,则返回步骤(2)继续生成路径点;若小于阈值,则转入步骤(6);
(6)、关节角度局部变步长搜索:
其中,θ(θt)作为关节角度的适应度评价标准;
局部变步长的更新如下所示:
(7)、路径点精度判断
判断当前路径点与目标路径点的空间位置距离,若该距离不小于精度阈值μ,则返回步骤(6),若小于精度阈值μ,则进入步骤(8);
(8)、路径修剪
计算每个路径点各关节角度变化下的模量,确定最小关节变化所在的点,具体如下式所示:
将当前计算的路径点和具有最小关节变化的点进行标注,对标注点之间的路径点进行平滑处理,并使用当前最小关节变化的点的关节角替换标注点之间路径点的关节角。
本发明提供的基于改进的天牛须搜索算法的机械臂避障路径规划方法,生成两个相互正交的搜索方向并得出四个判断点的空间位置坐标,能够提高全局搜索能力,可以有效简化初始路径,消除路径中的抖动,确保机械臂运行过程的安全性。
附图说明
图1为本发明实施例中基于改进的天牛须搜索算法的机械臂避障路径规划方法的流程图;
图2是具有6个自由度的安川制造MOTOMAN-ES165D机械手模型图,a模型图,b是其坐标系模型图;
图3是本发明的机械臂位置和障碍物分布示意图;
图4是本发明采用凸包结构近似的机械臂建模的示意图;
图5是本发明采用轴体包络法近似的障碍物建模的示意图;
图6是本发明采用的判断点优化部分简化图;
图7是初始路径生成的路径信息图;
图8是初始路径生成的关节角度变化趋势图,a是靠近底座的前3个关节角度变化情况,b是靠近末端执行器的后3个关节角度变化情况;
图9是经过修剪的路径信息图;
图10是修剪后路径的关节角度变化趋势图,a是靠近底座的前3个关节角度变化情况,b是靠近末端执行器的后3个关节角度变化情况。
具体实施方式
为了便于理解本发明,下面结合附图和具体实施例,对本发明进行更详细的说明。附图中给出了本发明的较佳的实施例。但是,本发明可以以许多不同的形式来实现,并不限于本说明书所描述的实施例。相反地,提供这些实施例的目的是使对本发明公开内容的理解更加透彻全面。
实施例1本发明提供了一种基于改进的天牛须搜索算法的机械臂避障路径规划方法,可应用于机械臂姿态规划,流程如图1所示,具体包括以下步骤:
步骤一、利用旋量理论建立机械臂数学模型,建立姿态规划结果的优化评估模型,以获得最优的机械臂关节角度及运行路径长度
本实施例中,以安川制造MOTOMAN-ES165D型机械臂为研究对象,利用旋量理论建立数学模型,具体参数见图2。
对于一个具有6个自由度的串联机械臂,将它的各个关节运动整合成一个整体,就可以获得用于表征该机械臂正运动学模型的指数积公式:
式中,gst(θ)表示机械臂经过关节运动后末端执行器的刚体坐标系在基坐标系中的位姿矩阵,gst(0)表示各关节在零时刻下末端执行器的刚体坐标系在基坐标系中的初始位姿矩阵,θ和ξ分别表示对应关节的关节角度与关节旋量。通过指数积公式,可以建立起由机械臂所有关节的运动旋量表示的正运动学模型。
机械臂的初始位姿表示为:
即可求取该机械臂的指数积公式并可以表示为如下形式:
其中齐次坐标的数学表达公式如下:
nx=c1c23c5-s5(c1c4s23+s1s4)
ny=c23c5s1-s5(c1c4-c4s1s23)
nz=-c3(c5s2+c2c4s5)-s3(c2c5-c4s2s5)
ox=c6(c1s23s4-c4s1)+s6(c5s1s4+c1(c4c5s23+c23s5))
oy=c1(c4c6-c5s4s6)+s1(c6s23s4+s6(c4c5s23+c23s5))
oz=c23(c6s4+c4c5s6)-s23s5s6
ax=s1(c5c6s4+c4s6)+c1(c4c5c6s23-s4s6s23+c23c6s5)
ay=c6(c4c5s1s23-c1c5s4+c23s1s5)-s6(c1c4+s1s23s4)
az=c23(c4c5c6-s4s6)-c6s23s5
px=d6(c1s2s3-c1c2c3)c4s5-d6s1s4s5-(c1c2s3+c1s2c3)(d4+d6c5)+a3c1c2c3-a3c1s2s3+a2c1c2
py=d6(s1s2s3-s1c2c3)c4s5-d6c1s4s5-(s1c2s3+s1s2c3)(d4+d6c5)+a3s1c2c3-a3s1s2s3+a2s1c2
pz=d6(s2c3+c2s3)c4s5+d1+(s2s3-c2c3)(d4+d6c5)-a3c2s3-a2s2
式中,符号c表示三角函数中的余弦函数,s符号表示正弦函数,d表示对应关节之间的相对距离,s23表示sin(θ2+θ3)和c23表示cos(θ2+θ3)。
同理,由于为六个自由度的串联机械臂,适应度评价函数如下:
式中,θ(θt)表示六自由度机械臂的六个关节经过N次搜索迭代后的角度差之和,就是所有路径点角度差值的和;L(P)表示机械臂末端执行器在空间中的移动距离,k表示路径中包含的路径点个数。M为路径点的总个数。
R6指该变量为一个有6个元素向量,每个元素都是实数,属于实数域R(R6可以解为包含6个元素的向量,其中每个元素是实数),R3同理。
步骤二、读取机械臂末端起点和终点位姿,利用逆运动学解析法求解起点关节角和终点关节角
在获得机械臂末端位姿后,需要获取机械臂的各个关节角才能结合之前建立的机械臂模型,确定机械臂在空间中的位置。因此,通过逆运动学求解关节角是十分重要的。
步骤三、建立机械臂和障碍物碰撞检测模型
在实际实施过程中,机械臂和障碍物的空间位置关系见图3所示。障碍物数据如下表1所示。
表1障碍物模型数据
由于实际机械臂模型较为复杂,实施过程中建立了对应的凸包模型,具体见图4所示。障碍物简化模型采用了轴体包络,考虑到实际的误差还进行了膨化,具体见图5所示。
步骤四、利用改进后的BAS4-AO算法生成有效的机械臂避障路径,具体如下:
(1)、初始化各项参数
根据碰撞试验的机械臂参数,各个关节角度范围见下表2所示。
表2机械臂各个关节角度有效区间
根据试验经验,算法相关参数的选择见下表3所示。
表3路径规划参数配置组合
(2)、路径点搜索方向生成
与传统BAS算法的两个判断点相比,改进后的BAS4-AO算法拥有四个位置不同的判断点,如图6所示,因此需要两个相互正交的方向向量。
根据以下公式计算每个路径点的搜索方向:
式中,a1和a2是两个比例常数,rand(·)为均匀分布于[0,1]上的随机值。本实施例中,由于a1为1,a2为10,则试验中搜索方向受当前点到目标点的连线方向的影响较大。表示从左到右的方向向量;/>表示从下到上的方向向量。
将方向向量归一化处理:
(3)、路径点空间位置生成
进行第t时刻迭代时,围绕空间坐标P的四个判断点的空间位置坐标为:
其中,搜索步长δ*是一个动态调整因子,随着搜索迭代循环衰减。本实施例中,搜索步长δ*初始值为0.8。
然后,生成下一次迭代的位姿信息:
Rt+1=Rt+δ**(Rg-Rt)*λ2
其中,L(P)作为四个判断点的适应度评价标准,符号函数min(·)是用于提取四个判断点中适应度函数值最小的点。矩阵Rg为目标点的旋转矩阵,Rt为当前点的旋转矩阵,以λ2作为匹配系数,δ*在这里作为Rg到Rt的逼近步长和全局步长相等。
(4)、碰撞检测及搜索步长调整
进行机械臂轴体与障碍物的碰撞检验,若无碰撞,则直接转入步骤(2)执行下一次迭代循环;若发生碰撞,则须衰减全局搜索步长,清除此次路径点信息并再次搜索新的路径点。碰撞检测过程是将机械臂凸包简化模型和障碍物模型在三个坐标平面上投影,通过判断投影是否重合来确定是否发生碰撞。
全局搜索步长数值衰减模型表示如下:
其中,λ1是一个常数,该试验设置为0.998。
(5)、进行关节角度寻优判断
根据机械臂末端执行器空间坐标求解机械臂关节角度,判断当前机械臂末端执行器关节角度θt和目标点关节角度θg之间的角度差是否小于阈值τ;若不小于阈值τ,则返回步骤(2)继续生成路径点;若小于阈值τ,则转入步骤(6)开始关节角度寻优。
(6)、关节角度局部变步长探索
在当前机械臂末端执行器关节角度θt和目标点关节角度θg之间的角度差小于阈值τ时,搜索转移到以角度优化为主导的姿态控制部分,具体如下:
其中迭代原理与坐标点的迭代相似,将空间坐标Pt替换为关节角θt,适应度评价函数根据前文将L(Pt)替换为θ(θt)。
局部变步长的更新如下所示:
(7)、路径点精度判断
判断当前路径点与目标路径点的空间位置距离,若该距离不小于精度阈值μ,则返回步骤(6),若小于精度阈值μ,则进入步骤(8)。
(8)、路径修剪
试验生成的路径信息和关节变化信息见图7和图8所示。图8中可以明显发现,关节角度存在剧烈的波动。因此,为了确保机械臂运行的安全性,在迭代生成路径后,还需要通过预处理去除路径中可能存在的奇异点。
本实施例中,首先依次计算了每个路径点和后续点各关节角度变化下的模量,确定了最小关节变化所在的点。具体如下式所示:
将当前计算的路径点和具有最小关节变化的点进行标注,对标注点之间的路径点进行平滑处理,并使用当前最小关节变化的点的关节角替换标注点之间路径点的关节角。该方法对路径修剪后路径信息和关节变化信息见图9和图10所示。
实施例2为了比较本发明改进后的BAS4-AO算法和现有RRT算法以及BAS算法的区别,本实施例统计了多次相同情况下,使用三种算法对机械臂进行路径规划的实验数据,并进行比较,结果见表4。
表4改进后的BAS4-AO算法和RRT算法、BAS算法的优化比较
与传统的RRT算法相比,本发明改进的BAS4-AO算法的时间效率缩短了87.62%,路径长度缩短了29.83%,整体性能优于RRT算法在机械手姿态规划中的应用,表明该算法具有较好的路径优化能力。并且,本发明中的“四须”(四个判断点),相对于BAS算法原有的“两须”具有可选择的路径方向更多,全局寻优效果更好,使其路径长度缩短了18.87%,并使其全局搜索能力与原BAS算法相比提升了13%。
六自由度机械臂在工业生产中有着非常广泛的应用,具有较大的研究价值。但目前使用的路径规划算法大多以随机采样的路径规划算法为主,虽然可以成功找到合适的运动路径,但由于进行了大范围的随机搜索,导致算法运算效率不高。本发明在提出一种改进的BAS算法,简称BAS4-AO算法。首先,引入适应度函数和目标位置搜索导向,使搜索更有目标性,减少算法运行时间;然后,采用三维笛卡尔坐标和关节角度搜索相结合的方式,从多角度保证机械臂的运行稳定。由实际试验结果可以看出,相比于RRT算法,BAS4-AO不仅能形成一个合适的运动规划路径,而且具有更快运行效率和更好的运行结果。
Claims (3)
1.基于改进的天牛须搜索算法的机械臂避障路径规划方法,其特征在于,包括以下步骤:
建立姿态规划结果的优化评估模型;包括用于优化机械臂关节角度的函数,其表达式为:,式中,/>为机械臂关节经过N次搜索迭代后的角度差之和;变量/>表示在路径点i上采样时刻t处的关节角度;M表示路径规划过程中所有路径点的总数;/>为包含6个元素的向量,其中每个元素是实数;
用于优化运行路径长度的函数,其表达式为:式中,表示机械臂末端执行器在空间中的移动距离,变量/>表示在路径点i上采样时刻t处的机械手端点位置;k表示路径中包含的路径点个数;/>为包含3个元素的向量,其中每个元素是实数;
获取机械臂末端起点和终点位姿,利用逆运动学解析法求解起点关节角和终点关节角,确定机械臂在空间中的位置;
建立机械臂和障碍物碰撞检测模型;
根据碰撞检测结果,结合优化评估模型,利用改进后的BAS4-AO算法生成机械臂避障路径,包括以下步骤:
(1)、初始化各项参数;
(2)、生成两个相互正交的路径点搜索方向,其中搜索方向的计算公式如下:
计算搜索方向之前,需要将方向向量归一化,公式如下:
(3)、路径点空间位置生成
进行第t时刻迭代时,围绕空间坐标P的四个判断点的空间位置坐标为:
(4)、碰撞检测及搜索步长调整
进行机械臂轴体与障碍物的碰撞检验,若无碰撞,则直接转入步骤(2)执行下一次迭代循环;若发生碰撞,则须衰减全局搜索步长,清除此次路径点信息并再次搜索新的路径点;
(5)、进行关节角度寻优判断
根据机械臂末端执行器空间坐标求解机械臂关节角度,判断当前机械臂末端执行器关节角度和目标点关节角度/>之间的角度差是否小于阈值/>,若不小于阈值/>,则返回步骤(2)继续生成路径点;若小于阈值/>,则转入步骤(6);
(6)关节角度局部变步长搜索:
(7)、路径点精度判断
(8)、路径修剪
计算每个路径点各关节角度变化下的模量,确定最小关节变化所在的点,具体如下式所示:
将当前计算的路径点和具有最小关节变化的点进行标注,对标注点之间的路径点进行平滑处理,并使用当前最小关节变化的点的关节角替换标注点之间路径点的关节角。
3.根据权利要求1所述的基于改进的天牛须搜索算法的机械臂避障路径规划方法,其特征在于,碰撞检测模型中,使用凸包简化模型作为机械臂模型,使用轴体包络模型作为障碍物模型。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111424954.1A CN114147708B (zh) | 2021-11-26 | 2021-11-26 | 基于改进的天牛须搜索算法的机械臂避障路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111424954.1A CN114147708B (zh) | 2021-11-26 | 2021-11-26 | 基于改进的天牛须搜索算法的机械臂避障路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114147708A CN114147708A (zh) | 2022-03-08 |
CN114147708B true CN114147708B (zh) | 2023-06-30 |
Family
ID=80458102
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111424954.1A Active CN114147708B (zh) | 2021-11-26 | 2021-11-26 | 基于改进的天牛须搜索算法的机械臂避障路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114147708B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115014375B (zh) * | 2022-06-06 | 2023-11-03 | 北京京深深向科技有限公司 | 碰撞检测方法、装置及电子设备、存储介质 |
CN115648220A (zh) * | 2022-11-15 | 2023-01-31 | 华侨大学 | 基于最小代价下降的机械臂关节空间避障路径规划方法 |
CN116522234B (zh) * | 2023-02-10 | 2023-11-17 | 东莞理工学院 | 一种关节角度预测方法、装置、设备及介质 |
CN117773911B (zh) * | 2023-11-03 | 2024-05-17 | 广东工业大学 | 一种复杂环境下工业机器人避障方法 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112975961A (zh) * | 2021-02-20 | 2021-06-18 | 华南理工大学 | 基于ctb-rrt*算法的采摘机械臂运动规划方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109866222B (zh) * | 2019-02-26 | 2020-09-01 | 杭州电子科技大学 | 一种基于天牛须优化策略的机械臂运动规划方法 |
CN111173573B (zh) * | 2020-01-08 | 2022-07-19 | 上海电力大学 | 一种汽轮机调节***功率对象模型的辨识方法 |
CN111844023A (zh) * | 2020-06-28 | 2020-10-30 | 合肥工业大学 | 一种基于天牛须算法的六自由度机器人逆解算法 |
CN113352319B (zh) * | 2021-05-08 | 2022-10-21 | 上海工程技术大学 | 基于改进快速扩展随机树的冗余机械臂避障轨迹规划方法 |
-
2021
- 2021-11-26 CN CN202111424954.1A patent/CN114147708B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112975961A (zh) * | 2021-02-20 | 2021-06-18 | 华南理工大学 | 基于ctb-rrt*算法的采摘机械臂运动规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114147708A (zh) | 2022-03-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114147708B (zh) | 基于改进的天牛须搜索算法的机械臂避障路径规划方法 | |
CN110228069B (zh) | 一种机械臂在线避障运动规划方法 | |
CN109571466B (zh) | 一种基于快速随机搜索树的七自由度冗余机械臂动态避障路径规划方法 | |
CN109960880B (zh) | 一种基于机器学习的工业机器人避障路径规划方法 | |
CN111546347B (zh) | 一种适用于动态环境下的机械臂路径规划方法 | |
US9411335B2 (en) | Method and apparatus to plan motion path of robot | |
CN111251295B (zh) | 一种应用于参数化零件的视觉机械臂抓取方法及装置 | |
CN108818530B (zh) | 基于改进rrt算法的机械臂抓取散乱堆放活塞运动规划方法 | |
CN110653805A (zh) | 笛卡尔空间下的七自由度冗余机械臂任务约束路径规划方法 | |
CN110561419B (zh) | 臂型线约束柔性机器人轨迹规划方法及装置 | |
CN112902971B (zh) | 基于高斯采样和目标偏向引导的快速扩展随机树算法的机器人运动轨迹计算方法、电子设备及存储介质 | |
CN111552300A (zh) | 一种基于实例分割和路径规划的农作物采摘*** | |
CN115416016A (zh) | 一种基于改进人工势场法的机械臂避障路径规划方法 | |
Liu et al. | Improved RRT path planning algorithm for humanoid robotic arm | |
CN115723129A (zh) | 一种机械臂连续操作运动规划方法 | |
CN113043278B (zh) | 一种基于改进型鲸鱼搜索方法的机械臂轨迹规划方法 | |
Xu et al. | Efficient object manipulation to an arbitrary goal pose: Learning-based anytime prioritized planning | |
CN116872212A (zh) | 一种基于A-Star算法和改进人工势场法的双机械臂避障规划方法 | |
CN116690557A (zh) | 基于点云的仿人三维扫描运动控制方法及装置 | |
Zhang et al. | Robot motion planning with orientational constraints based on offline sampling datasets | |
Tang et al. | Picking trajectory planning of citrus based on improved immune algorithm and binocular vision | |
Abainia et al. | Bio-inspired approach for inverse kinematics of 6-dof robot manipulator with obstacle avoidance | |
Li et al. | Path planning of a robotic manipulator for pruning apple trees based on RRT-connect algorithm | |
Li | A Design of Robot System for Rapidly Sorting Express Carton with Mechanical Arm Based on Computer Vision Technology | |
Lin et al. | A search strategy for motion planning of unmanned crawler crane |
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 |