CN109434836B - 一种结合球树模型的机械手人工势场空间路径规划方法 - Google Patents

一种结合球树模型的机械手人工势场空间路径规划方法 Download PDF

Info

Publication number
CN109434836B
CN109434836B CN201811538753.2A CN201811538753A CN109434836B CN 109434836 B CN109434836 B CN 109434836B CN 201811538753 A CN201811538753 A CN 201811538753A CN 109434836 B CN109434836 B CN 109434836B
Authority
CN
China
Prior art keywords
axis
point
obstacle
target point
potential field
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
Application number
CN201811538753.2A
Other languages
English (en)
Other versions
CN109434836A (zh
Inventor
林旭军
王进
泮求亮
陆国栋
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang University ZJU
Original Assignee
Zhejiang University ZJU
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhejiang University ZJU filed Critical Zhejiang University ZJU
Priority to CN201811538753.2A priority Critical patent/CN109434836B/zh
Publication of CN109434836A publication Critical patent/CN109434836A/zh
Application granted granted Critical
Publication of CN109434836B publication Critical patent/CN109434836B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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)
  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)

Abstract

本发明公开了一种结合球树模型的机械手人工势场空间路径规划方法，采用以下步骤：步骤一、构造障碍物的球体八叉树包围盒；步骤二、修剪空球体，修剪空球体后得到的模型具有障碍物的大致形状；步骤三、修剪冗余球体，修剪冗余球体后得到的模型更能准确反映模型形状；步骤四、搭建人工势场模型，计算机器人受到目标点的引力，障碍物的斥力以及合力：步骤五、判断是否陷入局部极小值或震荡区，如果是，建立虚拟目标点，计算当前点受到的虚拟目标点的引力，障碍物的斥力以及合力；步骤六、迭代计算，计算得到最优解，规划合适的避障路径；步骤七、轨迹光顺处理。

Description

