CN102902269B - 预选择最小距离指标冗余机器人动态避障方法 - Google Patents
预选择最小距离指标冗余机器人动态避障方法 Download PDFInfo
- Publication number
- CN102902269B CN102902269B CN201210355341.1A CN201210355341A CN102902269B CN 102902269 B CN102902269 B CN 102902269B CN 201210355341 A CN201210355341 A CN 201210355341A CN 102902269 B CN102902269 B CN 102902269B
- Authority
- CN
- China
- Prior art keywords
- rod member
- barrier
- obstacle avoidance
- minor increment
- dynamic obstacle
- 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.)
- Expired - Fee Related
Links
Landscapes
- Manipulator (AREA)
- Numerical Control (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及障碍物随机运动环境下,预选择最小距离指标冗余机器人动态避障路径规划方法,包括步骤:利用OBB包围盒对冗余机器人进行建模,建立预选择最小距离指标;通过相交测试,在计算实时距离之前剔除安全杆件;在相应杆件的局部坐标系中,采用局部映射距离计算方法,利用目标点坐标值直接得出实时最小距离并确定碰撞点位置;在此基础上,建立和最小距离相关的避障增益和逃逸速度,利用冗余机器人零空间映射矩阵进行避障路径规划。本发明在动态避障规划前便剔除安全杆件,去除了不必要的繁琐计算并优化距离计算方法,提高了动态避障的规划效率,满足实时性的要求。
Description
技术领域
本发明涉及障碍物随机运动的环境下,预选择最小距离指标冗余机器人动态避障路径规划方法,在动态避障规划前便剔除安全杆件,并采用局部映射距离计算方法,得出实时最小距离。本发明无需计算障碍物到所有杆件的最小距离,提高了动态避障的规划效率,满足实时性的要求。属于智能机器人技术领域。
背景技术
冗余机器人,是指关节空间维数n大于任务空间维数m,可以在自运动而不影响末端位姿的情况下实现多种二次目标。由于任务环境越来越复杂,要求冗余机器人具有更高的智能性,其中动态避障是机器人自主路径规划中一个重要的组成部分,日益成为人们关注的焦点。
目前,利用杆件与障碍物的距离信息完成避障规划是学者们的研究重点。Maciejiewski和Khatib应用人工势场法,通过距离信息建立吸引势场和排斥势场完成避障。LALIBERTE等人针对人工势场法容易发生局部极小的不足,提出了离散势场法,从而减少了局部极小发生的可能性。CHO等人基于流体力学的势流理论,提出了一种可以避免局部极小的新颖的速度排斥函数法。另外,Liegeois提出梯度投影法,利用最小距离指标,优化雅克比矩阵的零空间矢量,修改齐次解完成避障。IKADA等人提出一种潜在避障操作性能形状指标来控制机械臂达到易于避障的位形来进行避障,同时保持末端轨迹的跟踪。Kavraki等人提出了随机路标法,该方法通过环境距离检测,搜索出一些能够避开障碍物的关节坐标点来实现避障,但是随着机构的冗余度增加,计算量也在增加。
避障指标选取的合适与否将直接影响到避障效果的好坏,特别对于动态避障,障碍物随机运动,选择合理的并能准确快速描述障碍物与机械臂位置关系的指标,对于保证避障规划的实时性尤为重要。
传统的距离指标,需要计算障碍物到每个杆件的最小距离,然后再取最小值。当杆件处于某些特殊构形时,障碍物到杆件最小距离的垂足可能会落到杆件的延长线上,延长线并不属于机器人的一部分,对于该杆件计算的最小距离不准确,这时需要在杆件上取多个标志点并遍历各个标志点到障碍物的距离。可见,传统的距离避障指标,一是准确性不足,二是多个标志点的计算,耗费了大量的时间。对于传统的距离指标,可以完成静态避障规划,但是对于动态避障规划来说,障碍物随机运动,需要机器人在有限的时间内完成障碍物检测及关节的多种动作,对避障的效率提出了更高的要求。
发明内容
基于上述,本发明提出在障碍物随机运动环境下,一种预选择距离指标冗余机器人动态避障路径规划方法,该方法无需计算障碍物到所有杆件的最小距离,并且采用局部映射距离计算方法,提高了冗余机器人动态避障的规划效率。
为了实现此目的,本发明所采取的技术方案是:
(1)对于冗余机器人各个杆件及随机运动障碍物建立相应的包围盒,减少基本几何元素的数目和参与相交测试的包围盒的数目。
进一步的,本发明选用OBB方向包围盒建模,并设定包围盒的方向和杆件的方向重合,包围盒的长度和杆件的长度一致,宽度根据最小安全距离设定。面对全部关节都是旋转关节的冗余机器人,当杆件发生旋转运动后,只需让OBB盒的基底进行同样的旋转进行实时更新。对于形状不一的动态障碍物,采用球形包围盒。
(2)实时检测运动障碍物与机器人杆件的相对位置关系,建立预选择最小距离指标Hd-min,其思想是:针对不同的机器人构型建立相应的包围盒,利用相交测试,在计算实时距离之前剔除其他安全杆件,只考虑相碰撞的杆件和障碍物的位置关系,并在杆件的局部坐标系中计算距离值。如果在相交测试中有多个杆件相交,则Hd-min取相交距离中最小的。在避障过程中,要求Hd-min越大越好,说明离障碍物越远,机器人越安全。
具体步骤分为:2.1在机器人杆件的局部坐标系中,利用分离轴定理进行相交测试。2.2利用局部映射计算最小距离,优化传统距离计算方法。
进一步的,所述2.1相交测试中,OBB包围盒采用分离轴检测方法,将障碍物的坐标转换到每个杆件的局部坐标系中,相交测试在局部坐标系下完成,分离轴减少到3个,即X、Y、Z。如果在3个分离轴上,障碍物和机器人的投影全都重合,则判断相交。如果其中有一个分离轴上的投影分离,则不会发生碰撞,记为安全杆件,不作为计算实时距离的有效杆件。
设在杆件AB的局部坐标系中,A端的坐标为(xA’yA’,zA’),B端的坐标为(xB’,yB’,zB’)包围盒长度和宽度为2*d,高度为杆件长度L;障碍物球心半径为R,中心坐标为D1(x1,y1,z1),将杆件AB的包围盒和球体分别向三个坐标轴投影,当
3个式子同时成立时,判断杆件AB和障碍物球体相碰。否则不相交,视为需要剔除的安全杆件。
进一步的,所述2.2局部映射最小距离计算,在相交测试后,剔除不和障碍物发生碰撞的安全杆件,在此基础上,在碰撞杆件的局部坐标系中计算有效的最小距离。由于最小距离dmin是标量,所以在任意坐标系中它的值不变。碰撞点的求取,实质是为了求得碰撞点的雅可比矩阵,利用矢量积法计算雅可比矩阵J0,则需要计算碰撞点到杆件末端的距离,也是标量。所以不用转换到基坐标系中,直接在局部坐标系中利用目标点的坐标值直接得出结果。
设定相碰撞杆件A端坐标(xA’yA’,zA’),B端坐标(xB’,yB’,zB’),障碍物中心坐标D1(x1,y1,z1),碰撞点为P,障碍物距此杆件的最小距离为dmin,碰撞点距离末端关节A的长度为PA。则
P(x1,yA’,zA’)
dmin=|y1-yA’|
PA=|x1-xA’|
(3)根据上述预选择距离指标的建立,进行逃逸速度冗余机器人动态避障运动规划,其具体步骤分为:
3.1通过预选择最小距离指标的建立得出有效的最小距离dmin,并和预设定的最小安全距离做比较。如果大于最小安全距离,则不开启动态避障命令,继续执行末端规划的轨迹。反之则开启动态避障命令,并跟踪末端轨迹。
3.2建立和最小距离dmin相关的避障增益和逃逸速度,根据最小距离dmin的不同,而取相应的避障增益和逃逸速度,已达到较好的避障效果。
3.3计算机器人雅可比矩阵,碰撞点雅可比矩阵,明确逃逸方向。
3.4通过机器人逆运动学,利用冗余机器人自运动零空间映射矩阵进行动态避障路径规划;
3.5对角速度值积分,得到下一步关节角。
3.6跟踪末端轨迹,判断是否到达终点。
本发明的优点在于:通过预选择最小距离指标Hd-min的建立,在计算障碍物和机器人各个杆件距离之前,先进行相交测试,剔除安全杆件,并在局部坐标系中优化距离计算方法,去除了传统指标中大量繁琐的计算量,提高了冗余机器人动态避障的规划效率,更好的满足实时性的要求。
附图说明
图1为杆件坐标系中相交检测附图。
图2为局部坐标系中确定碰撞点与计算最小距离附图。
图3为避障增益和逃逸速度与最小距离dmin的关系。
图4为本发明整体的动态避障流程图。
具体实施方式
本发明是一种预选择最小距离指标冗余机器人动态避障方法,通过预选择最小距离指标Hd-min的建立,设定和最小距离相关的避障增益和逃逸速度,利用冗余机器人自运动零空间映射矩阵实现动态避障。
本发明中Hd-min的思想是:针对不同的机器人构型建立相应的包围盒,利用相交测试,在计算实时距离之前剔除其他安全杆件,只考虑相碰撞的杆件和障碍物的位置关系,并在杆件的局部坐标系中计算距离值。如果在相交测试中有多个杆件相交,则Hd-min取相交距离中最小的。采用Hd-min指标描述障碍物和机器人的位置关系,在避免障碍物到杆件的垂足落在杆件延长线上的情况下,剔除安全杆件,优化传统距离计算,去除不必要的计算量。提高了冗余机器人动态避障的规划效率,更好的满足实时性的要求。
下面结合附图,对本发明作进一步的详细说明。
(一)冗余机器人建模
对于冗余机器人,特别是全部关节都是旋转关节的机器人,OBB方向包围盒不同于一般的AABB包围盒,它的紧密性好,能更好地适应杆件的位置和方向变化,不损失避障空间。OBB盒的建模,只需让包围盒的方向和杆件的方向重合,当杆件发生旋转运动后,OBB的基底进行同样的旋转,无需繁琐的变换方向计算,因此本文选用OBB方向包围盒建模。OBB的中心坐标分别为各个杆件的中间点坐标,长度为杆件的长度,宽、高分别设定为机器人的最小安全距离d。对于形状不一的动态障碍物,我们采用球形包围盒,设球体的中心为(x0,y0,z0),半径为R,则球体的方程可以描述为(x-x0)2+(y-y0)2+(z-z0)2=R2。
(二)预选择最小指标Hd-min的建立
本发明提出预选择最小距离指标Hd-min的思想是:针对不同的机器人构型建立相应的包围盒,利用相交测试,在计算实时距离之前剔除其他安全杆件,只考虑相碰撞的杆件和障碍物的位置关系,并在杆件的局部坐标系中计算距离值。如果在相交测试中有多个杆件相交,则Hd-min取相交距离中最小的。采用Hd-min指标描述障碍物和机器人的位置关系,在避免障碍物到杆件的垂足落在杆件延长线上的情况下,剔除安全杆件,优化传统距离计算,去除不必要的计算量。在避障过程中,要求Hd-min越大越好,说明离障碍物越远,机器人越安全。
(1)相交测试
OBB包围盒采用分离轴检测方法,即给定两个凸体集A和B,若两个集合不存在交集,则必存在一个分离超平面P,使得A和B分别位于该超平面的两侧,向直线分离轴L投影,投影区间不重叠。如果在基坐标下测试,OBB包围盒,最多有15个分离轴,在分离轴上的投影全部重叠,才能判断相交。测试OBB中15个分离轴显然很繁琐。
如图1所示。将障碍物的坐标转换到每个杆件的局部坐标系中,相交测试在局部坐标系下完成,分离轴减少到3个,即X、Y、Z。冗余机器人中每个杆件都有相应的转换矩阵T,旋转矩阵R。若x0为障碍物在基坐标系中的坐标,R0n为杆件n相对于基坐标的旋转矩阵,xn障碍物在杆件n的局部坐标系中的坐标,则x0=R0n·xn,故
设在杆件AB的局部坐标系中,A端的坐标为(xA’,yA’,zA’),B端的坐标为(xB’,yB’,zB’)包围盒长度和宽度为2*d,高度为杆件长度L;障碍物球心半径为R,中心坐标为D1(x1,y1,z1),将杆件AB的包围盒和球体分别向三个坐标轴投影,当
3个式子同时成立时,判断杆件AB和障碍物球体相碰。否则不相交,视为需要剔除的安全杆件。
(2)局部映射距离计算
在相交测试后,剔除不和障碍物发生碰撞的安全杆件,在此基础上,在碰撞杆件的局部坐标系中计算有效的最小距离。如图2所示,杆件AB和障碍物球体检测相交,由于最小距离dmin是标量,所以在任意坐标系中它的值不变。碰撞点P的求取,实质是为了求得碰撞点的雅可比矩阵J0,利用矢量积法计算雅可比矩阵J0,则需要|PA|,也是标量。所以不用转换到基坐标系中,直接在局部坐标系中计算即可。在杆L局部坐标系中,从相交测试可知,A端坐标(xA’,yA’,zA’),B端坐标(xB’,yB’,zB’),障碍物中心坐标D1(x1,y1,z1),碰撞点P。则
P(x1,yA’,zA’)
dmin=|y1-yA’|
PA=|x1-xA’|
利用局部映射方法计算距离,直接利用目标点的坐标值就能直接得出结果,省去了传统距离计算中解大量方程组的繁琐计算。下面给出在基坐标系中传统的距离计算,作以比较。
传统距离计算在基坐标系中完成,杆件AB的空间直线方程可写成:
式中,(xA,yA,zA)为杆件A端点在基坐标中的坐标,(m,n,p)为杆件的方向矢量,t为方程参数。最小距离的计算,一般是向直线做垂线,垂足为最近点,即碰撞点,过球心点向杆件直线做垂面,如图2所示。垂面的法线为杆件的方向矢量,过球心点(x0,y0,z0)并垂直于杆件直线的平面方程为:
m(x-x0)+n(y-y0)+p(z-z0)=0
将式(3)改写成如下形式
式(3)与式(4)联立方程组,解得
将t值代入式(5),得到杆件直线和垂面的交点,即碰撞点B(xB,yB,zB)。
通过以上分析,预选择最小距离指标Hd-min在冗余机器人动态避障运用中,节省了避障处理中环境检测的时间,更好的满足动态避障实时性的要求,主要体现在以下两个方面:
①冗余机器人杆件数量多,在计算障碍物和各个杆件距离之前,先进行相交测试,剔除不相交杆件,即安全杆件,只考虑可能与障碍物发生碰撞的杆件,排除不必要的计算量。
②OBB包围盒的方向和杆件的方向一致,完成相交测试后,由于最小距离以及碰撞点到杆件端点的距离都是标量,不会随着坐标系的改变而改变,所以采用局部映射距离计算方法,舍去了传统方法中解大量方程组的繁琐计算。
(三)逃逸速度动态避障路径规划
实时最小距离dmin计算得出后,利用逃逸速度动态避障方法进行运动规划。建立和最小距离相关的避障增益an和逃逸速度a0,设置3个阈值距离d1,d2,d3,如图3所示。
当dmin>d3时,安全区域,障碍物与杆件满足无碰撞条件,a0,an均为零,可以不改变由伪逆解所得出的机器人位姿,即用最小范数求解。OBB包围盒的宽、高,由d3决定。
当d2<dmin<d3时,预警区域,an均匀增大,开启避障项,a0为零,此时可以不引入逃逸速度,得以保证障碍物远离杆件。
当d1<dmin<d2时,危险区域,随着dmin的减小,a0迅速增大,在连杆上增加一个远离障碍物的逃逸速度,利用冗余机器人零空间映射矩阵进行避障路径规划,当dmin到d1时,逃逸速度达到最大值。
若机器人在运动过程中某一时刻,通过碰撞检测,机械手与一连杆相交,记该连杆与障碍物的碰撞点为x0,碰撞点的雅可比矩阵J0。
利用冗余机器人的自运动进行避障,在关节的零空间选择最安全避障解,其逆运动学表逃逸速度动态避障逆运动学表示为
式中,x0′躲避障碍物的速度方向(单位矢量),设定为障碍物运动速度的反方向。由于避障增益和逃逸速度的平滑变化,也使机器人在避障过程中,关节运动连续,避免抖动现象的发生。
图4是本发明预选择最小距离指标动态避障运动规划的整体流程图,其步骤分为:对于冗余机器人各个杆件及随机运动障碍物建立OBB包围盒;实时检测运动障碍物与机器人杆件的相对位置关系,将基坐标系中的障碍物映射到杆件的局部坐标系中,建立预选择最小距离指标Hd-min;利用分离轴定理进行相交测试,剔除安全杆件;利用局部映射计算最小距离dmin,并和预设定的最小安全距离做比较,如果大于最小安全距离,则不开启动态避障命令,继续执行末端规划的轨迹,反之则开启动态避障命令,并跟踪末端轨迹;建立和最小距离dmin相关的避障增益和逃逸速度,根据最小距离dmin的不同,而取相应的避障增益和逃逸速度,已达到较好的避障效果;计算机器人雅可比矩阵,碰撞点雅可比矩阵,明确逃逸方向;通过机器人逆运动学,利用冗余机器人自运动零空间映射矩阵进行动态避障路径规划;对角速度值积分,得到下一步关节角;跟踪末端轨迹,判断是否到达终点。
Claims (4)
1.一种预选择最小距离指标冗余机器人动态避障方法,其特征在于包括以下步骤:
(1)对于冗余机器人各个杆件及随机运动障碍物建立相应的OBB包围盒,减少基本几伺元素的数目和参与相交测试的包围盒的数目;
(2)实时检测运动障碍物与机器人杆件的相对位置关系,将基坐标系中的障碍物映射到杆件的局部坐标系中,建立预选择最小距离指标Hd-min,其特征是针对不同的机器人构型建立相应的包围盒,利用相交测试,在计算实时距离之前剔除安全杆件,只考虑相碰撞的杆件和障碍物的位置关系,并在杆件的局部坐标系中计算距离值,如果在相交测试中有多个杆件相交,则Hd-min取相交距离中最小的;所述建立预选择最小距离指标Hd-min包括,2.1在机器人杆件的局部坐标系中,利用分离轴定理进行相交测试,2.2利用局部映射计算最小距离,优化传统距离计算方法;
(3)设定和最小距离相关的避障增益和逃逸速度,利用冗余机器人自运动零空间映射矩阵实现逃逸速度动态避障运动规划。
2.如权利要求1所述的预选择最小距离指标冗余机器人动态避障方法,其特征在于:
所述步骤2.1相交测试包括,OBB包围盒采用分离轴检测方法,将障碍物的坐标转换到每个杆件的局部坐标系中,相交测试在局部坐标系下完成,分离轴减少到3个,即X、Y、Z,如果在3个分离轴上,障碍物和机器人的投影全都重合,则判断相交;如果其中有一个分离轴上的投影分离,则不会发生碰撞,记为安全杆件,不作为计算实时距离的有效杆件;
设在杆件AB的局部坐标系中,A端的坐标为(xA’,yA’,zA’),B端的坐标为(xB’,yB’,zB’)包围盒长度和宽度为2*d,高度为杆件长度L;障碍物球心半径为R,中心坐标为D1(x1,y1,z1),将杆件AB的包围盒和球体分别向三个坐标轴投影,当
3个式子同时成立时,判断杆件AB和障碍物球体相碰,否则不相交,视为需要剔除的安全杆件。
3.如权利要求1所述的预选择最小距离指标冗余机器人动态避障方法,其特征在于:
所述步骤2.2利用局部映射计算最小距离包括,在相交测试后,剔除不和障碍物发生碰撞的安全杆件,在此基础上,在碰撞杆件的局部坐标系中计算有效的最小距离;
设定相碰撞杆件A端坐标(xA’,yA’,zA’),B端坐标(xB’,yB’,zB’),障碍物中心坐标D1(x1,y1,z1),碰撞点为P,障碍物距此杆件的最小距离为dmin,碰撞点距离末端关节A的长度为PA,则P(x1,yA’,zA’),dmin=|y1-yA’|,PA|x1-xA’|。
4.如权利要求1所述的预选择最小距离指标冗余机器人动态避障方法,其特征在于:
所述步骤(3)中根据预选择最小距离指标Hd-min的建立,进行逃逸速度冗余机器人动态避障运动规划包括,
3.1通过预选择最小距离指标的建立得出有效的最小距离dmin,并和预设定的最小安全距离做比较,如果大于最小安全距离,则不开启动态避障命令,继续执行末端规划的轨迹,反之则开启动态避障命令,并跟踪末端轨迹;
3.2建立和最小距离dmin相关的避障增益和逃逸速度,根据最小距离dmin的不同,而取相应的避障增益和逃逸速度,已达到较好的避障效果;
3.3计算机器人雅可比矩阵,碰撞点雅可比矩阵,明确逃逸方向;
3.4通过机器人逆运动学,利用冗余机器人自运动零空间映射矩阵进行动态避障路径规划;
3.5对角速度值积分,得到下一步关节角;
3.6跟踪末端轨迹,判断是否到达终点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210355341.1A CN102902269B (zh) | 2012-09-21 | 2012-09-21 | 预选择最小距离指标冗余机器人动态避障方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210355341.1A CN102902269B (zh) | 2012-09-21 | 2012-09-21 | 预选择最小距离指标冗余机器人动态避障方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102902269A CN102902269A (zh) | 2013-01-30 |
CN102902269B true CN102902269B (zh) | 2015-07-01 |
Family
ID=47574565
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210355341.1A Expired - Fee Related CN102902269B (zh) | 2012-09-21 | 2012-09-21 | 预选择最小距离指标冗余机器人动态避障方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102902269B (zh) |
Families Citing this family (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109171975B (zh) * | 2013-03-15 | 2021-04-09 | 直观外科手术操作公司 | 用于管理多个零空间目标和饱和sli行为的系统和方法 |
CN103365293B (zh) * | 2013-05-08 | 2015-11-18 | 北京大学深圳研究生院 | 一种基于动态区域划分的机器人安全路径规划方法 |
EP2849016B1 (de) * | 2013-09-17 | 2022-03-30 | Siemens Aktiengesellschaft | Erstellverfahren für eine von einem Endeffektor abzufahrende Bahn |
CN104842355B (zh) * | 2015-01-20 | 2016-08-17 | 西北工业大学 | 避障约束下冗余空间机器人的混合整数预测控制方法 |
CN104850699B (zh) * | 2015-05-19 | 2018-09-25 | 天津市天锻压力机有限公司 | 冲压线搬运机器人防碰撞控制方法 |
CN105479490A (zh) * | 2015-12-24 | 2016-04-13 | 华中科技大学 | 一种双机器人实时动态避障装置及其避障方法 |
CN105700527A (zh) * | 2016-01-26 | 2016-06-22 | 哈尔滨工业大学 | 一种平面冗余度机器人避障及避奇异的路径规划方法 |
CN106054876B (zh) * | 2016-06-02 | 2019-04-19 | 西北工业大学 | 一种针对空间多任务的避障路径最优逐次操作规划方法 |
CN106843223B (zh) * | 2017-03-10 | 2020-05-05 | 武汉理工大学 | 一种智能化避障agv小车系统及避障方法 |
CN106873600A (zh) * | 2017-03-31 | 2017-06-20 | 深圳市靖洲科技有限公司 | 一种面向无人自行车的局部避障路径规划方法 |
CN108803592B (zh) * | 2017-05-04 | 2024-02-09 | 罗伯特·博世有限公司 | 用于避免机器人碰撞的方法、装置和系统 |
CN108356819B (zh) * | 2018-01-17 | 2020-08-14 | 西安交通大学 | 基于改进a*算法的工业机械臂无碰撞路径规划方法 |
US10754341B2 (en) * | 2018-02-07 | 2020-08-25 | Baidu Usa Llc | Systems and methods for accelerated curve projection |
CN108873882B (zh) * | 2018-02-11 | 2022-06-07 | 北京石头创新科技有限公司 | 智能移动设备及其移动路径规划方法、装置、程序、介质 |
CN108908331B (zh) * | 2018-07-13 | 2022-04-22 | 哈尔滨工业大学(深圳) | 超冗余柔性机器人的避障方法及系统、计算机存储介质 |
CN109341697B (zh) * | 2018-11-29 | 2021-02-09 | 北京宇航系统工程研究所 | 一种无人机航路规划安全性评估方法 |
CN109434836B (zh) * | 2018-12-14 | 2021-07-13 | 浙江大学 | 一种结合球树模型的机械手人工势场空间路径规划方法 |
CN110456792A (zh) * | 2019-08-06 | 2019-11-15 | 清华大学 | 动态环境下的多智能体群系统导航与避障方法及装置 |
CN110658819B (zh) * | 2019-09-30 | 2022-04-15 | 北京猎户星空科技有限公司 | 一种避障方法、装置、电子设备和存储介质 |
CN110919661B (zh) * | 2019-12-26 | 2022-11-22 | 中国科学院沈阳自动化研究所 | 一种手套箱封闭空间内机械臂的运动规划方法 |
CN111026129B (zh) * | 2019-12-27 | 2022-05-27 | 芜湖哈特机器人产业技术研究院有限公司 | 一种多激光导引agv的安全距离检测方法 |
CN113119098B (zh) * | 2019-12-30 | 2022-12-02 | 深圳市优必选科技股份有限公司 | 机械臂控制方法、机械臂控制装置及终端设备 |
CN111591307B (zh) * | 2020-04-15 | 2021-10-01 | 毫末智行科技有限公司 | 一种避障轨迹规划方法、系统及车辆 |
CN112017237B (zh) * | 2020-08-31 | 2024-02-06 | 北京轩宇智能科技有限公司 | 一种基于视场拼接和三维重建的操作辅助装置及方法 |
CN112817308B (zh) * | 2020-12-30 | 2022-10-11 | 北京航空航天大学 | 一种在机测量的无碰撞全局路径规划方法及系统 |
CN113618739B (zh) * | 2021-08-24 | 2022-07-29 | 深圳市优必选科技股份有限公司 | 一种机器人动态避障方法、装置和机器人 |
CN114571469B (zh) * | 2022-05-05 | 2022-07-26 | 北京科技大学 | 一种机械臂零空间实时避障控制方法及系统 |
CN115540892B (zh) * | 2022-11-28 | 2023-03-24 | 北京理工大学深圳汽车研究院(电动车辆国家工程实验室深圳研究院) | 一种固定线路车辆绕障终点选择方法及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1883887A (zh) * | 2006-07-07 | 2006-12-27 | 中国科学院力学研究所 | 一种基于虚拟场景的机器人避障路径规划方法 |
CN101000507A (zh) * | 2006-09-29 | 2007-07-18 | 浙江大学 | 移动机器人在未知环境中同时定位与地图构建的方法 |
CN102207736A (zh) * | 2010-03-31 | 2011-10-05 | 中国科学院自动化研究所 | 基于贝塞尔曲线的机器人路径规划方法及装置 |
CN102609321A (zh) * | 2012-01-30 | 2012-07-25 | 华南理工大学 | 基于K_DOPs快速连续碰撞检测方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1972415B1 (en) * | 2007-03-23 | 2019-01-02 | Honda Research Institute Europe GmbH | Robots with collision avoidance functionality |
US8386080B2 (en) * | 2009-09-15 | 2013-02-26 | Harris Corporation | Robotic apparatus implementing collision avoidance scheme and associated methods |
-
2012
- 2012-09-21 CN CN201210355341.1A patent/CN102902269B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1883887A (zh) * | 2006-07-07 | 2006-12-27 | 中国科学院力学研究所 | 一种基于虚拟场景的机器人避障路径规划方法 |
CN101000507A (zh) * | 2006-09-29 | 2007-07-18 | 浙江大学 | 移动机器人在未知环境中同时定位与地图构建的方法 |
CN102207736A (zh) * | 2010-03-31 | 2011-10-05 | 中国科学院自动化研究所 | 基于贝塞尔曲线的机器人路径规划方法及装置 |
CN102609321A (zh) * | 2012-01-30 | 2012-07-25 | 华南理工大学 | 基于K_DOPs快速连续碰撞检测方法 |
Non-Patent Citations (2)
Title |
---|
七自由度空间机械臂避障路径规划方法;杨明远;《航天器工程》;20110731;第20卷(第4期);全文 * |
新颖的基于梯度投影法的混合指标动态避障算法;方承等;《机械工程学报》;20101031;第46卷(第19期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN102902269A (zh) | 2013-01-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102902269B (zh) | 预选择最小距离指标冗余机器人动态避障方法 | |
CN108908331B (zh) | 超冗余柔性机器人的避障方法及系统、计算机存储介质 | |
CN102646148B (zh) | 仿人机器人机械臂避碰运动轨迹规划方法 | |
CN103390101B (zh) | 串联形式机器人的逆运动学通用求解方法 | |
CN107116540B (zh) | 一种基于scs包围结构的机器人碰撞检测方法 | |
CN100410030C (zh) | 一种基于虚拟场景的机器人避障路径规划方法 | |
CN108705532A (zh) | 一种机械臂避障路径规划方法、设备及存储设备 | |
CN106584461A (zh) | 多约束条件下七自由度仿人机械臂的逆运动学拟人臂构型优化方法 | |
Hota et al. | Optimal geometrical path in 3D with curvature constraint | |
CN106557844A (zh) | 一种焊接机器人路径规划方法 | |
CN106335062A (zh) | 一种通用七轴冗余工业机器人作业规划方法 | |
CN104408774B (zh) | 一种基于gpu加速的实体面片模型间碰撞检测方法 | |
CN104317292A (zh) | 一种复杂形状机器人避碰路径的方法 | |
CN104267728A (zh) | 一种基于可达区域质心矢量的移动机器人避障方法 | |
Jian et al. | Putn: A plane-fitting based uneven terrain navigation framework | |
CN104999463B (zh) | 一种基于构形平面的冗余机械臂运动控制方法 | |
CN114012726A (zh) | 一种航天机械臂碰撞检测方法 | |
Xin et al. | Coordinated motion planning of multiple robots in multi-point dynamic aggregation task | |
Che et al. | Research on improved ACO algorithm-based multi-robot odor source localization | |
CN102074019A (zh) | 一种人体跟踪方法及系统 | |
CN102073320A (zh) | 基于轨道扩展的多机器人的寻迹编队控制方法 | |
Liu | Implementation of SLAM and path planning for mobile robots under ROS framework | |
Dai et al. | Research on hierarchical potential field method of path planning for UAVs | |
Xi | Obstacle avoidance trajectory planning of redundant robots based on improved Bi-RRT | |
Yin et al. | An improved potential field method for mobile robot path planning in dynamic environments |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150701 Termination date: 20160921 |
|
CF01 | Termination of patent right due to non-payment of annual fee |