140CHS41010 工业机器人(后文统称机器人)已广泛应用于现代工业,随着机器人和自动化技术的发展,其高速运动时的准确性和稳定性日益成为检验机器人性能的重要指标,是机器人的运动控制系统必须考虑的因素。在高速运动的情况下,机器人的非线性控制特性十分明显,并且实际存在的各种复杂不确性因素也严重影响着机器人的控制精度。SCARA(SelectiveComplianceAssemblyRobotArm)机器人广泛应用于3C装配、抓取等对机器人的运动速度和精度要求更高的场合,因此对SCARA机器人进行优化控制方法研究,以实现高速高精度的控制目标具有重要的理论意义和实用价值[1-3]。
为了实现机器人的高速高精度运动控制,国内外的研究主要集中在以下几个方面:(1)智能控制方法,主要包括时间最优[4]、能量最优[5]、加加速度最优[6]等,以上智能寻优算法,主要是对某些特定的轨迹,根据机器人关节几何、速度和加速度等约束条件下,建立机器人运动时的关于时间、能量、加加速度等的目标函数表达式,采用智能寻优的方法计算最优解。(2)基于动力学模型的控制方法,通过机器人动力学参数辨识,得到机器人的逆动力学模型,这样,可以根据目标轨迹计算出目标轨迹各处的理论驱动力矩,再进行相应的动力学控制。
综合来看,智能控制方法因为计算时间周期的原因,容易造成机器人控制器内存资源的紧张,很难应用在复杂的工业环境和实时插补的场合;基于动力学模型的运动控制,需要先进行复杂的动力学参数辨识,对模型的精确度要求较高,且需要计算每个插补周期的理论驱动力矩值,计算量较大。
本文在实时开放式SCARA机器人控制平台上,根据SCARA机器人的特点,建立简化的关节惯性力模型;通过数据采集和处理,辨识出模型各系数的值;根据机器人基关节(关节一)电机的理论最大电流,自适应计算插补路径起点处的加速度和终点处的减速度。这样,在开始插补前,可以确定最大的机器人关节运动加减速度,最大程度地利用关节一电机的机械性能,提高机器人运行的速度和精度。实验结果表明该方法能较好地适用于SCARA机器人的高速高精度运动控制中。
140CHS41010 基于惯性力模型的SCARA机器人加速度自适应控制方法
2.1SCARA机器人惯性力建模
串联机器人的动力学方程可以表示为:
(1)
式(1)中,为各关节的驱动力矩,为惯性力项,为哥氏力和离心力项,为重力项。对于主要应用于平面抓取、码垛等领域的SCARA机器人,其高速运动时受力较大的主要是关节一。所以考虑关节一的动力学表达式时,可以忽略重力项的影响,而只考虑惯性力、哥氏力及离心力的作用。为了实现高速控制,一般将关节角加速度设置为角速度的10倍以上,这样造成惯性力的作用远大于离心力和哥氏力。
140CHS41010
Siemens S5 CPU 928 6ES5928-3UB11
Indramat AC-Motor , MAC063D-0-JS-4-C/095-B-0/W1517LV
SEW Eurodrive MOVIDYN MAS51A005-503-00
SEW Eurodrive MOVIDYN MKS51A010-503-04
SEW Eurodrive MOVIDYN MKS51AC05-503-50
Sick CLV621-0000 mit V3.11 Software / 1 041 784
PHOENIX IBS RT 24 D0 32-T / 27 52 75 4
REXROTH VT-HACD-2-11a/V0/1-0-0 / R900772951
PHOENIX IBS RT 24 DI 32-T / 27 52 74 1
PHOENIX IBS RT 24 D0 16-T / 27 53 64 3
PHOENIX Digital Modul IBS RT 24 DI0 8/8R-T 27 53 61 4
PHOENIX Digital Eingabemodul IBS RT 24 DI 32-T Interbus
PHOENIX Digital Modul IBS RT 24 DI0 16/16-T / 27 53 60 1
DANFOSS: VLT 131B3376 FC-301 FC-301P2K2T4E20H2XG 2,2kW 0-1000Hz
Trafo für UV-CURE-CONTOLLER DPM200
PHOENIX Digital Eingabemodul IBS RT 24 DI 32-T
Siemens Simatic S5 WF470 6FM1470-4AA21 Anzeigebaugruppe
Siemens TELEPERM M 6DS1300-8AB Vers. 9
OSAI A-B spa - OS5441 - CONTROL BOARD ENCODER 90105541 9327928L-QC
PHOENIX Digital Ausgabemodul IBS RT120/230 DO 16-T
PHOENIX Interbus S5 IBS S5 DSC / I-T
W?HRLE - Anzeige BETA BV3-240-06-0101 Version: A0
REXROTH VT 3017-S36 R1 11110009 223688/2
REXROTH VT 3017-37 #1 Mat.Nr. 00020302
OSAI A-B spa I/O Card / OS 5560 / 86001893D / 071103
PHOENIX IBS RT RFC 24 DI0 16/16-T
Bosch 2STV-RGC2 / 0811 405073 gebraucht
Bosch QV60-RGC1 / 0 811 405 104
Rexroth VT 3006-20 / 553066
Siemens 6DR5020-0NG00-0AA0 |