CN114800491A - 一种冗余机械臂零空间避障规划方法 - Google Patents
一种冗余机械臂零空间避障规划方法 Download PDFInfo
- Publication number
- CN114800491A CN114800491A CN202210333465.3A CN202210333465A CN114800491A CN 114800491 A CN114800491 A CN 114800491A CN 202210333465 A CN202210333465 A CN 202210333465A CN 114800491 A CN114800491 A CN 114800491A
- Authority
- CN
- China
- Prior art keywords
- joint
- arm
- coordinate system
- angle
- mechanical arm
- 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.)
- Pending
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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
-
- 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
Abstract
本发明涉及一种冗余机械臂零空间避障规划方法,属于机械臂避障设计领域;利用机械臂零空间的旋转轴和臂形角的参考平面建立臂型面坐标系AX′Y′Z′;将障碍物进行三维建模,利用机械臂基坐标系BXYZ与障碍物的空间关系,将障碍物向臂型面坐标系AX′Y′Z′的X′Y′平面投影;利用机械臂基坐标系BXYZ与臂型面坐标系AX′Y′Z′的空间关系,将障碍物在机械臂基坐标系BXYZ内的投影转化到臂型面坐标系AX′Y′Z′的X′Y′平面内;上述三维模型简化为二维空间后,利用臂形角与障碍物的二维几何关系进行避障计算;本发明将三维空间简化为二维空间,包括障碍物的简化以及避障空间的简化,计算量大大降低。
Description
技术领域
本发明属于机械臂避障设计领域,涉及一种冗余机械臂零空间避障规划方法。
背景技术
冗余机械臂一般是指具有7个关节的串联型机器人,三维空间具有6个自由度,因此冗余机械臂逆运动学求解具有无穷多解,在机械臂末端位姿不变的情况下,无穷多解构成的空间称为冗余机械臂的零空间。当机械臂执行任务时,多会关注机械臂末端的位姿精度,为了与周围环境不发生干涉,冗余机械臂零空间的避障方法显得尤为重要。
目前冗余机械臂零空间避障方法多采用梯度投影法及其改进方法,主要思想是在机械臂连杆上布置多个点,计算每一点与周围环境的欧式距离,然后对所有点与周围环境的欧式距离求导,寻找距离增大的方向。其建模及计算量巨大,计算周期达到秒级以上,这在执行实时任务过程中是不可接受的。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提出一种冗余机械臂零空间避障规划方法,将三维空间简化为二维空间,包括障碍物的简化以及避障空间的简化,计算量大大降低。
本发明解决技术的方案是:
一种冗余机械臂零空间避障规划方法,包括:
制作7个关节和基座组成的机械臂,7个关节分别为第一关节、第二关节、……、第七关节;第一关节与基座连接;第二关节、……、第七关节与第一关节依次串联;设定第一关节、第二关节、……、第七关节的旋转角度为θ1、θ2、……、θ7;其中,第一关节、第二关节、第三关节为机械臂的肩部;第四关节为机械臂的肘部;第五关节、第六关节、第七关节为机械臂的腕部;
设定第一关节、第二关节、第三关节的轴线相交于S点;第五关节、第六关节、第七关节的轴线相交于W点;第四关节位于原点E′;SE′W所在平面为臂型面;当机械臂末端位姿给定后,臂型面绕SW旋转;
建立臂型面坐标系AX′Y′Z′;建立机械臂基坐标系BXYZ,建立第一障碍物C和第二障碍物D;
将第一障碍物C和第二障碍物D向臂型面坐标系的AX′Y′平面投影;臂型面SE′W与X′轴正方形的夹角记为臂形角此时,机械臂基坐标系BXYZ下的障碍物随着机械臂的运动在臂型面坐标系AX′Y′Z′中运动;此时寻找臂形角的目标则是臂型面SE′W的在AX′Y′平面投影线AE′与所有障碍物之间的最小距离最大;
建立机械臂DH建模图;第一关节、第二关节、……、第七关节在DH建模中自动生成各关节的对应坐标系;获得第七关节相对于机械臂基坐标系的位姿矩阵0T7;
设定0x7为第七关节的位置的表达式、0R7为第七关节的姿态的表达式;计算在机械臂基坐标系BXYZ下S点指向W点的向量0xsw的表达式;
令w=0xsw,定义v为机械臂基坐标系BXYZ中Z轴的方向向量,即v=[0 0 1]′;计算矢量J1z与SW组成的参考平面与w的垂直向量k;对向量k进行单位化处理得到臂型面坐标系AX′Y′Z′的X′轴的单位向量kn;则期望臂形角即为AE′与臂型面坐标系AX′Y′Z′的X′轴的夹角;
设第一障碍物C的坐标为(xC,yC),半径为RC;第二障碍物D的坐标为(xD,yD),半径为RD;AE′所在直线y=mx,存在两种情况:
S1、当(xC,yC)、(xD,yD)的连线穿过臂型面坐标系AX′Y′Z′的原点A,则AE′所在直线y=mx的斜率而AE′方向存在2种,即远离坐标原点或指向坐标原点;计算S1情况下的期望臂形角,并选取最优臂形角;
S2、当(xC,yC)、(xD,yD)的连线不穿过臂型面坐标系AX′Y′Z′的原点A,求解方程得到两个斜率m1和m2;即向量AE′的方向存在4种情况,斜率为m1时的两个方向和斜率为m2的两个方向;计算S2情况下的期望臂形角,并选取最优臂形角;
完成避障规划。
在上述的一种冗余机械臂零空间避障规划方法,臂型面坐标系AX′Y′Z′的建立方法为:
臂型面坐标系X′Y′Z′的坐标原点A位于E点向SW连线的垂点;Z′轴与SW连线同向;X′轴平行于参考平面,且指向第四关节;Y′由右手定则确定;
机械臂基坐标系BXYZ的建立方法为:
机械臂基坐标系BXYZ的坐标原点位于基座上;Z轴竖直向上;X轴、Y轴位于水平面,且X轴、Y轴、Z轴互相垂直。
在上述的一种冗余机械臂零空间避障规划方法,对第一障碍物C和第二障碍物D进行建模时,形状选用球形。
在上述的一种冗余机械臂零空间避障规划方法,第七关节相对于机械臂基坐标系的位姿矩阵0T7为:
式中,[nx ny nz]为第七关节坐标系的x轴在机械臂基坐标系BXYZ中的单位矢量;
[ox oy oz]为第七关节坐标系的y轴在机械臂基坐标系BXYZ中的单位矢量;
[ax ay az]为第七关节坐标系的z轴在机械臂基坐标系BXYZ中的单位矢量;
[px py pz]为第七关节坐标系的原点在机械臂基坐标系BXYZ中的单位矢量。
在上述的一种冗余机械臂零空间避障规划方法,向量0xsw的表达式为:
0xsw=0x7-0lbs-0R7 7lwt=0R3(3lse+3l+3R4 4lew)
式中,0lbs为机械臂基坐标系原点B指向S点在机械臂基坐标系BXYZ坐标系下的表达式;
0x7为第七关节的位置的表达式;
0R7为第七关节的姿态的表达式;
7lwt为W点指向工具坐标系原点在DH建模中第七关节的对应坐标系下的表达式;
0R3为第三关节的姿态表达式;
3lse为S点指向E点在DH建模中第三关节的对应坐标系下的表达式;
3l为偏置杆长在DH建模中第三关节的对应坐标系下的表达式;
3R4为DH建模中第四关节的对应坐标系的表达式相对于第三关节的对应坐标系的姿态矩阵;
4lew为E点指向W点在DH建模中第四关节的对应坐标系下的表达式。
在上述的一种冗余机械臂零空间避障规划方法,垂直向量k的计算方法为:
k=cross(cross(w,v),w);
式中,cross为向量的叉乘运算;
单位向量kn为:
kn=k/||k||。
在上述的一种冗余机械臂零空间避障规划方法,S1中,期望臂形角的计算方法为:
式中,norm为对向量单位化;
cross为向量的叉乘运算;
ms′为向量ms的转置;
kn为单位向量;
选取y=mx直线上的两个向量ms1和ms2;其中,ms1=(x,mx),ms2=(-x,-mx);
在上述的一种冗余机械臂零空间避障规划方法,S1中,最优臂形角的选取方法为:
在上述的一种冗余机械臂零空间避障规划方法,S2中,期望臂形角的计算方法为:
在上述的一种冗余机械臂零空间避障规划方法,S2中,最优臂形角的选取方法为:
本发明与现有技术相比的有益效果是:
(1)本发明创新性的利用机械臂零空间的旋转轴和臂形角的参考平面建立臂型面坐标系AX′Y′Z′;将障碍物进行三维建模,利用机械臂基坐标系BXYZ与障碍物的空间关系,将障碍物向臂型面坐标系AX′Y′Z′的X′Y′平面投影;利用机械臂基坐标系BXYZ与臂型面坐标系AX′Y′Z′的空间关系,将障碍物在机械臂基坐标系BXYZ内的投影转化到臂型面坐标系AX′Y′Z′的X′Y′平面内;实现了将三维模型简化为二维空间后,利用臂形角与障碍物的二维几何关系进行避障计算;本发明将三维空间简化为二维空间,包括障碍物的简化以及避障空间的简化,计算量大大降低;
(2)本发明计算实时性大幅提高,经DSP6701(120M主频)测算对臂形角的避障计算在10ms内完成,考虑逆运动学计算的时间,实时避障周期可达20Hz,满足实时避障工作的要求。
附图说明
图1为本发明7自由度冗余机械臂示意图;
图2为本发明机械臂DH模型示意图;
图3为本发明臂形角示意图;
图4为本发明坐标系关系示意图;
图5为本发明障碍物投影及避障示意图。
具体实施方式
下面结合实施例对本发明作进一步阐述。
本发明提供一种冗余机械臂零空间避障规划方法,利用机械臂零空间的旋转轴和臂形角的参考平面建立臂型面坐标系AX′Y′Z′;将障碍物进行三维建模,利用机械臂基坐标系BXYZ与障碍物的空间关系,将障碍物向臂型面坐标系AX′Y′Z′的X′Y′平面投影;利用机械臂基坐标系BXYZ与臂型面坐标系AX′Y′Z′的空间关系,将障碍物在机械臂基坐标系BXYZ内的投影转化到臂型面坐标系AX′Y′Z′的X′Y′平面内;上述三维模型简化为二维空间后,利用臂形角与障碍物的二维几何关系进行避障计算。
冗余机械臂零空间避障规划方法,具体包括如下步骤:
步骤一、制作7个关节和基座组成的机械臂,7个关节分别为第一关节、第二关节、……、第七关节;第一关节与基座连接;第二关节、……、第七关节与第一关节依次串联;设定第一关节、第二关节、……、第七关节的旋转角度为θ1、θ2、……、θ7;其中,第一关节、第二关节、第三关节为机械臂的肩部;第四关节为机械臂的肘部;第五关节、第六关节、第七关节为机械臂的腕部,如图1所示。
设定第一关节、第二关节、第三关节的轴线相交于S点;第五关节、第六关节、第七关节的轴线相交于W点;第四关节位于原点E′;SE′W所在平面为臂型面;当机械臂末端位姿给定后,臂型面绕SW旋转。
步骤二、建立臂型面坐标系AX′Y′Z′;建立机械臂基坐标系BXYZ;其中,臂型面坐标系AX′Y′Z′的建立方法为:
臂型面坐标系X′Y′Z′的坐标原点A位于E点向SW连线的垂点;Z′轴与SW连线同向;X′轴平行于参考平面,且指向第四关节;Y′由右手定则确定,如图3所示。
机械臂基坐标系BXYZ的建立方法为:
机械臂基坐标系BXYZ的坐标原点位于基座上;Z轴竖直向上;X轴、Y轴位于水平面,且X轴、Y轴、Z轴互相垂直。如图4所示。
建立第一障碍物C和第二障碍物D;对第一障碍物C和第二障碍物D进行建模时,形状选用球形,且位置任意。
本发明中,臂型面坐标系AX′Y′Z′的Z′轴与冗余机械臂零空间旋转轴同向,X’轴方向平行于臂形角参考平面,指向肘关节,Y’轴方向利用右手定则确定。基坐标系B如图所示,障碍物C和D如图所示,在障碍物进行三维建模时,可以根据障碍物的形状选用球形建模、圆柱体建模、长方体建模、圆锥体建模等方法。为描述方便,本专利交底书采用球形建模进行零空间避障算法描述,采用其他几何体建模时,避障方法相同,不再赘述。
步骤三、利用臂型面坐标系X′Y′Z′与机械臂基坐标系BXYZ的空间关系,将第一障碍物C和第二障碍物D向臂型面坐标系的AX′Y′平面投影;臂型面SE′W与X′轴正方形的夹角记为臂形角此时,机械臂基坐标系BXYZ下的障碍物随着机械臂的运动在臂型面坐标系AX′Y′Z′中运动;此时寻找臂形角的目标则是臂型面SE′W的在AX′Y′平面投影线AE′与所有障碍物之间的最小距离最大。
步骤四、建立机械臂DH建模图,如图2所示,第一关节、第二关节、……、第七关节在DH建模中自动生成各关节的对应坐标系。获得第七关节相对于机械臂基坐标系的位姿矩阵0T7;第七关节相对于机械臂基坐标系的位姿矩阵0T7为:
式中,[nx ny nz]为第七关节坐标系的x轴在机械臂基坐标系BXYZ中的单位矢量;
[ox oy oz]为第七关节坐标系的y轴在机械臂基坐标系BXYZ中的单位矢量;
[ax ay az]为第七关节坐标系的z轴在机械臂基坐标系BXYZ中的单位矢量;
[px py pz]为第七关节坐标系的原点在机械臂基坐标系BXYZ中的单位矢量。
步骤五、设定0x7为第七关节的位置的表达式、0R7为第七关节的姿态的表达式;计算在机械臂基坐标系BXYZ下S点指向W点的向量0xsw的表达式;向量0xsw的表达式为:
0xsw=0x7-0lbs-0R7 7lwt=0R3(3lse+3l+3R4 4lew)
式中,0lbs为机械臂基坐标系原点B指向S点在机械臂基坐标系BXYZ坐标系下的表达式;
0x7为第七关节的位置的表达式;
0R7为第七关节的姿态的表达式;
7lwt为W点指向工具坐标系原点在DH建模中第七关节的对应坐标系下的表达式;
0R3为第三关节的姿态表达式;
3lse为S点指向E点在DH建模中第三关节的对应坐标系下的表达式;
3l为偏置杆长在DH建模中第三关节的对应坐标系下的表达式;
3R4为DH建模中第四关节的对应坐标系的表达式相对于第三关节的对应坐标系的姿态矩阵;
4lew为E点指向W点在DH建模中第四关节的对应坐标系下的表达式。
步骤六、令w=0xsw,定义v为机械臂基坐标系BXYZ中Z轴的方向向量,即v=[0 01]′;计算矢量J1z与SW组成的参考平面与w的垂直向量k;对向量k进行单位化处理得到臂型面坐标系AX′Y′Z′的X′轴的单位向量kn;则期望臂形角即为AE′与臂型面坐标系AX′Y′Z′的X′轴的夹角;垂直向量k的计算方法为:
k=cross(cross(w,v),w);
式中,cross为向量的叉乘运算;
单位向量kn为:
kn=k/||k||。
步骤八、当将障碍物简化为球形模型并将其向臂型面坐标系AX′Y′Z′的X′Y′平面投影后,求解最优臂形角的问题简化为求解AE′所在直线y=mx的斜率m,使得障碍物C、D的圆心与直线y=mx的距离减去半径均最远即可。设第一障碍物C的坐标为(xC,yC),半径为RC;第二障碍物D的坐标为(xD,yD),半径为RD;AE′所在直线y=mx,存在两种情况:
S1、当(xC,yC)、(xD,yD)的连线穿过臂型面坐标系AX′Y′Z′的原点A,则AE′所在直线y=mx的斜率而AE′方向存在2种,即远离坐标原点或指向坐标原点;计算S1情况下的期望臂形角,并选取最优臂形角;期望臂形角的计算方法为:
式中,norm为对向量单位化;
cross为向量的叉乘运算;
ms′为向量ms的转置;
kn为单位向量;
选取y=mx直线上的两个向量ms1和ms2;其中,ms1=(x,mx),ms2=(-x,-mx);
最优臂形角的选取方法为:
S2、当(xC,yC)、(xD,yD)的连线不穿过臂型面坐标系AX′Y′Z′的原点A,求解方程得到两个斜率m1和m2;即向量AE′的方向存在4种情况,斜率为m1时的两个方向和斜率为m2的两个方向;计算S2情况下的期望臂形角,并选取最优臂形角;期望臂形角的计算方法为:
最优臂形角的选取方法为:
完成避障规划。
本发明利用机械臂零空间的旋转轴和臂形角的参考平面建立臂型面坐标系AX′Y′Z′;将障碍物进行三维建模,利用机械臂基坐标系BXYZ与障碍物的空间关系,将障碍物向臂型面坐标系AX′Y′Z′的X′Y′平面投影;利用机械臂基坐标系BXYZ与臂型面坐标系AX′Y′Z′的空间关系,将障碍物在机械臂基坐标系BXYZ内的投影转化到臂型面坐标系AX′Y′Z′的X′Y′平面内;实现了将三维模型简化为二维空间后,利用臂形角与障碍物的二维几何关系进行避障计算;本发明将三维空间简化为二维空间,包括障碍物的简化以及避障空间的简化,计算量大大降低;计算实时性大幅提高,经DSP6701(120M主频)测算对臂形角的避障计算在10ms内完成,考虑逆运动学计算的时间,实时避障周期可达20Hz,满足实时避障工作的要求。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (10)
1.一种冗余机械臂零空间避障规划方法,其特征在于:包括:
制作7个关节和基座组成的机械臂,7个关节分别为第一关节、第二关节、……、第七关节;第一关节与基座连接;第二关节、……、第七关节与第一关节依次串联;设定第一关节、第二关节、……、第七关节的旋转角度为θ1、θ2、……、θ7;其中,第一关节、第二关节、第三关节为机械臂的肩部;第四关节为机械臂的肘部;第五关节、第六关节、第七关节为机械臂的腕部;
设定第一关节、第二关节、第三关节的轴线相交于S点;第五关节、第六关节、第七关节的轴线相交于W点;第四关节位于原点E′;SE′W所在平面为臂型面;当机械臂末端位姿给定后,臂型面绕SW旋转;
建立臂型面坐标系AX′Y′Z′;建立机械臂基坐标系BXYZ,建立第一障碍物C和第二障碍物D;
将第一障碍物C和第二障碍物D向臂型面坐标系的AX′Y′平面投影;臂型面SE′W与X′轴正方形的夹角记为臂形角此时,机械臂基坐标系BXYZ下的障碍物随着机械臂的运动在臂型面坐标系AX′Y′Z′中运动;此时寻找臂形角的目标则是臂型面SE′W的在AX′Y′平面投影线AE′与所有障碍物之间的最小距离最大;
建立机械臂DH建模图;第一关节、第二关节、……、第七关节在DH建模中自动生成各关节的对应坐标系;获得第七关节相对于机械臂基坐标系的位姿矩阵0T7;
设定0x7为第七关节的位置的表达式、0R7为第七关节的姿态的表达式;计算在机械臂基坐标系BXYZ下S点指向W点的向量0xsw的表达式;
令w=0xsw,定义v为机械臂基坐标系BXYZ中Z轴的方向向量,即v=[0 0 1]′;计算矢量J1z与SW组成的参考平面与w的垂直向量k;对向量k进行单位化处理得到臂型面坐标系AX′Y′Z′的X′轴的单位向量kn;则期望臂形角即为AE′与臂型面坐标系AX′Y′Z′的X′轴的夹角;
设第一障碍物C的坐标为(xC,yC),半径为RC;第二障碍物D的坐标为(xD,yD),半径为RD;AE′所在直线y=mx,存在两种情况:
S2、当(xC,yC)、(xD,yD)的连线不穿过臂型面坐标系AX′Y′Z′的原点A,求解方程得到两个斜率m1和m2;即向量AE′的方向存在4种情况,斜率为m1时的两个方向和斜率为m2的两个方向;计算S2情况下的期望臂形角,并选取最优臂形角;
完成避障规划。
2.根据权利要求1所述的一种冗余机械臂零空间避障规划方法,其特征在于:臂型面坐标系AX′Y′Z′的建立方法为:
臂型面坐标系X′Y′Z′的坐标原点A位于E点向SW连线的垂点;Z′轴与SW连线同向;X′轴平行于参考平面,且指向第四关节;Y′由右手定则确定;
机械臂基坐标系BXYZ的建立方法为:
机械臂基坐标系BXYZ的坐标原点位于基座上;Z轴竖直向上;X轴、Y轴位于水平面,且X轴、Y轴、Z轴互相垂直。
3.根据权利要求2所述的一种冗余机械臂零空间避障规划方法,其特征在于:对第一障碍物C和第二障碍物D进行建模时,形状选用球形。
5.根据权利要求4所述的一种冗余机械臂零空间避障规划方法,其特征在于:向量0xsw的表达式为:
0xsw=0x7-0lbs-0R7 7lwt=0R3(3lse+3l+3R4 4lew)
式中,0lbs为机械臂基坐标系原点B指向S点在机械臂基坐标系BXYZ坐标系下的表达式;
0x7为第七关节的位置的表达式;
0R7为第七关节的姿态的表达式;
7lwt为W点指向工具坐标系原点在DH建模中第七关节的对应坐标系下的表达式;
0R3为第三关节的姿态表达式;
3lse为S点指向E点在DH建模中第三关节的对应坐标系下的表达式;
3l为偏置杆长在DH建模中第三关节的对应坐标系下的表达式;
3R4为DH建模中第四关节的对应坐标系的表达式相对于第三关节的对应坐标系的姿态矩阵;
4lew为E点指向W点在DH建模中第四关节的对应坐标系下的表达式。
6.根据权利要求5所述的一种冗余机械臂零空间避障规划方法,其特征在于:垂直向量k的计算方法为:
k=cross(cross(w,v),w);
式中,cross为向量的叉乘运算;
单位向量kn为:
kn=k/||k||。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210333465.3A CN114800491A (zh) | 2022-03-30 | 2022-03-30 | 一种冗余机械臂零空间避障规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210333465.3A CN114800491A (zh) | 2022-03-30 | 2022-03-30 | 一种冗余机械臂零空间避障规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114800491A true CN114800491A (zh) | 2022-07-29 |
Family
ID=82533503
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210333465.3A Pending CN114800491A (zh) | 2022-03-30 | 2022-03-30 | 一种冗余机械臂零空间避障规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114800491A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115464650A (zh) * | 2022-09-19 | 2022-12-13 | 哈尔滨工业大学 | 一种针对动态障碍物的冗余度机械臂避障模型的构建方法 |
-
2022
- 2022-03-30 CN CN202210333465.3A patent/CN114800491A/zh active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115464650A (zh) * | 2022-09-19 | 2022-12-13 | 哈尔滨工业大学 | 一种针对动态障碍物的冗余度机械臂避障模型的构建方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109895101B (zh) | 一种关节型机械臂逆运动学数值唯一解求取方法 | |
CN107901041B (zh) | 一种基于图像混合矩的机器人视觉伺服控制方法 | |
Gong et al. | Analytical inverse kinematics and self-motion application for 7-DOF redundant manipulator | |
JP3207728B2 (ja) | 冗長マニピュレータの制御方法 | |
CN112828359B (zh) | 基于势场法多约束的机器人铣削加工姿态规划方法和系统 | |
CN107791248B (zh) | 基于不满足Pieper准则的六自由度串联机器人的控制方法 | |
CN111469129A (zh) | 一种基于双机械臂的船体外板曲面成形无碰撞运动规划方法 | |
Xu et al. | Dual arm-angle parameterisation and its applications for analytical inverse kinematics of redundant manipulators | |
CN111515949B (zh) | 一种双臂协作机器人的双臂传接位置选取方法 | |
CN107253191B (zh) | 一种双机械臂系统及其协调控制方法 | |
WO2023024317A1 (zh) | 一种机器人避障方法、装置和机器人 | |
CN111496783B (zh) | 一种6r工业机器人逆运动学求解方法 | |
CN106844951B (zh) | 基于分段几何法求解超冗余机器人逆运动学的方法及系统 | |
CN111791234A (zh) | 一种狭窄空间内多机器人空间工作位置防撞控制算法 | |
Corinaldi et al. | Singularity-free path-planning of dexterous pointing tasks for a class of spherical parallel mechanisms | |
CN114589701B (zh) | 一种基于阻尼最小二乘的多关节机械臂避障逆运动学方法 | |
CN114800491A (zh) | 一种冗余机械臂零空间避障规划方法 | |
Li et al. | Solving inverse kinematics model for 7-DoF robot arms based on space vector | |
CN113043286B (zh) | 一种多自由度机械臂实时避障路径规划系统及方法 | |
CN109366486A (zh) | 柔性机器人逆运动学求解方法、系统、设备、存储介质 | |
CN113580135B (zh) | 一种有偏置七轴机器人实时逆解算法 | |
CN116330267A (zh) | 一种基于工业机器人腕部奇异点计算的控制方法 | |
Ge et al. | Kinematics modeling and analysis of manipulator using the dual quaternion | |
CN113084797B (zh) | 一种基于任务分解的双臂冗余机械臂动态协同控制方法 | |
CN116749150B (zh) | 一种多轴机器人系统运动规划方法、电子设备及介质 |
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 |