删除或更新信息,请邮件至freekaoyan#163.com(#换成@)

无传感器的工业机器人负载识别方法

本站小编 Free考研考试/2021-12-25

工业机器人在搬运[1, 2]、码垛[3, 4]等取放作业中应用越来越广泛.在取放操作过程中,拾取物体的变化导致末端负载的改变.不同的负载和不同的控制参数(如加速度、加加速度等)相匹配[5, 6].如果相应的控制参数不变,对诸如运动精度、速度等运动性能产生不利影响,甚至可能引起机械振动[7, 8].因此需要识别机器人末端负载.
机器人负载识别一般采用力或者力矩传感器的方法获得[9, 10, 11, 12, 13, 14, 15].在静止状态下,通过测量腕部的力和力矩直接获得机器人末端负载[11, 15];或者测量机器人关节力矩通过动力学变换获得负载[11, 12].在运动状态下,利用力或力矩传感器在动力学的基础上识别机器人负载[13, 14].Atkeson等[16]在机器人动力学的基础上利用力和力矩传感器对机器人进行了动态和静态的负载识别对比.基于机器人动力学模型,采用周期激励的方法识别工业机器人有效载荷[17].虽然上述研究都能识别机器人负载,但有些方法需附加额外的力或力矩传感器测得机器人的关节力或力矩,或者需要预先识别出机器人的动态模型参数,其成本高、效率低.
本文提出了一种基于伺服电机输出力矩,无传感器的工业机器人负载识别方法.通过对机器人连杆受力分析,得到电机转矩和负载之间的关系,建立负载与电机输出的模型,实现负载识别.
1 负载识别1.1 负载识别原理从机器人末端开始到基座,对工业机器人关节受力进行分析,获得作用在机器人每一个关节上的力和力矩,计算出平衡状态下各个关节所受的力和力矩,推导出关节力矩和末端负载之间的关系式.依据机械传动原理推导出关节力矩与电机输出转矩的关系.推导出电机的输出转矩与负载之间的数学关系式.机器人空载时和机器人带载时,分别读取机器人关节电机的输出转矩,利用差值计算出负载的质量,实现机器人末端负载的识别.机器人负载识别流程如图 1所示.
图 1 6R型工业机器人静态识别负载的流程图Fig. 1 Flow chart of static load recognition of 6R industrial robot
图选项


1.2 负载识别建模机器人的连杆为刚体,以6R机器人为例,按照D-H方法建模.连杆i及其相邻连杆之间的作用力与作用力矩的受力分析和平衡关系如图 2所示.其中i(i=1,2…,6)为杆件编号,Oi为连杆i的坐标系原点;Pi为连杆i的质心位置;Zi为坐标系Oiz轴;Gi为在坐标系Oi中连杆i的重力矢量;fi为连杆i-1施加在连杆i上的力矢量;Mi为在坐标系Oi中连杆i-1施加在连杆i上的力矩矢量;Oi+1为连杆i+1的坐标系原点;Zi+1为坐标系Oi+1中z轴;fi+1为在坐标系Oi+1中连杆i施加在连杆i+1上的作用力矢量;Mi+1为在坐标系Oi+1中连杆i施加在连杆i+1上的力矩矢量.
图 2 机器人单连杆的静力和静力矩平衡关系Fig. 2 Balance relationship between static and static torque of robots single link rod
图选项


当连杆i处于平衡状态时,连杆i所受的合力和合力矩为0,其力平衡方程为

式中:Rii+1为坐标系Oi+1在坐标系Oi中的姿态变换矩阵.
力矩平衡方程为

式中:Pi+1为连杆i+1的质心位置.
如果不考虑关节的摩擦,关节力和力矩除了驱动关节轴旋转的力矩分量外,其他分量用于保持机器人的本身机构的平衡.在连杆平衡状态下,关节i处的驱动力矩应该等于施加在连杆i上的力矩矢量和z轴单位矢量的点积,设τi为保持连杆i系统的静平衡所需的关节力矩,则有

