CN112936274B - 一种机器人夹持的柔性打磨轮位姿辨识方法 - Google Patents
一种机器人夹持的柔性打磨轮位姿辨识方法 Download PDFInfo
- Publication number
- CN112936274B CN112936274B CN202110159052.3A CN202110159052A CN112936274B CN 112936274 B CN112936274 B CN 112936274B CN 202110159052 A CN202110159052 A CN 202110159052A CN 112936274 B CN112936274 B CN 112936274B
- Authority
- CN
- China
- Prior art keywords
- robot
- coordinates
- coordinate system
- axis
- grinding wheel
- 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
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
- B25J11/005—Manipulators for mechanical processing tasks
- B25J11/0065—Polishing or grinding
-
- 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
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Finish Polishing, Edge Sharpening, And Grinding By Specific Grinding Devices (AREA)
- Manipulator (AREA)
- Constituent Portions Of Griding Lathes, Driving, Sensing And Control (AREA)
Abstract
本发明涉及一种机器人夹持的柔性打磨轮位姿辨识方法,包括:控制机器人携带移动探针以多种姿态接触固定探针,得到多个工具中心点坐标,采用Ransac算法和最小二乘法球心拟合完成固定探针位姿辨识;将打磨轮固定于机器人末端,对连接轴和打磨轮的交界圆选多个位置点分别接触固定探针,经机器人基坐标系向Too l 0转换得到多个位置点在Too l 0下的坐标;对多个位置点坐标采用Ransac算法和最小二乘法平面拟合得平面法向量记为X轴,以X轴为基准,对Too l 0下Z’轴施密特正交化得Z轴,右手定则得Y轴;对多个位置点坐标圆心拟合得交界圆圆心坐标,由打磨轮平均半径R可得磨削点位置坐标。本发明可有效解决目前打磨轮位姿辨识误差大、稳定性低、不利于实际生产加工的问题。
Description
技术领域
本发明涉及机器人技术领域,尤其涉及一种机器人夹持的柔性打磨轮位姿辨识方法、装置、设备及存储介质。
背景技术
橡胶轮、纱布轮、钢丝轮等常见柔性打磨轮主要用于金属、木材、亚克力等材料零件的表面精密加工,具有加工效率高及加工一致性好等优点。但用机器人夹持柔性打磨轮进行加工时,其显著的柔性特点给工具位姿辨识带来困难。传统位姿辨识方法主要分为三步:四点法完成固定探针位姿辨识;人工定位打磨轮磨削点位置;以Tool0姿态作为打磨轮姿态。传统方法主要存在三个弊端:当机器人运动误差较大或对点误差较大时,四点法辨识固定探针位置误差大;确定打磨轮磨削点位置时,将与Tool0下XOY平面平行的磨削轮切平面相切点作为磨削点,目测方式难以精确定位切平面,同时用固定探针接触柔性轮表面时会造成柔性轮接触点变形凹陷,而柔性轮高速转动工作时受离心力接触点会回弹,难以定位磨削点,磨削点定位精度差会造成工件过磨;由于存在装夹误差,打磨轮的轴线偏离Tool0下Z’轴,以Tool0的姿态作为打磨轮的姿态会造成工件非均匀磨削,且装夹误差越大、打磨轮长度越长非均匀磨削越严重。
综上所述,传统方法在装夹误差和人工定位误差较大的情况下难以满足后续加工要求。
发明内容
有鉴于此,有必要提供一种机器人夹持的柔性打磨轮位姿辨识方法、设备及存储介质,用以解决目前打磨轮位姿辨识误差大、稳定性低、不利于实际生产加工的问题。
第一方面,本发明提供一种机器人夹持的柔性打磨轮位姿辨识方法,包括如下步骤:
控制机器人以多种姿态携带移动探针接触固定探针,并获取各姿态下工具中心点的坐标;其中,所述固定探针固定于预设位置,所述移动探针固定于机器人末端;
采用随机抽样一致算法对获取的多个工具中心点的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的工具中心点的坐标进行球心拟合,以得到固定探针在机器人基坐标系下的位置坐标;
将移动探针替换成柔性打磨轮后,在连接轴和打磨轮的交界圆上选取多个位置点,控制所述机器人移动使若干个位置点分别接触所述固定探针后,获取每次接触时机器人末端的位置和姿态,根据每次接触时机器人末端的位置和姿态进行坐标系转换后,根据所述固定探针在机器人基坐标系下的位置坐标计算出每个位置点在机器人末端坐标系中的坐标;
采用随机抽样一致算法对多个位置点在机器人末端坐标系中的坐标进行平面拟合,剔除误差较大点后,采用最小二乘法对剩余的坐标进行平面拟合,得到平面法向量,并记做X轴;
以X轴与机器人末端坐标系下X’轴呈锐角的方向作为X轴正方向,以X轴为基准,对机器人末端坐标系下Z’轴进行施密特正交化得Z轴,并采用右手定则得到Y轴,以得到柔性打磨轮坐标系;
将每个位置点在机器人末端坐标系中的坐标转换为在柔性打磨轮坐标系中的坐标后,采用随机抽样一致算法对获取的多个位置点在柔性打磨轮坐标系中的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的坐标进行球心拟合后,得到交界圆圆心坐标,根据打磨轮平均半径、交界圆圆心坐标以及柔性打磨轮坐标系的单位方向向量得到磨削点坐标。
优选的,所述的机器人夹持的柔性打磨轮位姿辨识方法中,所述采用随机抽样一致算法对获取的多个工具中心点的坐标进行球心拟合的步骤具体为:
选取其中四个工具中心点的坐标作为组合,代入公式:(xi-x0)2+(yi-y0)2+(zi-z0)2=R2中,求取出圆心(x0,y0,z0)和半径R后,采用公式计算出剩余的坐标的欧式距离d,若满足d≤δ1,则视为内点,否则视为外点剔除;其中,δ1为预设的第一距离阈值,(xi,yi,zi)为工具中心点的坐标;
重新选取其中四个工具中心点的坐标作为组合,并进行内点筛选和外点剔除;
当所有的组合都计算完毕时,将内点数最多的组合及其内点作为最小二乘法的求解集合。
优选的,所述的机器人夹持的柔性打磨轮位姿辨识方法中,采用最小二乘法对剩余的工具中心点的坐标进行球心拟合,以得到固定探针在机器人基坐标系下的位置坐标的步骤具体为:
采用最小二乘法对求解集合进行球心拟合,其表达式如下:
其中,(xi,yi,zi)为求解集合中各点坐标,R为拟合半径;
采用下列公式对x0、y0、z0、R求偏导,
利用坐标差值公式将上述公式进行简化,具体公式为:
优选的,所述的机器人夹持的柔性打磨轮位姿辨识方法中,计算每个位置点在机器人末端坐标系中的坐标的方法具体为:
获取每次接触时机器人末端的位置和姿态,并计算得到机器人末端坐标系向机器人基坐标系的旋转矩阵Ri和平移矩阵Ti,则每个位置点在机器人末端坐标系下的坐标ci(xi’,yi’,zi’)的计算公式为:
优选的,所述的机器人夹持的柔性打磨轮位姿辨识方法中,采用随机抽样一致算法对多个位置点在机器人末端坐标系中的坐标进行平面拟合的步骤具体为:
选取其中三个位置点在机器人末端坐标系下的坐标作为组合,代入公式:中,求取出A、B、C、D后,采用公式计算出剩余的坐标的欧式距离d2,若满足d2≤δ2,则视为内点,否则视为外点剔除;其中,δ2为预设的第二距离阈值,(xi’,yi’,zi’)为位置点在机器人末端坐标系下的坐标,(A,B,C)为所求X轴;
重新选取其中三个位置点在机器人末端坐标系下的坐标作为组合,并进行内点筛选和外点剔除;
当所有的组合都计算完毕时,将内点数最多的组合及其内点作为最小二乘法的求解集合。
优选的,所述的机器人夹持的柔性打磨轮位姿辨识方法中,采用最小二乘法对剩余的坐标进行平面拟合,得到平面法向量,并记做X轴的步骤具体为:
采用最小二乘法对求解集合进行平面拟合,其表达式如下:
分别对a0、a1、a2求偏导数,可得公式:
对公式化简可得公式:
整理成矩阵形式可得公式:
优选的,所述的机器人夹持的柔性打磨轮位姿辨识方法中,所述以X轴与机器人末端坐标系下X’轴呈锐角的方向作为X轴正方向,以X轴为基准,对机器人末端坐标系下Z’轴进行施密特正交化得Z轴,并采用右手定则得到Y轴,以得到柔性打磨轮坐标系的步骤具体为:
对所求X轴计算X与机器人末端坐标系下的X’轴的点积,记θ=X·X',若θ>0,则X=X,否则X=-X;以所得单位向量轴X为基准,对机器人末端坐标系下单位向量轴Z’轴做施密特正交化处理,具体公式为:
根据上述计算得Z轴,并通过右手定则得道Y轴,以得到柔性打磨轮坐标系。
第二方面,本发明还提供一种机器人夹持的柔性打磨轮位姿辨识装置,包括:
工具中心点坐标获取模块,用于控制机器人以多种姿态携带移动探针接触固定探针,并获取各姿态下工具中心点的坐标;其中,所述固定探针固定于预设位置,所述移动探针固定于机器人末端;
固定探针坐标获取模块,用于采用随机抽样一致算法对获取的多个工具中心点的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的工具中心点的坐标进行球心拟合,以得到固定探针在机器人基坐标系下的位置坐标;
位置点坐标获取模块,用于将移动探针替换成柔性打磨轮后,在连接轴和打磨轮的交界圆上选取多个位置点,控制所述机器人移动使若干个位置点分别接触所述固定探针后,获取每次接触时机器人末端的位置和姿态,根据每次接触时机器人末端的位置和姿态进行坐标系转换后,根据所述固定探针在机器人基坐标系下的位置坐标计算出每个位置点在机器人末端坐标系中的坐标;
X轴计算模块,用于采用随机抽样一致算法对多个位置点在机器人末端坐标系中的坐标进行平面拟合,剔除误差较大点后,采用最小二乘法对剩余的坐标进行平面拟合,得到平面法向量,并记做X轴;
柔性打磨轮坐标系获取模块,用于以X轴与机器人末端坐标系下X’轴呈锐角的方向作为X轴正方向,以X轴为基准,对机器人末端坐标系下Z’轴进行施密特正交化得Z轴,并采用右手定则得到Y轴,以得到柔性打磨轮坐标系;
磨削点坐标获取模块,用于将每个位置点在机器人末端坐标系中的坐标转换为在柔性打磨轮坐标系中的坐标后,采用随机抽样一致算法对获取的多个位置点在柔性打磨轮坐标系中的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的坐标进行球心拟合后,得到交界圆圆心坐标,根据打磨轮平均半径、交界圆圆心坐标以及柔性打磨轮坐标系的单位方向向量得到磨削点坐标。
第三方面,本发明还提供一种机器人夹持的柔性打磨轮位姿辨识设备,包括:处理器和存储器;
所述存储器上存储有可被所述处理器执行的计算机可读程序;
所述处理器执行所述计算机可读程序时实现如上所述的机器人夹持的柔性打磨轮位姿辨识方法中的步骤。
第四方面,本发明还提供一种计算机可读存储介质,所述计算机可读存储介质存储有一个或者多个程序,所述一个或者多个程序可被一个或者多个处理器执行,以实现如上所述的机器人夹持的柔性打磨轮位姿辨识方法中的步骤。
相较于现有技术,本发明提供的机器人夹持的柔性打磨轮位姿辨识方法、装置、设备及存储介质,考虑了机器人误差、装夹误差、人工定位误差;Ransac算法结合最小二乘法精确辨识固定探针位置,提高辨识方法的精度和稳定性;拟合打磨轮轴线得X轴,对Tool0下Z’轴施密特正交化矫正得Z轴,右手定则得Y轴,避免装夹误差,精确辨识姿态。拟合交界圆圆心,并结合矫正得Z轴及打磨轮平均半径R精确辨识位置。本发明无需高精密仪器,操作简单,精度及稳定性高,剔除了机器人运动误差较大点,避免了装夹误差、减小了人工定位误差,适用于机器人夹持的柔性打磨轮位姿辨识,如橡胶轮、纱布轮、钢丝轮等常见柔性打磨轮。
附图说明
图1为本发明提供的机器人夹持的柔性打磨轮位姿辨识方法的一较佳实施例的流程图;
图2为本发明8点法辨识固定探针位置示意图;
图3为本发明8位置点固定探针接触打磨轮与连接轴交界圆示意图;
图4为8位置点拟合平面得法线X轴原理图;
图5为Tool0下Z’轴矫正示意图;
图6为传统方法磨削点位姿辨识原理图;
图7为本发明磨削点位姿辨识原理图;
图8为本发明打磨轮位姿辨识及传统方法打磨轮工件接触示意图;
图9为本发明打磨轮工件接触示意图。
附图标记:1-移动探针,2-固定探针,3-打磨轮,4-连接轴,5-交界圆,6-磨削点,7-Tool0下X’轴平行线,8-打磨轮轴线,9-传统方法打磨轮工件接触面,10-六轴法兰,11-本发明打磨轮工件接触面。
具体实施方式
下面结合附图来具体描述本发明的优选实施例,其中,附图构成本申请一部分,并与本发明的实施例一起用于阐释本发明的原理,并非用于限定本发明的范围。
请参阅图1,本发明实施例提供的机器人夹持的柔性打磨轮位姿辨识方法,包括如下步骤:
S100、控制机器人以多种姿态携带移动探针接触固定探针,并获取各姿态下工具中心点的坐标;其中,所述固定探针固定于预设位置,所述移动探针固定于机器人末端。
本实施例中,如图2所示,机器人携带移动探针以8种位姿接触固定探针,所述姿态的数量为8种,为方便说明,以下以8种位姿状态来对本发明的技术方案进行详细说明。
S200、采用随机抽样一致算法对获取的多个工具中心点的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的工具中心点的坐标进行球心拟合,以得到固定探针在机器人基坐标系下的位置坐标。
本实施例中,所述采用随机抽样一致算法(Ransac算法)对获取的多个工具中心点的坐标进行球心拟合的步骤具体为:
对得到的工具中心点在机器人坐标系下的坐标(xi,yi,zi)应满足公式(1):
(xi-x0)2+(yi-y0)2+(zi-z0)2=R2 公式(1)
其中(x0,y0,z0)为待求圆心,R为拟合半径,求解(x0,y0,z0)和R需四个坐标点,有共70种组合;对每一种组合计算圆心(x0,y0,z0)和半径R后,对剩余四点坐标计算欧式距离设一距离阈值δ1=0.1,若满足d≤δ1,则视为内点,否则视为外点剔除;遍历70种组合,将内点数最多的组合及其内点作为最小二乘求解集合。
Ransac算法球心拟合剔除误差较大点时,对给定的最大容忍距离阈值δ1max=0.3,若剔除外点后最小二乘求解集合中点个数小于五,视为对点误差过大,重新实验。
进一步的,采用最小二乘法对剩余的工具中心点的坐标进行球心拟合,以得到固定探针在机器人基坐标系下的位置坐标的步骤具体为:
采用最小二乘法对求解集合进行球心拟合,其表达式如下:
其中,(xi,yi,zi)为求解集合中各点坐标,R为拟合半径,对x0、y0、z0、R求偏导如公式(3):
利用坐标差值公式(4)将上式(3)简化为下式(5):
S300、将移动探针替换成柔性打磨轮后,在连接轴和打磨轮的交界圆上选取多个位置点,控制所述机器人移动使若干个位置点分别接触所述固定探针后,获取每次接触时机器人末端的位置和姿态,根据每次接触时机器人末端的位置和姿态进行坐标系转换后,根据所述固定探针在机器人基坐标系下的位置坐标计算出每个位置点在机器人末端坐标系中的坐标。
本实施例中,如图3所示,机器人携带打磨装置移动使固定探针接触打磨轮和连接轴交界圆上的8个位置点,为方便说明,以下均以8个位置点来进行说明。
具体的,计算每个位置点在机器人末端坐标系中的坐标的方法具体为:
获取每次接触时机器人末端的位置和姿态,并计算得到机器人末端坐标系向机器人基坐标系的旋转矩阵Ri和平移矩阵Ti,则每个位置点在机器人末端坐标系下的坐标ci(xi’,yi’,zi’)的计算公式为:
S400、采用随机抽样一致算法对多个位置点在机器人末端坐标系中的坐标进行平面拟合,剔除误差较大点后,采用最小二乘法对剩余的坐标进行平面拟合,得到平面法向量,并记做X轴。
具体的,如图4所示,采用随机抽样一致算法对多个位置点在机器人末端坐标系中的坐标进行平面拟合的步骤具体为:
Ransac算法对8个位置点坐标平面拟合剔除误差较大点,具体方法为:
平面的一般方程如式(7):
Ax+By+Cz+D=0 公式(7)
其中(A,B,C)为平面法向量即为所求X轴,对平面方程变形可得:
求解A、B、C、D需要三个位置坐标点,有共56种组合;对每一种组合计算平面参数A、B、C、D后,对剩余五点坐标计算欧式距离设一距离阈值δ2=0.1,若满足d2≤δ2,则视为内点,否则视为外点剔除;遍历56种组合,将内点数最多的组合及其内点作为最小二乘求解集合。
Ransac算法平面拟合剔除误差较大点时,对给定的最大容忍距离阈值δ2max=0.3,若剔除外点后最小二乘求解集合中点个数小于四,视为对点误差过大,重新实验。
进一步的,采用最小二乘法对剩余的坐标进行平面拟合,得到平面法向量,并记做X轴的步骤具体为:
由求解集合所有点平面距离最小化可得函数表达式如下:
分别对a0、a1、a2求偏导数,可得公式(10):
对公式(10)化简可得公式(11):
整理成矩阵形式可得公式(12):
即Ax=b,求解可得a0、a1、a2,代入公式(8)可得A、B、C,单位化向量(A,B,C)即为所求X轴标量。
S500、以X轴与机器人末端坐标系下X’轴呈锐角的方向作为X轴正方向,以X轴为基准,对机器人末端坐标系下Z’轴进行施密特正交化得Z轴,并采用右手定则得到Y轴,以得到柔性打磨轮坐标系。
具体的,如图5所示,所述步骤S500具体包括:
对所求X轴计算X与机器人末端坐标系下的X’轴的点积,记θ=X·X',若θ>0,则X=X,否则X=-X;以所得单位向量轴X为基准,对机器人末端坐标系下单位向量轴Z’轴做施密特正交化处理,具体公式为:
由公式(13)可得Z轴,右手定则可得Y轴,完成柔性打磨轮姿态辨识。
S600、将每个位置点在机器人末端坐标系中的坐标转换为在柔性打磨轮坐标系中的坐标后,采用随机抽样一致算法对获取的多个位置点在柔性打磨轮坐标系中的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的坐标进行球心拟合后,得到交界圆圆心坐标,根据打磨轮平均半径、交界圆圆心坐标以及柔性打磨轮坐标系的单位方向向量得到磨削点坐标。
具体来说,如图6所示,传统方法辨识打磨轮磨削点位置时通过人工定位,存在随机误差,a点为理想定位点,a点以外所有点均会导致工件过磨,如b、c两点,人工定位难以精确定位a点;如图7为本发明打磨轮磨削点位姿辨识原理图,其打磨轮磨削点辨识位置始终为理想定位点,柔性打磨轮坐标系(TCF)的磨削点位置坐标求解的具体方法为:
与8个工具中心点拟合球心原理相同,Ransac算法拟合交界圆圆心剔除误差较大点,构建求解集合后,若求解集合中的点数目小于五个,则重新实验;采用最小二乘法对求解集合中的点拟合得交界圆圆心坐标O1(x1,y1,z1),由打磨轮平均半径R可得磨削点位置坐标O2(x2,y2,z2+R*Z),完成柔性打磨轮位姿辨识。
如图8为本发明TCF辨识示意图,传统方法以Tool0的姿态作为TCF的姿态,由于存在装夹误差,轴线偏离Tool0下X’轴,会使打磨轮与工件接触面倾斜,造成非均匀磨削;如图9,本发明对TCF姿态重新辨识,轴线与TCF下X轴是平行的,打磨轮与工件接触面平行,属于均匀磨削。
基于上述机器人夹持的柔性打磨轮位姿辨识方法,本发明还相应的提供一种机器人夹持的柔性打磨轮位姿辨识装置,包括:
工具中心点坐标获取模块,用于控制机器人以多种姿态携带移动探针接触固定探针,并获取各姿态下工具中心点的坐标;其中,所述固定探针固定于预设位置,所述移动探针固定于机器人末端;
固定探针坐标获取模块,用于采用随机抽样一致算法对获取的多个工具中心点的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的工具中心点的坐标进行球心拟合,以得到固定探针在机器人基坐标系下的位置坐标;
位置点坐标获取模块,用于将移动探针替换成柔性打磨轮后,在连接轴和打磨轮的交界圆上选取多个位置点,控制所述机器人移动使若干个位置点分别接触所述固定探针后,获取每次接触时机器人末端的位置和姿态,根据每次接触时机器人末端的位置和姿态进行坐标系转换后,根据所述固定探针在机器人基坐标系下的位置坐标计算出每个位置点在机器人末端坐标系中的坐标;
X轴计算模块,用于采用随机抽样一致算法对多个位置点在机器人末端坐标系中的坐标进行平面拟合,剔除误差较大点后,采用最小二乘法对剩余的坐标进行平面拟合,得到平面法向量,并记做X轴;
柔性打磨轮坐标系获取模块,用于以X轴与机器人末端坐标系下X’轴呈锐角的方向作为X轴正方向,以X轴为基准,对机器人末端坐标系下Z’轴进行施密特正交化得Z轴,并采用右手定则得到Y轴,以得到柔性打磨轮坐标系;
磨削点坐标获取模块,用于将每个位置点在机器人末端坐标系中的坐标转换为在柔性打磨轮坐标系中的坐标后,采用随机抽样一致算法对获取的多个位置点在柔性打磨轮坐标系中的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的坐标进行球心拟合后,得到交界圆圆心坐标,根据打磨轮平均半径、交界圆圆心坐标以及柔性打磨轮坐标系的单位方向向量得到磨削点坐标。
由于上文已对机器人夹持的柔性打磨轮位姿辨识方法进行详细描述,所述机器人夹持的柔性打磨轮位姿辨识方法具备的技术效果,所述机器人夹持的柔性打磨轮位姿辨识装置同样具备,故在此不再赘述。
基于上述机器人夹持的柔性打磨轮位姿辨识方法,本发明还相应的提供一种机器人夹持的柔性打磨轮位姿辨识设备,包括:处理器和存储器;
所述存储器上存储有可被所述处理器执行的计算机可读程序;
所述处理器执行所述计算机可读程序时实现如上述各实施例所述的机器人夹持的柔性打磨轮位姿辨识方法中的步骤。
由于上文已对机器人夹持的柔性打磨轮位姿辨识方法进行详细描述,所述机器人夹持的柔性打磨轮位姿辨识方法具备的技术效果,所述机器人夹持的柔性打磨轮位姿辨识设备同样具备,故在此不再赘述。
基于上述机器人夹持的柔性打磨轮位姿辨识方法,本发明还相应的提供一种计算机可读存储介质,所述计算机可读存储介质存储有一个或者多个程序,所述一个或者多个程序可被一个或者多个处理器执行,以实现如上述各实施例所述的机器人夹持的柔性打磨轮位姿辨识方法中的步骤。
由于上文已对机器人夹持的柔性打磨轮位姿辨识方法进行详细描述,所述机器人夹持的柔性打磨轮位姿辨识方法具备的技术效果,所述计算机可读存储介质同样具备,故在此不再赘述。
综上所述,本发明提供的机器人夹持的柔性打磨轮位姿辨识方法、装置、设备及存储介质,考虑了机器人误差、装夹误差、人工定位误差;Ransac算法结合最小二乘法精确辨识固定探针位置,提高辨识方法的精度和稳定性;拟合打磨轮轴线得X轴,对Tool0下Z’轴施密特正交化矫正得Z轴,右手定则得Y轴,避免装夹误差,精确辨识姿态。拟合交界圆圆心,并结合矫正得Z轴及打磨轮平均半径R精确辨识位置。本发明无需高精密仪器,操作简单,精度及稳定性高,剔除了机器人运动误差较大点,避免了装夹误差、减小了人工定位误差,适用于机器人夹持的柔性打磨轮位姿辨识,如橡胶轮、纱布轮、钢丝轮等常见柔性打磨轮。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。
Claims (10)
1.一种机器人夹持的柔性打磨轮位姿辨识方法,其特征在于,包括如下步骤:
控制机器人以多种姿态携带移动探针接触固定探针,并获取各姿态下工具中心点的坐标;其中,所述固定探针固定于预设位置,所述移动探针固定于机器人末端;
采用随机抽样一致算法对获取的多个工具中心点的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的工具中心点的坐标进行球心拟合,以得到固定探针在机器人基坐标系下的位置坐标;
将移动探针替换成柔性打磨轮后,在连接轴和打磨轮的交界圆上选取多个位置点,控制所述机器人移动使若干个位置点分别接触所述固定探针后,获取每次接触时机器人末端的位置和姿态,根据每次接触时机器人末端的位置和姿态进行坐标系转换后,根据所述固定探针在机器人基坐标系下的位置坐标计算出每个位置点在机器人末端坐标系中的坐标;
采用随机抽样一致算法对多个位置点在机器人末端坐标系中的坐标进行平面拟合,剔除误差较大点后,采用最小二乘法对剩余的坐标进行平面拟合,得到平面法向量,并记做X轴;
以X轴与机器人末端坐标系下X’轴呈锐角的方向作为X轴正方向,以X轴为基准,对机器人末端坐标系下Z’轴进行施密特正交化得Z轴,并采用右手定则得到Y轴,以得到柔性打磨轮坐标系;
将每个位置点在机器人末端坐标系中的坐标转换为在柔性打磨轮坐标系中的坐标后,采用随机抽样一致算法对获取的多个位置点在柔性打磨轮坐标系中的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的坐标进行球心拟合后,得到交界圆圆心坐标,根据打磨轮平均半径、交界圆圆心坐标以及柔性打磨轮坐标系的单位方向向量得到磨削点坐标。
2.根据权利要求1所述的机器人夹持的柔性打磨轮位姿辨识方法,其特征在于,所述采用随机抽样一致算法对获取的多个工具中心点的坐标进行球心拟合的步骤具体为:
选取其中四个工具中心点的坐标作为组合,代入公式:(xi-x0)2+(yi-y0)2+(zi-z0)2=R2中,求取出球心(x0,y0,z0)和半径R后,采用公式计算出剩余的坐标的欧式距离d,若满足d≤δ1,则视为内点,否则视为外点剔除;其中,δ1为预设的第一距离阈值,(xi,yi,zi)为工具中心点的坐标;
重新选取其中四个工具中心点的坐标作为组合,并进行内点筛选和外点剔除;
当所有的组合都计算完毕时,将内点数最多的组合及其内点作为最小二乘法的求解集合。
5.根据权利要求4所述的机器人夹持的柔性打磨轮位姿辨识方法,其特征在于,采用随机抽样一致算法对多个位置点在机器人末端坐标系中的坐标进行平面拟合的步骤具体为:
选取其中三个位置点在机器人末端坐标系下的坐标作为组合,代入公式:中,求取出A、B、C、D后,采用公式计算出剩余的坐标的欧式距离d2,若满足d2≤δ2,则视为内点,否则视为外点剔除;其中,δ2为预设的第二距离阈值,(xi’,yi’,zi’)为位置点在机器人末端坐标系下的坐标,(A,B,C)为所求X轴标量;
重新选取其中三个位置点在机器人末端坐标系下的坐标作为组合,并进行内点筛选和外点剔除;
当所有的组合都计算完毕时,将内点数最多的组合及其内点作为最小二乘法的求解集合。
8.一种机器人夹持的柔性打磨轮位姿辨识装置,其特征在于,包括:
工具中心点坐标获取模块,用于控制机器人以多种姿态携带移动探针接触固定探针,并获取各姿态下工具中心点的坐标;其中,所述固定探针固定于预设位置,所述移动探针固定于机器人末端;
固定探针坐标获取模块,用于采用随机抽样一致算法对获取的多个工具中心点的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的工具中心点的坐标进行球心拟合,以得到固定探针在机器人基坐标系下的位置坐标;
位置点坐标获取模块,用于将移动探针替换成柔性打磨轮后,在连接轴和打磨轮的交界圆上选取多个位置点,控制所述机器人移动使若干个位置点分别接触所述固定探针后,获取每次接触时机器人末端的位置和姿态,根据每次接触时机器人末端的位置和姿态进行坐标系转换后,根据所述固定探针在机器人基坐标系下的位置坐标计算出每个位置点在机器人末端坐标系中的坐标;
X轴计算模块,用于采用随机抽样一致算法对多个位置点在机器人末端坐标系中的坐标进行平面拟合,剔除误差较大点后,采用最小二乘法对剩余的坐标进行平面拟合,得到平面法向量,并记做X轴;
柔性打磨轮坐标系获取模块,用于以X轴与机器人末端坐标系下X’轴呈锐角的方向作为X轴正方向,以X轴为基准,对机器人末端坐标系下Z’轴进行施密特正交化得Z轴,并采用右手定则得到Y轴,以得到柔性打磨轮坐标系;
磨削点坐标获取模块,用于将每个位置点在机器人末端坐标系中的坐标转换为在柔性打磨轮坐标系中的坐标后,采用随机抽样一致算法对获取的多个位置点在柔性打磨轮坐标系中的坐标进行球心拟合,剔除误差较大的坐标后,采用最小二乘法对剩余的坐标进行球心拟合后,得到交界圆圆心坐标,根据打磨轮平均半径、交界圆圆心坐标以及柔性打磨轮坐标系的单位方向向量得到磨削点坐标。
9.一种机器人夹持的柔性打磨轮位姿辨识设备,其特征在于,包括:处理器和存储器;
所述存储器上存储有可被所述处理器执行的计算机可读程序;
所述处理器执行所述计算机可读程序时实现如权利要求1-7任意一项所述的机器人夹持的柔性打磨轮位姿辨识方法中的步骤。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有一个或者多个程序,所述一个或者多个程序可被一个或者多个处理器执行,以实现如权利要求1-7任意一项所述的机器人夹持的柔性打磨轮位姿辨识方法中的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110159052.3A CN112936274B (zh) | 2021-02-05 | 2021-02-05 | 一种机器人夹持的柔性打磨轮位姿辨识方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110159052.3A CN112936274B (zh) | 2021-02-05 | 2021-02-05 | 一种机器人夹持的柔性打磨轮位姿辨识方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112936274A CN112936274A (zh) | 2021-06-11 |
CN112936274B true CN112936274B (zh) | 2022-05-17 |
Family
ID=76242406
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110159052.3A Active CN112936274B (zh) | 2021-02-05 | 2021-02-05 | 一种机器人夹持的柔性打磨轮位姿辨识方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112936274B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114589692B (zh) * | 2022-02-25 | 2024-03-26 | 埃夫特智能装备股份有限公司 | 一种机器人零点标定方法及其标定设备 |
CN115033842B (zh) * | 2022-06-17 | 2024-02-20 | 合肥工业大学 | 一种空间6自由度位姿变换数据的拟合方法及拟合*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106705956A (zh) * | 2017-02-28 | 2017-05-24 | 南京工程学院 | 工业机器人末端位姿快速测量装置及其测量方法 |
CN107462154A (zh) * | 2017-07-28 | 2017-12-12 | 深圳市圆梦精密技术研究院 | 机器人末端工具的位姿测量方法 |
CN110625600A (zh) * | 2019-10-29 | 2019-12-31 | 华中科技大学 | 一种机器人末端工件坐标系标定方法 |
CN110978058A (zh) * | 2019-12-24 | 2020-04-10 | 复旦大学 | 适用于工业机器人的位姿测量及其运动学模型修正的方法 |
CN111421542A (zh) * | 2020-04-03 | 2020-07-17 | 重庆固高科技长江研究院有限公司 | 机器人末端夹具的工具中心点位姿计算方法及控制方法 |
-
2021
- 2021-02-05 CN CN202110159052.3A patent/CN112936274B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106705956A (zh) * | 2017-02-28 | 2017-05-24 | 南京工程学院 | 工业机器人末端位姿快速测量装置及其测量方法 |
CN107462154A (zh) * | 2017-07-28 | 2017-12-12 | 深圳市圆梦精密技术研究院 | 机器人末端工具的位姿测量方法 |
CN110625600A (zh) * | 2019-10-29 | 2019-12-31 | 华中科技大学 | 一种机器人末端工件坐标系标定方法 |
CN110978058A (zh) * | 2019-12-24 | 2020-04-10 | 复旦大学 | 适用于工业机器人的位姿测量及其运动学模型修正的方法 |
CN111421542A (zh) * | 2020-04-03 | 2020-07-17 | 重庆固高科技长江研究院有限公司 | 机器人末端夹具的工具中心点位姿计算方法及控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112936274A (zh) | 2021-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112936274B (zh) | 一种机器人夹持的柔性打磨轮位姿辨识方法 | |
CN100506480C (zh) | 带有同心度修正的研磨机 | |
CN110202318B (zh) | 一种基于双侧超声滚压加工的航空叶片定位与姿态调节方法 | |
CN110793794B (zh) | 基于球杆仪的五轴机床复杂运动状态下动态精度检测方法 | |
CN106705880B (zh) | 一种大口径反射镜面形轮廓在位检测方法及装置 | |
Xie et al. | Pose error estimation using a cylinder in scanner-based robotic belt grinding | |
CN111546330A (zh) | 一种自动化工件坐标系标定方法 | |
CN114012585A (zh) | 一种双摆轴式五轴磁流变机床抛光点位置标定方法 | |
CN113932753A (zh) | 一种轮毂法兰盘打磨的轮廓标定方法 | |
CN111882614A (zh) | 一种基于knn-icp算法的自由曲面定位方法 | |
CN114200891B (zh) | 无模型筒形铸件内腔铣削加工***及轨迹规划方法 | |
CN108827210A (zh) | 一种结合数控机床的关节式坐标测量机标定方法 | |
CN109465677B (zh) | 一种机器人恒力抛光方法 | |
CN110227994B (zh) | 一种高阶切触包络式磨抛加工方法及其应用 | |
JP6506149B2 (ja) | 工作機械の幾何誤差同定方法及び幾何誤差同定プログラム | |
JPS6114836A (ja) | 加工位置の座標系補正装置 | |
CN214323368U (zh) | 进料转盘机械臂上下样的视觉定位及手眼标定装置 | |
CN115284079A (zh) | 磁流变抛光标定方法 | |
CN111240267B (zh) | 一种面向机器人加工的轮廓误差定义与估计方法及装置 | |
CN114227539A (zh) | 汽车轮毂去毛刺工作站机器人标定工具及其标定方法 | |
CN115365941B (zh) | 一种用于光学抛光的工件位姿自动校准方法 | |
CN111922785A (zh) | 一种校正工装、机床虚拟旋转轴补偿方法及***、五轴机床 | |
CN110666589A (zh) | 用于确定工件坐标及降低其加工旋转误差的方法及装置 | |
CN113720261B (zh) | 一种基于平面的标靶球头标定方法、***及应用 | |
CN116587268B (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 |