具有谐波减速器的机器人关节建模与动力学参数辨识

张一楠, 丁建完

张一楠, 丁建完. 具有谐波减速器的机器人关节建模与动力学参数辨识[J]. 信息与控制, 2023, 52(3): 292-301. DOI: 10.13976/j.cnki.xk.2023.2100
引用本文: 张一楠, 丁建完. 具有谐波减速器的机器人关节建模与动力学参数辨识[J]. 信息与控制, 2023, 52(3): 292-301. DOI: 10.13976/j.cnki.xk.2023.2100
ZHANG Yinan, DING Jianwan. Modelling and Dynamics Parameter Identification of Robot Joints with Harmonic Reducers[J]. INFORMATION AND CONTROL, 2023, 52(3): 292-301. DOI: 10.13976/j.cnki.xk.2023.2100
Citation: ZHANG Yinan, DING Jianwan. Modelling and Dynamics Parameter Identification of Robot Joints with Harmonic Reducers[J]. INFORMATION AND CONTROL, 2023, 52(3): 292-301. DOI: 10.13976/j.cnki.xk.2023.2100
张一楠, 丁建完. 具有谐波减速器的机器人关节建模与动力学参数辨识[J]. 信息与控制, 2023, 52(3): 292-301. CSTR: 32166.14.xk.2023.2100
引用本文: 张一楠, 丁建完. 具有谐波减速器的机器人关节建模与动力学参数辨识[J]. 信息与控制, 2023, 52(3): 292-301. CSTR: 32166.14.xk.2023.2100
ZHANG Yinan, DING Jianwan. Modelling and Dynamics Parameter Identification of Robot Joints with Harmonic Reducers[J]. INFORMATION AND CONTROL, 2023, 52(3): 292-301. CSTR: 32166.14.xk.2023.2100
Citation: ZHANG Yinan, DING Jianwan. Modelling and Dynamics Parameter Identification of Robot Joints with Harmonic Reducers[J]. INFORMATION AND CONTROL, 2023, 52(3): 292-301. CSTR: 32166.14.xk.2023.2100

具有谐波减速器的机器人关节建模与动力学参数辨识

基金项目: 

国家重点研发计划 2019YFB1706501

详细信息
    作者简介:

    张一楠(1996-),男,硕士生。研究领域为机器人参数辨识,机器人动力学建模

    丁建完(1975-),男,博士,副教授。研究领域为多领域建模仿真

    通讯作者:

    张一楠,1114801159@qq.com

  • 中图分类号: TP242