一种结合球树模型的机械手人工势场空间路径规划方法
技术领域
本发明涉及了一种机器人自动避障方法，尤其是涉及了一种结合球树模型的机械手人工势场空间路径规划方法，涉及工业生产、物流运输等领域中广泛使用的工业机器人与服务型机器人。
背景技术
路径规划是机器人技术中非常关键的一项技术，工业机器人与服务型机器人在运行中的迅速，精确的定位到目标点，需要使用路径规划来规划最合适的运行路径，规避障碍物，增加机器人运行的安全性，提高机器人的运行效率。环境是未知的，变化的；这就需要动态的路径规划技术，静态的路径规划已经无法满足要求。
面向工业机器人与服务型机器人的动态路径规划，需要高效碰撞检测技术，碰撞检测技术依赖于各种包围盒模型，例如AABB，OBB,球包围盒模型等。
在动态路径规划算法的研究上，常用的方法有传统人工势场法、神经网络、随机路标图法、VFH类算法、遗传算法等。但是面对复杂的形体障碍物，模型描述复杂度高，同时会存在震荡现象。选用障碍物的球形包络抽象模型能使计算量得到了简化，但扩大了障碍物区域。针对细长形障碍物，球形包络模型的冗余空间大。
传统的人工势场法其间存在一些不是目标点的空间点，该点处机械手末端受到的合力为零，从而导致运动停滞。该情况被称为局部极小值问题，当机械手末端受到的力处于一条直线时，由于引力与斥力大小的改变，会存在机械手末端在某些点来回震荡而无法跳出的现象，该情况被称为局部震荡区问题，两者统称为目标点不可达问题。
APF陷入局部极小值与局部震荡区的情况得到的轨迹，会有局部轨迹锯齿状波动的现象
发明内容
本发明针对障碍物球形包络模型冗余空间问题，通过构建球树模型来描述障碍物；采用改进的人工势场法模型来解决目标点斥力不为零问题；针对人工势场法在三维空间中存在的局部极小值与路径反复震荡问题，通过临时构造虚拟目标点跳出极小值点和局部震荡区，使机械手能顺利到达目标点。具体技术方案如下：
一种结合球树模型的机械手人工势场空间路径规划方法，采用以下步骤：
步骤一、构造障碍物的球体八叉树包围盒，根据障碍物尺寸，构建一个与当前坐标系对齐的障碍物外接立方体，选定八叉树深度，递归构建球体八叉树包围盒；
步骤二、修剪空球体，修剪空球体后得到的模型具有障碍物的大致形状；
步骤三、修剪冗余球体，修剪冗余球体后得到的模型更能准确反映模型形状，
步骤四、搭建人工势场模型，计算机器人受到目标点的引力，障碍物的斥力以及合力：
步骤五、判断是否陷入局部极小值或震荡区，如果是，建立虚拟目标点，计算当前点受到的虚拟目标点的引力，障碍物的斥力以及合力；
步骤六、迭代计算，计算得到最优解，规划合适的避障路径；
步骤七、轨迹光顺处理。
进一步的，所述步骤四具体如下：
改进的斥力势场函数如式(1)所示：
Figure BDA0001906637660000021
其中，m为大于零的斥力增益系数，q，qo，qg分别代表机械手末端点，障碍物和目标点的空间位置坐标，ρ(q,qo)代表障碍物和机械手末端点的空间最短距离，ρ(q,qg)代表机械手末端点和目标点的空间距离，ρo为障碍物最大影响距离，根据障碍物与目标点的特定环境而改变；
相应的斥力如式(2)所示：
Figure BDA0001906637660000022
其中，
Figure BDA0001906637660000031
Figure BDA0001906637660000032
斥力由Frep1(q)和Frep2(q)两部分组成，Frep1(q)方向为当前位置点与障碍物的连线从障碍物指向当前位置点，Frep2(q)方向为当前位置点与目标点的连线从当前位置点指向目标点；
人工势场法的引力势场函数定义如式(5)所示：
Figure BDA0001906637660000033
其中，k为大于零的引力增益系数；
引力函数Fatt(q)是引力势场函数的负梯度，定义如式(6)所示：
Figure BDA0001906637660000034
则机械手末端受到的合力为：
F(q)＝Fatt(q)+Frep1(q)+Frep2(q) (7)
已知在三维空间中两点q1＝(x1,y1,z1)和q2＝(x2,y2,z2)，经过q1和q2的直线在笛卡尔直角坐标系中与x轴，y轴，z轴的夹角分别为:
Figure BDA0001906637660000035
又已知三维空间有一力F(q)，其在笛卡尔直角坐标系中与x轴，y轴，z轴的夹角分别为α，β，γ，则可得F(q)在x轴，y轴，z轴的分量分别为：
Figure BDA0001906637660000041
在笛卡尔坐标系中的机械手末端受力分析：
假设机械手末端在空间中的位置为q＝(x,y,z)，目标点的位置为qg＝(xg,yg,zg)；由式(8)可得，末端点与目标点的连线与x轴，y轴，z轴的夹角分别为:αg，βg，γg；
由式(9)可得，目标点对机械手末端的引力在x轴，y轴，z轴上的分量分别为：Fatt(qx)，Fatt(qy)，Fatt(qz)；
假设三维空间中存在n个障碍物，其在空间中的位置分别为qoi＝(xoi,yoi,zoi),i∈[0,n)；由式(8)可得，末端点与障碍物的连线与x轴，y轴，z轴的夹角分别为：αoi,βoi,γoi，其中i∈[0,n)；
由式(9)可得，各障碍物对机械手末端的斥力在x轴，y轴，z轴上的分量分别为：Frep,i(qx)，Frep,i(qy)，Frep,i(qz)，其中i∈[0,n)；
由此可得机械手末端受到的合力在x轴，y轴，z轴上的分量分别为：
Figure BDA0001906637660000042
机械手末端受到的合力与x轴，y轴，z轴的夹角分别为:αres,βres,γres。
假设单位移动步长为a，则下一位置点qnext＝(xnext,ynext,znext)的计算为：
Figure BDA0001906637660000043
进一步的，所述步骤五具体如下：
(1)构造球切线基点B：由于O点处于障碍物影响斥力球半径范围内，无法构造斥力球与O点的外切线，对O点进行预处理，将O点沿着OAG连线方向远离A点偏移斥力球直径(2r)的距离，得到基点B；
(2)斥力球切线的选取：将三维空间投影到二维平面XOY，投影方向可根据实际需求进行自行调整；
(3)构造虚拟目标点：计算得到平面XOY的切点D1与D2后，再将其转化到三维空间点，此时D1与D2的Z轴坐标与A点相同；沿着B，D1与B，D2的连线得到V1与V2，使得BV1＝BV2＝BG，其中V1与V2就是构建的虚拟目标点；
虚拟目标点的计算方式如下：
假设O(xo,yo,zo)，A(xA,yA,zA)，G(xG,yG,zG)，B(xB,yB,zB)，D1(xD1,yD1,zD1)，D2(xD2,yD2,zD2)，V1(xV1,yV1,zV1)，V2(xV2,yV2,zV2)，O点与A点的连线与x轴，y轴，z轴的夹角分别为:αAO，βAO，γAO，O点与B点的连线长度为2r，由式(12)可得B点空间坐标为
Figure BDA0001906637660000051
将三维空间投影至二维平面XOY，由式(13)可得基点B与障碍物斥力圆切线斜率k：
Figure BDA0001906637660000052
得到斜率即可利用式(14)得到圆上切点坐标：
Figure BDA0001906637660000053
D点的Z轴坐标为O点Z轴方向值，由此确定D点坐标。由式(8)可得B点与D点的连线与X轴，Y轴，Z轴的夹角分别为:αBD，βBD，γBD，已知BV＝BG，由此可得V点的空间坐标。
进一步的，所述步骤七具体如下：
采用道格拉斯-普克算法，实现APF轨迹的压缩以提取必要的路径点；APF路径的压缩方式为：将路径的首末顶点连成一条直线(AB),求出路径上的点到该直线的距离d，将最大值dmax与设定阈值相比较,，若dmax≤ε,则只保留首末端点，若dmax>ε，则将路径分为两部分(AC,BC),再分别对已经得到两段路径递归。
本发明有益效果
本发明采用了一种基于八叉树空间细分的球面几何近似方法，通过子球体抽象离散障碍物，以此将障碍物拆分成若干个子障碍物，简化计算量的同时也解决了障碍物模型冗余空间过大的问题，对于避障功能有着较好的促进作用。
本发明引入了虚拟目标点来替代原目标点使其合力不为零，这样机械手就能跳出局部极小值与局部震荡区，继续向目标点前进。虚拟目标点尽可能与原目标点保持相近特性，保证了机械手朝着原目标点以尽可能小的偏离方向及更快的速度到达目标点。
本发明采用道格拉斯-普克算法，实现APF轨迹的压缩以提取必要的路径点，选用Ferguson曲线来对路径进行光顺处理，以此实现APF路径的光顺。
附图说明
图1是本发明方法的流程框图；
图2是本发明中构建球体八叉树包围盒的示意图；
图3是本发明中修剪空球体的示意图；
图4是本发明中修剪冗余球体的示意图；
图5a是局部极小值示意图；
图5b是局部震荡区示意图；
图6a是三维空间基点构造示意图；
图6b是二维平面斥力球切点构造示意图；
图6c是三维空间虚拟目标点构造示意图；
图7是APF路径的压缩示意图；
图8a-8c是避障仿真效果的示意图。
具体实施方式
下面结合附图对本发明作进一步说明。
如图1所示，本发明的结合球树模型的机械手人工势场空间路径规划方法，采用以下步骤：
步骤一、如图2所示，构造障碍物的球体八叉树包围盒，根据障碍物尺寸，构建一个与当前坐标系对齐的障碍物外接立方体，选定八叉树深度，递归构建球体八叉树包围盒；
步骤二、修剪空球体，空球体是指球体不与障碍物相交或者包含，即球体与障碍物分离。修剪空球体后得到的模型具有障碍物的大致形状，如图3所示；
步骤三、修剪冗余球体，冗余球体是指若该球体被移除，其他球体仍然能够完全覆盖当前障碍物。修剪冗余球体后得到的模型更能准确反映模型形状，如图4所示；
步骤四、搭建人工势场模型，计算机器人受到目标点的引力，障碍物的斥力以及合力：
改进的斥力势场函数如式(1)所示：
Figure BDA0001906637660000071
其中，m为大于零的斥力增益系数，q，qo，qg分别代表机械手末端点，障碍物和目标点的空间位置坐标，ρ(q,qo)代表障碍物和机械手末端点的空间最短距离，ρ(q,qg)代表机械手末端点和目标点的空间距离，ρo为障碍物最大影响距离，它的值可根据障碍物与目标点的特定环境而改变。一般该值应小于所有障碍物之间的最短距离。相应的斥力如式(2)所示：
Figure BDA0001906637660000072
其中，
Figure BDA0001906637660000073
Figure BDA0001906637660000081
斥力由Frep1(q)和Frep2(q)两部分组成，Frep1(q)方向为当前位置点与障碍物的连线从障碍物指向当前位置点，Frep2(q)方向为当前位置点与目标点的连线从当前位置点指向目标点。
人工势场法的引力势场函数定义如式(5)所示：
Figure BDA0001906637660000082
其中，k为大于零的引力增益系数。引力函数Fatt(q)是引力势场函数的负梯度，定义如式(6)所示：
Figure BDA0001906637660000083
则机械手末端受到的合力为：
F(q)＝Fatt(q)+Frep1(q)+Frep2(q) (7)
已知在三维空间中两点q1＝(x1,y1,z1)和q2＝(x2,y2,z2)，经过q1和q2的直线在笛卡尔直角坐标系中与x轴，y轴，z轴的夹角分别为:
Figure BDA0001906637660000084
又已知三维空间有一力F(q)，其在笛卡尔直角坐标系中与x轴，y轴，z轴的夹角分别为α，β，γ，则可得F(q)在x轴，y轴，z轴的分量分别为：
Figure BDA0001906637660000085
现给出定义在笛卡尔坐标系中的机械手末端受力分析：
假设机械手末端在空间中的位置为q＝(x,y,z)，目标点的位置为qg＝(xg,yg,zg)。由式(8)可得，末端点与目标点的连线与x轴，y轴，z轴的夹角分别为:αg，βg，γg。
由式(9)可得，目标点对机械手末端的引力在x轴，y轴，z轴上的分量分别为：Fatt(qx)，Fatt(qy)，Fatt(qz)。
假设三维空间中存在n个障碍物，其在空间中的位置分别为qoi＝(xoi,yoi,zoi),i∈[0,n)。由式(8)可得，末端点与障碍物的连线与x轴，y轴，z轴的夹角分别为：αoi,βoi,γoi，其中i∈[0,n)。
由式(9)可得，各障碍物对机械手末端的斥力在x轴，y轴，z轴上的分量分别为：Frep,i(qx)，Frep,i(qy)，Frep,i(qz)，其中i∈[0,n)。
由此可得机械手末端受到的合力在x轴，y轴，z轴上的分量分别为：
Figure BDA0001906637660000091
机械手末端受到的合力与x轴，y轴，z轴的夹角分别为:αres,βres,γres。
假设单位移动步长为a，则下一位置点qnext＝(xnext,ynext,znext)的计算为：
Figure BDA0001906637660000092
步骤五、判断是否陷入如图5a所示的局部极小值或如图5b所示的震荡区，如果是，就建立虚拟目标点，计算当前点受到的虚拟目标点的引力，障碍物的斥力以及合力。具体如下：
(1)构造球切线基点B。由于O点处于障碍物影响斥力球半径范围内，无法构造斥力球与O点的外切线，因此需对O点做一个预处理。将O点沿着OAG连线方向远离A点偏移斥力球直径(2r)的距离，得到基点B，如图6a所示。
(2)斥力球切线的选取。将三维空间投影到二维平面XOY，将问题转换为求点到圆的切线，以此将无数条切线缩减为只有2条切线。投影方向可根据实际需求进行自行调整。如图6b所示。
(3)构造虚拟目标点。计算得到平面XOY的切点D1与D2后，再将其转化到三维空间点，此时D1与D2的Z轴坐标与A点相同。沿着B，D1与B，D2的连线得到V1与V2，使得BV1＝BV2＝BG，其中V1与V2就是构建的虚拟目标点，如图6c所示。
虚拟目标点的计算方式如下：
假设O(xo,yo,zo)，A(xA,yA,zA)，G(xG,yG,zG)，B(xB,yB,zB)，D1(xD1,yD1,zD1)，D2(xD2,yD2,zD2)，V1(xV1,yV1,zV1)，V2(xV2,yV2,zV2)，O点与A点的连线与x轴，y轴，z轴的夹角分别为:αAO，βAO，γAO，O点与B点的连线长度为2r，由式(12)可得B点空间坐标为
Figure BDA0001906637660000101
将三维空间投影至二维平面XOY，由式(13)可得基点B与障碍物斥力圆切线斜率k：
Figure BDA0001906637660000102
得到斜率即可利用式(14)得到圆上切点坐标：
Figure BDA0001906637660000103
D点的Z轴坐标为O点Z轴方向值，由此确定D点坐标。由式(8)可得B点与D点的连线与X轴，Y轴，Z轴的夹角分别为:αBD，βBD，γBD。已知BV＝BG，由此可得V点的空间坐标。
步骤六、迭代计算，计算得到最优解，规划合适的避障路径；
步骤七、轨迹光顺处理，由于APF(人工势场法)陷入局部极小值和局部震荡区时，会有局部轨迹锯齿状波动的现象。因此，本发明采用道格拉斯-普克算法，实现APF轨迹的压缩以提取必要的路径点。APF路径的压缩方式为：将路径的首末顶点连成一条直线(AB),求出路径上的点到该直线的距离d,将最大值dmax与设定阈值相比较,若dmax≤ε,则只保留首末端点；若dmax>ε，则将路径分为两部分(AC,BC),再分别对已经得到两段路径递归。如图7所示。选用Ferguson曲线来对路径进行光顺处理，以此实现APF路径的光顺。
实施例
机器人初始位置为(100,500,350)；目标位置为(400,150,350)，障碍物1坐标(200,450,350)，影响直径65；障碍物2坐标(350,450,350)，影响直径65；障碍物3坐标(225,250,350)，影响直径75；障碍物4坐标(350,250,350)，影响直径75。
仿真效果：
如图8a-8c所示，从避障仿真效果图中可以看出，本发明的方法可以实现机器人在复杂障碍物，未知环境中进行有效的避障和较优路径的选取，在面对局部震荡或局部极小点时，能够实现对轨迹的光顺处理，实现轨迹的优化。