设机器人末端负载为mg,末端受力和力矩均为0,各个杆件的质量和质心位置已知.将式(2)代入式(3)依次进行迭代计算,便可以得到各个连杆的关节驱动力矩为

式中:ki为关节驱动力矩τi中与机器人的末端所作用的负载mg有关项的系数项,是末端相对于连杆坐标系ix轴的位置分量,可以通过位姿矩阵求解得到;qiτi中与负载mg无关、与连杆mig有关项之和.
当工业机器人在某一位姿下空载时,根据式(4)可以得到机器人空载时关节i的驱动力矩τik

末端负载mg时,所处的位姿与空载时所处位姿相同的情况下,根据式(4)可得到机器人关节i的驱动力矩为

根据式(5)和式(6)可得关节i的驱动力矩在末端带载mg与空载时的差为

末端负载的质量m由式(7)可得

从式(8)可以看出,机器人末端负载的质量m与连杆的质量、质心等惯性参数无关.
机器人的关节由伺服电机驱动,设关节i处的电机输出转矩为τMi,电机的减速比为bi,传动效率为ηi,则关节i处的驱动力矩τi与伺服电机输出转矩τMi的关系为

因此机器人的末端负载的质量为

式(10)是末端负载的计算表达式.伺服电机的输出力矩直接从伺服驱动中读取,差值ΔτMi无需附加额外的传感器即可得到;减速比bi与传动效率ηi均为已知,可根据设备的型号获得.
2 试 验为了验证机器人负载识别算法,使用埃夫特机器人QH165进行试验,QH165机器人的最大负载是165 kg,关节采用松下的A5系列伺服.QH165的模型如图 3所示,D-H参数如表 1所示.
图 3 QH165机器人模型Fig. 3 QH165 robot model
图选项


表 1 机器人D-H参数Table 1 D-H parameters of robot
iαi-1/(°)ai-1/mmd/mmθi/(°)
10000
2-90a1(400)0-90
30a2(1 100)00
4-90a3(230)d4(1 134.56)0
590000
6-900d5(244)0

表选项


试验如图 4所示.机器人末端负载21 kg和70 kg.试验步骤如下:
1) 在机器人的工作空间内随机示教10个测量点.在空载的情况下,操作机器人运行到测量点并保持静止,记录测量点处机器人各个关节轴的角度和电机输出转矩τik.
2) 在机器人末端附加已知的负载,再次操作机器人运行到测量点处并保持静止,记录测量.
3) 点处机器人各个关节的角度和电机输出转矩τiz.
4) 根据两次记录的测量数据求差值,得到关节i的输出转矩差值Δτi.将ki、Δτi、减速比bi和传动效率为ηi代入式(10),求出负载质量m.
图 4 负载识别试验Fig. 4 Load identification experiment
图选项


采用A5自带的测量电机转矩的软件,如图 5所示,读取负载率,乘额定转矩即可得电机输出力矩.
图 5 测量软件Fig. 5 Measurement software
图选项


以关节2为例,关节电机采用松下A5的MHMA50ZS1H,额定输出功率为5 kW,额定转速2 000 r/min,额定转矩为23.875 nm.传动效率为80%,减速比为210.
测量各轴的移动量和2轴空载和带载时的转矩,如表 2所示.采用两组负载数据:一般负载,载荷a为21 kg;重载,载荷b为70 kg,如表 2所示.将各个轴的移动量代入位姿变换矩阵,求得末端点相对于坐标系O2x2y2z2x2轴的位置矢量,即系数k2,如表 2所示.
表 2 机器人测量的数据Table 2 Measurement data of robot
测量点关节轴角度/(°)2轴的扭矩/nmk2/m
1轴2轴3轴4轴5轴6轴空载载荷a载荷b
10.761-121.14841.9450.96671.267151.9627.748.5613.790.66
20.761-101.92615.290-3.35168.260151.9674.827.1127.321.87
30.760-86.4022.368-6.39266.143151.9717.027.8313.220.66
40.760-65.483-12.672-8.70164.535151.9735.066.8818.381.48
5-31.383-88.12313.952-8.70164.535151.9736.647.8314.680.97
613.304-58.548-5.696-1.69354.455171.9334.117.3727.732.66
721.048-52.572-7.670-1.63534.055171.9332.876.1625.072.69
824.985-41.338-32.679-1.63539.106171.9380.243.8230.242.92
927.400-34.445-48.024-1.63642.206171.9422.391.624.49-0.62
1029.929-27.228-64.089-1.63645.451171.9455.402.9127.61-2.03

