CN116021528A - 一种机器人转台装置校正方法 - Google Patents
一种机器人转台装置校正方法 Download PDFInfo
- Publication number
- CN116021528A CN116021528A CN202310322858.9A CN202310322858A CN116021528A CN 116021528 A CN116021528 A CN 116021528A CN 202310322858 A CN202310322858 A CN 202310322858A CN 116021528 A CN116021528 A CN 116021528A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- robot
- turntable
- small
- axis
- 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
- 238000000034 method Methods 0.000 title claims abstract description 58
- 238000012937 correction Methods 0.000 title abstract description 20
- 239000011159 matrix material Substances 0.000 claims abstract description 114
- 238000005491 wire drawing Methods 0.000 claims abstract description 23
- 239000013598 vector Substances 0.000 claims description 43
- 238000004364 calculation method Methods 0.000 claims description 19
- 238000006073 displacement reaction Methods 0.000 claims description 16
- 230000008569 process Effects 0.000 claims description 14
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 238000009434 installation Methods 0.000 abstract description 6
- 238000010276 construction Methods 0.000 abstract description 4
- 238000001514 detection method Methods 0.000 abstract description 4
- 238000005259 measurement Methods 0.000 description 18
- 238000010586 diagram Methods 0.000 description 8
- 238000004590 computer program Methods 0.000 description 7
- 230000000694 effects Effects 0.000 description 6
- 230000000007 visual effect Effects 0.000 description 6
- 238000003860 storage Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 238000003754 machining Methods 0.000 description 4
- 238000004519 manufacturing process Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000003698 laser cutting Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000004080 punching Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Manipulator (AREA)
Abstract
本发明涉及机器人控制技术领域,公开了一种机器人转台装置校正方法,机器人转台装置包括:机器人和小转台,小转台可水平转动,小转台上设有拉线传感器,拉线传感器的拉线与机器人末端固定连接,方法包括如下步骤:获取拉线传感器出线端在机器人坐标系中的初始坐标信息;基于拉线传感器的初始坐标信息,构建小转台坐标系,建立小转台坐标系与机器人坐标系的第一标定矩阵;基于第一标定矩阵计算小转台在机器人坐标系中的第一空间姿态,依据第一空间姿态对小转台进行姿态校正。通过以较低的硬件成本(一个拉线传感器)实现机器人与转台相对位置的自动测量,检测精度高,检测速度快,降低现场调试人员的工作难度,缩短现场施工安装的调试时间。
Description
技术领域
本发明涉及机器人控制技术领域,特别涉及一种机器人转台装置校正方法。
背景技术
机器人搭载转台进行作业已经比较常见,利用转台装置完成工件上下料,配合机器人实现某些特定工序,如喷涂等等。转台系统成本低、占地面积小、投入少见效快、布局比较灵活,深受中小企业客户青睐。目前,机器人与转台的现场安装调试比较复杂,单就转台而言存在一个问题即与机械结构相关的参数需要设置。因为机械零部件加工普遍存在一定误差,参数按照设计值参与机器人与转台的控制系统运算则会导致实际作业效果与预期存在偏差。目前现场调试时工作人员主要通过卷尺等测量工具对设备的实际参数进行测量,这样的做法存在一些缺陷:(1)人工测量精度难以保证;(2)对操作人员要求较高,人工工资、差旅费等成本较高;(3)某些参数如转台倾斜角度本身比较微小,人工测量难度较大甚至不可行。
以大小转台为例,在机械零部件加工过程中即在其表面打上一定记号作为转台对齐的标志是一种做法,但这样对机加工精度有要求,相当于提高了制造成本。类似机器人本体与大转台的相对角度通常需要人工目视来判断,如判断机器人本体的坐标轴方向与大小转台转动角度是否对齐,如果人工目视稍微出现少许偏差即会引起机器人与转台上工件的相对位置与预计的理想状态存在偏差,从而影响机器人作业效果。上述问题也有用视觉扫描的方式解决工件相对位置存在偏差的问题,但视觉系统的引入成本增加较大,不利于实际推广。
发明内容
本发明实施例的目的是提供一种机器人转台装置校正方法,通过以较低的硬件成本(一个拉线传感器)实现机器人与转台相对位置的自动测量,检测精度高,检测速度快,降低现场调试人员的工作难度,缩短现场施工安装的调试时间,极大地降低了成本。
为解决上述技术问题,本发明实施例的第一方面提供了一种机器人转台装置校正方法,机器人转台装置包括:机器人和小转台,所述小转台可水平转动,所述小转台上设有拉线传感器,所述拉线传感器的拉线与机器人末端固定连接,包括如下步骤:
获取所述拉线传感器出线端在机器人坐标系中的初始坐标信息;
基于所述拉线传感器的初始坐标信息,构建小转台坐标系,建立所述小转台坐标系与机器人坐标系的第一标定矩阵;
基于所述第一标定矩阵计算所述小转台在所述机器人坐标系中的第一空间姿态,依据所述第一空间姿态对所述小转台进行姿态校正。
进一步地,所述获取所述拉线传感器出线端在机器人坐标系中的初始坐标信息,包括:
控制所述机器人末端移动,获取所述机器人末端移动时不共线的三个末端轨迹点与所述拉线传感器出线端的距离值;
依据所述机器人各关节角度计算机器人坐标系中所述三个末端轨迹点的坐标信息;
依据所述三个末端轨迹点与所述拉线传感器出线端的距离值及三个末端轨迹点的坐标信息,计算所述拉线传感器出线端在所述机器人坐标系中的初始坐标信息。
进一步地,所述机器人末端移动时不共线的三个末端轨迹点两控制所述小转台由初始位置两之间的连线构成等边三角形。
进一步地,所述构建小转台坐标系并建立所述小转台坐标系与机器人坐标系的第一标定矩阵,包括:
控制所述小转台由初始位置连续转动多个第一预设角度,得到所述拉线传感器出线端在所述小转台转动过程中三个出线端轨迹点在所述机器人坐标系下的坐标信息;
依据三个所述出线端轨迹点,构建小转台坐标系;
建立所述小转台坐标系与所述机器人坐标系的第一标定矩阵,所述第一标定矩阵包括:第一旋转矩阵和第一位移矩阵。
进一步地,所述依据三个所述出线端轨迹点构建小转台坐标系,包括:
以所述小转台圆心为坐标原点、以第一个所述出线端轨迹点和第三个所述出线端轨迹点连线为X轴方向、以所述小转台圆心和第二个所述出线端轨迹点为Y轴方向,建立所述小转台坐标系。
进一步地,所述基于所述第一标定矩阵计算所述小转台在所述机器人坐标系中的第一空间姿态,包括:
依据所述第一旋转矩阵得到所述小转台在所述机器人坐标系下的第一零位偏转角;
其中,、和分别对应小转台坐标系X轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量;、和分别对应小转台坐标系Y轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量;、和分别对应小转台坐标系Z轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量;
进一步地,所述机器人转台装置还包括:大转台和横梁,所述机器人设置于所述大转台顶部,所述横梁与所述大转台固定连接且随所述大转台同步水平转动,所述小转台设置于所述横梁的一端;
所述获取所述拉线传感器出线端在机器人坐标系中的初始坐标信息之后,还包括:
基于在大转台连续旋转多个第二预设角度时的小转台三个圆心轨迹点,构建大转台坐标系,建立所述大转台坐标系与所述机器人坐标系的第二标定矩阵;
基于所述第二标定矩阵计算所述大转台在所述机器人坐标系中的第二空间姿态,依据所述第二空间姿态对所述大转台进行姿态校正。
进一步地,所述构建大转台坐标系并建立所述大转台坐标系与所述机器人坐标系的第二标定矩阵,包括:
控制所述小转台连续转动多个所述第一预设角度,得到三个所述出线端轨迹点,计算所述小转台圆心轨迹点在所述机器人坐标系中的坐标信息;
控制所述大转台由初始位置连续转动多个第二预设角度,得到所述大转台转动过程中的小转台三个圆心轨迹点在所述机器人坐标系中的坐标信息;
依据小转台三个圆心轨迹点在机器人坐标系中的坐标信息,构建大转台坐标系;
建立所述大转台坐标系与所述机器人坐标系的第二标定矩阵,所述第二标定矩阵包括:第二旋转矩阵和第二位移矩阵。
进一步地,所述依据三个小转台圆心轨迹点在机器人坐标系中的坐标信息,构建大转台坐标系,包括:
依据所述大转台处于不同角度下的小转台三个圆心轨迹点在所述机器人坐标系中的坐标信息,计算所述大转台圆心在所述机器人坐标系中的坐标信息;
获取所述大转台处于不同角度下的小转台三个圆心轨迹点所在平面的法向量;
获取所述大转台处于所述初始位置时的所述小转台的圆心与所述大转台的圆心所在直线在所述机器人坐标系中的方向向量,该方向向量的指向为所述大转台的圆心指向所述小转台的圆心;
以所述大转台圆心为坐标原点、以所述法向量为Z轴、以所述方向向量为X轴,构建大转台坐标系,建立所述大转台坐标系与所述机器人坐标系的第二标定矩阵,所述第二标定矩阵包括:第二旋转矩阵和第二位移矩阵。
进一步地,所述基于所述第二标定矩阵计算所述大转台在所述机器人坐标系中的第二空间姿态,包括:
依据所述第二旋转矩阵得到所述大转台在所述机器人坐标系下的第二零位偏转角;
其中,、和分别对应大转台坐标系X轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量;、和分别对应大转台坐标系Y轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量;、和分别对应大转台坐标系Z轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量。
相应地,本发明实施例的第二方面提供了一种机器人转台装置的校正系统,机器人转台装置包括:机器人和小转台,所述小转台可水平转动,所述小转台上设有拉线传感器,所述拉线传感器的拉线与机器人末端固定连接,校正系统包括:
位置信息获取模块,其用于获取所述拉线传感器出线端在机器人坐标系中的初始坐标信息;
标定矩阵建立模块,其用于基于所述拉线传感器的初始坐标信息,构建小转台坐标系,建立所述小转台坐标系与机器人坐标系的第一标定矩阵;
姿态校正模块,其用于基于所述第一标定矩阵计算所述小转台在所述机器人坐标系中的第一空间姿态,依据所述第一空间姿态对所述小转台进行姿态校正。
相应地,本发明实施例的第三方面提供了一种电子设备,包括:至少一个处理器;以及与所述至少一个处理器连接的存储器;其中,所述存储器存储有可被所述一个处理器执行的指令,所述指令被所述一个处理器执行,以使所述至少一个处理器执行上述机器人转台装置校正方法。
相应地,本发明实施例的第四方面提供了一种计算机可读存储介质,其上存储有计算机指令,该指令被处理器执行时实现上述机器人转台装置校正方法。
本发明实施例的上述技术方案具有如下有益的技术效果:
1、可自动检测因机械零部件制造、装配过程引起的机械结构参数的误差,以及大小转台的零位校准及大小转台所在平面的倾斜角度,无需人工测量或目视;
2、硬件成本较低:增加硬件较少(仅增加一个拉线编码器),充分利用了如机器人自身、大小转台伺服等现有零部件;
3、精度较高,测量过程无人工干预,自动测量,充分利用了如机器人自身、大小转台伺服等现有零部件已有的信息,未使用人工测量数据,精度有保障;
4、提高调试效率:降低现场调试人员的工作难度,大幅缩短现场施工安装的调试时间,降低成本。
附图说明
图1是本发明实施例提供的机器人转台装置示意图;
图2是本发明实施例提供的机器人转台装置校正方法流程图;
图3是本发明实施例提供的机器人末端移动示意图;
图4是本发明实施例提供的小转台转动示意图;
图5是本发明实施例提供的大转台转动示意图;
图6是本发明实施例提供的机器人转台装置的校正系统模块框图。
附图标记:
1、位置信息获取模块,2、标定矩阵建立模块,3、姿态校正模块。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了,下面结合具体实施方式并参照附图,对本发明进一步详细说明。应该理解,这些描述只是示例性的,而并非要限制本发明的范围。此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本发明的概念。
请参照图1和图2,本发明实施例的第一方面提供了一种机器人转台装置校正方法,机器人转台装置包括:机器人、小转台,所述小转台可水平转动,所述小转台上设有拉线传感器,所述拉线传感器的拉线与机器人末端固定连接,如图2所示,校正方法包括如下步骤:
步骤S100,获取拉线传感器出线端在机器人坐标系中的初始坐标信息。
步骤S200,基于拉线传感器的初始坐标信息,构建小转台坐标系,建立小转台坐标系与机器人坐标系的第一标定矩阵。
步骤S300,基于第一标定矩阵计算小转台在机器人坐标系中的第一空间姿态,依据第一空间姿态对小转台进行姿态校正。
机器人转台装置工作,大转台实现上下料,小转台实现工件旋转。小转台的转盘上安装一个拉线传感器,假设拉线传感器出线口位于点P,其与小转台旋转中心轴线距离为r。拉线拉出后连接在机器人末端即空间中点A。假设机器人坐标系为{B},如图4所示,机器人坐标系的X、Y和Z轴的方向向量分别为XB、YB和ZB。
此外,图1中机器人末端与拉线传感器连接的拉线为可伸缩测量拉线。
具体的,请参照图3,步骤S100中,获取拉线传感器出线端在机器人坐标系中的初始坐标信息,包括:
步骤S110,控制机器人末端移动,获取机器人末端移动时不共线的三个末端轨迹点与拉线传感器出线端的距离值。
步骤S120,依据机器人各关节角度计算机器人坐标系中三个末端轨迹点的坐标信息。
步骤S130,依据三个末端轨迹点与拉线传感器出线端的距离值及三个末端轨迹点的坐标信息,计算拉线传感器出线端在机器人坐标系中的初始坐标信息。
当机器人末端在空间中移动至不共线的三个点A1、A2、A3时,拉线传感器测量得到三个点距离点P的距离依次为、、。同时,根据机器人各关节角度通过正运动学计算可以得到机器人坐标系{B}下A1、A2、A3三个点的坐标值,假设依次为,,。设P点在机器人坐标系{B}下的坐标为。根据几何关系,可以得到以下三个等式:
更进一步地,机器人末端移动时不共线的三个末端轨迹点两两之间的连线构成等边三角形。为简化计算,可以使A1、A2、A3位于水平面上的等边三角形的三个顶点。
在本发明实施例的一个实施方式中,请参照图4,步骤S200中的构建小转台坐标系并建立小转台坐标系与机器人坐标系的第一标定矩阵,包括:
步骤S211,控制小转台由初始位置连续转动多个第一预设角度,得到拉线传感器出线端转动过程中三个出线端轨迹点在机器人坐标系下的坐标信息。
步骤S212,依据三个出线端轨迹点,构建小转台坐标系.
步骤S213,建立小转台坐标系与机器人坐标系的第一标定矩阵,第一标定矩阵包括:第一旋转矩阵和第一位移矩阵。
当小转台位于不同角度时,点P 位置及其在机器人坐标系{B}下的坐标值显然会有变化。假设小转台位于0°、-90°、-180°时,小转台上拉线传感器出线口位置分别为P1、P2、P3,根据上述方法计算得到的机器人坐标系{B}下三个点对应的坐标值依次为、、。
更进一步地,步骤S212,依据三个出线端轨迹点构建小转台坐标系,具体包括:
步骤S212a,以小转台圆心为坐标原点、以第一个出线端轨迹点和第三个出线端轨迹点连线为X轴方向、以小转台圆心和第二个出线端轨迹点为Y轴方向,建立小转台坐标系。
根据P1、P2、P3三个点在小转台上的相对位置,以小转台圆心所在位置Ro为坐标系原点,P1与P3所在直线为X轴方向,Ro与P2所在直线为Y轴方向,建立小转台坐标系{R},则{R}的原点Ro在{B}中表达为,X轴方向向量在{B}中表达为,Y轴方向向量在{B}中表达为,Z轴方向向量在{B}中表达为。其中,假设小转台位于0°、-90°、-180°时,小转台上拉线传感器出线口位置分别为P1、P2、P3,根据上述方法计算得到的机器人坐标系{B}下三个点对应的坐标值依次为、、。
因此,小转台坐标系{R}相对机器人坐标系{B}的旋转矩阵即所述第一旋转矩阵为:
小转台坐标系{R}相对机器人坐标系{B}的位移矩阵即所述第一位移矩阵为:
因此,小转台坐标系{R}相对机器人坐标系{B}的标定矩阵即所述第一标定矩阵为:
图4中的XB、YB、ZB分别表示机器人坐标系中的X坐标轴、Y坐标轴及Z坐标轴。
进一步地,步骤S300中的基于第一标定矩阵计算小转台在机器人坐标系中的第一空间姿态,包括:
步骤S310,依据第一旋转矩阵得到小转台在机器人坐标系下的第一零位偏转角;
将机器人坐标系绕自身Z轴旋转角度,再绕自身Y轴旋转角度,最后绕自身X轴旋转角度,可以得到小转台坐标系。其中、、为机器人坐标系到小转台坐标系旋转的欧拉角,由欧拉角对应计算出的旋转矩阵值与所述第一旋转矩阵相等。
其中,、和分别对应小转台坐标系X轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量;、和分别对应小转台坐标系Y轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量;、和分别对应小转台坐标系Z轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量。
依据所述第一旋转矩阵与欧拉角的转换计算,可得欧拉角的计算值:
在整个系统中,定义小转台坐标系X轴与机器人坐标系X、Z轴所在平面XOZ的夹角为小转台的零位偏转角,即所述第一零位偏转角,其角度值等于欧拉角中机器人坐标系绕Z轴旋转角度,因此第一零位偏转角的计算公式为:
理想情况下,默认机器人示教轨迹是在小转台坐标系相对机器人坐标系无偏转角度的条件下建立起来的。在小转台存在偏转角度的情况下复现示教轨迹,会使得机器人工作时的姿态受到一定影响,可能出现运行轨迹不顺畅甚至存在奇异点、超速等异常情况。
为了尽量减少机器人工作姿态受到小转台偏转角度的影响,应该校正小转台的零点位置。具体地,在小转台位于0°时,将小转台绕Z轴旋转-,也就是旋转所述第一零位偏转角的相反数,此时小转台坐标系X轴与机器人坐标系X、Z轴所在平面XOZ保持平行,设定此时小转台的位置为校正后的零度位置,从而完成小转台的零位偏转的校正过程。
此时,小转台坐标系由{R}校正为{R’}。校正后小转台坐标系{R’}在机器人坐标系{B}中的第一标定矩阵应为:
上述小转台的零位偏转的校正过程只解决了小转台坐标系绕Z轴旋转角度的问题,小转台仍然可能与机器人坐标系存在绕X轴或Y轴的偏转角度,即小转台可能存在水平倾斜角度,这是由机械加工装配误差等因素引起,其影响很难通过机械的方式消除。
机器人示教轨迹是在小转台坐标系相对机器人坐标系无偏转角度的条件下建立起来的,可以认为示教轨迹相对工件是固定的,由于工件固定在小转台上,因此也可以认为示教轨迹相对小转台是固定的。当小转台存在水平倾斜角度时,需要通过所述第一标定矩阵调整示教轨迹的位置与姿态信息,再通过机器人的运动学求逆等一系列运算得到新的机器人的关节指令,进而驱动机器人运动。
在本发明实施例的另一个实施方式中,请参照图5,机器人转台装置还包括:大转台和横梁,机器人设置于大转台顶部,横梁与大转台固定连接且随大转台同步水平转动,小转台设置于横梁的一端。步骤S100中的获取小转台圆心位置坐标后,还包括:
步骤S400,基于在大转台连续旋转多个第二预设角度时的三个小转台圆心位置,构建大转台坐标系,建立大转台坐标系与机器人坐标系的第二标定矩阵。
步骤S500,基于第二标定矩阵计算大转台在机器人坐标系中的第二空间姿态,依据第二空间姿态分别对大转台进行姿态校正。
具体的,步骤S400中的构建大转台坐标系并建立大转台坐标系与机器人坐标系的第二标定矩阵,包括:
步骤S410,控制小转台连续转动多个第一预设角度,得到三个出线端轨迹点,计算小转台圆心在机器人坐标系中的坐标信息。
步骤S420,控制大转台由初始位置连续转动多个第二预设角度,重复前述计算小转台圆心坐标信息的步骤,得到的三个小转台圆心点在机器人坐标系中的坐标信息。
步骤S430,依据三个小转台圆心在机器人坐标系中的坐标信息,构建大转台坐标系。
步骤S440,建立大转台坐标系与机器人坐标系的第二标定矩阵,第二标定矩阵包括:第二旋转矩阵和第二位移矩阵。
如图5所示,转动大转台带动小转台,小转台随大转台公转而不围绕小转台轴向自转,大转台带动小转台圆心点达到、、位置,(假设对应大转台处于零度位置),采用前述类似方法,可以测量得到三个点在机器人坐标系{B}下的坐标依次为,=、=。显然,、、三个点在同一个圆上,该圆的半径为大转台与小转台圆心之间的距离。根据、、坐标值,容易计算出三个点所在圆(即大转台所在的圆)的圆心Po在机器人坐标系{B}下的坐标,以及三点所在平面的法向量(法向量存在两种方向,选取与机器人坐标系{B}的Z轴比较接近的法向量作为n)。
因此,同样可得到大转台坐标系{D}在机器人坐标系{B}中的第二旋转矩阵为:
因此,大转台坐标系{D}在机器人坐标系{B}中的第二标定矩阵为:
更进一步地,步骤S430中,依据三个小转台圆心在机器人坐标系中的坐标信息,构建大转台坐标系,包括:
步骤S431,依据大转台处于不同角度下的小转台圆心在机器人坐标系中的坐标信息,计算大转台圆心在机器人坐标系中的坐标信息。
步骤S432,获取大转台处于不同角度下的三个小转台的圆心所在平面的法向量。
步骤S433,获取大转台处于初始位置时的小转台的圆心与大转台的圆心所在直线为机器人坐标系中的方向向量,该向量的指向为大转台的圆心指向小转台的圆心。
步骤S424,以大转台圆心为坐标原点、以法向量为Z轴、以方向向量为X轴,构建大转台坐标系,建立大转台坐标系与机器人坐标系的第二标定矩阵,第二标定矩阵包括:第二旋转矩阵和第二位移矩阵。
进一步地,步骤S500中的基于第二标定矩阵计算大转台在机器人坐标系中的第二空间姿态,包括:
步骤S510,依据第二旋转矩阵得到大转台在机器人坐标系下的第二零位偏转角;
将机器人坐标系绕自身Z轴旋转角度,再绕自身Y轴旋转角度,最后绕自身X轴旋转角度,则可以得到大转台坐标系。其中、、为机器人坐标系到大转台坐标系旋转的欧拉角,由欧拉角对应计算出的旋转矩阵值与所述第二选转矩阵相等。
其中,、和分别对应大转台坐标系X轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量;、和分别对应大转台坐标系Y轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量;、和分别对应大转台坐标系Z轴方向的单位矢量在机器人坐标系下X轴、Y轴和Z轴方向上的分量。
依据所述第二旋转矩阵与欧拉角的转换计算,可得欧拉角的计算值:
具体的,通过测量计算得到当前位置第二零位偏转角后,驱动大转台机械结构反向旋转该角度值,即可使大转台坐标系X轴与机器人坐标系X、Z轴所在平面XOZ保持平行,设定此时大转台位置为对应的零点位置,完成大转台零位偏转的校正。
第一旋转矩阵1的代表的是小转台坐标系{R}相对机器人坐标系{B}的倾斜角度,由于机器人安装时一般尽量使得机器人底座处于水平状态,因此第一旋转矩阵1代表了小转台在水平面上的倾斜角度。由于倾斜角度一般都比较微小,因此通过人工测量难度比较大。第一位移矩阵代表的是小转台坐标系的原点与机器人坐标系的原点之间的相对位置。由于所述机器人安装在所述大转台顶部,机器人坐标系的原点与大转台转动的轴线比较接近,因此,第一位移矩阵也在很大程度上代表了小转台坐标系的原点与大转台转动的轴线之间的相对位置关系,也就是小转台的轴心与大转台的轴心之间的距离,对应的物理含义就是大转台与小转台之间的连接臂的长度。
第一旋转矩阵与第一位移矩阵依据小转台半径、拉线传感器长度测量结果、小转台的角度测量结果、机器人末端位置坐标等数据计算得到。上述数据中,小转台半径可以由激光切割机一体打孔得到,比较确定;长度测量结果取自拉线传感器,小转台的角度来自为转台提供动力的伺服电机,数据本身精度已经足够高;机器人末端位置信息根据机器人当前各关节角度及机器人DH参数计算得到,精度足够高。整个过程无人工干预,没有引入人工测量误差,整体精度有保证。通过上述数据计算得到的机械参数也具有较高的精度,将其代入机器人控制系统中参与运动学求逆等过程,可以使得机器人控制系统考虑到机械结构参数细微的差别,因此可以得到更精准的运动轨迹、更好的作业效果。
相应地,请参照图6,本发明实施例的第二方面提供了一种机器人转台装置的校正系统,机器人转台装置包括:机器人和小转台,所述小转台可水平转动,所述小转台上设有拉线传感器,所述拉线传感器的拉线与机器人末端固定连接,校正系统包括:
位置信息获取模块1,其用于获取拉线传感器出线端在机器人坐标系中的初始坐标信息;
标定矩阵建立模块2,其用于基于拉线传感器的初始坐标信息,构建小转台坐标系,建立小转台坐标系与机器人坐标系的第一标定矩阵;
姿态校正模块3,其用于基于第一标定矩阵计算小转台在机器人坐标系中的第一空间姿态,依据第一空间姿态对小转台进行姿态校正。
上述机器人转台装置的校正系统还可进一步细分为若干个单元及子单元,以实现上述校正方法的步骤,在此不再赘述。
相应地,本发明实施例的第三方面提供了一种电子设备,包括:至少一个处理器;以及与至少一个处理器连接的存储器;其中,存储器存储有可被一个处理器执行的指令,指令被一个处理器执行,以使至少一个处理器执行上述机器人转台装置校正方法。
相应地,本发明实施例的第四方面提供了一种计算机可读存储介质,其上存储有计算机指令,该指令被处理器执行时实现上述机器人转台装置校正方法。
本发明实施例旨在保护一种机器人转台装置校正方法,机器人转台装置包括:机器人、小转台,所述小转台可水平转动,所述小转台上设有拉线传感器,所述拉线传感器的拉线与机器人末端固定连接,包括如下步骤:获取拉线传感器出线端在机器人坐标系中的初始坐标信息;基于拉线传感器的初始坐标信息,构建小转台坐标系,建立小转台坐标系与机器人坐标系的第一标定矩阵;基于第一标定矩阵计算小转台在机器人坐标系中的第一空间姿态,依据第一空间姿态对小转台进行姿态校正。上述技术方案具备如下效果:
1、可自动检测因机械零部件制造、装配过程引起的机械结构参数的误差,以及大小转台的零位校准及大小转台所在平面的倾斜角度,无需人工测量或目视;
2、硬件成本较低:增加硬件较少(仅增加一个拉线编码器),充分利用了如机器人自身、大小转台伺服等现有零部件;
3、精度较高,测量过程无人工干预,自动测量,充分利用了如机器人自身、大小转台伺服等现有零部件已有的信息,未使用人工测量数据,精度有保障;
4、提高调试效率:降低现场调试人员的工作难度,大幅缩短现场施工安装的调试时间,降低成本。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
最后应当说明的是:以上实施例仅用以说明本发明的技术方案而非对其限制,尽管参照上述实施例对本发明进行了详细的说明,所属领域的普通技术人员应当理解:依然可以对本发明的具体实施方式进行修改或者等同替换,而未脱离本发明精神和范围的任何修改或者等同替换,其均应涵盖在本发明的权利要求保护范围之内。
Claims (10)
1.一种机器人转台装置校正方法,其特征在于,机器人转台装置包括:机器人和小转台,所述小转台可水平转动,所述小转台上设有拉线传感器,所述拉线传感器的拉线与机器人末端固定连接,所述方法包括如下步骤:
获取所述拉线传感器出线端在机器人坐标系中的初始坐标信息;
基于所述拉线传感器的初始坐标信息,构建小转台坐标系,建立所述小转台坐标系与机器人坐标系的第一标定矩阵;
基于所述第一标定矩阵计算所述小转台在所述机器人坐标系中的第一空间姿态,依据所述第一空间姿态对所述小转台进行姿态校正。
2.根据权利要求1所述的机器人转台装置校正方法,其特征在于,所述获取所述拉线传感器出线端在机器人坐标系中的初始坐标信息,包括:
控制所述机器人末端移动,获取所述机器人末端移动时不共线的三个末端轨迹点与所述拉线传感器出线端的距离值;
依据所述机器人各关节角度计算机器人坐标系中所述三个末端轨迹点的坐标信息;
依据所述三个末端轨迹点与所述拉线传感器出线端的距离值及三个末端轨迹点的坐标信息,计算所述拉线传感器出线端在所述机器人坐标系中的初始坐标信息。
3.根据权利要求2所述的机器人转台装置校正方法,其特征在于,所述机器人末端移动时不共线的三个末端轨迹点两两之间的连线构成等边三角形。
4.根据权利要求1所述的机器人转台装置校正方法,其特征在于,所述构建小转台坐标系,建立所述小转台坐标系与机器人坐标系的第一标定矩阵,包括:
控制所述小转台由初始位置连续转动多个第一预设角度,得到所述拉线传感器出线端转动过程中三个出线端轨迹点在所述机器人坐标系下的坐标信息;
依据所述三个出线端轨迹点,构建小转台坐标系;
建立所述小转台坐标系与所述机器人坐标系的第一标定矩阵,所述第一标定矩阵包括:第一旋转矩阵和第一位移矩阵。
5.根据权利要求4所述的机器人转台装置校正方法,其特征在于,所述依据所述三个出线端轨迹点,构建小转台坐标系,包括:
以所述小转台的圆心为坐标原点、以第一个所述出线端轨迹点和第三个所述出线端轨迹点连线为X轴方向、以所述小转台圆心和第二个所述出线端轨迹点连线为Y轴方向,建立所述小转台坐标系。
7.根据权利要求1-6任一所述的机器人转台装置校正方法,其特征在于,所述机器人转台装置还包括:大转台和横梁,所述机器人设置于所述大转台顶部,所述横梁与所述大转台固定连接且随所述大转台同步水平转动,所述小转台设置于所述横梁的一端;
所述获取所述拉线传感器出线端在机器人坐标系中的初始坐标信息之后,还包括:
基于在大转台连续旋转多个第二预设角度时的小转台三个圆心轨迹点,构建大转台坐标系,建立所述大转台坐标系与所述机器人坐标系的第二标定矩阵;
基于所述第二标定矩阵计算所述大转台在所述机器人坐标系中的第二空间姿态,依据所述第二空间姿态对所述大转台进行姿态校正。
8.根据权利要求7所述的机器人转台装置校正方法,其特征在于,所述构建大转台坐标系,建立所述大转台坐标系与所述机器人坐标系的第二标定矩阵,包括:
控制所述小转台连续转动多个所述第一预设角度,得到三个出线端轨迹点,计算所述小转台圆心轨迹点在所述机器人坐标系中的坐标信息;
控制所述大转台由初始位置连续转动多个所述第二预设角度,得到所述大转台转动过程中的小转台三个圆心轨迹点在所述机器人坐标系中的坐标信息;
依据小转台三个圆心轨迹点在机器人坐标系中的坐标信息,构建大转台坐标系;
建立所述大转台坐标系与所述机器人坐标系的第二标定矩阵,所述第二标定矩阵包括:第二旋转矩阵和第二位移矩阵。
9.根据权利要求8所述的机器人转台装置校正方法,其特征在于,所述依据三个小转台圆心轨迹点在机器人坐标系中的坐标信息,构建大转台坐标系,包括:
依据所述大转台处于不同角度下的小转台三个圆心轨迹点在所述机器人坐标系中的坐标信息,计算所述大转台圆心在所述机器人坐标系中的坐标信息;
获取所述大转台处于不同角度下的小转台三个圆心轨迹点所在平面的法向量;
获取所述大转台处于所述初始位置时的所述小转台的圆心与所述大转台的圆心所在直线在所述机器人坐标系中的方向向量,该方向向量的指向为所述大转台的圆心指向所述小转台的圆心;
以所述大转台圆心为坐标原点、以所述法向量为Z轴、以所述方向向量为X轴,构建大转台坐标系,建立所述大转台坐标系与所述机器人坐标系的第二标定矩阵,所述第二标定矩阵包括:第二旋转矩阵和第二位移矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310322858.9A CN116021528B (zh) | 2023-03-30 | 2023-03-30 | 一种机器人转台装置校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310322858.9A CN116021528B (zh) | 2023-03-30 | 2023-03-30 | 一种机器人转台装置校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116021528A true CN116021528A (zh) | 2023-04-28 |
CN116021528B CN116021528B (zh) | 2023-06-02 |
Family
ID=86074503
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310322858.9A Active CN116021528B (zh) | 2023-03-30 | 2023-03-30 | 一种机器人转台装置校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116021528B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010179389A (ja) * | 2009-02-04 | 2010-08-19 | Ihi Corp | ロボットのツール座標系の較正方法及びその治具 |
CN105666490A (zh) * | 2016-01-12 | 2016-06-15 | 昆明理工大学 | 一种机器人的标定系统及方法 |
CN106232303A (zh) * | 2014-04-23 | 2016-12-14 | 拉普兰塔理工大学 | 基于缆线的距离检测器以及基于其来生成机器人校准数据的系统 |
CN110948522A (zh) * | 2019-11-19 | 2020-04-03 | 南京熊猫电子股份有限公司 | 一种基于拉线旋转传感器的工业机器人空间位姿测量机构及测量方法 |
-
2023
- 2023-03-30 CN CN202310322858.9A patent/CN116021528B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010179389A (ja) * | 2009-02-04 | 2010-08-19 | Ihi Corp | ロボットのツール座標系の較正方法及びその治具 |
CN106232303A (zh) * | 2014-04-23 | 2016-12-14 | 拉普兰塔理工大学 | 基于缆线的距离检测器以及基于其来生成机器人校准数据的系统 |
CN105666490A (zh) * | 2016-01-12 | 2016-06-15 | 昆明理工大学 | 一种机器人的标定系统及方法 |
CN110948522A (zh) * | 2019-11-19 | 2020-04-03 | 南京熊猫电子股份有限公司 | 一种基于拉线旋转传感器的工业机器人空间位姿测量机构及测量方法 |
Also Published As
Publication number | Publication date |
---|---|
CN116021528B (zh) | 2023-06-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8457786B2 (en) | Method and an apparatus for calibration of an industrial robot system | |
CN102802883B (zh) | 工业机器人的基座坐标系的校准 | |
JP2766290B2 (ja) | 溶接ロボット | |
JP5025641B2 (ja) | 運動学的特異点補償システムおよび方法 | |
CN105773609A (zh) | 一种基于视觉测量及距离误差模型的机器人运动学标定方法 | |
JP4917252B2 (ja) | アーク溶接用装置 | |
CN113001535A (zh) | 机器人工件坐标系自动校正系统与方法 | |
CN111299929A (zh) | 一种自动测量与校正焊接机器人焊枪姿态的方法 | |
US20130310973A1 (en) | Method of controlling seven-axis articulated robot, control program, and robot control device | |
WO2015070010A1 (en) | Calibration system and method for calibrating industrial robot | |
CN112833792A (zh) | 一种用于六自由度机械臂的精度标定和验证方法 | |
CN113021017B (zh) | 随形自适应3d检测与加工系统 | |
CN109032072B (zh) | 一种双并联杆钻铆设备的法矢调姿及其偏移补偿方法 | |
JPH06131032A (ja) | ロボット装置およびロボット装置のティ−チング方法。 | |
CN111409067A (zh) | 一种机器人用户坐标自动标定系统及其标定方法 | |
CN113733155B (zh) | 六轴工业机器人标定装置和标定方法 | |
CN116021528B (zh) | 一种机器人转台装置校正方法 | |
CN113977558B (zh) | 一种可视化动态显示并联机器人末端轨迹的装置及方法 | |
TWI710441B (zh) | 機器手臂的座標校正方法 | |
JPS60127987A (ja) | ならい制御方法および装置 | |
US11654562B2 (en) | Apparatus, robot control device, robot system, and method of setting robot coordinate system | |
JP7384653B2 (ja) | ロボットの位置を制御するロボット装置の制御装置 | |
JP2000094370A (ja) | ロボットの作業表面の傾き測定方法およびその測定装置 | |
KR102582430B1 (ko) | 레이저 트래커 피드백을 이용한 로봇 제어 방법 및 장치 | |
CN115716175B (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 |