Claims (3)

1.一种结合球树模型的机械手人工势场空间路径规划方法，采用以下步骤：
步骤一、构造障碍物的球体八叉树包围盒，根据障碍物尺寸，构建一个与当前坐标系对齐的障碍物外接立方体，选定八叉树深度，递归构建球体八叉树包围盒；
步骤二、修剪空球体，修剪空球体后得到的模型具有障碍物的大致形状；
步骤三、修剪冗余球体，修剪冗余球体后得到的模型更能准确反映模型形状，
步骤四、搭建人工势场模型，计算机械手受到目标点的引力，障碍物的斥力以及合力：
步骤五、判断是否陷入局部极小值或震荡区，如果是，建立虚拟目标点，计算当前点受到的虚拟目标点的引力，障碍物的斥力以及合力；
步骤六、迭代计算，计算得到最优解，规划合适的避障路径；
步骤七、轨迹光顺处理。
2.如权利要求1所述的结合球树模型的机械手人工势场空间路径规划方法，其特征在于：所述步骤四具体如下：
改进的斥力势场函数如式(1)所示：
Figure FDA0003020004420000011
其中，m为大于零的斥力增益系数，q，qo，qg分别代表机械手末端点，障碍物和目标点的空间位置坐标，ρ(q,qo)代表障碍物和机械手末端点的空间最短距离，ρ(q,qg)代表机械手末端点和目标点的空间距离，ρo为障碍物最大影响距离，根据障碍物与目标点的特定环境而改变；
相应的斥力如式(2)所示：
Figure FDA0003020004420000012
其中，
Figure FDA0003020004420000021
Figure FDA0003020004420000022
斥力由Frep1(q)和Frep2(q)两部分组成，Frep1(q)方向为当前位置点与障碍物的连线从障碍物指向当前位置点，Frep2(q)方向为当前位置点与目标点的连线从当前位置点指向目标点；
人工势场法的引力势场函数定义如式(5)所示：
Figure FDA0003020004420000023
其中，k为大于零的引力增益系数；
引力函数Fatt(q)是引力势场函数的负梯度，定义如式(6)所示：
Figure FDA0003020004420000024
则机械手末端受到的合力为：
F(q)＝Fatt(q)+Frep1(q)+Frep2(q) (7)
已知在三维空间中两点q1＝(x1,y1,z1)和q2＝(x2,y2,z2)，经过q1和q2的直线在笛卡尔直角坐标系中与x轴，y轴，z轴的夹角分别为:
Figure FDA0003020004420000025
又已知三维空间有一力F(q)，其在笛卡尔直角坐标系中与x轴，y轴，z轴的夹角分别为α，β，γ，则可得F(q)在x轴，y轴，z轴的分量分别为：
Figure FDA0003020004420000031
在笛卡尔坐标系中的机械手末端受力分析：
假设机械手末端在空间中的位置为q＝(x,y,z)，目标点的位置为qg＝(xg,yg,zg)；由式(8)可得，末端点与目标点的连线与x轴，y轴，z轴的夹角分别为:αg，βg，γg；
由式(9)可得，目标点对机械手末端的引力在x轴，y轴，z轴上的分量分别为：Fatt(qx)，Fatt(qy)，Fatt(qz)；
假设三维空间中存在n个障碍物，其在空间中的位置分别为qoi＝(xoi,yoi,zoi),i∈[0,n)；由式(8)可得，末端点与障碍物的连线与x轴，y轴，z轴的夹角分别为：αoi,βoi,γoi，其中i∈[0,n)；
由式(9)可得，各障碍物对机械手末端的斥力在x轴，y轴，z轴上的分量分别为：Frep,i(qx)，Frep,i(qy)，Frep,i(qz)，其中i∈[0,n)；
由此可得机械手末端受到的合力在x轴，y轴，z轴上的分量分别为：
Figure FDA0003020004420000032
机械手末端受到的合力与x轴，y轴，z轴的夹角分别为:αres,βres,γres；
假设单位移动步长为a，则下一位置点qnext＝(xnext,ynext,znext)的计算为：
Figure FDA0003020004420000033
3.如权利要求1所述的结合球树模型的机械手人工势场空间路径规划方法，其特征在于：所述步骤七具体如下：
采用道格拉斯-普克算法，实现APF轨迹的压缩以提取必要的路径点；APF路径的压缩方式为：将路径的首末顶点连成一条直线(AB),求出路径上的点到该直线的距离d，将最大值dmax与设定阈值相比较，若dmax≤ε,则只保留首末端点，若dmax>ε，则将路径分为两部分(AC,BC),再分别对已经得到两段路径递归。
CN201811538753.2A 2018-12-14 2018-12-14 一种结合球树模型的机械手人工势场空间路径规划方法 Active CN109434836B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811538753.2A CN109434836B (zh) 2018-12-14 2018-12-14 一种结合球树模型的机械手人工势场空间路径规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811538753.2A CN109434836B (zh) 2018-12-14 2018-12-14 一种结合球树模型的机械手人工势场空间路径规划方法