表选项


由表 2的数据采用式(10)计算出负载的质量,如表 3和图 6所示.识别的负载与实际的负载相差较小.但是由于在计算的时候不考虑摩擦力和关节变形导致误差存在.负载越大摩擦力和关节变形越大,导致的误差越大.测量21 kg负载相对误差为0.002%,而70 kg负载的相对误差为 0.003 9%.
表 3 机器人识别负载结果Table 3 Results of robot identification load
测量点实际负载/kg识别负载/kg相对误差/%
载荷a载荷b载荷a载荷b载荷a载荷b
1217020.9968.210.047 62.551 7
2217021.2071.790.952 42.557 1
3217021.0971.310.428 61.871 4
4217020.7769.141.095 21.228 6
5217020.6868.781.523 81.742 9
6217021.5671.552.666 72.214 3
7217020.8768.770.619 01.757 1
8217020.9269.380.381 00.885 7
9217021.0069.9700.042 9
10217021.3471.371.619 01.957 1
平均值217021.04270.0270.002 00.003 9

表选项


图 6 试验数据与实际数据对比分析图Fig. 6 Analysis diagram of comparison between
experimental data and the actual data
图选项


3 结 论本文提出了一种机器人静态识别负载的方法:
1) 采用该方法识别负载时,利用伺服电机的输出力矩,无需额外的传感器,节约了成本,简单易行.
2) 在埃夫特机器人QH165上进行了试验验证,实际负载与测得的负载相对误差小.
3) 由于忽略了关节摩擦和关节变形,导致误差.试验结果验证了该负载识别方法的正确性及可行性.
参考文献
[1] Ko C M, Chung G J, Kin D H.Designing of heavy duty handling robot (HEDURI-I robot design)[C]//Proceedings of the 2009 IEEE International Conference on Mechatronics.Piscataway, NJ:IEEE Press, 2009:1-6.
Click to display the text
[2] Feng Y L, Qu D K, Xu F, et al.Analysis and compensation for the dynamic error of the FPD glass substrates transfer robot[C]//IEEE International Conference on Robotics and Automation.Piscataway, NJ:IEEE Press, 2011:1-3.
Click to display the text
[3] Lu D M, Zhang C Q, Fan Y Z, et al.The kinematic self-calibration method and simulation of one palletizing robot[C]//Proceedings of the 8th World Congress on Intelligent Control and Automation.Piscataway, NJ:IEEE Press, 2010:6424-6427.
Click to display the text
[4] Guang X Q, Wang J D.Mechanical design and kinematic analysis of a new kind of palletizing robot[C]//Mechanic Automation and Control Engineering.Piscataway, NJ:IEEE Press, 2011:199-202.
Click to display the text
[5] Tsumugiwa T, Watanabe Y, Yokogawa R.Robot motion control using mechanical load adjuster with motion measurement interface for human-robot cooperation[C]//Intelligent robots and systems.Piscataway, NJ:IEEE Press, 2009:467-472.
Click to display the text
[6] Song Y F, Wang H G, Gao W B, et al.Dynamic deformation analysis of a spot welding robot under high speed and heavy load working condition[C]//IEEE International Conference on Robotics and Biomimetics.Piscataway, NJ:IEEE Press, 2013:2043-2048.
Click to display the text
[7] Seki K, Nakamura H, Iwasaki M, et al.Suppression of resonant vibration due to angular transmission errors of reduction gearing in industrial robots[C]//IEEE International Conference on Mechatronics (ICM).Piscataway, NJ:IEEE Press, 2013:835-840.
Click to display the text
[8] Huang L S, Qu D K, Xu F.Motion control strategy of industrial direct drive robot for vibration suppression[C]//Intelligent Control and Automation.Piscataway, NJ:IEEE Press, 2010:2430-2433.
Click to display the text
[9] Hamon P, Gautier M, Garrec P, et al.Dynamic identification of robot with a load-dependent joint friction model[C]//Robotics Automation and Mechatronics.Piscataway, NJ:IEEE Press, 2010:129-135.
Click to display the text
[10] Hamon P, Gautier M, Garrec P.Dynamic identification of robots with a dry friction model depending on load and velocity[C]//Intelligent Robots and Systems.Piscataway, NJ:IEEE Press, 2010:6187-6193.
Click to display the text
[11] Paul R P.Robot manipulators:Mathematics, programming, and control[M].Cambridge:MIT Press, 1981:157-195.
Click to display the text
[12] Coiffet P.Robot technology:Interaction with the environment[M].2nd ed.Englewood Cliffs:Prentice-Hall, 1983:102-128.
Click to display the text
[13] Amitabha M.Adaptation in biological sensory-motor systems:A model for robotic control[C]//Intelligent Robots and Computer Vision.Bellingham, WA:SPIE, 1984, 521:243-247.
Click to display the text
[14] Amitabha M, Ballard D H.Self-calibration in robot manipulators[C]//Robotics and Automation.Piscataway, NJ:IEEE Press, 1985:1050-1057.
Click to display the text
[15] Olsen H B, Bekey G A.Identification of parameters in models of robots with rotary joints[C]//Robotics and Automation.Piscataway, NJ:IEEE Press, 1985:1045-1050.
Click to display the text
[16] Atkeson C G, An C H, Hollerbach J M.Estimation of inertial parameters of manipulator loads and links[J].International Journal of Robotics Research, 1986, 5(3):101-119.
Click to display the text
[17] Swevers J, Verdonck W, de Schutter J.Dynamic model identification for industrial robots[J].IEEE Control Systems Magazine, 2007, 27(5):58-71.
Click to display the text


