CN107718050B - Scara机器人臂长与零点标定方法、装置、介质及计算机设备 - Google Patents
Scara机器人臂长与零点标定方法、装置、介质及计算机设备 Download PDFInfo
- Publication number
- CN107718050B CN107718050B CN201711120228.4A CN201711120228A CN107718050B CN 107718050 B CN107718050 B CN 107718050B CN 201711120228 A CN201711120228 A CN 201711120228A CN 107718050 B CN107718050 B CN 107718050B
- Authority
- CN
- China
- Prior art keywords
- scara robot
- preset
- hole
- equation set
- arm length
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means or methods for testing 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明提供一种SCARA机器人臂长与零点标定方法、装置、存储介质及其计算机设备,方法包括:获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,构建SCARA机器人的运动学方程组,采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组,求解该超静定齐次线性方程组,并基于求解结果、运动学方程组以及已知的预设第一孔与预设第二孔距离,计算SCARA机器人臂长与零点。整个过程,采用三角恒等式对机器人运动学正解方程进行变换并作变量代换,将其从非线性方程转化为线性方程求解该线性方程,处理过程简单,能够同时且准确计算SCARA机器人的臂长与零点。
Description
技术领域
本发明涉及机器人技术领域,特别是涉及SCARA机器人臂长与零点标定方法、装置、介质及计算机设备。
背景技术
SCARA机器人(Selective ComplianceAssembly RobotArm,选择顺应性装配机器手臂),具有四个轴和四个运动自由度,(包括沿X,Y,Z方向的平移和绕Z轴的旋转自由度)。SCARA机器人在X,Y方向上具有顺从性,而在Z轴方向具有良好的刚度,此特性特别适合于装配工作;其串接的两杆结构,类似人的手臂,可以伸进有限空间中作业然后收回,适合于搬动和取放物件。SCARA机器人结构紧凑、动作灵活,速度快、位置精度高,广泛应用于塑料工业、汽车工业、电子产品工业、药品工业和食品工业等领域。
由于机械加工误差、装配误差,摩擦磨损等因素的影响,实际机器人的运动学参数与理论设计值存在偏差,必须通过一定的测量手段或几何约束关系等,并基于机器人的运动学模型,准确地辨识出运动学参数,从而提高机器人的绝对定位精度。如何通过简单实用而有效的方法求得SCARA机器人臂长与零点,有着重要意义。
目前,一般SCARA机器人臂长标定与零点方法必须采用激光跟踪仪、三坐标仪等昂贵的测量设备,标定成本很高,且操作麻烦,不利于现场快速标定;对于采用低成本测量工具的方法,有的不能同时标定得出SCARA机器人的零点和臂长,有的对测量工具加工精度要求高,操作步骤多。
发明内容
基于此,有必要针对一般无法对SCARA机器人臂长与零点标定便捷且准确标定的问题,提供一种便捷且准确的SCARA机器人臂长与零点标定方法、装置、存储介质及计算机设备。
一种SCARA机器人臂长与零点标定方法,包括步骤:
获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,预设第一孔与预设第二孔的距离已知;
根据测量参数,构建SCARA机器人运动学方程组;
采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组;
求解超静定齐次线性方程组,获得方程组求解结果;
根据方程组求解结果、SCARA机器人运动学方程组以及预设第一孔与预设第二孔之间的已知距离,计算SCARA机器人臂长与零点。
在其中一个实施例中,求解超静定齐次线性方程组,获得方程组求解结果的步骤包括:
将超静定齐次线性方程组问题转化为带等式约束的优化问题,推导获得正定矩阵;
求解正定矩阵的最小特征值及对应的特征向量,获得方程组求解结果。
在其中一个实施例中,求解正定矩阵的最小特征值及对应的特征向量的步骤包括:
采用最小二乘法和二分法,求解正定矩阵的最小特征值及对应的特征向量。
在其中一个实施例中,采用最小二乘法和二分法,求解正定矩阵的最小特征值及对应的特征向量的步骤包括:
获取正定矩阵的特征多项式;
基于正定矩阵的特征值均大于0情况,求解特征多项式较小的根,记录为λ';
在区间(0,λ')里,对特征多项式采用二分法,求解正定矩阵的最小特征值;
采用最小二乘法,求解最小的特征值对应的特征向量。
在其中一个实施例中,获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数的步骤之前还包括:
将SCARA机器人的末端标定针分别以左手系和右手系对准预设第一孔,分别记录下SCARA机器人第一关节与第二关节对应的角度;
将SCARA机器人的末端标定针分别以左手系和右手系对准预设第二孔,分别记录下SCARA机器人第一关节与第二关节对应的角度。
一种SCARA机器人臂长与零点标定装置,包括:
参数获取模块,用于获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,预设第一孔与预设第二孔的距离已知;
方程组构建模块,用于根据测量参数,构建SCARA机器人运动学方程组;
线性方程模块,用于采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组;
求解模块,用于求解超静定齐次线性方程组,获得方程组求解结果;
标定计算模块,用于根据方程组求解结果、SCARA机器人运动学方程组以及预设第一孔与预设第二孔之间的已知距离,计算SCARA机器人臂长与零点。
在其中一个实施例中,求解模块包括:
第一处理单元,用于对超静定齐次线性方程组进行带等式约束的优化处理,获得正定矩阵;
第二处理单元,用于求解正定矩阵的最小特征值及对应的特征向量,获得方程组求解结果。
在其中一个实施例中,第二处理单元具体用于采用最小二乘法和二分法,求解正定矩阵的最小特征值及对应的特征向量。
本发明SCARA机器人臂长与零点标定方法与装置,获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,构建SCARA机器人运动学方程组,采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组,求解该超静定齐次线性方程组,并基于求解结果、机器人运动学方程组以及已知的预设第一孔与预设第二孔距离,计算SCARA机器人的臂长与零点。整个过程中,采用三角恒等式对机器人运动学正解方程进行变换并作变量代换,将其从非线性方程转化为线性方程,求解该线性方程,整个处理、计算过程简单,能够同时且准确计算SCARA机器人的臂长与零点。
另,本发明一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如上方法的步骤。
另,本发明一种计算机设备,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,处理器执行程序时实现如上方法的步骤。
上述计算机可读存储介质与计算机设备,其执行上述SCARA机器人臂长与零点标定方法时,采用三角恒等式对机器人运动学正解方程进行变换并作变量代换,将其从非线性方程转化为线性方程,求解该线性方程,整个处理、计算过程简单,能够同时且准确计算SCARA机器人臂长与零点。
附图说明
图1为常规SCARA机器人的结构示意图;
图2为SCARA机器人运动学正解示意图;
图3为本发明SCARA机器人臂长与零点标定方法第一个实施例的流程示意图;
图4为SCARA机器人臂长与零点标定示意图;
图5为本发明SCARA机器人臂长与零点标定方法第二个实施例的流程示意图;
图6为本发明SCARA机器人臂长与零点标定装置第一个实施例的结构示意图;
图7为本发明SCARA机器人臂长与零点标定装置第二个实施例的结构示意图;
图8为L1的计算值标准差与孔距、误差圆半径的关系示意图;
图9为L2的计算值标准差与孔距、误差圆半径的关系示意图;
图10为Δθ2的计算值标准差与孔距、误差圆半径的关系示意图。
具体实施方式
为了更进一步详细解释本发明SCARA机器人臂长与零点标定方法与装置的技术方案及其实现的效果,下面将首先介绍下与SCARA机器人相关的内容。
SCARA机器人具有四个关节(包括三个绕Z轴的旋转关节和一个沿Z轴的平移关节),如图1所示,由于SCARA机器人零点与臂长标定与三、四关节无关,因此这里将其看成平面二自由度机器人。如图2,OA为旋转关节,B为机器人末端,xoy为机器人的基座标系,大臂长L1,小臂长L2,关节1角度θ1,关节2角度θ2,零点偏移值Δθ2,得到机器人的运动学正解如下:
对于机器人工作空间里任意一点P(x,y),机器人有两种不同的姿态抵达点P,为了区分这两种情况,可以约定:若θ2<0,机器人处于左手系;若θ2>0,机器人处于右手系(θ2=0时,机器人处于奇异位置)。
如图3所示,一种SCARA机器人臂长与零点标定方法,包括步骤:
S100:获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,预设第一孔与预设第二孔的距离已知。
测量参数包括SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时对应的角度参数。具体来说,参见图4,测量参数包括SCARA机器人的末端标定针以左手系对准预设第一孔M的第一关节角度θ1 (1)、第二关节角度θ2 (1);SCARA机器人的末端标定针以右手系对准预设第一孔M的第一关节角度θ1 (2)、第二关节角度θ2 (2);SCARA机器人的末端标定针以左手系对准预设第二孔N的第一关节角度θ1 (3)、第二关节角度θ2 (3);SCARA机器人的末端标定针以右手系对准预设第二孔N的第一关节角度θ1 (4)、第二关节角度θ2 (4)。非必要的,测量参数可以是实时采集获取的,也可以是外部设备(器件)已经采集,当前只需要进行下一步处理计算的,当需要实时采集时,将SCARA机器人的末端标定针分别以左手系和右手系对准预设第一孔,分别记录下SCARA机器人第一关节与第二关节对应的角度;将SCARA机器人的末端标定针分别以左手系和右手系对准预设第二孔,分别记录下SCARA机器人第一关节与第二关节对应的角度。
另外,预设第一孔与预设第二孔之间的孔距已知。继续研究发现,预设第一孔与预设第二孔之间的孔距越大,臂长的计算值的稳定性以及对点误差的抗干扰能力越强,因此,一般情况下,预设第一孔M与预设第二孔N之间距离尽量大,以提升整个臂长标定过程的稳定性以及对点误差的抗干扰能力。
S200:根据测量参数,构建SCARA机器人运动学方程组。
机器人末端标定针分别以不同手系对准预设第一孔M,根据式(1),可以得到方程组:
S300:采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组。
三角恒等式的具体公式如下:
做变量代换,如下公式:
为简化符号,记:
末端标定针分别以不同手系对准预设第一孔M,上述公式(2)可以成:
末端标定针分别以不同手系对准预设第二孔N,同理可以得到方程组:
联立方程组(6)和方程组(7)可以得到超静定齐次线性方程组,将其(SCARA机器人的运动学方程组)从非线性方程转化为线性方程(超静定齐次线性方程组),以进行下一步的处理。
S400:求解超静定齐次线性方程组,获得方程组求解结果。
对超静定齐次线性方程组进行求解,以求解出其中特征向量λ1、λ2、λ3的值。具体来说,这个求解计算过程可以选择最小二乘法和二分法进行。
S500:根据方程组求解结果、SCARA机器人的运动学方程组以及预设第一孔与预设第二孔之间的已知距离,计算SCARA机器人的臂长与零点。
根据上述公式(4),可以得到零点偏移值的公式如下:
SCARA机器人大臂与小臂长度的比例值:
由于孔M与孔N的长度d已知,利用式(1),可以求臂长实际值L1、L2。
同理可得L1 (2)、L1 (3)、L1 (4),大小臂长度:
本发明SCARA机器人臂长与零点标定方法,获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,构建SCARA机器人运动学方程组,采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组,求解该超静定齐次线性方程组,并基于求解结果、机器人运动学方程组以及已知的预设第一孔与预设第二孔距离,计算SCARA机器人的臂长与零点。整个过程中,采用三角恒等式对机器人运动学正解方程进行变换并作变量代换,将其从非线性方程转化为线性方程,求解该线性方程,整个处理、计算过程简单,能够同时且准确计算SCARA机器人的臂长与零点。
如图5所示,在其中一个实施例中,步骤S400包括:
S420:将超静定齐次线性方程组问题转化为带等式约束的优化问题,推导获得正定矩阵;
S440:求解正定矩阵的最小特征值及对应的特征向量,获得方程组求解结果。
具体来说,该转换和计算过程可以采用最小二乘法和二分法,最终求解超静定齐次线性方程组。更具体来说,该转换过程具体为:联立(6)和(7)可以得到超静定齐次线性方程组,可以利用最小二乘法求解。对于任意非零实数k,齐次线性方程Aλ=0与A(kλ)=0同解,不失一般性,可以加入约束||λ||=1。求解超静定齐次线性方程组的问题可以转化为带等式约束的优化问题。具体优化过程计算公式如下:
||Aλ||=(Aλ)T(Aλ)=λTATAλ=λT(ATAλ)=λT(ηλ)=η||λ||=η (13)。
更具体来说,在其中一个实施例中,采用最小二乘法和二分法,求解正定矩阵的最小特征值及对应的特征向量的步骤包括:
步骤一:获取正定矩阵的特征多项式。
步骤二:基于正定矩阵的特征值均大于0情况,求解特征多项式较小的根,记录为λ'。
步骤三:在区间(0,λ')里,对特征多项式采用二分法,求解正定矩阵的最小特征值。
步骤四:采用最小二乘法和二分法,求解最小的特征值对应的特征向量。
实对称正定矩阵ATA的特征多项式为一元三次多项式:
f(λ)=λ3+aλ2+bλ+c(a,b,c∈R) (14)
由于正定矩阵ATA所有特征值均大于0,求一元二次方程f'(λ)=0较小的根λ',在区间(0,λ')里对于方程f(λ)=0,利用二分法,可以快速求得最小的特征值λmin。再利用最小二乘法,求矩阵方程(ATA-λminI3×3)λ=0的解,便可得到最小的特征值对应的特征向量λ=[λ1 λ2 λ3]T。
如图6所示,一种SCARA机器人臂长与零点标定装置,包括:
参数获取模块100,用于获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,预设第一孔与预设第二孔的距离已知;
方程组构建模块200,用于根据测量参数,构建SCARA机器人运动学方程组;
线性方程模块300,用于采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组;
求解模块400,用于求解超静定齐次线性方程组,获得方程组求解结果;
标定计算模块500,用于根据方程组求解结果、SCARA机器人运动学方程组以及预设第一孔与预设第二孔之间的已知距离,计算SCARA机器人臂长与零点。
本发明SCARA机器人臂长与零点标定装置,参数获取模块100获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,方程组构建模块200构建SCARA机器人运动学方程组,线性方程模块300采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组,求解模块400求解该超静定齐次线性方程组,标定计算模块500基于求解结果、机器人运动学方程组以及已知的预设第一孔与预设第二孔距离,计算SCARA机器人的臂长与零点。整个过程中,采用三角恒等式对机器人运动学正解方程进行变换并作变量代换,将其从非线性方程转化为线性方程,求解该线性方程,整个处理、计算过程简单,能够同时且准确计算SCARA机器人的臂长与零点。
如图7所示,在其中一个实施例中,求解模块400包括:
第一处理单元420,用于将超静定齐次线性方程组问题转化为带等式约束的优化问题,推导获得正定矩阵;
第二处理单元440,用于求解正定矩阵的最小特征值及对应的特征向量,获得方程组求解结果。
在其中一个实施例中,第二处理单元440具体用于采用最小二乘法和二分法,求解正定矩阵的最小特征值及对应的特征向量。
在其中一个实施例中,第二处理单元440具体用于获取正定矩阵的特征多项式;基于正定矩阵的特征值均大于0情况,求解特征多项式较小的根,记录为λ';在区间(0,λ')里,对特征多项式采用二分法,求解正定矩阵的最小特征值;采用最小二乘法,求解最小的特征值对应的特征向量。
在其中一个实施例中,本发明SCARA机器人臂长与零点标定装置还包括:
第一记录模块,用于将SCARA机器人的末端标定针分别以左手系和右手系对准预设第一孔,分别记录下SCARA机器人第一关节与第二关节对应的角度;
第二记录模块,用于将SCARA机器人的末端标定针分别以左手系和右手系对准预设第二孔,分别记录下SCARA机器人第一关节与第二关节对应的角度。
为证明本发明SCARA机器人臂长与零点标定方法与装置能够准确同时标定SCARA机器人臂长与零点的效果,下面将采用具体实例,结合具体的实验数据以及附图进行说明。
本发明SCARA机器人臂长与零点标定方法,影响机器人零点及臂长标定精度有两方面:末端标定针对点的精度与标定板孔距。设SCARA机器人臂长与零点理论值为:L1=200mm,L2=200mm,Δθ2=0°。臂长与零点实际值为:L1=199mm,L2=201mm,Δθ2=1°。分别取标定板孔距d=100,200,300mm,标定针对点误差为以准确点为圆心,误差半径为errR=0.02,0.04,...,0.5mm的误差圆。利用MATLAB(Matrix Laboratory,矩阵实验室)软件随机模拟标定过程10000次,可以求得在不同的标定板孔距与对点精度下的标定结果,进而求得大小臂长度和零点偏移值的标准差,仿真结果如图8至图10。由图8至图10可以得出:本发明SCARA机器人臂长与零点标定方法稳定,并且孔距越大,臂长的计算值的稳定性对对点误差的抗干扰能力越强,零点偏移值的计算值的稳定性很好,不同孔距对偏移值的计算值的稳定性影响小。
在实际应用中,本发明SCARA机器人臂长与零点标定方法只需拖拽机器人末端标定针分别以左右手系对准已知距离的两标定孔,记录当前关节1和关节2的角度,即可完成标定,操作步骤极其简单。标定孔只需满足距离精度要求,大大降低标定板的机械加工难度,相对于传统的标定方法需要昂贵的测量设备,标定过程复杂的特点,该方法更有利于SCARA机器人现场快速标定,该标定方法稳定,且孔距越大,臂长的标定结果越稳定,零点的标定结果受孔距的影响小,标定后,机器人同一个点的左右手系定位精度在0.09mm以内,精度较高。
另,本发明一种计算机可读存储介质,其上存储有计算机程序,该程序被处理器执行时实现如上方法的步骤。
另,本发明一种计算机设备,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,处理器执行程序时实现如上方法的步骤。
上述计算机可读存储介质与计算机设备,其执行上述SCARA机器人臂长与零点标定方法时,采用三角恒等式对机器人运动学正解方程进行变换并作变量代换,将其从非线性方程转化为线性方程,求解该线性方程,整个处理、计算过程简单,能够同时且准确计算SCARA机器人臂长与零点。
以上实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种SCARA机器人臂长与零点标定方法,其特征在于,包括步骤:
获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,所述预设第一孔与所述预设第二孔的距离已知;
根据所述测量参数,构建SCARA机器人运动学方程组;
采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组;
求解所述超静定齐次线性方程组,获得方程组求解结果;
根据所述方程组求解结果、所述SCARA机器人运动学方程组以及所述预设第一孔与所述预设第二孔之间的已知距离,计算SCARA机器人臂长与零点;
所述测量参数包括SCARA机器人的末端标定针以左手系对准预设第一孔M的第一关节角度θ1 (1)、第二关节角度θ2 (1),SCARA机器人的末端标定针以右手系对准预设第一孔M的第一关节角度θ1 (2)、第二关节角度θ2 (2),SCARA机器人的末端标定针以左手系对准预设第二孔N的第一关节角度θ1 (3)、第二关节角度θ2 (3);SCARA机器人的末端标定针以右手系对准预设第二孔N的第一关节角度θ1 (4)、第二关节角度θ2 (4);
所述SCARA机器人运动学方程组为:
其中,L1表示所述SCARA机器人的大臂长,L2表示所述SCARA机器人的小臂长,Δθ2表示零点偏移值。
2.根据权利要求1所述的SCARA机器人臂长与零点标定方法,其特征在于,所述求解所述超静定齐次线性方程组,获得方程组求解结果的步骤包括:
将超静定齐次线性方程组问题转化为带等式约束的优化问题,推导获得正定矩阵;
求解所述正定矩阵的最小特征值及对应的特征向量,获得方程组求解结果。
3.根据权利要求2所述的SCARA机器人臂长与零点标定方法,其特征在于,所述求解所述正定矩阵的最小特征值及对应的特征向量的步骤包括:
采用最小二乘法和二分法,求解所述正定矩阵的最小特征值及对应的特征向量。
4.根据权利要求3所述的SCARA机器人臂长与零点标定方法,其特征在于,所述采用最小二乘法和二分法,求解所述正定矩阵的最小特征值及对应的特征向量的步骤包括:
获取所述正定矩阵的特征多项式;
基于所述正定矩阵的特征值均大于0情况,求解所述特征多项式较小的根,记录为λ';
在区间(0,λ')里,对所述特征多项式采用二分法,求解所述正定矩阵的最小特征值;
采用最小二乘法,求解所述最小的特征值对应的特征向量。
5.根据权利要求1所述的SCARA机器人臂长与零点标定方法,其特征在于,所述获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数的步骤包括:
将SCARA机器人的末端标定针分别以左手系和右手系对准预设第一孔,分别记录下SCARA机器人第一关节与第二关节对应的角度;
将SCARA机器人的末端标定针分别以左手系和右手系对准预设第二孔,分别记录下SCARA机器人第一关节与第二关节对应的角度。
6.一种SCARA机器人臂长与零点标定装置,其特征在于,包括:
参数获取模块,用于获取SCARA机器人的末端标定针分别以不同手系对准预设第一孔与预设第二孔时的测量参数,所述预设第一孔与所述预设第二孔的距离已知;
方程组构建模块,用于根据所述测量参数,构建SCARA机器人运动学方程组,所述测量参数包括SCARA机器人的末端标定针以左手系对准预设第一孔M的第一关节角度θ1 (1)、第二关节角度θ2 (1),SCARA机器人的末端标定针以右手系对准预设第一孔M的第一关节角度θ1 (2)、第二关节角度θ2 (2),SCARA机器人的末端标定针以左手系对准预设第二孔N的第一关节角度θ1 (3)、第二关节角度θ2 (3);SCARA机器人的末端标定针以右手系对准预设第二孔N的第一关节角度θ1 (4)、第二关节角度θ2 (4),所述SCARA机器人运动学方程组为:
其中,L1表示所述SCARA机器人的大臂长,L2表示所述SCARA机器人的小臂长,Δθ2表示零点偏移值;
线性方程模块,用于采用三角恒等式对机器人运动学方程组进行变换、并作变量代换,获得超静定齐次线性方程组;
求解模块,用于求解所述超静定齐次线性方程组,获得方程组求解结果;
标定计算模块,用于根据所述方程组求解结果、所述SCARA机器人运动学方程组以及所述预设第一孔与所述预设第二孔之间的已知距离,计算SCARA机器人臂长与零点。
7.根据权利要求6所述的SCARA机器人臂长与零点标定装置,其特征在于,求解模块包括:
第一处理单元,用于将超静定齐次线性方程组问题转化为带等式约束的优化问题,推导获得正定矩阵;
第二处理单元,用于求解所述正定矩阵的最小特征值及对应的特征向量,获得方程组求解结果。
8.根据权利要求7所述的SCARA机器人臂长与零点标定装置,其特征在于,所述第二处理单元具体用于采用最小二乘法和二分法,求解所述正定矩阵的最小特征值及对应的特征向量。
9.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,该程序被处理器执行时实现如权利要求1-5中任意一项所述方法的步骤。
10.一种计算机设备,包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现如权利要求1-5中任意一项所述方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711120228.4A CN107718050B (zh) | 2017-11-14 | 2017-11-14 | Scara机器人臂长与零点标定方法、装置、介质及计算机设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711120228.4A CN107718050B (zh) | 2017-11-14 | 2017-11-14 | Scara机器人臂长与零点标定方法、装置、介质及计算机设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107718050A CN107718050A (zh) | 2018-02-23 |
CN107718050B true CN107718050B (zh) | 2020-07-17 |
Family
ID=61215425
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711120228.4A Active CN107718050B (zh) | 2017-11-14 | 2017-11-14 | Scara机器人臂长与零点标定方法、装置、介质及计算机设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107718050B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109636783B (zh) * | 2018-12-04 | 2020-11-27 | 广东拓斯达科技股份有限公司 | 机器人臂长的确定方法、装置、计算机设备及存储介质 |
CN109664328B (zh) * | 2018-12-29 | 2022-04-01 | 日照市越疆智能科技有限公司 | Scara机器人的治具标定方法 |
CN110614635B (zh) * | 2019-08-31 | 2021-11-02 | 武汉弗雷德斯科技发展有限公司 | 一种scara机器人运动学参数的辨识方法 |
CN110682293A (zh) * | 2019-10-24 | 2020-01-14 | 广东拓斯达科技股份有限公司 | 机器臂校正方法、装置、机器臂的控制器和存储介质 |
CN110802597A (zh) * | 2019-11-22 | 2020-02-18 | 中船重工鹏力(南京)智能装备***有限公司 | 基于奇异值分解的水平关节机器人的标定方法 |
CN111037551B (zh) * | 2019-12-05 | 2022-10-11 | 上海新时达机器人有限公司 | 机器人测试空间的获取方法、装置及机器人*** |
CN113043264B (zh) * | 2019-12-26 | 2022-07-05 | 沈阳新松机器人自动化股份有限公司 | 一种一体化关节七轴机器人的零位标定方法 |
CN111113419B (zh) * | 2019-12-27 | 2022-01-25 | 深圳市越疆科技有限公司 | Scara机器人机械参数的标定方法、装置及scara机器人 |
CN112238340B (zh) * | 2020-10-26 | 2022-05-24 | 广东三扬机器人有限公司 | 一种三轴螺丝机的标定方法 |
CN112720457B (zh) * | 2020-12-03 | 2022-03-18 | 深圳众为兴技术股份有限公司 | 机器人标定方法、装置、电子设备及存储介质 |
CN112815887B (zh) * | 2020-12-30 | 2022-10-21 | 廊坊市亿创科技有限公司 | 一种工业机器人末端工具坐标系标定方法 |
CN113263523B (zh) * | 2021-04-25 | 2022-06-17 | 项淮智能科技(长兴)有限公司 | 一种测量scara机器人臂长方法 |
CN114750156B (zh) * | 2022-04-24 | 2023-07-28 | 杭州翼菲机器人智能制造有限公司 | 一种scara机器人机械参数的标定方法 |
CN116852383B (zh) * | 2023-09-05 | 2023-12-08 | 山东大学 | 一种机械臂零位自动标定装置及方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SE501263C2 (sv) * | 1991-12-10 | 1994-12-19 | Asea Brown Boveri | Förfarande för kalibrering av rörelseaxlar hos en industrirobot |
CN101493315B (zh) * | 2009-02-27 | 2010-09-08 | 科瑞自动化技术(深圳)有限公司 | 机械手标定方法 |
CN102910533A (zh) * | 2012-10-26 | 2013-02-06 | 北京机械设备研究所 | 一种基于吊机的空间角度测量方法 |
CN106610266B (zh) * | 2015-10-22 | 2019-01-04 | 沈阳新松机器人自动化股份有限公司 | 一种scara机器人标定方法 |
CN106064379B (zh) * | 2016-07-21 | 2019-04-12 | 深圳众为兴技术股份有限公司 | 一种机器人自动计算实际臂长的方法 |
-
2017
- 2017-11-14 CN CN201711120228.4A patent/CN107718050B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107718050A (zh) | 2018-02-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107718050B (zh) | Scara机器人臂长与零点标定方法、装置、介质及计算机设备 | |
CN107042528B (zh) | 一种工业机器人的运动学标定***及方法 | |
CN107717993B (zh) | 一种高效便捷的简易机器人标定方法 | |
CN109176494B (zh) | 绳驱多关节柔性机器人自标定方法及***、存储介质 | |
US7904202B2 (en) | Method and system to provide improved accuracies in multi-jointed robots through kinematic robot model parameters determination | |
Ikits et al. | Kinematic calibration using a plane constraint | |
CN111546328B (zh) | 基于三维视觉测量的手眼标定方法 | |
Yu et al. | Simultaneous and on-line calibration of a robot-based inspecting system | |
CN104215206B (zh) | 一种双机器人协作***的基坐标标定方法 | |
CN106064379B (zh) | 一种机器人自动计算实际臂长的方法 | |
CN106568381B (zh) | 一种基于标准平面的线激光测量***标定方法 | |
GB2188754A (en) | A method for identifying kinematic parameters of robotic manipulators | |
CN102087096A (zh) | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 | |
CN108890645A (zh) | 一种五自由度混联机器人驱动关节零点误差的补偿方法 | |
KR101797122B1 (ko) | 이동형 3차원 좌표 측정기(cmm)의 에러 측정 및 보상 방법 | |
Li et al. | Kinematic calibration of serial robot using dual quaternions | |
JP7258516B2 (ja) | キャリブレーション方法および把持システム | |
CN109866224B (zh) | 一种机器人雅可比矩阵计算方法、装置及存储介质 | |
CN110900608B (zh) | 基于最优测量构型选择的机器人运动学标定方法 | |
Solovyev et al. | CONTROL SYSTEM OF THE ARTICULATED ARM BRAKING MECHATRONIC MACHINE (AABMM). | |
CN115493616B (zh) | 一种激光跟踪姿态角现场精度的评定方法 | |
CN115493617B (zh) | 一种激光跟踪姿态角现场精度评定*** | |
CN110125982B (zh) | 微操作机器人三自由度运动控制***运动轨迹正交性测量方法 | |
CN108375337B (zh) | 一种机器人及其工艺设备相对位姿的测定方法及测定装置 | |
Lundberg et al. | Intrinsic camera and hand-eye calibration for a robot vision system using a point marker |
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 |