CN109605369A - 机械臂奇异点控制方法及系统 - Google Patents
机械臂奇异点控制方法及系统 Download PDFInfo
- Publication number
- CN109605369A CN109605369A CN201811497400.2A CN201811497400A CN109605369A CN 109605369 A CN109605369 A CN 109605369A CN 201811497400 A CN201811497400 A CN 201811497400A CN 109605369 A CN109605369 A CN 109605369A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- point
- singular
- path
- result
- 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
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
-
- 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)
- Numerical Control (AREA)
Abstract
本发明涉及一种机械臂奇异点控制方法及系统,用于控制机械臂通过奇异区,奇异区为包括奇异点的区域,该控制方法包括如下步骤:获取机械臂模型信息、路径起点信息和路径终点信息,并进行逆向运动学求解,并在此过程中于路径起点和路径终点连成的直线上插入多个插补点;控制机械臂的末端沿直线路径依序经过各个插补点而向着路径终点运动,并预先计算出下一插补点的逆解结果;根据下一插补点的逆解结果判断机械臂是否进入奇异区,在判定机械臂进入奇异区时,将机械臂的运动由末端沿直线路径运动切换至采用轴运动规划算法控制的运动;在判定机械臂未进入奇异区时,继续依据逆向运动学求解的结果控制机械臂的末端沿直线路径运动。
Description
技术领域
本发明涉及机械臂控制技术领域,特指一种机械臂奇异点控制方法及系统。
背景技术
一般来说,机械臂在运行中都存在奇异点问题。以四轴的SCARA机械臂为例,其第一、第二、第四轴具有转动特性,第三轴具有线性移动特性。该机械臂的奇异点出现在第二关节角度为0,即两连杆共线的状态;再以六轴的6R机械臂为例,它比四轴机械臂多两个关节,该机械臂具有3个奇异点,即第一、第六关节共线,第四、第六关节共线和第二、第三、第五关节共线的三种情况。
然而,在实现本发明过程中,发明人发现现有技术中至少存在以下技术问题:当机械臂处于奇异点时:(1)机械臂自由度会减少,无法实现某些运动;(2)某些关节角速度趋向于无穷大,导致失控;(3)无法求逆运算。
发明内容
本发明的目的在于克服现有技术的缺陷,提供一种机械臂奇异点控制方法及系统,可以解决机械臂在运行中存在的奇异点的问题。
实现上述目的的技术方案是:
本发明提供了一种机械臂奇异点控制方法,用于控制机械臂通过奇异区,所述奇异区为包括奇异点的区域,所述控制方法包括如下步骤:
获取机械臂模型信息、路径起点信息和路径终点信息,并进行逆向运动学求解;
在进行逆向运动学求解中,于路径起点和路径终点连成的直线上插入多个插补点;
依据逆向运动学求解的结果控制所述机械臂的末端沿直线路径依序经过各个插补点而向着路径终点运动,并预先计算出下一插补点的逆解结果;
根据所述下一插补点的逆解结果判断机械臂是否进入所述奇异区,
在判定机械臂进入所述奇异区时,待所述机械臂完成当前的逆解结果时将所述机械臂的运动由末端沿直线路径运动切换至采用轴运动规划算法控制的运动;
在判定机械臂未进入所述奇异区时,继续依据逆向运动学求解的结果控制所述机械臂的末端沿直线路径运动。
本发明的有益效果是,在机械臂执行末端沿直线路径运动的过程中,预先计算出下一插补点的逆解结果并加以判断机械臂是否进入奇异区,在机械臂进入奇异区时由末端沿直线路径运动切换至采用轴运动规划算法控制的运动,由于轴运动规划算法不需要进行逆向运动学求解,从而避开机械臂的奇异点问题,使机械臂能够进入奇异区且不报错。
本发明机械臂奇异点控制方法的进一步改进在于,根据所述下一插补点的逆解结果判断机械臂是否进入所述奇异区的步骤包括:
判断所述下一插补点的逆解结果是否无解,在无解时则判定机械臂进入所述奇异区;或者
判断所述下一插补点的逆解结果中机械臂各关节轴的运动速度是否大于预设关节轴速度阈值,在大于预设关节轴速度阈值时则判定机械臂进入所述奇异区;或者
判断所述下一插补点的逆解结果中对应特定关节轴的旋转角度是否在预设旋转角度阈值内,在所述预设旋转角度阈值内时则判定进入所述奇异区。
本发明机械臂奇异点控制方法的进一步改进在于,采用轴运动规划算法控制机械臂运动,包括:
获取所述机械臂当前的各关节轴的角度作为起始角度;
依据下一插补点的位置信息计算所述机械臂的末端位于下一插补点的位置时对应的各关节轴角度作为终止角度;
控制所述机械臂的各关节轴以设定时间从所述起始角度旋转至所述终止角度。
本发明机械臂奇异点控制方法的进一步改进在于,控制所述机械臂的各关节轴以设定时间从所述起始角度旋转至所述终止角度,包括:
依据轴运动计算公式计算出对应设定时间的各关节轴的运动曲线,所述轴运动计算公式为:
其中,qs为各关节轴的起始角度,qe为各关节轴的终止角度,vs为各关节轴的起始速度,t1为采用轴运动规划算法的起始时间,t 1=0,t2为轴运动规划算法的终止时间,t2等于设定时间;
依据所计算出的各关节轴的运动曲线中对应当前时间的各关节轴的当前角度和当前速度控制各关节轴运动。
本发明机械臂奇异点控制方法的进一步改进在于,依据下一插补点的位置信息计算所述机械臂的末端位于下一插补点的位置时对应的各关节轴角度的步骤包括:
通过逆解获得下一插补点位置对应的各关节轴的终止角度。
本发明机械臂奇异点控制系统的进一步改进在于,对所述路径终点信息进行逆向运动学求解;
在依据路径终点信息的逆向运动学求解结果判断得出机械臂进入所述奇异区时,
判断所述机械臂的末端的当前位置距所述路径终点信息的距离是否大于设定距离阈值,
若大于设定距离阈值,则利用轴运动规划算法控制机械臂运动至下一插补点;
若小于设定距离阈值,则利用轴运动规划算法控制机械臂直接运动至路径终点。
本发明机械臂奇异点控制系统的进一步改进在于,利用轴运动规划算法控制机械臂直接运动至路径终点的步骤,还包括:
实时获取所述机械臂的末端的当前位置信息;
判定所述机械臂的末端的当前位置信息与所述路径终点信息是否一致;
当判定一致时,控制所述机械臂停止运动。
本发明机械臂奇异点控制系统的进一步改进在于,判定所述机械臂的末端的当前位置信息与所述路径终点信息是否一致,还包括:
计算所述机械臂的末端的当前位置信息距所述路径终点信息的距离,并判断所计算得出的距离是否在预设收敛阈值范围内;
在所计算得出的距离在所述预设收敛阈值范围内时,则得出判定一致的结果。
本发明机械臂奇异点控制系统的进一步改进在于,在采用轴运动规划算法控制机械臂运动之前,还包括:
获取所述机械臂的末端的当前运动速度,并判定所述机械臂的末端的当前运动速度是否大于预设末端速度阈值;
在判定大于预设末端速度阈值时,控制所述机械臂的末端进行平滑降速,直至所述机械臂的末端的当前运动速度小于等于预设末端速度阈值。
本发明还提供了一种机械臂奇异点控制系统,用于控制机械臂通过奇异区,所述奇异区为包括奇异点的区域,所述控制系统包括:
信息获取模块,用于获取机械臂模型信息、路径起点信息和路径终点信息;
连接于所述信息获取模块的第一计算模块,用于根据所述的机械臂模型信息、路径起点信息和路径终点信息进行逆向运动学求解,并在进行逆向运动学求解中,于路径起点和路径终点连成的直线上插入多个插补点,且预先计算得到下一插补点的逆解结果;
连接于所述第一计算模块处理模块,用于依据逆向运动学求解的结果控制所述机械臂的末端沿直线路径依序经过各个插补点而向着路径终点运动,还用于根据所述下一插补点的逆解结果判断机械臂是否进入所述奇异区,
在判定机械臂进入所述奇异区时,所述处理模块控制一第二计算模块采用轴运动规划算法计算下一插补点的结果,待所述机械臂完成当前的逆解结果时所述处理模块将所述机械臂的运动由末端沿直线路径运动切换至采用轴运动规划算法控制的运动;
在判定机械臂未进入所述奇异区时,所述处理模块继续依据逆向运动学求解的结果控制所述机械臂的末端沿直线路径运动。
附图说明
图1为本发明一实施例的机械臂奇异点控制方法的流程图。
图2为本发明一实施例的机械臂奇异点控制系统的结构示意图。
附图标记说明:
11-信息获取模块;12-第一计算模块;13-第二计算模块;14-处理模块。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明。
本发明中的“奇异点”是指机械臂在该点丧失空间某个或者几个自由度的位置;“奇异区”是指包括奇异点的区域,具体是指导致机械臂进入奇异点的特定关节在奇异点附近的一个可设定的区间范围。
参阅图1,本发明提供了一种机械臂奇异点控制方法,用于控制机械臂通过奇异区,该控制方法包括以下步骤:
步骤S1:获取机械臂模型信息、路径起点信息和路径终点信息,并根据获取的机械臂模型信息、路径起点信息和路径终点信息进行逆向运动学求解。
步骤S2:在进行进行逆向运动学求解中,于路径起点和路径终点连成的直线上插入多个插补点。
步骤S3:依据逆向运动学求解的结果驱动机械臂的各个关节轴运动,从而控制机械臂的末端沿直线路径依序经过各个插补点而向着路径终点运动,并预先计算出下一插补点的逆解结果。
具体地,机械臂的末端处于路径起点时,计算出第一插补点的逆解结果和第二插补点的逆解结果,其中的第一插补点的逆解结果用于控制机械臂的末端沿直线路径运动,第二插补点的逆解结果用于提前判定机械臂是否进入奇异区,在机械臂运动至第一插补点处时,预先计算第三插补点的逆解结果,即预先计算下一插补点的逆解结果,此时无需重复计算第二插补点的逆解结果了,因在路径起点时已经预先计算过,同样地,在机械臂运动至第二插补点时,预先计算第四插补点的逆解结果,即机械臂在当前插补点处预先计算与其相隔一个插补点的插补点(即下一插补点)的逆解结果。
步骤S4:根据下一插补点的逆解结果判断机械臂是否进入奇异区。
在判定机械臂未进入奇异区时,执行步骤S5;在判定机械臂进入奇异区时,执行步骤S6。
步骤S5:继续依据逆向运动学求解的结果控制机械臂的末端沿直线路径运动。
步骤S6:待机械臂完成当前的逆解结果时,将机械臂的运动由末端沿直线路径运动切换至采用轴运动规划算法控制的运动。
下面以一实例对本发明的控制方法控制机械臂通过奇异区的过程进行说明。该实例中路径起点和路径终点连成的直线上插入有5个插补点,分别是第一插补点至第五插补点,并假设第四插补点为奇异点。具体的控制过程为:初始时机械臂的末端位于路径起点处,此时计算第一插补点逆解结果并且预先计算第二插补点的逆解结果,依据第一插补点的逆解结果控制机械臂的末端沿直线路径从路径起点运动至第一插补点,根据预先计算的第二插补点的逆解结果判断机械臂是否进入奇异区,此时判断结果为否;在机械臂的末端到达第一插补点时,预先计算第三插补点的逆解结果,根据预先计算的第三插补点的逆解结果判断机械臂是否进入奇异区,并依据第二插补点的逆解结果控制机械臂的末端沿直线路径从第一插补点运动至第二插补点,此时第三插补点的逆解结果的判断结果仍为否;在机械臂的末端达到第二插补点时,预先计算第四插补点的逆解结果,根据预先计算的第四插补点的逆解结果判断并判断机械臂是否进入奇异区,并依据第三插补点的逆解结果控制机械臂的末端沿直线路径从第二插补点运动至第三插补点,此时的判断结果为是,也就表明第四插补点处无逆解结果,此时,在第三插补点处切换轴运动模式,获取路径终点通过降自由度逆解计算得到的各关节旋转角度作为轴运动终点,控制机械臂末端移动至路径终点,从而实现了机械臂运动的过程中遇到奇异点时,可顺利通过奇异点。
当路径终点位于奇异区内时,本发明的控制方法还包括以下步骤:
对路径终点信息进行逆向运动学求解;
在依据路径终点信息的逆向运动学求解结果判断得出机械臂进入奇异区时,判断机械臂的末端的当前位置距路径终点信息的距离是否大于设定距离阈值;
若大于设定距离阈值,则利用轴运动规划算法控制机械臂运动至下一插补点;
若小于设定距离阈值,则利用轴运动规划算法控制机械臂直接运动至路径终点。
下面以一实例对本发明的控制方法控制机械臂到达位于奇异区内的路径的过程进行说明。该实例中路径起点和路径终点连成的直线上插入有5个插补点,分别是第一插补点至第五插补点,并假设第三插补点、第四插补点、第五插补点及终点均位于奇异区内,且第三插补点到路径终点的距离大于设定距离阈值大于第四插补点到路径终点的距离。具体的控制过程为:初始时机械臂的末端位于路径起点处,此时先判断路径终点是否位于奇异区内,得到判断结果为是,利用降自由度逆解得到路径终点对应的各关节轴的角度;然后计算第一插补点逆解结果并且预先计算第二插补点的逆解结果,依据第一插补点的逆解结果控制机械臂的末端沿直线路径从路径起点运动至第一插补点,根据预先计算的第二插补点的逆解结果判断机械臂是否进入奇异区,此时判断结果为否;在机械臂的末端到达第一插补点时,预先计算第三插补点的逆解结果,根据预先计算的第三插补点的逆解结果判断机械臂是否进入奇异区,此时第三插补点的逆解结果的判断结果为是,也就表明第三插补点处无逆解结果,此时,在第二插补点处切换轴运动模式,获取路径终点通过降自由度逆解计算得到的各关节旋转角度作为轴运动终点,控制机械臂末端移动至路径终点。
下面对各步骤的具体实施方式进行说明。
步骤S1具体地,路径起点信息和路径终点信息包括路径起点和路径终点的空间坐标及机械臂在末端位于路径起点时和位于路径终点时的空间姿态。本领域技术人员可以理解的是,逆向运动学求解为机械臂运动计算中常用的方法,故在此不做赘述。
步骤S2具体地,在进行进行逆向运动学求解的过程中,需要根据路径起点的空间坐标和路径终点的空间坐标,可以求出机械臂末端沿直线路径移动的直线方程,变量为时间,根据用户设定的笛卡尔空间速度,即可以计算出从路径起点开始每一个等时间间隔内机械臂末端移动的距离,从而得到机械臂末端从路径起点沿直线路径移动到路径终点时所需经过的多个插补点的位置信息。
且较佳地,插补点之间的间距为0.01mm,以使得在利用轴运动规划算法控制机械臂末端运动时,尽管机械臂的末端的路径为弧线,但由于该弧线的长度极短,因而非常接近直线。
步骤S3具体地,通过逆向运动学求解得到Jacobian矩阵,进而利用公式(为机械臂末端笛卡尔空间线速度,为机械臂各关节轴的旋转角速度,J为Jacobian矩阵)将机械臂末端的笛卡尔空间速度换算成机械臂各关节轴的旋转速度,并驱动机械臂的各个关节轴运动。
步骤S4具体包括以下三种实施方式:
在一实施方式中,判断下一插补点的逆解结果是否无解,在无解时则判定机械臂进入奇异区。
在另一实施方式中,判断下一插补点的逆解结果中机械臂各关节轴的运动速度是否大于预设关节轴速度阈值,在大于预设关节轴速度阈值时则判定机械臂进入奇异区。
在又一实施方式中,判断下一插补点的逆解结果中对应特定关节轴的旋转角度是否在预设旋转角度阈值内,在预设旋转角度阈值内时则判定进入奇异区。
步骤S6具体地,在采用轴运动规划算法控制机械臂运动之前,先获取机械臂的末端的当前运动速度,并判定机械臂的末端的当前运动速度是否大于预设末端速度阈值;在判定大于预设末端速度阈值时,控制机械臂的末端进行平滑降速,直至机械臂的末端的当前运动速度小于等于预设末端速度阈值。通过该步骤使得机械臂可平滑地从末端沿直线路径的运动切换至轴运动规划算法控制的运动。
然后,获取机械臂当前的各关节轴的角度作为起始角度;
获取路径终点各关节轴的角度作为终止角度。
控制机械臂的各关节轴以设定时间从起始角度旋转至终止角度,且具体是依据轴运动计算公式计算出对应设定时间的各关节轴的运动曲线,轴运动计算公式为:
其中,qs为各关节轴的起始角度,qe为各关节轴的终止角度,vs为各关节轴的起始速度,t1为采用轴运动规划算法的起始时间,t 1=0,t2为轴运动规划算法的终止时间,t2等于设定时间,设定时间由加减速时间和路程长度决定;
依据所计算出的各关节轴的运动曲线中对应当前时间的各关节轴的当前角度和当前速度控制各关节轴运动。
当路径终点位于奇异区内时,利用轴运动规划算法控制机械臂直接运动至路径终点的步骤,还包括:
在利用轴运动规划算法控制机械臂直接运动至路径终点的过程中,实时获取机械臂的末端的当前位置信息;
判定机械臂的末端的当前位置信息与路径终点信息是否一致,进一步地,计算机械臂的末端的当前位置信息距路径终点信息的距离,并判断所计算得出的距离是否在预设收敛阈值范围内;
在所计算得出的距离在预设收敛阈值范围内时,则得出判定一致的结果,此时控制机械臂停止运动。
下面结合附图对本发明机械臂奇异点控制系统进行说明。
如图2所示,本发明还提供一种机械臂奇异点控制系统,用于控制机械臂通过奇异区,该控制系统包括:
信息获取模块11,用于获取机械臂模型信息、路径起点信息和路径终点信息。其中,路径起点信息和路径终点信息包括路径起点和路径终点的空间坐标及机械臂在末端位于路径起点时和位于路径终点时的空间姿态。
连接于信息获取模块11的第一计算模块12,用于根据获取的机械臂模型信息、路径起点信息和路径终点信息进行逆向运动学求解,并在进行逆向运动学求解中,于路径起点和路径终点连成的直线上插入多个插补点,且预先计算出下一插补点的逆解结果。
连接于第一计算模块12的处理模块14,用于依据逆向运动学求解的结果控制机械臂的末端沿直线路径依序经过各个插补点而向着路径终点运动,还用于根据下一插补点的逆解结果判断机械臂是否进入奇异区,具体包括以下三种实施方式:
在一实施方式中,处理模块14判断下一插补点的逆解结果是否无解,在无解时则判定机械臂进入奇异区。
在另一实施方式中,处理模块14判断下一插补点的逆解结果中机械臂各关节轴的运动速度是否大于预设关节轴速度阈值,在大于预设关节轴速度阈值时则判定机械臂进入奇异区。
在又一实施方式中,处理模块14判断下一插补点的逆解结果中对应特定关节轴的旋转角度是否在预设旋转角度阈值内,在预设旋转角度阈值内时则判定进入奇异区。
在判定机械臂进入奇异区时,处理模块14控制一连接于处理模块14的第二计算模块13采用轴运动规划算法计算下一插补点的结果,待机械臂完成当前的逆解结果时,将机械臂的运动由末端沿直线路径运动切换至采用轴运动规划算法控制的运动;
在判定机械臂未进入奇异区时,处理模块14继续依据逆向运动学求解的结果控制机械臂的末端沿直线路径运动。
该控制系统还包括一末端速度获取模块,用于在采用轴运动规划算法控制机械臂运动之前,获取机械臂的末端的当前运动速度;该控制系统还包括一连接于末端速度获取模块和处理模块14的末端速度判断模块,用于判断机械臂的末端的当前运动速度是否大于预设末端速度阈值;在判定大于预设末端速度阈值时,处理模块14控制机械臂的末端进行平滑降速,直至机械臂的末端的当前运动速度小于等于预设末端速度阈值,使得机械臂可平滑地从末端沿直线路径的运动切换至轴运动规划算法控制的运动。
该控制系统还包括一角度获取模块,用于获取机械臂当前的各关节轴的角度作为起始角度;该角度获取模块连接于第二计算模块13,第二计算模块13进一步地用于依据下一插补点的位置信息计算机械臂的末端位于下一插补点的位置时对应的各关节轴角度作为终止角度,且具体地,第二计算模块13通过逆解获得下一插补点位置对应的各关节轴的终止角度;然后处理模块14控制机械臂的各关节轴以设定时间从起始角度旋转至终止角度。
进一步地,第一计算模块12还用于对路径终点信息进行逆向运动学求解;
该控制系统还包括一连接于处理模块14的距离判断模块,用于在依据路径终点信息的逆向运动学求解结果判断得出机械臂进入奇异区时,判断机械臂的末端的当前位置距路径终点信息的距离是否大于设定距离阈值;
若大于设定距离阈值,则处理模块14利用轴运动规划算法控制机械臂运动至下一插补点;
若小于设定距离阈值,则处理模块14利用轴运动规划算法控制机械臂直接运动至路径终点。
具体地,该控制系统还包括一位置获取模块,用于在利用轴运动规划算法控制机械臂直接运动至路径终点的过程中,实时获取机械臂的末端的当前位置信息;
该控制系统还包括一连接于位置获取模块和处理模块14的位置判断模块,用于判定机械臂的末端的当前位置信息与路径终点信息是否一致,在判定一致时,处理模块14控制机械臂停止运动。
本发明机械臂奇异点控制方法及系统的有益效果为:
在机械臂执行末端沿直线路径运动的过程中,预先计算出下一插补点的逆解结果并加以判断机械臂是否进入奇异区,在机械臂进入奇异区时由末端沿直线路径运动切换至采用轴运动规划算法控制的运动,由于轴运动规划算法不需要进行逆向运动学求解,从而避开机械臂的奇异点问题,使机械臂能够进入奇异区且不报错。
以上结合附图实施例对本发明进行了详细说明,本领域中普通技术人员可根据上述说明对本发明做出种种变化例。因而,实施例中的某些细节不应构成对本发明的限定,本发明将以所附权利要求书界定的范围作为本发明的保护范围。
Claims (10)
1.一种机械臂奇异点控制方法,用于控制机械臂通过奇异区,所述奇异区为包括奇异点的区域,其特征在于,所述控制方法包括如下步骤:
获取机械臂模型信息、路径起点信息和路径终点信息,并进行逆向运动学求解;
在进行逆向运动学求解中,于路径起点和路径终点连成的直线上插入多个插补点;
依据逆向运动学求解的结果控制所述机械臂的末端沿直线路径依序经过各个插补点而向着路径终点运动,并预先计算出下一插补点的逆解结果;
根据所述下一插补点的逆解结果判断机械臂是否进入所述奇异区,
在判定机械臂进入所述奇异区时,待所述机械臂完成当前的逆解结果时将所述机械臂的运动由末端沿直线路径运动切换至采用轴运动规划算法控制的运动;
在判定机械臂未进入所述奇异区时,继续依据逆向运动学求解的结果控制所述机械臂的末端沿直线路径运动。
2.如权利要求1所述的机械臂奇异点控制方法,其特征在于,根据所述下一插补点的逆解结果判断机械臂是否进入所述奇异区的步骤包括:
判断所述下一插补点的逆解结果是否无解,在无解时则判定机械臂进入所述奇异区;或者
判断所述下一插补点的逆解结果中机械臂各关节轴的运动速度是否大于预设关节轴速度阈值,在大于预设关节轴速度阈值时则判定机械臂进入所述奇异区;或者
判断所述下一插补点的逆解结果中对应特定关节轴的旋转角度是否在预设旋转角度阈值内,在所述预设旋转角度阈值内时则判定进入所述奇异区。
3.如权利要求1所述的机械臂奇异点控制方法,其特征在于,采用轴运动规划算法控制机械臂运动,包括:
获取所述机械臂当前的各关节轴的角度作为起始角度;
依据下一插补点的位置信息计算所述机械臂的末端位于下一插补点的位置时对应的各关节轴角度作为终止角度;
控制所述机械臂的各关节轴以设定时间从所述起始角度旋转至所述终止角度。
4.如权利要求3所述的机械臂奇异点控制方法,其特征在于,控制所述机械臂的各关节轴以设定时间从所述起始角度旋转至所述终止角度,包括:
依据轴运动计算公式计算出对应设定时间的各关节轴的运动曲线,所述轴运动计算公式为:
其中,qs为各关节轴的起始角度,qe为各关节轴的终止角度,vs为各关节轴的起始速度,t1为采用轴运动规划算法的起始时间,t1=0,t2为轴运动规划算法的终止时间,t2等于设定时间;
依据所计算出的各关节轴的运动曲线中对应当前时间的各关节轴的当前角度和当前速度控制各关节轴运动。
5.如权利要求3所述的机械臂奇异点控制方法,其特征在于,依据下一插补点的位置信息计算所述机械臂的末端位于下一插补点的位置时对应的各关节轴角度的步骤包括:
通过逆解获得下一插补点位置对应的各关节轴的终止角度。
6.如权利要求3所述的机械臂奇异点控制方法,其特征在于,还包括:
对所述路径终点信息进行逆向运动学求解;
在依据路径终点信息的逆向运动学求解结果判断得出机械臂进入所述奇异区时,
判断所述机械臂的末端的当前位置距所述路径终点信息的距离是否大于设定距离阈值,
若大于设定距离阈值,则利用轴运动规划算法控制机械臂运动至下一插补点;
若小于设定距离阈值,则利用轴运动规划算法控制机械臂直接运动至路径终点。
7.如权利要求6所述的机械臂奇异点控制方法,其特征在于,利用轴运动规划算法控制机械臂直接运动至路径终点的步骤,还包括:
实时获取所述机械臂的末端的当前位置信息;
判定所述机械臂的末端的当前位置信息与所述路径终点信息是否一致;
当判定一致时,控制所述机械臂停止运动。
8.如权利要求7所述的机械臂奇异点控制方法,其特征在于,判定所述机械臂的末端的当前位置信息与所述路径终点信息是否一致,还包括:
计算所述机械臂的末端的当前位置信息距所述路径终点信息的距离,并判断所计算得出的距离是否在预设收敛阈值范围内;
在所计算得出的距离在所述预设收敛阈值范围内时,则得出判定一致的结果。
9.如权利要求1所述的机械臂奇异点控制方法,其特征在于,在采用轴运动规划算法控制机械臂运动之前,还包括:
获取所述机械臂的末端的当前运动速度,并判定所述机械臂的末端的当前运动速度是否大于预设末端速度阈值;
在判定大于预设末端速度阈值时,控制所述机械臂的末端进行平滑降速,直至所述机械臂的末端的当前运动速度小于等于预设末端速度阈值。
10.一种机械臂奇异点控制系统,用于控制机械臂通过奇异区,所述奇异区为包括奇异点的区域,其特征在于,所述控制系统包括:
信息获取模块,用于获取机械臂模型信息、路径起点信息和路径终点信息;
连接于所述信息获取模块的第一计算模块,用于根据所述的机械臂模型信息、路径起点信息和路径终点信息进行逆向运动学求解,并在进行逆向运动学求解中,于路径起点和路径终点连成的直线上插入多个插补点,且预先计算得到下一插补点的逆解结果;
连接于所述第一计算模块处理模块,用于依据逆向运动学求解的结果控制所述机械臂的末端沿直线路径依序经过各个插补点而向着路径终点运动,还用于根据所述下一插补点的逆解结果判断机械臂是否进入所述奇异区,
在判定机械臂进入所述奇异区时,所述处理模块控制一第二计算模块采用轴运动规划算法计算下一插补点的结果,待所述机械臂完成当前的逆解结果时所述处理模块将所述机械臂的运动由末端沿直线路径运动切换至采用轴运动规划算法控制的运动;
在判定机械臂未进入所述奇异区时,所述处理模块继续依据逆向运动学求解的结果控制所述机械臂的末端沿直线路径运动。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811497400.2A CN109605369B (zh) | 2018-12-07 | 2018-12-07 | 机械臂奇异点控制方法及系统 |
TW108136190A TWI704039B (zh) | 2018-12-07 | 2019-10-05 | 機械臂奇異點控制方法及系統 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811497400.2A CN109605369B (zh) | 2018-12-07 | 2018-12-07 | 机械臂奇异点控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109605369A true CN109605369A (zh) | 2019-04-12 |
CN109605369B CN109605369B (zh) | 2021-09-07 |
Family
ID=66007472
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811497400.2A Active CN109605369B (zh) | 2018-12-07 | 2018-12-07 | 机械臂奇异点控制方法及系统 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN109605369B (zh) |
TW (1) | TWI704039B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112060093A (zh) * | 2020-09-10 | 2020-12-11 | 云南电网有限责任公司电力科学研究院 | 一种用于架空线路检修机械臂的路径规划方法 |
CN112486034A (zh) * | 2020-11-09 | 2021-03-12 | 北京配天技术有限公司 | 验证轨迹规划的方法、电子设备及存储介质 |
CN112511759A (zh) * | 2021-02-08 | 2021-03-16 | 常州微亿智造科技有限公司 | 飞拍控制方法和装置 |
CN113021347A (zh) * | 2021-03-23 | 2021-06-25 | 深圳市优必选科技股份有限公司 | 机械臂控制方法、装置、作业控制设备及可读存储介质 |
CN113084792A (zh) * | 2019-12-23 | 2021-07-09 | 配天机器人技术有限公司 | 关节奇异区域的确定方法、机器人及存储装置 |
CN113681570A (zh) * | 2021-10-26 | 2021-11-23 | 季华实验室 | 一种六轴机械臂过奇异点的控制方法 |
CN113768626A (zh) * | 2020-09-25 | 2021-12-10 | 武汉联影智融医疗科技有限公司 | 手术机器人控制方法、计算机设备及手术机器人系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003300183A (ja) * | 2002-04-09 | 2003-10-21 | Nippon Steel Corp | 垂直多関節型マニピュレータの制御装置 |
CN103802114A (zh) * | 2012-11-08 | 2014-05-21 | 沈阳新松机器人自动化股份有限公司 | 工业机器人奇异点处理方法及装置 |
CN103909522A (zh) * | 2014-03-19 | 2014-07-09 | 华南理工大学 | 一种六自由度工业机器人通过奇异域的方法 |
CN105437235A (zh) * | 2016-01-25 | 2016-03-30 | 珠海格力电器股份有限公司 | 一种奇异点区域减速保护方法、系统和工业机器人 |
CN107148328A (zh) * | 2014-10-30 | 2017-09-08 | 生活机器人学股份有限公司 | 机械臂机构 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6845295B2 (en) * | 2002-03-07 | 2005-01-18 | Fanuc Robotics America, Inc. | Method of controlling a robot through a singularity |
-
2018
- 2018-12-07 CN CN201811497400.2A patent/CN109605369B/zh active Active
-
2019
- 2019-10-05 TW TW108136190A patent/TWI704039B/zh active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003300183A (ja) * | 2002-04-09 | 2003-10-21 | Nippon Steel Corp | 垂直多関節型マニピュレータの制御装置 |
CN103802114A (zh) * | 2012-11-08 | 2014-05-21 | 沈阳新松机器人自动化股份有限公司 | 工业机器人奇异点处理方法及装置 |
CN103909522A (zh) * | 2014-03-19 | 2014-07-09 | 华南理工大学 | 一种六自由度工业机器人通过奇异域的方法 |
CN107148328A (zh) * | 2014-10-30 | 2017-09-08 | 生活机器人学股份有限公司 | 机械臂机构 |
CN105437235A (zh) * | 2016-01-25 | 2016-03-30 | 珠海格力电器股份有限公司 | 一种奇异点区域减速保护方法、系统和工业机器人 |
Non-Patent Citations (2)
Title |
---|
吕永军等: "基于区域限定的奇异位置避免规划算法 ", 《计算机系统应用》 * |
邵浩然: "六自由度焊接机器人工作性能评价分析及轨迹规划研究", 《万方数据库》 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113084792B (zh) * | 2019-12-23 | 2024-05-03 | 配天机器人技术有限公司 | 关节奇异区域的确定方法、机器人及存储装置 |
CN113084792A (zh) * | 2019-12-23 | 2021-07-09 | 配天机器人技术有限公司 | 关节奇异区域的确定方法、机器人及存储装置 |
CN112060093B (zh) * | 2020-09-10 | 2022-08-02 | 云南电网有限责任公司电力科学研究院 | 一种用于架空线路检修机械臂的路径规划方法 |
CN112060093A (zh) * | 2020-09-10 | 2020-12-11 | 云南电网有限责任公司电力科学研究院 | 一种用于架空线路检修机械臂的路径规划方法 |
CN113768626B (zh) * | 2020-09-25 | 2024-03-22 | 武汉联影智融医疗科技有限公司 | 手术机器人控制方法、计算机设备及手术机器人系统 |
CN113768626A (zh) * | 2020-09-25 | 2021-12-10 | 武汉联影智融医疗科技有限公司 | 手术机器人控制方法、计算机设备及手术机器人系统 |
CN112486034A (zh) * | 2020-11-09 | 2021-03-12 | 北京配天技术有限公司 | 验证轨迹规划的方法、电子设备及存储介质 |
CN112486034B (zh) * | 2020-11-09 | 2023-11-10 | 北京配天技术有限公司 | 验证轨迹规划的方法、电子设备及存储介质 |
CN112511759B (zh) * | 2021-02-08 | 2021-05-11 | 常州微亿智造科技有限公司 | 飞拍控制方法和装置 |
CN112511759A (zh) * | 2021-02-08 | 2021-03-16 | 常州微亿智造科技有限公司 | 飞拍控制方法和装置 |
CN113021347A (zh) * | 2021-03-23 | 2021-06-25 | 深圳市优必选科技股份有限公司 | 机械臂控制方法、装置、作业控制设备及可读存储介质 |
CN113681570B (zh) * | 2021-10-26 | 2022-01-04 | 季华实验室 | 一种六轴机械臂过奇异点的控制方法 |
CN113681570A (zh) * | 2021-10-26 | 2021-11-23 | 季华实验室 | 一种六轴机械臂过奇异点的控制方法 |
Also Published As
Publication number | Publication date |
---|---|
TWI704039B (zh) | 2020-09-11 |
TW202021752A (zh) | 2020-06-16 |
CN109605369B (zh) | 2021-09-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109605369A (zh) | 机械臂奇异点控制方法及系统 | |
CN107848005B (zh) | 折弯跟随轨迹规划方法、装置及系统 | |
CN107571261B (zh) | 示教机器人多空间轨迹规划的平滑过渡方法及装置 | |
CN108549322B (zh) | 一种针对机器人圆弧轨迹运动的位姿同步方法和装置 | |
CN110497411B (zh) | 一种工业机器人协同运动控制方法 | |
CN107263484A (zh) | 机器人关节空间点到点运动的轨迹规划方法 | |
CN107901041A (zh) | 一种基于图像混合矩的机器人视觉伺服控制方法 | |
CN107030697A (zh) | 一种机器人笛卡尔空间平滑轨迹的规划方法 | |
CN108189038A (zh) | 一种实用的工业六轴机械臂直线运动轨迹规划方法及系统 | |
CN111469129A (zh) | 一种基于双机械臂的船体外板曲面成形无碰撞运动规划方法 | |
CN107756400A (zh) | 一种基于旋量理论的6r机器人逆运动学几何求解方法 | |
CN107584474A (zh) | 一种基于几何投影的球面关节双臂机器人协调运动方法 | |
CN108829113A (zh) | 一种多机器人编队自适应零空间行为融合方法 | |
US4967125A (en) | Tool posture control method for a robot | |
CN109304711A (zh) | 串联机器人轨迹规划方法 | |
CN109311155B (zh) | 一种工业机器人的工具坐标系原点的标定方法及装置 | |
CN111633668A (zh) | 一种用于机器人加工三维自由曲面的运动控制方法 | |
CN104750116A (zh) | 一种双臂机器人协调操作的路径规划方法 | |
CN111496783A (zh) | 一种6r工业机器人逆运动学求解方法 | |
CN103454979A (zh) | 一种封装成PLCOpen指令的变速曲线圆弧快速插补方法 | |
CN111496798B (zh) | 机器人传送带跟踪方法、设备及存储装置 | |
CN109773778B (zh) | 一种工业机器人关节空间同步运动的规划方法 | |
CN109129470B (zh) | 机器人直线路径的规划方法及系统 | |
CN109648563B (zh) | 串联机器人运动控制方法及计算机存储介质 | |
CN107290959B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20220407 Address after: 201114 building 3, No. 789, Puxing highway, Minhang District, Shanghai Patentee after: Shanghai yingyida Medical Instrument Co.,Ltd. Address before: 201114 No. 789 Pu Xing Road, Shanghai, Minhang District Patentee before: INVENTEC APPLIANCES (PUDONG) Corp. Patentee before: INVENTEC APPLIANCES Corp. Patentee before: INVENTEC APPLIANCES (SHANGHAI) Co.,Ltd. |
|
TR01 | Transfer of patent right |