CN111745623A - 五自由度混联机器人末端位姿误差检测补偿***及方法 - Google Patents
五自由度混联机器人末端位姿误差检测补偿***及方法 Download PDFInfo
- Publication number
- CN111745623A CN111745623A CN202010590685.5A CN202010590685A CN111745623A CN 111745623 A CN111745623 A CN 111745623A CN 202010590685 A CN202010590685 A CN 202010590685A CN 111745623 A CN111745623 A CN 111745623A
- Authority
- CN
- China
- Prior art keywords
- main shaft
- stirring head
- axis
- coordinate system
- shaft
- 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
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/003—Programme-controlled manipulators having parallel kinematics
- B25J9/0072—Programme-controlled manipulators having parallel kinematics of the hybrid type, i.e. having different kinematics chains
-
- 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/02—Sensing devices
- B25J19/021—Optical sensing devices
- B25J19/023—Optical sensing devices including video camera means
-
- 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/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/023—Cartesian coordinate type
-
- 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
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Multimedia (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种五自由度混联机器人末端位姿误差检测补偿***,包括混联机器人本体以及安装在混联机器人本体末端的搅拌摩擦焊搅拌头,混联机器人本体包括过约束三自由度的并联机构及A/C轴双摆角头,还包括视觉定位***及激光测距仪;视觉定位***用于测量搅拌头主轴末端的三维坐标值,其包括至少一组双目相机;激光测距仪用于采集其发射端到工件表面的距离;在搅拌头主轴的轴肩上设有环形转动盘;环形转动盘在驱动装置驱动下围绕搅拌头主轴轴线匀速转动,激光测距仪固定在环形转动盘上。本发明还公开了一种五自由度混联机器人末端位姿误差检测补偿方法,其可适用于搅拌摩擦焊混联机器人的误差精确动态检测及补偿。
Description
技术领域
本发明涉及一种机器人末端位姿误差检测补偿***及方法,特别涉及一种五自由度混联机器人末端位姿误差检测补偿***及方法。
背景技术
目前,机器人发展迅速,并且广泛应用于各行各业。现代自动化领域高精技术的快速发展,对机器人的性能要求越来越高。混联机器人由于刚度大,性能好的特点,在工业自动化加工领域应用颇多。评价机器人的性能指标众多,其中较为重要的是绝对定位精度和加工轨迹的重复定位精度。其中位姿的准确性综合反映了机器人的控制精度以及整个机电***的性能。因此补偿机器人在加工过程中的位姿误差尤为重要。
公开号为CN108297101A的中国专利文献公开了一种多关节臂串联机器人末端位姿误差检测和动态补偿方法,该方法利用倾角传感器模块获得机器人末端位姿误差。但是由于串联关节轴的实际参数值跟理论值存在误差,所以获得的位姿误差不够精确。
发明内容
本发明为解决公知技术中存在的技术问题而提供一种精确的五自由度混联机器人末端位姿误差检测补偿***及方法。
本发明为解决公知技术中存在的技术问题所采取的技术方案是:一种五自由度混联机器人末端位姿误差检测补偿***,包括混联机器人本体以及安装在混联机器人本体末端的搅拌摩擦焊搅拌头,混联机器人本体包括过约束三自由度的并联机构及A/C轴双摆角头,其中,并联机构包括动平台及与动平台铰接且沿轴向运动的第一至第三主动臂;双摆角头的C轴与动平台转动连接;双摆角头的A轴与搅拌头主轴的轴承座固接,且A轴轴线与搅拌头主轴轴线重合,还包括视觉定位***及激光测距仪;视觉定位***用于测量搅拌头主轴末端的三维坐标值,其包括至少一组双目相机;激光测距仪用于采集其发射端到工件表面的距离;在搅拌头主轴的轴肩上设有环形转动盘;环形转动盘在驱动装置驱动下围绕搅拌头主轴轴线匀速转动,激光测距仪固定在环形转动盘上。
进一步地,驱动装置包括电机和齿轮;环形转动盘的周侧面设有与齿轮啮合的齿;电机固定在搅拌头主轴的轴肩上,电机的输出轴与齿轮固接。
进一步地,在搅拌头主轴的轴肩上固接有环形滑轨,环形转动盘吊挂在环形滑轨上并与环形滑轨滑动连接。
进一步地,在混联机器人本体的固定基座上固接有支架,视觉定位***的双目相机固定在支架上。
本发明还提供了一种利用上述的五自由度混联机器人末端位姿误差检测补偿***的五自由度混联机器人末端位姿误差检测补偿方法,该方法为:
在基坐标系下,标定激光测距仪发射端初始坐标、搅拌头主轴末端的初始坐标以及A、C轴初始角度;
设位于工件表面上的激光照射点为检测点,设激光测距仪测量值第一次出现峰值的时刻为T1,设T1时刻环形转动盘绕搅拌头主轴轴线转动的角度为α;设第一次峰值对应的检测点为A点,设激光测距仪测量值第二次出现峰值的时刻为T2,设T2时刻环形转动盘绕搅拌头主轴轴线转动的角度为β;设第二次峰值对应的检测点为B点;
读取T1至T2时间段的视觉定位***测得的搅拌头主轴末端在基坐标系下的实际坐标值,由搅拌头主轴末端与激光测距仪发射端两者初始时刻的相对坐标、环形转动盘的转速,计算得到T1至T2时间段的激光测距仪发射端在基坐标系下的实际坐标值;由激光测距仪在T1至T2时间段测得的其发射端到工件表面检测点的距离,进一步得到T1至T2时间段的检测点在基坐标系下的坐标;
以搅拌头末端为原点,焊缝方向为X轴,工件平面法向量为Z轴建立坐标系O2;令γ=α-β,由和γ,计算得到搅拌头主轴轴线在坐标系O2中的坐标,利用坐标系O2和基坐标系之间的坐标转换,计算得到搅拌头主轴轴线在基坐标系下的姿态角,姿态角包括主轴轴线绕基坐标系的X轴转动的转角及绕基坐标系的Y轴转动的转角;
设T1时刻搅拌头主轴垂直于工件表面,由T2时刻视觉定位***测得的搅拌头主轴末端在基坐标系下的坐标实际值以及搅拌头主轴轴线在基坐标系下的姿态角,根据五自由度混联机器人逆运动学方程,得到T2时刻第一至第三主动臂的轴向位移实际值及A、C轴转角实际值;由位姿指令得到对应T2时刻第一至第三主动臂的轴向位移给定值以及A、C轴转角给定值,进一步获得T2时刻第一至第三主动臂的轴向位移误差值以及A、C轴转角误差值;将得到的误差值作为补偿值。
本发明具有的优点和积极效果是:本发明基于激光测距仪和视觉定位***,将混联加工机器人加工过程中由于各种因素导致的末端位姿误差进行检测和动态补偿,实时修正机器人末端位姿,简化了工业机器人末端位姿测量方式,大大提高了加工精度,有效弥补了机器人半闭环控制的缺陷,优化了机器人的实时性能,显著提高了智能化水平,该方法可适用于搅拌摩擦焊混联机器人的误差检测及补偿。
附图说明
图1是本发明的一种五自由度混联机器人末端位姿误差检测补偿***结构示意图。
图2是本发明的一种五自由度混联机器人末端位姿误差检测补偿方法工作流程图。
图中:1、搅拌头主轴;2、第一相机;3、第二相机;4、工件;5、工作台;6、激光测距仪;7、混联机器人本体。
具体实施方式
为能进一步了解本发明的发明内容、特点及功效,兹列举以下实施例,并配合附图详细说明如下:
请参见图1至图2,一种五自由度混联机器人末端位姿误差检测补偿***,包括混联机器人本体7以及安装在混联机器人本体7末端的搅拌摩擦焊搅拌头,混联机器人本体7包括过约束三自由度的并联机构及A/C轴双摆角头,其中,并联机构包括动平台及与动平台铰接且沿轴向运动的第一至第三主动臂;双摆角头的C轴与动平台转动连接;双摆角头的A轴与搅拌头主轴1的轴承座固接,且A轴轴线与搅拌头主轴1的轴线重合,还包括视觉定位***及激光测距仪6;视觉定位***用于测量搅拌头主轴1末端的三维坐标值,其包括至少一组双目相机;激光测距仪6用于采集其发射端到工件4表面的距离;在搅拌头主轴1的轴肩上设有环形转动盘;环形转动盘在驱动装置驱动下围绕搅拌头主轴1的轴线匀速转动,激光测距仪6固定在环形转动盘上。
五自由度混联机器人由三自由度过约束空间并联机构与一两自由度A/C轴双摆角头串接而成,其中并联机构的第一至第三主动臂形成三条主动支链,第一至第三主动臂的一端可通过虎克铰链铰接在静平台上,另一端可通过球铰链铰接在动平台上,动平台后端可设有从动支撑臂;动平台前端连接A/C轴双摆角头,其中双摆角头的C轴与动平台转动连接。
视觉定位***的工作原理为:先用双目相机进行图像信息采集,将采集的图像信息进行目标特征提取处理,基于双目测距原理,将采集到的目标图像信息和目标的实际位置联系起来,完成目标的三维坐标位置测量。
视觉定位***,其包括至少一组双目相机,其中一组双目相机包括第一相机2和第二相机3,可在第一相机2建立坐标系P1,在第二相机3建立坐标系P2,经过图片矫正和双目标定后,可对坐标系P1、坐标系P2相对机器人基坐标系进行标定。获得搅拌头末端在坐标系P1及坐标系P2中的坐标,通过坐标转换,可获得搅拌头末端在基坐标系下的坐标。
视觉定位***可采用现有技术中的视觉定位***,如基恩士XG-X系列视觉定位***等。可采用常规技术手段对视觉定位***的双目相机进行内外参数标定。
将工件4放在工作台5上,激光测距仪6围绕搅拌头主轴1的轴线旋转,其发出激光束,可检测搅拌头的轴肩等相对工件4表面的高度。激光测距仪6可采用无线激光测距仪6,其将检测信号通过无线方式发送给混联机器人的控制***。
视觉定位***和激光测距仪6将检测的数据作为反馈数据发送至混联机器人的数控***中,混联机器人的数控***对接收的反馈数据进行处理,得到搅拌头主轴1末端的位姿实际数据,其与位姿给定数据进行相减,得到搅拌头主轴1末端的位姿偏差数据,其将位姿偏差数据作为补偿数据,进行补偿控制。
进一步地,驱动环形转动盘绕搅拌头主轴1的轴线旋转的驱动装置可包括电机和齿轮;环形转动盘的周侧面设有与齿轮啮合的齿;电机固定在搅拌头主轴1的轴肩上,电机的输出轴与齿轮固接。驱动装置也可以采用现有技术中的其他驱动装置、驱动结构和传动方法。
进一步地,在搅拌头主轴1的轴肩上可固接有环形滑轨,环形转动盘可吊挂在环形滑轨上并与环形滑轨滑动连接。
进一步地,在混联机器人本体7的固定基座上可固接有支架,视觉定位***的双目相机固定在支架上。
本发明还提供了一种利用上述的五自由度混联机器人末端位姿误差检测补偿***的五自由度混联机器人末端位姿误差检测补偿方法实施例,该方法为:
在基坐标系下,标定激光测距仪6发射端初始坐标、搅拌头主轴1末端的初始坐标以及A、C轴初始角度。
激光测距仪6的发射端在工件4平面的投影方向即为搅拌头Z向前进方向,激光测距仪6的发射端距离焊缝高度,大于激光测距仪6的发射端到工件4表面其他部位高度,即环形转动盘在旋转一圈的时间段内,激光测距仪6测得的数据中会出现一个峰值。
设位于工件4表面上的激光照射点为检测点,设激光测距仪6测量值第一次出现峰值的时刻为T1,设T1时刻环形转动盘绕搅拌头主轴1的轴线转动的角度为α;设第一次峰值对应的检测点为A点,设激光测距仪6测量值第二次出现峰值的时刻为T2,设T2时刻环形转动盘绕搅拌头主轴1的轴线转动的角度为β;设第二次峰值对应的检测点为B点;转动角度α和转动角度β皆为相对于初始时刻绕搅拌头主轴1的轴线旋转的角度值。
两个相邻峰值出现时刻之间的时间段,相当于激光测距仪6的一个测量周期,由这两个时刻之间的搅拌头主轴1末端的三维坐标值可推导出工件4平面上的多个点的坐标值。当搅拌头前进方向出现偏差时,第二次峰值对应的检测点B与第一次峰值对应的检测点A的连线与焊缝的中线不重合。
读取T1至T2时间段的视觉定位***测得的搅拌头主轴1末端在基坐标系下的实际坐标值,由搅拌头主轴1末端与激光测距仪6发射端两者初始时刻的相对坐标、环形转动盘的转速,计算得到T1至T2时间段的激光测距仪6发射端在基坐标系下的实际坐标值;由激光测距仪6在T1至T2时间段测得的其发射端到工件4表面检测点的距离,进一步得到T1至T2时间段的检测点在基坐标系下的坐标。
采样T1至T2时间段且不含A、B点的检测点,由采样的检测点在基坐标系下的坐标值拟合工件4平面;从而得到工件4平面法向量,由工件4平面法向量得到工件4平面与搅拌头主轴1的夹角,设该夹角为拟合工件4平面可采用如下拟合工件4平面方程进行拟合:ax+by+cz+d=0,拟合后可得到平面法向量(a,b,c),工件4平面法向量与Z轴夹角即为搅拌头倾角。
以搅拌头末端为原点,焊缝方向为X轴,工件4平面法向量为Z轴建立坐标系O2;令γ=α-β,由和γ,由空间几何关系,可计算得到搅拌头主轴1的轴线在坐标系O2中的坐标,利用坐标系O2和基坐标系之间的坐标转换,计算得到搅拌头主轴1的轴线在基坐标系下的姿态角,姿态角包括主轴轴线绕基坐标系的X轴转动的转角及绕基坐标系的Y轴转动的转角。
设T1时刻搅拌头主轴1垂直于工件4表面,由T2时刻视觉定位***测得的搅拌头主轴1末端在基坐标系下的坐标实际值以及搅拌头主轴1的轴线在基坐标系下的姿态角,根据五自由度混联机器人逆运动学方程,得到T2时刻第一至第三主动臂的轴向位移实际值及A、C轴转角实际值;由位姿指令得到对应T2时刻第一至第三主动臂的轴向位移给定值以及A、C轴转角给定值,进一步获得T2时刻第一至第三主动臂的轴向位移误差值以及A、C轴转角误差值;将得到的误差值作为补偿值。五自由度混联机器人逆运动学方程由混联机器人的结构推导得出。
下面以本发明的详细工作流程来进一步说明本发明的工作步骤及工作原理:
步骤一:设定机器人本体运动学参数,包括各关节杆长,零点位置,标定视觉定位***的双目相机及激光测距仪6。
步骤二:在数控***人机交互界面中,设定机器人运动轨迹,编辑一条焊缝轨迹,从而生成对应的加工G代码,即给定搅拌头主轴1末端位姿T=[x,y,z,A,B]。根据机器人运动学逆解求取并联机构三个主动支链的进给长度q1,q2,q3,以及串联机构A/C双摆角头的两个转角θ4,θ5,令θ=[q1,q2,q3,θ4,θ5],并在数控***底层运动学模块设定初始补偿值为Δθ=[0,0,0,0,0]。
步骤三:在激光测距仪6上建立坐标系O1-XYZ,并与机器人基坐标系标定。激光测距仪6围绕搅拌头主轴1的轴线旋转,其发出激光束,可检测搅拌头的轴肩等相对工件4表面的高度。设位于工件4表面上的激光照射点为检测点,由视觉定位***测得的搅拌头主轴1末端在基坐标系下的坐标实际值,得到一系列检测点在基坐标系下的坐标值,由检测点在基坐标系下的坐标值拟合工件4平面;从而得到工件4的平面法向量,由工件4的平面法向量得到工件4的平面与搅拌头主轴1的夹角,令该夹角为即搅拌头主轴1相对工件4平面的倾角为以搅拌头末端为原点,焊缝方向为X轴,工件4平面法向量为Z轴建立坐标系O2-XYZ。
设激光测距仪6测量值第一次出现峰值的时刻为T1,设T1时刻环形转动盘绕搅拌头主轴1的轴线转动的角度为α;设第一次峰值对应的检测点为A点,设激光测距仪6测量值第二次出现峰值的时刻为T2,设T2时刻环形转动盘绕搅拌头主轴1的轴线转动的角度为β;设第二次峰值对应的检测点为B点;转动角度α和转动角度β皆为相对于初始时刻绕搅拌头主轴1的轴线旋转的角度值。
令γ=α-β,利用倾角和角度γ,可获得搅拌头矢量在坐标系O2中的坐标,利用坐标系O2和基坐标系之间的坐标转换,计算得到搅拌头主轴1的轴线在基坐标系下的姿态角,姿态角包括搅拌头主轴1的轴线绕基坐标系的X轴转动的转角A1,及搅拌头主轴1的轴线绕基坐标系的Y轴转动的转角B1。依此可得到末端姿态角A1、B1。将测得的数据实时传送到机器人数控***。
步骤四:通过标定的坐标系O2-XYZ与机器人基坐标系O-XYZ之间的转换关系,求解当前机器人执行器末端即搅拌头主轴1末端,在基坐标系O-XYZ下的位置坐标及姿态角,得到混联机器人末端实际位姿数据,用Treal表示,Treal=[x1,y1,z1,A1,B1],并显示在数控***位姿补偿模块界面中。
步骤五:通过数控***底层运动学模块,将获得的机器人实际位姿数据和给定位姿数据进行实时比对,得到的位姿偏差,用ΔT表示,ΔT=[Δx,Δy,Δz,ΔA,ΔB],可根据混联机器人的雅克比矩阵J,利用公式ΔT=J*Δθ,可求解各关节角度补偿值,将该值输入数控***位姿补偿模块中。数控***将该补偿值补偿到下一个插补周期中。
以上所述的实施例仅用于说明本发明的技术思想及特点,其目的在于使本领域内的技术人员能够理解本发明的内容并据以实施,不能仅以本实施例来限定本发明的专利范围,即凡本发明所揭示的精神所作的同等变化或修饰,仍落在本发明的专利范围内。
Claims (5)
1.一种五自由度混联机器人末端位姿误差检测补偿***,包括混联机器人本体以及安装在混联机器人本体末端的搅拌摩擦焊搅拌头,混联机器人本体包括过约束三自由度的并联机构及A/C轴双摆角头,其中,并联机构包括动平台及与动平台铰接且沿轴向运动的第一至第三主动臂;双摆角头的C轴与动平台转动连接;双摆角头的A轴与搅拌头主轴的轴承座固接,且A轴轴线与搅拌头主轴轴线重合,其特征在于:还包括视觉定位***及激光测距仪;视觉定位***用于测量搅拌头主轴末端的三维坐标值,其包括至少一组双目相机;激光测距仪用于采集其发射端到工件表面的距离;在搅拌头主轴的轴肩上设有环形转动盘;环形转动盘在驱动装置驱动下围绕搅拌头主轴轴线匀速转动,激光测距仪固定在环形转动盘上。
2.根据权利要求1所述的五自由度混联机器人末端位姿误差检测补偿***,其特征在于,驱动装置包括电机和齿轮;环形转动盘的周侧面设有与齿轮啮合的齿;电机固定在搅拌头主轴的轴肩上,电机的输出轴与齿轮固接。
3.根据权利要求1所述的五自由度混联机器人末端位姿误差检测补偿***,其特征在于,在搅拌头主轴的轴肩上固接有环形滑轨,环形转动盘吊挂在环形滑轨上并与环形滑轨滑动连接。
4.根据权利要求1所述的五自由度混联机器人末端位姿误差检测补偿***,其特征在于,在混联机器人本体的固定基座上固接有支架,视觉定位***的双目相机固定在支架上。
5.一种利用权利要求1至4任一所述的五自由度混联机器人末端位姿误差检测补偿***的五自由度混联机器人末端位姿误差检测补偿方法,其特征在于,该方法为:
在基坐标系下,标定激光测距仪发射端初始坐标、搅拌头主轴末端的初始坐标以及A、C轴初始角度;
设位于工件表面上的激光照射点为检测点,设激光测距仪测量值第一次出现峰值的时刻为T1,设T1时刻环形转动盘绕搅拌头主轴轴线转动的角度为α;设第一次峰值对应的检测点为A点,设激光测距仪测量值第二次出现峰值的时刻为T2,设T2时刻环形转动盘绕搅拌头主轴轴线转动的角度为β;设第二次峰值对应的检测点为B点;
读取T1至T2时间段的视觉定位***测得的搅拌头主轴末端在基坐标系下的实际坐标值,由搅拌头主轴末端与激光测距仪发射端两者初始时刻的相对坐标、环形转动盘的转速,计算得到T1至T2时间段的激光测距仪发射端在基坐标系下的实际坐标值;由激光测距仪在T1至T2时间段测得的其发射端到工件表面检测点的距离,进一步得到T1至T2时间段的检测点在基坐标系下的坐标;
以搅拌头末端为原点,焊缝方向为X轴,工件平面法向量为Z轴建立坐标系O2;令γ=α-β,由和γ,计算得到搅拌头主轴轴线在坐标系O2中的坐标,利用坐标系O2和基坐标系之间的坐标转换,计算得到搅拌头主轴轴线在基坐标系下的姿态角,姿态角包括主轴轴线绕基坐标系的X轴转动的转角及绕基坐标系的Y轴转动的转角;
设T1时刻搅拌头主轴垂直于工件表面,由T2时刻视觉定位***测得的搅拌头主轴末端在基坐标系下的坐标实际值以及搅拌头主轴轴线在基坐标系下的姿态角,根据五自由度混联机器人逆运动学方程,得到T2时刻第一至第三主动臂的轴向位移实际值及A、C轴转角实际值;由位姿指令得到对应T2时刻第一至第三主动臂的轴向位移给定值以及A、C轴转角给定值,进一步获得T2时刻第一至第三主动臂的轴向位移误差值以及A、C轴转角误差值;将得到的误差值作为补偿值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010590685.5A CN111745623B (zh) | 2020-06-24 | 2020-06-24 | 五自由度混联机器人末端位姿误差检测补偿***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010590685.5A CN111745623B (zh) | 2020-06-24 | 2020-06-24 | 五自由度混联机器人末端位姿误差检测补偿***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111745623A true CN111745623A (zh) | 2020-10-09 |
CN111745623B CN111745623B (zh) | 2021-11-23 |
Family
ID=72677158
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010590685.5A Active CN111745623B (zh) | 2020-06-24 | 2020-06-24 | 五自由度混联机器人末端位姿误差检测补偿***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111745623B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112819899A (zh) * | 2021-02-08 | 2021-05-18 | 燕山大学 | 基于混联机构的相机自动标定***及其相机自动标定方法 |
CN113547196A (zh) * | 2021-07-27 | 2021-10-26 | 天津大学 | 一种双侧搅拌摩擦焊接装备的主从镜像同步运动控制方法 |
CN113878581A (zh) * | 2021-10-28 | 2022-01-04 | 天津大学 | 一种五自由度混联机器人误差预测及实时补偿技术 |
CN114211140A (zh) * | 2021-11-26 | 2022-03-22 | 中国科学院西安光学精密机械研究所 | 一种激光双摆轴的光束指向调节方法 |
CN114235817A (zh) * | 2021-12-17 | 2022-03-25 | 南京苏胜天信息科技有限公司 | 一种基于机器视觉的物体表面缺陷检测装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN202555968U (zh) * | 2012-04-23 | 2012-11-28 | 无锡天野数控装备有限公司 | 厚板双轴肩搅拌摩擦焊主轴结构 |
CN102914262A (zh) * | 2012-09-29 | 2013-02-06 | 北京控制工程研究所 | 一种基于附加视距的非合作目标贴近测量方法 |
CN104570938A (zh) * | 2015-01-06 | 2015-04-29 | 常州先进制造技术研究所 | 一种插装生产中的双臂机器人***及其智能控制方法 |
CN105058376A (zh) * | 2015-08-17 | 2015-11-18 | 天津大学 | 一种具有三对称运动学性能的过约束高刚度机器人 |
CN106625573A (zh) * | 2016-10-25 | 2017-05-10 | 天津大学 | 一种五自由度混联机器人直接误差补偿技术 |
CN107351062A (zh) * | 2017-07-25 | 2017-11-17 | 天津大学 | 一种非对称过约束五自由度混联机器人 |
CN109648188A (zh) * | 2019-02-18 | 2019-04-19 | 安徽理工大学 | 混联式重载搅拌摩擦焊接机器人 |
-
2020
- 2020-06-24 CN CN202010590685.5A patent/CN111745623B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN202555968U (zh) * | 2012-04-23 | 2012-11-28 | 无锡天野数控装备有限公司 | 厚板双轴肩搅拌摩擦焊主轴结构 |
CN102914262A (zh) * | 2012-09-29 | 2013-02-06 | 北京控制工程研究所 | 一种基于附加视距的非合作目标贴近测量方法 |
CN104570938A (zh) * | 2015-01-06 | 2015-04-29 | 常州先进制造技术研究所 | 一种插装生产中的双臂机器人***及其智能控制方法 |
CN105058376A (zh) * | 2015-08-17 | 2015-11-18 | 天津大学 | 一种具有三对称运动学性能的过约束高刚度机器人 |
CN106625573A (zh) * | 2016-10-25 | 2017-05-10 | 天津大学 | 一种五自由度混联机器人直接误差补偿技术 |
CN107351062A (zh) * | 2017-07-25 | 2017-11-17 | 天津大学 | 一种非对称过约束五自由度混联机器人 |
CN109648188A (zh) * | 2019-02-18 | 2019-04-19 | 安徽理工大学 | 混联式重载搅拌摩擦焊接机器人 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112819899A (zh) * | 2021-02-08 | 2021-05-18 | 燕山大学 | 基于混联机构的相机自动标定***及其相机自动标定方法 |
CN112819899B (zh) * | 2021-02-08 | 2022-11-01 | 燕山大学 | 基于混联机构的相机自动标定***及其相机自动标定方法 |
CN113547196A (zh) * | 2021-07-27 | 2021-10-26 | 天津大学 | 一种双侧搅拌摩擦焊接装备的主从镜像同步运动控制方法 |
CN113878581A (zh) * | 2021-10-28 | 2022-01-04 | 天津大学 | 一种五自由度混联机器人误差预测及实时补偿技术 |
CN114211140A (zh) * | 2021-11-26 | 2022-03-22 | 中国科学院西安光学精密机械研究所 | 一种激光双摆轴的光束指向调节方法 |
CN114235817A (zh) * | 2021-12-17 | 2022-03-25 | 南京苏胜天信息科技有限公司 | 一种基于机器视觉的物体表面缺陷检测装置 |
CN114235817B (zh) * | 2021-12-17 | 2023-09-08 | 南京苏胜天信息科技有限公司 | 一种基于机器视觉的物体表面缺陷检测装置 |
Also Published As
Publication number | Publication date |
---|---|
CN111745623B (zh) | 2021-11-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111745623B (zh) | 五自由度混联机器人末端位姿误差检测补偿***及方法 | |
CN111331367B (zh) | 智能装配控制*** | |
CN109655024B (zh) | 采用空间变换技术的位移传感器外部参数标定方法 | |
US7503125B2 (en) | Coordinate measuring method and device | |
JP2015042437A (ja) | ロボットシステム及びロボットシステムの校正方法 | |
CN111665784B (zh) | 一种基于西门子***的空间定位误差补偿方法 | |
CN104354166B (zh) | 一种三自由度并联机器人的零点标定方法 | |
CN109968402B (zh) | 回程间隙测量方法及控制方法、装置、***和存储介质 | |
CN108890645A (zh) | 一种五自由度混联机器人驱动关节零点误差的补偿方法 | |
CN110253574A (zh) | 一种多任务机械臂位姿检测和误差补偿方法 | |
CN110370271B (zh) | 工业串联机器人的关节传动比误差校准方法 | |
CN101804470A (zh) | 翼身对接自动制孔***及方法 | |
CN112025722B (zh) | C型自动钻铆设备及工件法向测量和调整方法 | |
CN201744691U (zh) | 翼身对接自动制孔*** | |
CN113195176A (zh) | 制造***及方法 | |
CN114770517B (zh) | 通过点云获取装置对机器人进行标定的方法以及标定*** | |
JP5378908B2 (ja) | ロボットの精度調整方法およびロボット | |
CN113021017A (zh) | 随形自适应智能3d检测与加工*** | |
CN117506933A (zh) | 基于多测距传感器实时感知的机器人运动控制方法及应用 | |
CN1262817C (zh) | 六自由度机器人位姿检测装置 | |
CN113733155B (zh) | 六轴工业机器人标定装置和标定方法 | |
US20220161439A1 (en) | Information processing apparatus, information processing method, robot system, measurement system, method of manufacturing article with robot system, and recording medium | |
CN112518802A (zh) | 一种用于机器人刚度测量的高精度装置 | |
CN107650149B (zh) | 一种基于串联机械臂的接触与非接触融合测量***及方法 | |
CN111650882A (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 |