CN113211500B - 球形标记物在机器人末端安装位置的获取方法 - Google Patents
球形标记物在机器人末端安装位置的获取方法 Download PDFInfo
- Publication number
- CN113211500B CN113211500B CN202110569147.2A CN202110569147A CN113211500B CN 113211500 B CN113211500 B CN 113211500B CN 202110569147 A CN202110569147 A CN 202110569147A CN 113211500 B CN113211500 B CN 113211500B
- Authority
- CN
- China
- Prior art keywords
- robot
- tcp
- tail end
- coordinate system
- spherical
- 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
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种球形标记物在机器人末端安装位置的获取方法,首先将球形标记物固定在法兰或夹具末端,将空间定位设备架设在机器人旁;移动机器人末端至舒展位置,记录下此时机器人末端在基坐标系下的坐标,并设定为初始位置Po,此时TCP位于机器人末端法兰中心,标记为TCP_0;以TCP_0坐标系各轴为参考建立XY,YZ,ZX平面,以三个平面为参考建立球形标记物参考坐标系{Ball},并使各轴方向与TCP_0坐标系一致;将机器人移动到初始位置Po,控制机器人绕TCP_0任意旋转30次,然后对球面进行拟合求出球心坐标和半径;本发明避免了使用接触式标定带来的人工误差以及末端夹具的加工误差和安装误差,大大提高了测量精度。
Description
[技术领域]
本发明涉及机器人的标定技术领域,特别是利用空间定位设备获取球形标记物在多自由度机器人末端的精确安装位置,具体地说是一种球形标记物在机器人末端安装位置的获取方法。
[背景技术]
随着科技的发展与进步,工业机器人与协作机器人也拥有了越来越高的重复精度与绝对精度,并已广泛应用于医疗、航空航天、智能制造等尖端领域。在机器人正式投入生产应用之前,需要使用各种标定设备对机器人的精度及性能进行校准与测试。而球形标记物则会被安装在形状各异的末端夹具上,然后根据夹具的生产尺寸来确定靶球的安装位置及新的TCP坐标。由于安装误差、生产误差,理论TCP与实际TCP坐标往往存在较大差异,在对机器人末端运行轨迹追踪时,会产生较大的影响。在对单个或多个机器人基坐标系进行标定时,获取球形标记物在法兰末端坐标系下的精确坐标是非常重要的一个步骤,如误差较大,会对整个标定结果产生很大影响。
现有的方法多采用接触式校准,通过将伸出的TCP末端以不同的位姿触碰同一个点,然后获取机器人各个关节转角来解算新的TCP坐标。此方法多用于末端为焊枪、刀具、针尖等可以点对点接触的工具,并不适用于安装在法兰末端的球形标记物;且人工操作不能保证机器人TCP绕着同一点进行姿态变换,因此标定精度并不理想。
[发明内容]
本发明的目的就是要解决上述的不足而提供一种球形标记物在机器人末端安装位置的获取方法,避免了使用接触式标定带来的人工误差以及末端夹具的加工误差和安装误差,大大提高了测量精度。
为实现上述目的设计一种球形标记物在机器人末端安装位置的获取方法,包括以下步骤:
步骤1,将球形标记物固定在机器人法兰或夹具末端,确保球形标记物在机器人移动时稳定不会晃动;将空间定位设备架设在机器人旁,确保机器人的运动范围均在空间定位设备的可测范围内,同时确保机器人在移动过程中,空间定位设备与球形标记物之间不会被障碍物遮挡;
步骤2,移动机器人末端至舒展位置,确保机器人可绕末端进行自由转动且不会与其他关节产生碰撞,记录下此时机器人末端在基坐标系下的坐标,并设定为初始位置Po,此时TCP位于机器人末端法兰中心,标记为TCP_0;
步骤3,以TCP_0坐标系各轴为参考建立三个平面;首先将机器人移动到初始位置Po,随后激活TCP_0,使机器人绕TCP_0的Z轴随机旋转三次,使用空间定位设备记录点Pz1~Pz3,并使用这三个点建立XY平面;类似地,控制机器人回归初始位置Po,并使其分别绕X轴、Y轴各旋转三次,记录下各点坐标并建立YZ平面与ZX平面;
步骤4,以XY,YZ,XZ平面为参考建立球形标记物参考坐标系{Ball},并使各轴方向与TCP_0坐标系一致;
步骤5,将机器人移动到初始位置Po,控制机器人绕TCP_0任意旋转30次,并使用空间定位设备记录当球形标记物移动到点P1~P30时,在坐标系{Ball}下的坐标;
步骤6,现已有近似分布在以TCP_0为球心的球面点云,对球面进行拟合即可获得球心坐标和半径。
进一步地,步骤6中,首先建立球面方程:
(Xi-Xo)2+(Yi-Yo)2+(Zi-Zo)2=R2(i=1,2,...30)
其中,Xo、Yo、Zo为球心在坐标系{Ball}下的坐标,即TCP_0在坐标系{Ball}下的坐标,与R都是待求参数;
再构建误差方程:
对E求偏导:
最后,将采集到的点云数据带入,求解该方程组即得到TCP_0在坐标系{Ball}下的坐标(Xo,Yo,Zo);球形标记物球心在TCP_0下的坐标则为(-Xo,-Yo,-Zo),从而球形标记物在机器人末端的安装位置也随之求出。
进一步地,构建误差方程并对E求偏导后,化简上式得:
整理得:
最后求解该方程组即得到TCP_0在坐标系{Ball}下的坐标(Xo,Yo,Zo)。
本发明同现有技术相比,通过机器人的姿态变换与空间定位设备记录的点云数据,可精确获得球形标记物中心在机器人法兰末端下的坐标,避免了使用接触式标定带来的人工误差以及末端夹具的加工误差和安装误差,大大提高了测量精度,不仅有助于对机器人基坐标系标定时进行矩阵转换,也提升了对机器人末端精度校准及轨迹追踪的准确性,值得推广应用。
[附图说明]
图1是本发明所用的6自由度机器人示意图;
图2是本发明所使用的空间定位设备示意图;
图3是本发明所用的球形标记物在机器人法兰末端安装示意图。
[具体实施方式]
下面结合具体实施例对本发明作以下进一步说明:
本发明提供了一种球形标记物在机器人末端安装位置的获取方法,利用空间定位设备获取球形标记物在多自由度机器人末端的精确安装位置。
如附图1所示,为本发明使用的6自由度机器人,图中标明了机器人基坐标系与法兰末端坐标系。如附图2所示,为本发明所使用的空间定位设备。首先将球形标记物固定在法兰或夹具末端,如按附图3所示将球形标记物固定在机器人末端夹具上,确保球形标记物在机器人移动时稳定不会晃动。将空间定位设备架设在机器人正前方5米处,确保机器人的运动范围均在空间定位设备的可测范围内。同时机器人在移动过程中,空间定位设备与球形标记物之间不会被障碍物遮挡。
移动机器人末端至舒展位置,确保机器人可绕末端进行自由转动且不会与其他关节产生碰撞。记录下此时机器人末端在基坐标系下的坐标,并设定为初始位置Po,此时TCP位于机器人末端法兰中心,各轴偏移量均为0,标记为TCP_0。
以TCP_0坐标系的X,Y,Z轴为参考建立三个平面。先将机器人移动到初始位置Po,随后激活TCP_0。使机器人绕TCP_0的Z轴随机旋转三次,使用空间定位设备记录点Pz1~Pz3,并使用这三个点建立XY平面。类似地,控制机器人回归初始位置Po,使其绕X轴随机旋转三次,记录点Px1~Px3并建立YZ平面。再次控制机器人回到初始位置Po,使其绕Y轴随机旋转三次,记录点PY1~PY3并建立XZ平面。
以XY,YZ,XZ平面为参考建立球形标记物参考坐标系{Ball},并使各轴方向与TCP_0坐标系相同,TCP_0坐标系与球形标记物坐标系关系如附图3所示。此时坐标系{Ball}原点应与初始位置Po重合。
将机器人移动到初始位置Po,控制机器人绕TCP_0任意旋转30次,并使这30个点尽可能分散。随后用空间定位设备记录点P1~P30在坐标系{Ball}下的坐标,即,使用空间定位设备记录当球形标记物移动到点P1~P30时,在坐标系{Ball}下的坐标。
现已有近似分布在以TCP_0为球心的球面点云,对球面进行拟合即可获得球心坐标和半径。
首先建立球面方程:
(Xi-Xo)2+(Yi-Yo)2+(Zi-Zo)2=R2(i=1,2,...30)
其中,Xo,Yo,Zo为球心在坐标系{Ball}下的坐标,即TCP_0在坐标系{Ball}下的坐标,与R都是待求参数。
再构建误差方程:
对E求偏导:
化简上式:
整理可得:
将采集到的点云数据带入,求解该方程组即可得到TCP_0在坐标系{Ball}下的坐标(Xo,Yo,Zo)。
球形标记物球心在TCP_0下的坐标则为(-Xo,-Yo,-Zo)。球形标记物在机器人末端的安装位置也随之求出。
因此,本发明仅需变换机器人姿态,使其绕原始TCP转动并采取一组点云数据,便可计算出球形标记物在机器人法兰末端精确的安装位置;整个流程操作简单,避免了使用接触式标定带来的人工误差以及末端夹具的加工误差和安装误差;大大提高了测量精度,不仅有助于对机器人基坐标系标定时进行矩阵转换,也提升了对机器人末端精度校准及轨迹追踪的准确性。
本发明并不受上述实施方式的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
Claims (3)
1.一种球形标记物在机器人末端安装位置的获取方法,其特征在于,包括以下步骤:
步骤1,将球形标记物固定在机器人法兰或夹具末端,确保球形标记物在机器人移动时稳定不会晃动;将空间定位设备架设在机器人旁,确保机器人的运动范围均在空间定位设备的可测范围内,同时确保机器人在移动过程中,空间定位设备与球形标记物之间不会被障碍物遮挡;
步骤2,移动机器人末端至舒展位置,确保机器人可绕末端进行自由转动且不会与其他关节产生碰撞,记录下此时机器人末端在基坐标系下的坐标,并设定为初始位置Po,此时TCP位于机器人末端法兰中心,标记为TCP_0;
步骤3,以TCP_0坐标系各轴为参考建立三个平面;首先将机器人移动到初始位置Po,随后激活TCP_0,使机器人绕TCP_0的Z轴随机旋转三次,使用空间定位设备记录点Pz1~Pz3,并使用这三个点建立XY平面;类似地,控制机器人回归初始位置Po,并使其分别绕X轴、Y轴各旋转三次,记录下各点坐标并建立YZ平面与ZX平面;
步骤4,以XY,YZ,XZ平面为参考建立球形标记物参考坐标系{Ball},并使各轴方向与TCP_0坐标系一致;
步骤5,将机器人移动到初始位置Po,控制机器人绕TCP_0任意旋转30次,并使用空间定位设备记录当球形标记物移动到点P1~P30时,在坐标系{Ball}下的坐标;
步骤6,现已有近似分布在以TCP_0为球心的球面点云,对球面进行拟合即可获得球心坐标和半径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110569147.2A CN113211500B (zh) | 2021-05-25 | 2021-05-25 | 球形标记物在机器人末端安装位置的获取方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110569147.2A CN113211500B (zh) | 2021-05-25 | 2021-05-25 | 球形标记物在机器人末端安装位置的获取方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113211500A CN113211500A (zh) | 2021-08-06 |
CN113211500B true CN113211500B (zh) | 2023-01-06 |
Family
ID=77098222
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110569147.2A Active CN113211500B (zh) | 2021-05-25 | 2021-05-25 | 球形标记物在机器人末端安装位置的获取方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113211500B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114536324B (zh) * | 2022-01-11 | 2023-11-07 | 重庆智能机器人研究院 | 一种工业机器人自动工具工件标定方法 |
CN116572255B (zh) * | 2023-07-10 | 2023-10-20 | 北京集度科技有限公司 | 坐标原点的标定方法、标定装置及介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105058387A (zh) * | 2015-07-17 | 2015-11-18 | 北京航空航天大学 | 基于激光跟踪仪的一种工业机器人基坐标系标定方法 |
CN108692688A (zh) * | 2018-04-28 | 2018-10-23 | 武汉理工大学 | 一种机器人测量-加工系统扫描仪坐标系自动标定方法 |
CN109531577A (zh) * | 2018-12-30 | 2019-03-29 | 北京猎户星空科技有限公司 | 机械臂标定方法、装置、系统、介质、控制器及机械臂 |
CN111771099A (zh) * | 2018-02-26 | 2020-10-13 | 瑞尼斯豪公司 | 坐标定位机 |
CN112304218A (zh) * | 2020-10-22 | 2021-02-02 | 中国人民解放军战略支援部队信息工程大学 | 工业机器人的工具中心点位置标定方法及系统 |
CN213165463U (zh) * | 2020-08-21 | 2021-05-11 | 季华实验室 | 一种标定构件 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008522836A (ja) * | 2004-10-25 | 2008-07-03 | ユニバーシティ・オブ・デイトン | 運動学的ロボット・モデル・パラメータ決定によって多関節ロボットにおいて改善された精度を提供する方法及びシステム |
-
2021
- 2021-05-25 CN CN202110569147.2A patent/CN113211500B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105058387A (zh) * | 2015-07-17 | 2015-11-18 | 北京航空航天大学 | 基于激光跟踪仪的一种工业机器人基坐标系标定方法 |
CN111771099A (zh) * | 2018-02-26 | 2020-10-13 | 瑞尼斯豪公司 | 坐标定位机 |
CN108692688A (zh) * | 2018-04-28 | 2018-10-23 | 武汉理工大学 | 一种机器人测量-加工系统扫描仪坐标系自动标定方法 |
CN109531577A (zh) * | 2018-12-30 | 2019-03-29 | 北京猎户星空科技有限公司 | 机械臂标定方法、装置、系统、介质、控制器及机械臂 |
CN213165463U (zh) * | 2020-08-21 | 2021-05-11 | 季华实验室 | 一种标定构件 |
CN112304218A (zh) * | 2020-10-22 | 2021-02-02 | 中国人民解放军战略支援部队信息工程大学 | 工业机器人的工具中心点位置标定方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN113211500A (zh) | 2021-08-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106705956B (zh) | 工业机器人末端位姿快速测量装置及其测量方法 | |
CN111660295B (zh) | 工业机器人绝对精度标定系统及标定方法 | |
CN113211500B (zh) | 球形标记物在机器人末端安装位置的获取方法 | |
CN109859275B (zh) | 一种基于s-r-s结构的康复机械臂的单目视觉手眼标定方法 | |
CN105058387A (zh) | 基于激光跟踪仪的一种工业机器人基坐标系标定方法 | |
CN107883929B (zh) | 基于多关节机械臂的单目视觉定位装置及方法 | |
US8457786B2 (en) | Method and an apparatus for calibration of an industrial robot system | |
CN102706277B (zh) | 一种基于全方位点约束的工业机器人在线零位标定装置及方法 | |
CN112070133B (zh) | 一种基于测距仪和机器视觉的三维空间点定位的方法 | |
CN106625774B (zh) | 一种空间机械臂几何参数标定方法 | |
CN110757504B (zh) | 高精度可移动机器人的定位误差补偿方法 | |
CN102601684B (zh) | 基于间接测量法的高精度制孔机器人的工具参数标定方法 | |
CN111360812B (zh) | 一种基于相机视觉的工业机器人dh参数标定方法及标定装置 | |
CN102654387A (zh) | 一种基于空间曲面约束的工业机器人在线标定装置 | |
CN111203861A (zh) | 一种机器人工具坐标系的标定方法及标定系统 | |
CN111360585B (zh) | 一种机器人铣削系统中刀具端实时位置误差的获取方法 | |
CN113843792B (zh) | 一种手术机器人的手眼标定方法 | |
CN116079790B (zh) | 一种加工机器人的工具标定装置、方法、终端及介质 | |
CN112277002B (zh) | 基于非完整位姿信息的机器人运动学标定装置及标定方法 | |
CN113681559A (zh) | 一种基于标准圆柱的线激光扫描机器人手眼标定方法 | |
CN114654466B (zh) | 自动标定方法、装置、系统、电子设备及存储介质 | |
CN115179323A (zh) | 基于远心视觉约束的机器末位姿测量装置及精度提升方法 | |
CN112762822B (zh) | 一种基于激光跟踪仪的机械臂校准方法及系统 | |
CN206683651U (zh) | 工业机器人末端位姿快速测量装置 | |
CN115139338B (zh) | 一种机器人tcp快速高精度标定方法 |
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 |