CN114932551A - 机械臂零点标定方法、***及介质 - Google Patents
机械臂零点标定方法、***及介质 Download PDFInfo
- Publication number
- CN114932551A CN114932551A CN202210574360.7A CN202210574360A CN114932551A CN 114932551 A CN114932551 A CN 114932551A CN 202210574360 A CN202210574360 A CN 202210574360A CN 114932551 A CN114932551 A CN 114932551A
- Authority
- CN
- China
- Prior art keywords
- calibration
- zero
- theta
- mechanical arm
- module
- 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/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration 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/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/1628—Programme controls characterised by the control loop
- B25J9/163—Programme controls characterised by the control loop learning, adaptive, model based, rule based expert control
-
- 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/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明提供一种机械臂零点标定方法、***及介质,包括:建立机器人DH参数模型,得到转换矩阵T;在机器人末端安装工装,在固定位置放置一块标定板,用工装上的顶尖使用多个姿态分别接触不同点位,并记录下对应的各轴关节角度θi,i∈[1,6];设各个关节角的零点偏差值为Δθi,得到新的θ′i,将Δθi使用运动学正解得到工装顶尖的世界坐标系下点位{P1、P2…P9};设得到的9个点两两之间距离为lj,j∈[1,8],建立目标方程;对目标方程进行优化求解,计算出满足迭代条件的Δθi值;将机械臂回到初始零点位置,并根据Δθi值作为补偿量得到最终准确的零点。本发明能够以较低成本的方法实现较高精度的零点标定。
Description
技术领域
本发明涉及六自由度串联机器人技术领域,具体地,涉及一种使用蚁群算法进行机械臂零点标定的方法,具体涉及一种机械臂零点标定方法、***及介质。
背景技术
机械臂的精度被分为重复定位精度和绝对定位精度,重复定位精度是指机械臂多次到达同一个位置的精确度,而绝对定位精度是指机械臂到达空间中某一点的准确度。在大多数的工业应用中机械臂都是使用示教在线的方式,这种场景中就对机械臂的重复定位精度有着较高的要求,随着机器人应用范围的增加,更多场景应用中对机械臂的定位精度要求在逐渐提高,比如机械臂配合视觉使用时,机械臂需要根据视觉识别出来的位置进行定位,准确移动到目标位置。
因此为了提高机械臂的绝对定位精度,机械臂的零点标定就是其中一个重要环节,零点标定的作用是使各轴的理论零点位置与机械装置的实际零点位置重合,这样就可以保证算法的准确控制。常见的零点标定方法有通过将侧倾仪安装在机械臂上来进行零点校准的,这种方法能达到很高精度,但缺点是倾侧传感器价格昂贵。还有种常见的方式是通过定位销、键、刻度的方式来进行关节对齐,对齐位置即为零点,这种方法成本低,操作方便,但精度较差。
公开号为CN113211436B的发明专利,公开了一种基于遗传算法的六自由度串联机器人误差标定方法,包括:1)DH参数建模方法建立机器人实际模型;2)采用空间对点的方式,将机器人末端对齐到同一个点N次(N≥4),记录N个点的关节轴数据;3)基于遗传算法建立误差模型寻找机器人零位误差的最优误差参数;4)通过穷举法优化零位误差参数;5)计算补偿零位误差参数后的TCP工具值。该相关专利中使用机械臂末端多次触碰同一个点,然后根据末端到达同一点的一致性误差为目标函数进行求解,且该专利使用遗传进行迭代求解。
发明内容
针对现有技术中的缺陷,本发明提供一种机械臂零点标定方法、***及介质。
根据本发明提供的一种机械臂零点标定方法、***及介质,所述方案如下:
第一方面,提供了一种机械臂零点标定方法,所述方法包括:
步骤S1:建立机器人DH参数模型,得到转换矩阵T;
步骤S2:在机器人末端安装工装,在固定位置放置一块上面有若干个等距离d的标定板,用工装上的顶尖使用多个姿态分别接触不同点位,并记录下对应的各轴关节角度θi,i∈[1,6];
步骤S3:假设各个关节角的零点偏差值为Δθi,将θi的角度减去Δθi就得到新的θ′i,将Δθi使用运动学正解得到工装顶尖的世界坐标系下点位{P1、P2…P9};
步骤S4:根据等距离的点位,设步骤S3得到的9个点两两之间距离为lj,j∈[1,8],建立目标方程;
步骤S5:使用蚁群算法对步骤S4的目标方程进行优化求解,计算出满足迭代条件的Δθi值;
步骤S6:将机械臂回到初始零点位置,并根据步骤S5求得的Δθi值作为补偿量得到最终准确的零点。
优选地,所述步骤S1包括:建立机器人DH参数模型,得到转换矩阵:
式中,θi表示Xi与Xi+1的夹角,αi表示Zi与Zi+1的夹角,di表示Xi与Xi+1的距离,ai表示杆件长度,为Zi与Zi+1的距离。
优选地,所述步骤S2包括:在机器人末端安装带顶尖的工装,在固定位置放置一块上面有若干个等距离d的标定板并保持标定板在标定过程中不动;
用工装上的顶尖使用多个姿态分别接触标定板上的9个点位,并记录下9个点位对应的各轴关节角度θij,i∈[1,6],j∈[1,9];其中,i表示机械臂的关节轴号,j表示点位数。
优选地,所述步骤S4包括:令步骤S3得到的9个点两两之间距离为lk,k∈[1,8];
第二方面,提供了一种机械臂零点标定***,所述***包括:
模块M1:建立机器人DH参数模型,得到转换矩阵T;
模块M2:在机器人末端安装工装,在固定位置放置一块上面有若干个等距离d的标定板,用工装上的顶尖使用多个姿态分别接触不同点位,并记录下对应的各轴关节角度θi,i∈[1,6];
模块M3:假设各个关节角的零点偏差值为Δθi,将θi的角度减去Δθi就得到新的θ′i,将Δθi使用运动学正解得到工装顶尖的世界坐标系下点位{P1、P2…P9};
模块M4:根据等距离的点位,设模块M3得到的9个点两两之间距离为lj,j∈[1,8],建立目标方程;
模块M5:使用蚁群算法对模块M4的目标方程进行优化求解,计算出满足迭代条件的Δθi值;
模块M6:将机械臂回到初始零点位置,并根据模块M5求得的Δθi值作为补偿量得到最终准确的零点。
优选地,所述模块M1包括:建立机器人DH参数模型,得到转换矩阵:
式中,θi表示Xi与Xi+1的夹角,αi表示Zi与Zi+1的夹角,di表示Xi与Xi+1的距离,ai表示杆件长度,为Zi与Zi+1的距离。
优选地,所述模块M2包括:在机器人末端安装带顶尖的工装,在固定位置放置一块上面有若干个等距离d的标定板并保持标定板在标定过程中不动;
用工装上的顶尖使用多个姿态分别接触标定板上的9个点位,并记录下9个点位对应的各轴关节角度θij,i∈[1,6],j∈[1,9];其中,i表示机械臂的关节轴号,j表示点位数。
优选地,所述模块M4包括:令模块M3得到的9个点两两之间距离为lk,k∈[1,8];
第三方面,提供了一种存储有计算机程序的计算机可读存储介质,所述计算机程序被处理器执行时实现所述方法的步骤。
与现有技术相比,本发明具有如下的有益效果:
1、本发明在机械臂丢失零点后能够快速恢复零点,操作简单;
2、本发明运算量小,能够较快得到最终标定结果;
3、说明书背景中提到的相关专利中使用机械臂末端多次触碰同一个点,然后根据末端到达同一点的一致性误差为目标函数进行求解,本发明则使用9个固定距离的点位作为目标位置,可以避免只需要一个点的一致性误差。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1为本发明整体流程图;
图2为标定板样式图。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变化和改进。这些都属于本发明的保护范围。
本发明实施例提供一种机械臂零点标定方法,参照图1所示,该方法包括:
步骤S1:建立机器人DH参数模型,得到转换矩阵T。
具体地,建立机器人DH参数模型,得到转换矩阵:
式中,θi表示Xi与Xi+1的夹角,αi表示Zi与Zi+1的夹角,di表示Xi与Xi+1的距离,ai表示杆件长度,为Zi与Zi+1的距离。
步骤S2:在机器人末端安装工装,在固定位置放置一块上面有若干个等距离d的标定板,用工装上的顶尖使用多个姿态分别接触不同点位,并记录下对应的各轴关节角度θi,i∈[1,6]。
具体地,该步骤S2具体为:在机器人末端安装带顶尖的工装,在固定位置放置一块上面有若干个等距离d的标定板并保持标定板在标定过程中不动;用工装上的顶尖使用多个姿态分别接触标定板上的9个点位,并记录下9个点位对应的各轴关节角度θij,i∈[1,6],j∈[1,9];其中,i表示机械臂的关节轴号,j表示点位数。
步骤S3:假设各个关节角的零点偏差值为Δθi,将θi的角度减去Δθi就得到新的θ′i,将Δθi使用运动学正解得到工装顶尖的世界坐标系下点位{P1、P2…P9};
具体地,该步骤S3具体为:设各个关节角的零点偏差值为Δθi,将步骤S2中的θij的角度值分别减去Δθi就得到新的θ′ij,再对θ′ij使用运动学正解得到标定板上9个点在机械臂的世界坐标系下点位{P1、P2…P9},如图2所示。
步骤S4:根据等距离的点位,设步骤S3得到的9个点两两之间距离为lj,j∈[1,8],建立目标方程。
具体地,该步骤S4具体为:令步骤S3得到的9个点两两之间距离为lk,k∈[1,8];
步骤S5:使用蚁群算法对步骤S4的目标方程进行优化求解,即可计算出满足迭代条件的Δθi值;
步骤S6:将机械臂回到初始零点位置,并根据步骤S5求得的Δθi值作为零点数据的补偿量重新计算即可得到最终准确的零点。
本发明还提供了一种机械臂零点标定***,该***具体包括:
模块M1:建立机器人DH参数模型,得到转换矩阵T。
在模块M1中,建立机器人DH参数模型,得到转换矩阵:
式中,θi表示Xi与Xi+1的夹角,αi表示Zi与Zi+1的夹角,di表示Xi与Xi+1的距离,ai表示杆件长度,为Zi与Zi+1的距离。
模块M2:在机器人末端安装工装,在固定位置放置一块上面有若干个等距离d的标定板,用工装上的顶尖使用多个姿态分别接触不同点位,并记录下对应的各轴关节角度θi,i∈[1,6]。
具体地,模块M2包括:在机器人末端安装带顶尖的工装,在固定位置放置一块上面有若干个等距离d的标定板并保持标定板在标定过程中不动;用工装上的顶尖使用多个姿态分别接触标定板上的9个点位,并记录下9个点位对应的各轴关节角度θij,i∈[1,6],j∈[1,9];其中,i表示机械臂的关节轴号,j表示点位数。
模块M3:假设各个关节角的零点偏差值为Δθi,将θi的角度减去Δθi就得到新的θ′i,将Δθi使用运动学正解得到工装顶尖的世界坐标系下点位{P1、P2…P9}。
模块M4:根据等距离的点位,设模块M3得到的9个点两两之间距离为lj,j∈[1,8],建立目标方程。
模块M5:使用蚁群算法对模块M4的目标方程进行优化求解,计算出满足迭代条件的Δθi值。
模块M6:将机械臂回到初始零点位置,并根据模块M5求得的Δθi值作为补偿量得到最终准确的零点。
本发明实施例提供了一种机械臂零点标定方法、***及介质,只需要一个带有顶尖的工装和标定板即可完成标定的方法,成本低并且具有一定的精度。
本领域技术人员知道,除了以纯计算机可读程序代码方式实现本发明提供的***及其各个装置、模块、单元以外,完全可以通过将方法步骤进行逻辑编程来使得本发明提供的***及其各个装置、模块、单元以逻辑门、开关、专用集成电路、可编程逻辑控制器以及嵌入式微控制器等的形式来实现相同功能。所以,本发明提供的***及其各项装置、模块、单元可以被认为是一种硬件部件,而对其内包括的用于实现各种功能的装置、模块、单元也可以视为硬件部件内的结构;也可以将用于实现各种功能的装置、模块、单元视为既可以是实现方法的软件模块又可以是硬件部件内的结构。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变化或修改,这并不影响本发明的实质内容。在不冲突的情况下,本申请的实施例和实施例中的特征可以任意相互组合。
Claims (9)
1.一种机械臂零点标定方法,其特征在于,包括:
步骤S1:建立机器人DH参数模型,得到转换矩阵T;
步骤S2:在机器人末端安装工装,在固定位置放置一块上面有若干个等距离d的标定板,用工装上的顶尖使用多个姿态分别接触不同点位,并记录下对应的各轴关节角度θi,i∈[1,6];
步骤S3:假设各个关节角的零点偏差值为Δθi,将θi的角度减去Δθi就得到新的θ′i,将Δθi使用运动学正解得到工装顶尖的世界坐标系下点位{P1、P2…P9};
步骤S4:根据等距离的点位,设步骤S3得到的9个点两两之间距离为lj,j∈[1,8,建立目标方程;
步骤S5:使用蚁群算法对步骤S4的目标方程进行优化求解,计算出满足迭代条件的Δθi值;
步骤S6:将机械臂回到初始零点位置,并根据步骤S5求得的Δθi值作为补偿量得到最终准确的零点。
3.根据权利要求1所述的机械臂零点标定方法,其特征在于,所述步骤S2包括:在机器人末端安装带顶尖的工装,在固定位置放置一块上面有若干个等距离d的标定板并保持标定板在标定过程中不动;
用工装上的顶尖使用多个姿态分别接触标定板上的9个点位,并记录下9个点位对应的各轴关节角度θij,i∈[1,6],j∈[1,9];其中,i表示机械臂的关节轴号,j表示点位数。
5.一种机械臂零点标定***,其特征在于,包括:
模块M1:建立机器人DH参数模型,得到转换矩阵T;
模块M2:在机器人末端安装工装,在固定位置放置一块上面有若干个等距离d的标定板,用工装上的顶尖使用多个姿态分别接触不同点位,并记录下对应的各轴关节角度θi,i∈[1,6];
模块M3:假设各个关节角的零点偏差值为Δθi,将θi的角度减去Δθi就得到新的θ′i,将Δθi使用运动学正解得到工装顶尖的世界坐标系下点位{P1、P2…P9};
模块M4:根据等距离的点位,设模块M3得到的9个点两两之间距离为lj,j∈[1,8,建立目标方程;
模块M5:使用蚁群算法对模块M4的目标方程进行优化求解,计算出满足迭代条件的Δθi值;
模块M6:将机械臂回到初始零点位置,并根据模块M5求得的Δθi值作为补偿量得到最终准确的零点。
7.根据权利要求5所述的机械臂零点标定***,其特征在于,所述模块M2包括:在机器人末端安装带顶尖的工装,在固定位置放置一块上面有若干个等距离d的标定板并保持标定板在标定过程中不动;
用工装上的顶尖使用多个姿态分别接触标定板上的9个点位,并记录下9个点位对应的各轴关节角度θij,i∈[1,6],j∈[1,9;其中,i表示机械臂的关节轴号,j表示点位数。
9.一种存储有计算机程序的计算机可读存储介质,其特征在于,所述计算机程序被处理器执行时实现权利要求1至4中任一项所述的方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210574360.7A CN114932551A (zh) | 2022-05-25 | 2022-05-25 | 机械臂零点标定方法、***及介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210574360.7A CN114932551A (zh) | 2022-05-25 | 2022-05-25 | 机械臂零点标定方法、***及介质 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114932551A true CN114932551A (zh) | 2022-08-23 |
Family
ID=82865503
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210574360.7A Pending CN114932551A (zh) | 2022-05-25 | 2022-05-25 | 机械臂零点标定方法、***及介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114932551A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116587283A (zh) * | 2023-06-16 | 2023-08-15 | 南方电网电力科技股份有限公司 | 一种机械臂控制零点标定方法及相关装置 |
CN116587283B (zh) * | 2023-06-16 | 2024-07-30 | 南方电网电力科技股份有限公司 | 一种机械臂控制零点标定方法及相关装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20200094407A1 (en) * | 2018-09-24 | 2020-03-26 | Mitutoyo Corporation | Robot system with end tool metrology position coordinates determination system |
CN113664835A (zh) * | 2021-09-15 | 2021-11-19 | 上海景吾智能科技有限公司 | 机器人自动手眼标定方法与*** |
CN114260941A (zh) * | 2021-12-24 | 2022-04-01 | 上海大学 | 一种基于激光位移计的机械臂参数标定方法 |
CN114396900A (zh) * | 2022-01-18 | 2022-04-26 | 上海景吾酷租科技发展有限公司 | 基于平面约束的机器人标定方法及*** |
-
2022
- 2022-05-25 CN CN202210574360.7A patent/CN114932551A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20200094407A1 (en) * | 2018-09-24 | 2020-03-26 | Mitutoyo Corporation | Robot system with end tool metrology position coordinates determination system |
CN113664835A (zh) * | 2021-09-15 | 2021-11-19 | 上海景吾智能科技有限公司 | 机器人自动手眼标定方法与*** |
CN114260941A (zh) * | 2021-12-24 | 2022-04-01 | 上海大学 | 一种基于激光位移计的机械臂参数标定方法 |
CN114396900A (zh) * | 2022-01-18 | 2022-04-26 | 上海景吾酷租科技发展有限公司 | 基于平面约束的机器人标定方法及*** |
Non-Patent Citations (1)
Title |
---|
廖文和: "机器人精度补偿技术与应用进展", 航空学报, vol. 43, no. 5 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116587283A (zh) * | 2023-06-16 | 2023-08-15 | 南方电网电力科技股份有限公司 | 一种机械臂控制零点标定方法及相关装置 |
CN116587283B (zh) * | 2023-06-16 | 2024-07-30 | 南方电网电力科技股份有限公司 | 一种机械臂控制零点标定方法及相关装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106338990B (zh) | 基于激光跟踪仪的工业机器人dh参数标定与零位标定方法 | |
CN110193829B (zh) | 一种耦合运动学与刚度参数辨识的机器人精度控制方法 | |
CN108748159B (zh) | 一种机械臂工具坐标系自标定方法 | |
CN109514549B (zh) | 一种可实现六自由度的tcp在线快速标定方法及装置 | |
CN112105484B (zh) | 机器人运动学参数自标定方法、***及存储装置 | |
CN104608129B (zh) | 基于平面约束的机器人标定方法 | |
CN110640747B (zh) | 机器人的手眼标定方法、***、电子设备和存储介质 | |
CN112318498B (zh) | 一种考虑参数耦合的工业机器人标定方法 | |
CN111168719B (zh) | 一种基于定位工装的机器人校准方法及*** | |
CN110253574B (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
CN111438688B (zh) | 机器人校正方法、装置、计算机设备及存储介质 | |
CN111975771A (zh) | 一种基于偏差重定义神经网络的机械臂运动规划方法 | |
CN113459094B (zh) | 一种工业机器人工具坐标系及零点自标定方法 | |
CN113160334A (zh) | 一种基于手眼相机的双机器人***标定方法 | |
Yang et al. | Self-calibration of three-legged modular reconfigurable parallel robots based on leg-end distance errors | |
CN113910218A (zh) | 基于运动学与深度神经网络融合的机器人标定方法和装置 | |
CN117182931A (zh) | 一种机械臂标定数据校准方法及***,存储介质 | |
CN114932551A (zh) | 机械臂零点标定方法、***及介质 | |
CN115237056B (zh) | 工业机器人多工具快速纠偏方法 | |
CN109397293B (zh) | 一种基于移动机器人的地面水平误差建模及补偿方法 | |
CN113211436B (zh) | 基于遗传算法的六自由度串联机器人误差标定方法 | |
CN112847441B (zh) | 基于梯度下降法的六轴机器人坐标偏移检测方法和装置 | |
Jiang et al. | Position-Based Robot Calibration and Compensation Using an Improved Adjoint Error Model | |
CN114521960B (zh) | 一种腹腔手术机器人的全自动实时标定方法、装置及*** | |
CN115533896B (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 | ||
TA01 | Transfer of patent application right | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20230404 Address after: 311231 building 3, No. 477, Hongxing Road, Qiaonan block, economic and Technological Development Zone, Xiaoshan District, Hangzhou City, Zhejiang Province Applicant after: Hangzhou Jingwu Intelligent Technology Co.,Ltd. Address before: 2 / F, 979 Yunhan Road, Lingang xinpian District, China (Shanghai) pilot Free Trade Zone, Pudong New Area, Shanghai 200120 Applicant before: Shanghai jingwukuzu Technology Development Co.,Ltd. |