相关话题/测量 电机 质量 传感器 工业

  • 领限时大额优惠券,享本站正版考研考试资料!
    大额优惠券
    优惠券领取后72小时内有效,10万种最新考研考试考证类电子打印资料任你选。涵盖全国500余所院校考研专业课、200多种职业资格考试、1100多种经典教材,产品类型包含电子书、题库、全套资料以及视频,无论您是考研复习、考证刷题,还是考前冲刺等,不同类型的产品可满足您学习上的不同需求。 ...
    本站小编 Free壹佰分学习网 2022-09-19
  • 无轴承异步电机无径向位置传感器控制
    异步电机因具有结构简单、成本低、气隙均匀等优点得到了广泛应用[1,2,3],但是其所使用的机械轴承不可避免地存在润滑、磨损等问题,这将导致电机气隙不均匀、绕组发热、温升增加,从而带来一系列的影响,比如工作效率下降、使用寿命缩减等[4].“无轴承电机”的出现改变了传统电机转子的支撑方式,开创了电机应用 ...
    本站小编 Free考研考试 2021-12-25
  • 数字化组合测量辅助飞机装配质量检测技术
    ?大型飞机壁板类组件广泛应用于飞机的外形及结构中,大型飞机蒙皮壁板具有尺寸大、外形复杂和结构刚性差等特点,制造过程中经常采用拉伸成形(简称拉形)工艺,对零件外形尺寸准确度和表面完整性等技术指标要求严格[1,2].目前,飞机壁板类组件成形质量检测手段已经由传统几何模拟量测量方式向数字化测量方式转变.文 ...
    本站小编 Free考研考试 2021-12-25
  • 压力传感器激波管校准条件下的动态参数估计
    ?压力传感器广泛应用于航空、航天和武器装备等领域[1].例如,为了评估某新型战斗部动爆冲击波的超压毁伤效应,在进行导弹撬动发射实验时,常在靶标上分布式布置压力传感器用以动态测量动爆冲击波的超压数据[1,2].这类冲击波的速度高、信号频带宽(有效带宽可达100kHz)、信号上升快(一般在几微秒内),且 ...
    本站小编 Free考研考试 2021-12-25
  • 红外窗口材料的热辐射特性测量方法
    ?飞行器在大气层内超声速飞行时,红外(Infrared,IR)探测系统面临复杂的气动光学效应,使红外探测系统的性能下降[1,2].高温绕流气体流场强烈的气动加热使红外窗口的温度迅速上升,高温红外窗口和高温气体产生强烈的气动热辐射,不仅使目标探测信噪比降低,还形成强烈的背景辐射,极易导致红外探测器饱和 ...
    本站小编 Free考研考试 2021-12-25
  • 时变热辐射环境下高温合金蜂窝板三维热变形测量
    高温合金蜂窝板结构由较薄的高强度合金蒙皮和较厚的低强度蜂窝芯层焊接或黏接组成三明治结构,因其具有重量轻、强度高、高温环境下抗变形能力强、导热系数小等优点使之成为高速飞行器理想的隔热结构,已广泛应用于火箭、导弹、飞机等高速飞行器的热防护结构材料[1,2].20世纪40年代德国最早将蜂窝板结构应用于四引 ...
    本站小编 Free考研考试 2021-12-25
  • 电缆长度辅助的光纤陀螺测斜仪组合测量方法
    在石油行业,精确的油气井井眼轨迹姿态(方位角、倾斜角及工具面角)和位置(经度、纬度及高度)信息对于油气田开发具有重要意义.近年来随着大斜度井、定向井、丛式井及水平井等复杂油气井的增多,对油气井轨迹参数测量计算提出了更高要求.目前常用到的井眼轨迹测量仪器主要有磁通门测斜仪和动调陀螺测斜仪.磁通门测斜仪 ...
    本站小编 Free考研考试 2021-12-25
  • 基于光学微腔模式劈裂的角速率测量方法
    回音壁式光学微腔具有低模式体积、高品质因数和可集成的特点,在基础物理及应用领域得到了广泛关注[1,2].微腔内可同时存在一对频率上简并的行波模,分别沿顺时针(ClockWise,CW)及逆时针(Counter-ClockWise,CCW)方向传播.亚波长散射源会引发该简并模互相耦合,2个腔模借助散射 ...
    本站小编 Free考研考试 2021-12-25
  • 压力传感器动态校准不确定度评定
    压力传感器广泛应用于航空航天运载系统、战术导弹、遥感测量、火炮装备及船舶制造等领域[1,2];实际工程中的许多物理量,如液位、流量、飞行速度和飞行高度等,也可以通过压力传感器来间接测量[3].使用压力传感器实时、可靠地跟踪被测信号的变化、获得准确的测量结果,这就要求开展动态校准、准确掌握传感器动态参 ...
    本站小编 Free考研考试 2021-12-25
  • iGPS测量不确定度空间分布分析方法
    iGPS是一种新型数字化大尺寸空间测量设备,相较于其他数字化测量设备,它凭借其大尺寸测量精度高、测量实时性好、可同时多点测量、无光路遮挡失效问题、扩展方便等优势[1,2],已逐渐在航空航天制造领域得以应用,如美国波音公司将iGPS应用于747,777与787等型号飞机的总装对接中[2,3],加拿大庞 ...
    本站小编 Free考研考试 2021-12-25
  • 用于测量机翼形变的分布式惯性导航算法研究
    用于测量机翼形变的分布式惯性导航算法研究张华强1,刘林1,秦昌礼1,陈雨2,苏庆华31.山东理工大学园机械工程学院2.北京航天发射技术研究所3.北京物资学院收稿日期:2021-04-01修回日期:2021-06-08出版日期:2021-12-28发布日期:2021-11-16通讯作者:张华强E-ma ...
    本站小编 Free考研考试 2021-12-25