Publications (2)

Publication Number Publication Date
CN109434836A CN109434836A (zh) 2019-03-08
CN109434836B true CN109434836B (zh) 2021-07-13

Family

ID=65559887

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811538753.2A Active CN109434836B (zh) 2018-12-14 2018-12-14 一种结合球树模型的机械手人工势场空间路径规划方法

Country Status (1)

Country Link
CN (1) CN109434836B (zh)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110216670B (zh) * 2019-04-30 2022-04-15 武汉理工大学 一种基于损失场的工业机器人自动避障方法及装置
CN110018689B (zh) * 2019-05-15 2020-07-07 福州大学 一种基于动态窗口的多虚拟目标点全局动态路径规划算法
CN110538051A (zh) * 2019-08-27 2019-12-06 华南理工大学 一种自动寻路的盲人智能辅助装置及其方法
CN111546377A (zh) * 2020-04-22 2020-08-18 哈尔滨工业大学 一种空间机械臂的快速自碰撞检测方法
CN111966125B (zh) * 2020-08-18 2022-11-11 重庆交通大学 一种基于改进人工势场的无人机航迹避障重构方法
CN112276953B (zh) * 2020-10-27 2021-12-28 清华大学深圳国际研究生院 连续型超冗余机械臂的臂型协同规划方法、终端设备和存储介质
CN113084811B (zh) * 2021-04-12 2022-12-13 贵州大学 一种机械臂路径规划方法
CN113220008B (zh) * 2021-05-21 2022-11-25 南京航空航天大学 多火星飞行器的协同动态路径规划方法
CN114131616B (zh) * 2021-12-28 2024-02-02 华中科技大学 一种应用于机械臂操控的三维虚拟力场视觉增强方法
CN114460965B (zh) * 2022-01-21 2023-08-29 上海应用技术大学 一种基于改进人工势场法的无人机三维避障方法
CN114564009A (zh) * 2022-01-21 2022-05-31 首都医科大学 一种手术机器人路径规划方法及系统
CN116352714B (zh) * 2023-04-11 2023-09-26 广东工业大学 一种机械臂避障路径规划方法

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101076008B1 (ko) * 2010-07-19 2011-10-21 삼성탈레스 주식회사 자기장을 이용하여 경로계획을 생성하는 자율주행 로봇
CN102902269B (zh) * 2012-09-21 2015-07-01 北京邮电大学 预选择最小距离指标冗余机器人动态避障方法
US9436187B2 (en) * 2015-01-15 2016-09-06 The United States Of America As Represented By The Secretary Of The Navy System and method for decentralized, multi-agent unmanned vehicle navigation and formation control
JP6606442B2 (ja) * 2016-02-24 2019-11-13 本田技研工業株式会社 移動体の経路計画生成装置
CN108326849B (zh) * 2018-01-04 2019-08-30 浙江大学 一种基于改进人工势场法的多自由度机械臂动态避障路径规划方法
CN108693879B (zh) * 2018-04-28 2021-07-13 上海理工大学 基于改进人工势场法的移动机器人路径规划方法
CN108582073B (zh) * 2018-05-02 2020-09-15 北京邮电大学 一种基于改进的随机路标地图法的机械臂快速避障方法
CN108827312B (zh) * 2018-08-08 2021-10-08 清华大学 一种基于神经网络和人工势场的协同博弈路径规划方法