Modelling and Dynamics Parameter Identification of Robot Joints with Harmonic Reducers

  • 摘要:

    针对串联机器人,提出了一种改进的机器人关节模型,并采用该模型开展了机器人动力学建模与辨识工作。建立了机器人动力学模型,对机器人关节结构进行分析,改进了关节模型,并通过谐波减速器的输入力矩近似估计其摩擦力矩。选取傅里叶级数为激励轨迹并优化其参数,通过控制关节按照所得轨迹运动,采集并处理相关数据,并基于加权最小二乘法分别辨识机器人关节模型参数与连杆动力学参数。通过关节预测力矩对所得参数进行验证,结果表明,基于改进关节模型的机器人动力学模型精度得到明显提升。

    Abstract:

    In this study, we propose an improved robot joint model to carry out robot dynamics modeling and identification work. For this, we establish a robot dynamic model, analyze the joint structure of the robot, improve the joint model, and then use the input torque of a harmonic reducer to approximately estimate friction torque. We select the Fourier series as the excitation trajectory and optimize its parameters. Relevant data are collected and processed by controlling the movement of joints according to the obtained trajectory. We then identify and link the robot joint model parameters based on the weighted least squares method. The obtained parameters are verified using the joint predicted torque. Our experimental results show that the robot dynamics model based on the improved joint model has significantly improved accuracy.

  • 在基于模型的机器人控制研究中,精确的逆动力学模型是必不可少的。因此需要对实际机器人开展动力学参数辨识工作,得到较为准确的参数,从而得到对应轨迹下的电机输出力矩。

    关于机器人动力学参数的获取,目前主要的途径有:直接测量法[1]、CAD计算法[2]、实验辨识法[3]。其中,实验辨识法是指通过辨识实验获得所需参数,该方法被广泛应用[4-5]。实验流程主要为:线性化动力学建模,优化激励轨迹,采集处理所需数据,参数估计与验证[6]

    机器人的关节模型是动力学建模中的重要部分。以往的众多研究成果中,在关节建模上方法疏于探索,常采用库伦- 黏滞摩擦模型或Stribeck摩擦模型来代表关节整体的摩擦[7-9]。但对于协作机器人而言,其关节模组中采用了紧凑的谐波减速器,该减速器能够保证较高的传动精度,并且可以实现更小的体积及更大的传动比。但同时也具有较为复杂的摩擦来源以及关节柔性等问题[10]。对于采用了谐波减速器的机器人关节,上述研究中的方法并不能准确反映关节内部的摩擦。需要对机器人的关节结构进行细分,以考虑谐波减速器等组件对动力学模型的贡献。

    因此,对于以协作机器人为代表的串联机器人而言,需要建立其关节模型,以提高整体模型精度。Kircanski等[11]对关节摩擦与关节刚度开展了辨识工作。张奇等[12]对安装谐波减速器的机器人关节摩擦及刚度等开展了辨识研究。但上述研究只探究了关节转速对关节整体摩擦的作用,没有从谐波减速器本身原理出发对其摩擦展开研究。

    有研究指出,谐波减速器摩擦的组成为:传动过程中的啮合摩擦、波发生器的滚动摩擦、滚动轴承摩擦、润滑液搅动等[13]。针对谐波减速器的摩擦现象,Tuttle[14]、Gandhi[15]、石崟[16]等进行了相关研究,并提出相应的摩擦模型。但上述摩擦模型形式较为复杂,参数较多,难以应用在机器人整体的动力学参数辨识研究中。

    因此,有必要从谐波减速器的原理出发,得到更为简洁的摩擦力矩理论模型,从而建立更为精准的机器人关节模型,以进一步提高参数辨识的精度。

    根据相关原理,可将n自由度机器人动力学方程表示为基于最小惯性参数的线性形式[17-18]

    (1)

    其中,τl为各连杆输出力矩,ql为各关节位置;为最小惯性参数对应观测矩阵,为各连杆最小惯性参数。

    但在实际运行中,若要得到关节电机的输出力矩,还需要考虑关节摩擦力矩的作用。

    在一些参数辨识研究中,通常对机器人关节进行简化,便于开展研究。

    图 1为关节i的简化模型,其中,分别为电机端和连杆端角速度,τqiτli分别为电机力矩和连杆输出力矩,τfi为关节摩擦力矩在连杆一侧的等效力矩,ηi为减速比。基于图 1所述的关节模型可得:

    (2)
    图  1  机器人简化关节模型
    Fig. 1.  Simplified robot joint model

    其中,τqτl均为各关节对应变量所组成的n×1维的列向量;η为各关节减速比所组成的对角矩阵,即η=diag(η1η2,…,ηn)。对于摩擦力矩τf,通常选用可线性化表示的库伦- 黏滞摩擦:

    (3)

    其中,fcfv均为对角矩阵,分别表示机器人n个关节的库伦-黏滞摩擦参数。

    综合式(1)~(3),可得基于图 1所示关节模型的动力学方程:

    (4)

    其中,,为机器人最小惯性参数和摩擦参数;,为对应观测矩阵。

    协作机器人的关节模组主要包括电机、谐波减速器、位置编码器、力矩传感器等组件。其中谐波减速器结构复杂,包含波发生器、柔轮及刚轮等多个组件。在关节运转时,除电机转子与连杆转动存在相应摩擦外,减速器传动过程中的啮合摩擦以及波发生器滚动摩擦也是关节摩擦的重要来源。

    图 2为采用谐波减速器的单个关节结构简图[12]。其中可按照关节结构将关节模型拆分为3个部分:伺服电机端、谐波减速器、连杆端。其中Jmi为电机转子和波发生器的转动惯量,下文统称为转动惯量;τmiτri分别为电机输出力矩和减速器输出力矩,其中τmi为1.1节中的τqiτmfiτmfi分别为电机转子和连杆转动时的摩擦力矩;τrfi为谐波减速器结构摩擦在靠近连杆一侧的等效力矩;KfiKti分别为谐波减速器与力矩传感器的刚度系数,统称为Ki

    图  2  改进的机器人关节模型
    Fig. 2.  Improved robot joint model

    力矩传感器测量力矩为τri,包含了连杆输出力矩τli和连杆转动摩擦力矩τlfi。对于机器人整体,改进关节模型可如式(5)所示:

    (5)

    其中,τmτmfτlfτrτ′rτrf均由各关节相应的变量所组成,均为n×1维列向量;Jm为各关节转动惯量所成的对角矩阵,即Jm=diag(Jm1Jm2,…,Jmn)。对于摩擦力矩τmfτlf,则可通过式(3)所示的库伦- 黏滞摩擦模型来进行建模。

    对于谐波减速器中的摩擦力矩τrf,文[19]研究表明,当谐波减速器工作时,其内部摩擦主要来源于减速器工作过程中的啮合摩擦与滚动摩擦。其摩擦力矩τrf与输入力矩τ′r满足:

    (6)

    其中,ξgf=diag(ξgf1ξgf2,…,ξgfn)为各关节啮合摩擦系数所成对角矩阵;ξsf=diag(ξsf1ξsf2,…,ξsfn)为各关节滚动摩擦系数所成对角矩阵。对于单个关节i而言,其减速器摩擦系数可表示为

    (7)

    其中,kmα分别为当前谐波齿轮的等效变形系数、模数和齿面角;R0Dd分别为减速器等速曲线曲率半径、未形变时柔轮直径和波发生器滚子直径;μμr则分别为齿面的摩擦系数与滚动摩擦系数。

    由式(7)可知,当关节i的谐波减速器的结构确定时,其摩擦系数ξgfiξsfi是唯一确定的,因此可以认为减速器的摩擦力矩τrf与输入力矩τ′r之间近似满足关系:

    (8)

    基于式(8),可通过减速器摩擦系数来估计其摩擦力矩。该方法参数相对更少,表达形式更为简洁,更适用于参数辨识的整体工作中。

    作为参数辨识工作中的关键部分,激励轨迹的选择至关重要。SWEVERS[20]提出采用多阶傅里叶级数作为关节的激励轨迹,具有良好的效果。因此,在本次研究选择上述方案作为关节轨迹。对于关节i而言,其关节位置可表示为

    (9)

    其中,aikbik分别为正弦、余弦函数的幅值;ω为函数基频;qi0为初始位置的补偿量。本次研究取i=5,即关节轨迹为5阶傅里叶级数。

    为减小辨识理论误差,需优化上述轨迹中的参数。目前广泛以观测矩阵条件数即cond(W)为优化目标,通过减小观测矩阵的条件数来减轻噪声对辨识精度的影响[21]。关节激励轨迹的优化本质上是一个非线性优化过程,本文通过Matlab中fmincon函数对上述问题开展优化,以得到理论激励轨迹。

    通过控制器中的PID控制模块控制机器人关节,以使各关节按照理论轨迹中的位置运动。

    在本研究中,为进一步开展辨识,需要对机器人连杆端位置ql、减速器输出力矩τr、电机等效输出力矩τ′m(τ′q)等参数进行采集。

    由于关节内置力矩传感器,因此力矩τr可通过传感器直接测得。而电机等效输出力矩τ′m则需要借助采集伺服电机的工作电流来得到。电机的工作电流与其输出力矩近似成线性关系,对关节i而言:

    (10)

    其中,ηi为关节减速比,在本研究中机器人各关节减速器的减速比为101;βi是电机的扭矩常数,其中关节1、关节2为0.124 N·m/A,关节3~关节6为0.096 N·m/A。

    受数据采集过程中的噪声影响,实际所得数据存在较多的“毛刺”,需进行相关数据的处理工作。为了去除力矩τrτ′m中的“毛刺”,可选择五点三次法进行平滑[22],以降低噪声对数据的影响。

    对于连杆端、实际输出角度,可通过关节内部连杆端的编码器采集。考虑到机器人实际跟踪精度可能存在的不足,因此选择对关节角度先差分计算后低通滤波降噪的方式获取连杆实际角速度与角加速度

    采集激励轨迹中各时刻对应的关节运动状态,进而可计算对应轨迹下的观测矩阵[18],即

    在得到关节连杆端运动参数ql后,可基于式(5),由τl对减速器输入端即电机端的运动参数进行表示:

    (11)

    以文[7-9]中的研究为例,在许多机器人参数辨识研究中,均采用了相似的辨识思路。即基于1.1节中的模型来对关节进行建模,并通过加权最小二乘法来辨识所需参数。为了评估本文所提出的改进方法的效果,可按照上述传统思路开展辨识,得到相应动力学参数作为对照。

    采用统一辨识的方法对机器人整体的参数开展辨识。在运行激励轨迹中,共在N个时间点上采集各个关节电机输出力矩和关节端实际输出角度,由式(4)可知:

    (12)

    其中,Tq为各时刻对应的电机等效输出力矩,即Tq=[τ′q(t1),τ′q(t2),…,τ′q(tN)]T为各时刻对应的观测矩阵所组成的组合矩阵,以下可简称为W。通过加权最小二乘法,可基于式(13)得到动力学参数

    (13)

    其中,为测量力矩Tq测量方差所成的对角矩阵[23],称其为权重矩阵。辨识流程如图 3所示。

    图  3  基于简化关节模型的辨识流程
    Fig. 3.  Identification process based on the simplified joint model

    图 3所示,控制器将控制命令下发给伺服驱动,进而使各关节根据理论轨迹来运动。在完成数据采集及数据处理工作后,可得到激励轨迹下各个关节的力矩Tq与对应矩阵W,进而对动力学参数进行辨识。

    在对机器人运行数据进行采集和处理后,可得到所对应的qlτrτ′m。从而进行参数辨识实验,辨识步骤为:

    1) 连杆参数辨识

    图 2所示关节结构可知,关节力矩传感器所测量力矩τr包含了τlτf,由式(1)可知,τl为连杆输出力矩。τlf为连杆所受摩擦力矩,可通过式(3) 所示的库伦- 黏滞摩擦模型来建模。因此可采用与2.3.1节中相同的方法对改进模型连杆端的动力学参数进行辨识:

    (14)

    其中,Τr为各时刻力矩传感器测量数值,Τr=[τr(t1),τr(t2),…,τr(tN)]Tpr为所需辨识的参数,主要包括连杆的最小惯性参数pb和及相应的摩擦参数flcflv,即pr=[pbflcflv]T

    通过加权最小二乘法(WLS)辨识连杆参数pr

    (15)

    其中,为反映测量力矩Tr误差的对角矩阵。

    2) 关节模型参数辨识

    为完成机器人完整模型的参数辨识,在辨识度得到连杆参数pr后,需进一步对关节模型的参数开展辨识工作。由式(5)可知,采集电机输出力矩τm和力矩传感器力矩τr,通过二者之差可得:

    (16)

    由式(6)可知,减速器摩擦力矩τrf与其输入力矩τ′r为线性关系。考虑到无法对τ′r直接测量,由式(5) 可知,忽略Jmτmf,用电机输出力矩τ′m作为替代。综合式(3)、式(8)、式(11)后可得:

    (17)

    其中,fmcfvc分别为各关节库伦- 黏滞摩擦参数组合而成的对角矩阵,fmc=diag(fmc1fmc2,…,fmcn),fvc=diag(fvc1fvc2,…,fvcn);τ′m可通过采集处理获得,其余则为待辨识参数。

    为简化上述模型的辨识过程,提高参数辨识的效率,可对式(17)中的参数进行合并整理。合并后的各参数分别为

    (18)

    经过对参数的整理,可将式(17)的形式转换为

    (19)

    基于式(19),在轨迹运行中的N个时刻采集数据后可得:

    (20)

    其中,ΔT=[Δτ(t1),Δτ(t1),…,Δτ(tN)]T为各时刻力矩差Δτ所组成向量;Tm=[τ′m(t1),τ′m(t1),…,τ′m(tN)]T为各时刻τ′m所组成的向量;为各时刻所组成的向量;表示各时刻所成向量;Ai=diag(ai,…,ai)∈ 为总的关节系数矩阵。

    基于上述得到的式(20),可对各个关节模型的参数开展辨识工作,具体的流程如图 4所示。

    图  4  关节模型辨识流程
    Fig. 4.  Identification process of the joint model

    在完成参数辨识工作后,需要对参数的精度进行评估验证。值得注意的是,参数辨识本身的意义是在给定任意轨迹下,都可基于所辨识参数得到电机输出力矩τ′m预测值,进而得到关节电机的控制电流。

    1) 基于WLS法与简化关节模型的参数验证

    对于基于简化模型辨识的参数而言,可根据理论运动参数得到验证轨迹对应的理论观测矩阵,从而基于式(12)计算关节预测力矩:

    (21)

    在计算电机输出力矩预测向量Tpre后,可通过计算预测值与实测力矩Tq间的均方差(RMS)对其进行评估:

    (22)

    2) 基WLS法与改进关节模型的参数验证

    在辨识连杆参数时,其方法步骤与简化关节模型中的相同,参数验证方法也相同。因此,可由式(14)计算连杆端预测力矩向量Trp

    (23)

    为了获得改进模型的电机输出力矩预测值Tmp,需要预测力矩损耗ΔTpTrp相加。但ΔTp的计算却需要事先获得电机输出力矩Tm。为此,可以采用基于简化关节模型的辨识结果对Tm进行预测,即用Tpre来替代Tm

    (24)

    虽然该方法会引入Tpre的误差,但相对于简化模型的辨识结果,精度依然有所提升。图 5为所得参数的验证过程。

    图  5  参数验证流程
    Fig. 5.  Parameter verification process

    图 6为实验所需的6轴协作型串联机器人,其D-H坐标如图 7所示。

    图  6  6轴串联机器人
    Fig. 6.  Six-axis serial robot
    图  7  机器人D-H坐标系
    Fig. 7.  D-H coordinate system of robot

    该机器人的关节结构与1.2节中所述模型相同,主要为位置编码器、谐波减速器、驱动器、伺服电机等。控制系统与机器人之间通过Ether CAT总线进行通信,控制信号发送间隔为1 ms,信号采集间隔为10 ms。如表 1所示为D-H坐标参数,表中参数θi对应如图 7所示的机器人俯卧状态。

    表  1  机器人D-H参数
    Tab. 1.  D-H parameters of robot
    i αi-1/(°) ai-1/mm di-1/mm θi/(°)
    1 0 0 122.3 0
    2 90 0 0 0
    3 0 -270 0 0
    4 0 -253 123.3 0
    5 90 0 107.1 0
    6 -90 0 99.1 0
    下载: 导出CSV 
    | 显示表格

    令激励轨迹的基频为0.1π,轨迹周期为20 s,以cond(W)为优化指标,对傅里叶级数中的若干参数开展优化。可采用Matlab中用于求解非线性函数最值的fmincon函数进行优化,得到相应参数。所得各关节激励轨迹如图 8所示。

    图  8  机器人激励轨迹
    Fig. 8.  Robot excitation trajectory

    图 8中的关节位置对应了D-H坐标系中的角度θi,其中关节2、关节4的始末位置为-90°,此时机器人运动过程中的始末状态对应了图 6中的直立姿态。

    控制器通过其PID控制模块,生成相应控制命令,驱动机器人关节运动。同时采集所需数据并进行处理,其中电机端输出力矩和连杆传感器力矩信号进行5点3次平滑处理,取单个关节力矩的处理次数为20次。通过Matlab中的Butterworth滤波函数,对差分后所得的角速度与角加速度低通滤波处理,以减少差分处理造成的噪声影响。

    在对数据进行采集和处理后,按照图 3图 4的步骤分别对参数pr和{a1a2a3a4a5}进行辨识。其中关节模型的参数如表 2所示。

    表  2  关节模型参数
    Tab. 2.  Model parameters of the joints
    i a1i a2i a3i a4i a5i
    1 0.402 1.578 2.937 0.515 0.014
    2 0.804 1.139 7.870 0.477 0.009
    3 0.464 0.822 3.047 0.638 0.029
    4 0.266 0.925 2.721 0.534 0.033
    5 0.603 1.916 3.690 0.123 -0.034
    6 0.282 0.795 2.689 0.614 -0.076
    下载: 导出CSV 
    | 显示表格

    表 2中,关节5、关节6的参数a55a56(即K-1)为负。这是由于关节5、关节6的负载小,关节发生的弹性形变很小,可以基本视作刚体,因此a55a56数值较小。当采用最小二乘拟合时,为了最小化整体误差,会造成上述较小的参数存在负数的情况。因此本实验中,关节5、关节6的等效刚度难以准确辨识。但本文目的是对电机输出力矩进行预测,该参数对力矩的作用很小,因此可忽略其影响。

    分别基于式(21)、式(23)、式(20)计算激励轨迹下预测力矩向量TpreTrp、ΔTp,进而得到Tmp。基于式(22),可计算基于简化模型的预测力矩Tpre和基于改进模型的预测力矩Tmp与实测力矩Tm(即Tq)间的均方差(RMS),分别为1.685 9 N·m和0.681 5 N·m。对于激励轨迹下的关节力矩,基于改进模型的预测精度相对于简化模型提高了59.58%。

    TpreTmpTm进行整理,可得各关节对应力矩,如图 9所示。其中传统法预测力矩为采用2.3.1节中辨识方法所得参数对应的关节预测力矩;而改进法预测力矩则对应了2.3.2节中辨识方法所得参数对应的预测力矩。

    图  9  不同辨识方法预测力矩
    Fig. 9.  Predicted torque of identification methods

    将两种辨识方法所得的预测力矩与实测关节力矩进行比较可知,对于基于改进关节模型辨识所得参数,其对应的预测力矩与实测关节力矩更为接近。这也间接说明改进的关节模型具有更高的精度。

    同时,由图 9可知,对于关节2和关节3而言,改进关节模型的精度提升效果更为明显。这可能是由于关节2和关节3所承受转矩较大,因此在传动过程中,减速器的啮合与滚动摩擦则更加明显。并且较大的转矩载荷会造成关节内润滑介质的挤压,进而造成内部润滑状态的转变。内部的润滑状态由完全润滑转变为混合润滑状态及边界润滑状态。此时关节的摩擦并不能简单地通过库伦- 黏滞摩擦来表述。

    为了进一步对辨识所得参数的效果进行评估,需要在与辨识轨迹不同的轨迹下对比效果。在实际情况下,往往需要对给定目标轨迹下的关节力矩进行预测,此时的Tmp未知。因此无法通过式(20)来获得,而需基于式(24)来对其进行近似估计。生成的验证轨迹如图 10所示。

    图  10  机器人验证轨迹
    Fig. 10.  Robot verification trajectory

    对所得力矩向量进行整理,可得各关节在验证轨迹下的关节力矩,如图 11所示。

    图  11  验证轨迹预测力矩
    Fig. 11.  Predicted torque of verification trajectory

    图 11中结果与图 9类似,对于验证轨迹而言,通过改进法所得的关节预测力矩更接近实测数值。这也进一步证明改进后的关节模型具有更高的精度,并验证了相应参数辨识方法的效果。

    通过控制器驱动机器人关节按照验证轨迹进行跟踪,并按图 5所示的验证流程分别基于式(21)、式(23)、式(24)计算此时验证轨迹下预测力矩向量TpreTrp、ΔTp。计算TpreTmp与实测力矩Tm的均方差(RMS),分别为1.704 5 N·m和1.576 2 N·m。由结果可知,对于验证轨迹对应力矩,基于改进模型的辨识精度相对于简化模型提高了7.52%。

    本文研究了谐波减速器的摩擦来源,提出了一种改进的机器人关节模型。并提出了相应的参数辨识方案。通过辨识与验证实验,对该关节模型与相应辨识方法的效果进行了评估。实验结果说明,改进的关节模型具有良好的效果,相应的参数辨识方法具有一定的工程意义。

    但在对验证轨迹下的关节力矩进行预测时,需要借助传统辨识方法所得参数对谐波减速器的输入力矩进行近似计算,因此难以摆脱传统方法中误差的影响,在一定程度上限制了精度提升的效果。针对上述问题,可在后续研究中,通过力矩传感器等设备对减速器的输入力矩进行测量。同时可针对谐波减速器摩擦来源及其估计方法开展更深入的研究,以进一步提高关节模型的精度与动力学参数辨识的效果。

  • 图  1   机器人简化关节模型

    Figure  1.   Simplified robot joint model

    图  2   改进的机器人关节模型

    Figure  2.   Improved robot joint model

    图  3   基于简化关节模型的辨识流程

    Figure  3.   Identification process based on the simplified joint model

    图  4   关节模型辨识流程

    Figure  4.   Identification process of the joint model

    图  5   参数验证流程

    Figure  5.   Parameter verification process

    图  6   6轴串联机器人

    Figure  6.   Six-axis serial robot

    图  7   机器人D-H坐标系

    Figure  7.   D-H coordinate system of robot

    图  8   机器人激励轨迹

    Figure  8.   Robot excitation trajectory

    图  9   不同辨识方法预测力矩

    Figure  9.   Predicted torque of identification methods

    图  10   机器人验证轨迹

    Figure  10.   Robot verification trajectory

    图  11   验证轨迹预测力矩

    Figure  11.   Predicted torque of verification trajectory

    表  1   机器人D-H参数

    Table  1   D-H parameters of robot

    i αi-1/(°) ai-1/mm di-1/mm θi/(°)
    1 0 0 122.3 0
    2 90 0 0 0
    3 0 -270 0 0
    4 0 -253 123.3 0
    5 90 0 107.1 0
    6 -90 0 99.1 0
    下载: 导出CSV

    表  2   关节模型参数

    Table  2   Model parameters of the joints

    i a1i a2i a3i a4i a5i
    1 0.402 1.578 2.937 0.515 0.014
    2 0.804 1.139 7.870 0.477 0.009
    3 0.464 0.822 3.047 0.638 0.029
    4 0.266 0.925 2.721 0.534 0.033
    5 0.603 1.916 3.690 0.123 -0.034
    6 0.282 0.795 2.689 0.614 -0.076
    下载: 导出CSV
  • [1]

    ARMSTRONG B, KHATIB O, BURDICK J. The explicit dynamic model and inertial parameters of the PUMA 560 arm[C]//IEEE International Conference on Robotics & Automation. Piscataway, USA: IEEE, 1986: 510-518.

    [2] 王树新, 张海根, 黄铁球, 等. 机器人动力学参数辨识方法的研究[J]. 机械工程学报, 1999, 35(1): 23-26. https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB901.005.htm

    WANG S X, ZHANG H G, HUANG T Q, et al. Study on dynamic parameter identification of robot[J]. Chinese Journal of Mechanical Engineering, 1999, 35(1): 23-26. https://www.cnki.com.cn/Article/CJFDTOTAL-JXXB901.005.htm

    [3] 刘正士, 陈恩伟, 干方建. 机器人惯性参数辨识的若干方法及进展[J]. 合肥工业大学学报(自然科学版), 2005(9): 998-1003, 1007. https://www.cnki.com.cn/Article/CJFDTOTAL-HEFE200509008.htm

    LIU Z S, CHEN E W, QIAN F J. Several methods and progress of robot inertial parameter identification[J]. Journal of Hefei University of Technology (Natural Science Edition), 2005(9): 998-1003, 1007. https://www.cnki.com.cn/Article/CJFDTOTAL-HEFE200509008.htm

    [4]

    DUTKIEWICZ P, KOZLOWSKI K R, WROBLEWSKI W S. Experimental identification of robot and load dynamic parameters[C/OL]//IEEE International Conference on Control and Applications. Piscataway, USA: IEEE, 1993[2022-01-15]. https://ieeexplore.ieee.org/document/348238. DOI: 10.1109/CCA.1993.348238.

    [5]

    OLSEN M M, PETERSEN H G. A new method for estimating parameters of a dynamic robot model[J]. IEEE Transactions on Robotics and Automation, 2001, 17(1): 95-100. doi: 10.1109/70.917088

    [6] 耿令波. 工业机器人动力学参数辨识方法研究[D]. 南京: 南京航空航天大学, 2013.

    GENG L B. Research on the identification method of industrial robot dynamics parameters[D]. Nanjing: Nanjing University of Aeronautics and Astronautics, 2013.

    [7] 丁亚东, 陈柏, 吴洪涛, 等. 一种工业机器人动力学参数的辨识方法[J]. 华南理工大学学报(自然科学版), 2015, 43(3): 49-56. https://www.cnki.com.cn/Article/CJFDTOTAL-HNLG201503009.htm

    DING Y D, CHEN B, WU H T, et al. An identification method of industrial robot dynamic parameters[J]. Journal of South China University of Technology (Natural Science Edition), 2015, 43(3): 49-56. https://www.cnki.com.cn/Article/CJFDTOTAL-HNLG201503009.htm

    [8] 陶婕妤. 基于动力学参数辨识的工业机器人力/位柔顺控制的研究[D]. 武汉: 华中科技大学, 2019.

    TAO J Y. Research on force/position compliance control of industrial robot based on dynamic parameter identification[D]. Wuhan: Huazhong University of Science and Technology, 2019.

    [9] 孙玉阳. 重载机器人动力学建模及前馈控制方法研究与实现[D]. 南京: 东南大学, 2017.

    SUN Y Y. Research and implementation of dynamic modeling and feedforward control methods for heavy-duty robots[D]. Nanjing: Southeast University, 2017.

    [10] 韩邦成, 马纪军, 李海涛. 谐波减速器的非线性摩擦建模及补偿[J]. 光学精密工程, 2011, 19(5): 1095-1103. https://www.cnki.com.cn/Article/CJFDTOTAL-GXJM201105021.htm

    HAN B C, MA J J, LI H T. Modeling and compensation of nonlinear friction in harmonic driver[J]. Optical Precision Engineering, 2011, 19(5): 1095-1103. https://www.cnki.com.cn/Article/CJFDTOTAL-GXJM201105021.htm

    [11]

    KIRCANSKI N M, GOLDENBERG A. An experimental study of nonlinear stiffness, hysteresis, and friction effects in robot joints with harmonic drives and torque sensors[J]. International Journal of Robotics Research, 1997, 16(2): 214-239. doi: 10.1177/027836499701600207

    [12] 张奇, 刘振, 谢宗武, 等. 具有谐波减速器的柔性关节参数辨识[J]. 机器人, 2014, 36(2): 164-170. https://www.cnki.com.cn/Article/CJFDTOTAL-JQRR201402005.htm

    ZHANG Q, LIU Z, XIE Z W, et al. Parameters identification of flexible joints with harmonic driver[J]. Robot, 2014, 36(2): 164-170. https://www.cnki.com.cn/Article/CJFDTOTAL-JQRR201402005.htm

    [13] 黑沫. 精密谐波齿轮传动系统建模与控制方法研究[D]. 长沙: 国防科学技术大学, 2015.

    HEI M. Research on the modeling and control of precision harmonic drive system[J]. Changsha: National University of Defense Technology, 2015.

    [14]

    TUTTLE T D. Understanding and modeling the behavior of a harmonic drive gear transmission[D]. Cambridge, UK: Massachusetts Institute of Technology, 1992.

    [15]

    GANDHI P S, GHORBEL F H, DABNEY J. Modeling, identification, and compensation of friction in harmonic drives[C]//Conference on Decision & Control. Piscataway, USA: IEEE, 2002: 160-166.

    [16] 石崟, 尹华川, 李俊阳, 等. 谐波减速器摩擦特性建模及参数辨识[J]. 东北大学学报(自然科学版), 2022, 43(1): 89-96, 110. https://www.cnki.com.cn/Article/CJFDTOTAL-DBDX202201013.htm

    SHI Y, YIN H C, LI J Y, et al. Modeling and parameter identification of friction characteristics of harmonic reducer[J]. Journal of Northeastern University (Natural Science), 2022, 43(1): 89-96, 110. https://www.cnki.com.cn/Article/CJFDTOTAL-DBDX202201013.htm

    [17]

    VANDANJON P O, GAUTIER M, DESBATS P. Identification of robots inertial parameters by means of spectrum analysis[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 1995: 3033-3038.

    [18]

    GAUTIER M, KHALIL W. On the identification of the inertial parameters of robots[C/OL]//27th IEEE Conference on Decision and Control. Piscataway, USA: IEEE, 1988[2022-02-11]. https://ieeexplore.ieee.org/document/194738. DOI: 10.1109/CDC.1988.194738.

    [19] 金茨勃格E F. 谐波齿轮传动——原理、设计与工艺[M]. 北京: 国防工业出版社, 1982.

    JINZBERG E F. Harmonic gear transmission - Principle, design and technology[M]. Beijing: National Defense Industry Press, 1982.

    [20]

    SWEVERS J, GANSEMAN C, SCHUTTER J D, et al. Experimental robot identification using optimised periodic trajectories[J]. Mechanical Systems & Signal Processing, 1996, 10(5): 561-577.

    [21] 吴文祥. 多自由度串联机器人关节摩擦分析与低速高精度运动控制[D]. 杭州: 浙江大学, 2013.

    WU W X. Joint friction analysis and low-speed high-precision motion control of multi-degree-of-freedom tandem robots[D]. Hangzhou: Zhejiang University, 2013.

    [22] 陈柏, 谢本华, 丁力, 等. 一种带负载工业机器人动力学模型辨识方法[J]. 南京航空航天大学学报, 2016, 48(6): 835-840. https://www.cnki.com.cn/Article/CJFDTOTAL-NJHK201606009.htm

    CHEN B, XIE B H, DING L, et al. A dynamic model identification method for loaded industrial robots[J]. Journal of Nanjing University of Aeronautics and Astronautics, 2016, 48(6): 835-840. https://www.cnki.com.cn/Article/CJFDTOTAL-NJHK201606009.htm

    [23] 涂骁. 基于动力学前馈的工业机器人运动控制关键技术研究[D]. 武汉: 华中科技大学, 2018.

    TU X. Research on the key technology of industrial robot motion control based on feedforward dynamics[J]. Wuhan: Huazhong University of Science and Technology, 2018.

  • 期刊类型引用(1)

    1. 杨中华,俞经虎,俞哲,周嘉铨. 应用于动力学参数辨识的激励轨迹优化研究. 机械传动. 2024(11): 37-47 . 百度学术

    其他类型引用(1)

图(11)  /  表(2)
计量
  • 文章访问数:  156
  • HTML全文浏览量:  15
  • PDF下载量:  48
  • 被引次数: 2
出版历程
  • 收稿日期:  2022-03-03
  • 录用日期:  2022-05-23
  • 刊出日期:  2023-06-19

目录

/

返回文章
返回
x