Also Published As

Publication number Publication date
CN109434836A (zh) 2019-03-08

Similar Documents

Publication Publication Date Title
CN109434836B (zh) 一种结合球树模型的机械手人工势场空间路径规划方法
Gao et al. Gradient-based online safe trajectory generation for quadrotor flight in complex environments
CN110471429B (zh) 基于改进人工势场法的割草机器人实时避障方法
Matthies et al. Stereo vision-based obstacle avoidance for micro air vehicles using disparity space
CN107966153B (zh) 水下航行器路径规划算法
MacAllister et al. Path planning for non-circular micro aerial vehicles in constrained environments
US20160158936A1 (en) Collision avoidance method, control device, and program
JP2019516146A (ja) ロボットの障害物回避制御システム、方法、ロボット及び記憶媒体
CN109358637A (zh) 一种基于预设航线的地表近距离自主探查无人机的三维避障方法
CN113759936B (zh) 一种适用于动态目标跟踪的比例导引法与人工势场法相结合的路径规划方法
Kaldestad et al. Collision avoidance with potential fields based on parallel processing of 3D-point cloud data on the GPU
CN113246143A (zh) 一种机械臂动态避障轨迹规划方法及装置
CN113119112B (zh) 适用于六自由度机器人视觉测量的运动规划方法及系统
CN110775288B (zh) 一种基于仿生的飞行机械颈眼系统及控制方法
Savin An algorithm for generating convex obstacle-free regions based on stereographic projection
Scholer et al. Configuration space and visibility graph generation from geometric workspaces for uavs
Lee et al. RRT-based path planning for fixed-wing UAVs with arrival time and approach direction constraints
CN112016660A (zh) 一种物理力和数据联合驱动的三维集群行为模拟方法
CN115416016A (zh) 一种基于改进人工势场法的机械臂避障路径规划方法
Wu et al. Real-time three-dimensional smooth path planning for unmanned aerial vehicles in completely unknown cluttered environments
Kabutan et al. Motion planning by T‐RRT with potential function for vertical articulated robots
CN108981717A (zh) 一种基于双曲度规的路径规划方法
Adler et al. Towards autonomous airborne mapping of urban environments
CN116009558A (zh) 一种结合运动学约束的移动机器人路径规划方法
Emad Path-Planning Dynamic 3D Space Using Modified A* Algorithm

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