CN110941183A - 一种基于神经网络的工业机器人动力学辨识方法 - Google Patents

Abstract

本发明提出了一种基于神经网络的工业机器人动力学辨识方法，包括以下步骤：S1、选用循环神经网络作为工业机器人动力学的近似模型；S2、辨识实验轨迹；S3、数据采集和预处理；S4、模型参数辨识；S5、模型验证。本发明选用循环神经网络作为工业机器人动力学的近似模型，利用上述采集得到的机器人运动数据，使用二阶学习算法列文伯格‑马夸尔特算法训练动力学模型的参数，最终得到一个能够准确反映工业机器人关节运动变量和关节电机转矩两种数据之间的关系的动力学模型。本发明有助于提高机器人的控制性能。

Description

一种基于神经网络的工业机器人动力学辨识方法

技术领域

本发明涉及工业机器人技术领域，特别涉及一种基于利用神经网络对工业机器人进行动力学参数辨识的方法。

背景技术

工业机器人的动力学模型广泛被应用于工业机器人技术的很多方面，包括：工业机器人的控制、离线仿真、能耗和优化、最优控制方案设计等。一个准确反映工业机器人关节变量与关节电机驱动转矩关系的动力学模型，依赖于动力学模型参数的准确性。然而，由于工业机器人在生产制造过程中存在不可避免的误差，工业机器人内部高度集成化和高耦合性导致工业机器人动力学参数存在不确定性，这种不确定性影响了动力学模型的准确性，从而降低其在控制和仿真场景中的应用性能。因此，根据工业机器人的实际数据对其动力学模型进行辨识具有必要性。动力学辨识主要包括：建模/模型选择、辨识实验设计、数据采集和预处理、模型参数辨识和模型验证。

据查，现阶段常用的工业机器人动力学辨识方法有：直接测量法、基于最小二乘拟合的动力学辨识法。

其中，直接测量法通过利用测量工具直接对工业机器人连杆进行质量、质心位置、惯量等参数的测量，或根据工业机器人的CAD模型图对动力学参数进行估算。直接测量法的缺陷在于，工业机器人内部的高耦合度无法通过直接测量反映；而CAD模型图只反映工业机器人的理论参数，与实际模型必然存在一定误差。

采用最小二乘拟合的动力学模型(专利号CN106346513A，CN106346477A)通过动力学模型的线性化，然后利用工业机器人在实际运动过程中的关节变量数据和转矩数据进行线性动力学模型参数的拟合。这种方法的缺陷在于，在数据采集过程中，除了关节角位移和关节电机驱动转矩，还需要对关节角速度和关节角加速度进行采集，进而增加了辨识成本；并且，对高度集成的工业机器人，加装传感器相对难以实施。此外，现代工业机器人复杂的控制系统给原有的动力学模型增加非线性，影响了原线性动力学模型的估计精度。

发明内容

本发明的目的在于提供一种新型且有效的工业机器人动力学辨识方法，并旨在解决现有技术缺陷，提供一个准确的动力学辨识方法。

本发明至少通过如下技术方案之一实现。

一种基于神经网络的工业机器人动力学辨识方法，包括以下步骤：

S1、选用循环神经网络作为工业机器人动力学的近似模型；

S2、设置辨识实验轨迹，利用周期性的激励轨迹控制机器人进行辨识实验运动；

S3、数据采集和预处理，采集机器人再运动过程中的每个关节的运动变量：关节角位移、关节角速度、关节角加速度，以及每个关节电机的驱动转矩；

S4、模型参数辨识，使用列文伯格-马夸尔特算法训练近似模型的参数；

S5、模型验证，利用近似模型的预测误差验证近似模型的效果；

S6、根据步骤S5验证后的近似模型，预测和控制机器人。

进一步地，工业机器人传统的动力学模型即原模型表示为：

其中，t表示时间变量，动力学方程的变量包括关节角位移q(t)、角速度

角加速度

关节电机转矩τ(t)；方程参数：M(q(t))为惯性矩阵，与角位移q(t)有关；

为离心力和哥氏力矩阵，与角位移q(t)和角速度

有关；G(q(t))为重力矩阵，与角位移q(t)有关；

步骤S1具体是选用循环神经网络-带外部输入的非线性自回归神经网络模型(Nonlinear AutoRegressive with eXternal input neural network，NARX neuralnetwork，NARX循环神经网络，下文统称为近似模型)，对原模型进行近似，近似模型的数学表述：

其中，f_NARX表示NARX循环神经网络的映射关系，W,b分别表示NARX循环神经网络中的权重向量和偏置向量，

表示在时刻t每个关节组成的关节运动变量，其中q(t)为关节角位移，

为关节角速度，

为关节角加速度；实际运算中，连续时间会被离散化成N个离散时刻[t₁,t₂…t_n]，t_n表示第n个离散时刻；x(t-t_n)＝[x(t-t₁),x(t-t₂),…,x(t-t_n)]表示在历史时刻[t-t₁,t-t₂,…,t-t_n]的关节运动变量向量；同理，

表示在时刻t所述的动力学模型输出的电机驱动转矩估计值，

表示在历史时刻[t-t₁,t-t₂,…,t-t_n]的关节电机转矩向量；

根据式(2)的模型数学表述，关节运动变量x(t)为动力学模型的外部输入；电机驱动转矩

既是近似模型当前时刻的估计输出，又在下一时刻作为近似模型的输入；W,b为近似模型参数，该参数通过列文伯格-马夸尔特学习算法调整至最优参数值。

进一步地，步骤S2的辨识实验轨迹设置具体如下：

对于机器人的每个关节，采用有限项傅里叶级数组成的周期性关节角度激励轨迹，作为控制信号控制工业机器人进行辨识实验运动，周期性的激励轨迹能提高实验数据的信噪比，更易于通过差分从关节角度数据求得关节角速度和关节角加速度，周期性的激励如式(3～5)所示，其中i表示第i个关节，N_f,i为第i个关节傅里叶级数轨迹的项数N_f，l为表示第l项傅里叶级数，w_f＝2πf_f为基础角频率，f_f为基础频率，a_l,i和b_l,i为正余弦函数的幅值，q_l0为偏移项，q_i(t)为关节角位移，

为关节角速度，

为关节角加速度

式(3)为傅里叶级数关节的轨迹，关节的轨迹即角位移变化主要由幅值a_l,i和b_l,i、偏移q_l0、项数N_f,i以及基频w_f决定。

进一步地，步骤S3所述的采集是利用工业机器人中的传感器接口模块即传感器组；传感器组实时测量工业机器人的当前状态并存储在机器人控制系统的本地存储器中，机器人状态数据从机器人控制系统，经由以太网线和TCP/IP传输协议，被读取至其他运算设备中；运算设备为个人电脑或者带有网卡设备的嵌入式运算设备；机器人控制系统作为服务器端，运算设备作为客户端；按照固定的采样周期进行读取。

所述机器人控制系统是工业机器人自带集成的控制系统，每个厂商的控制系统都不同，例如Kawasaki机器人、KUKA机器人、UR机器人等都有自己的机器人控制系统。传感器也是机器人自带的传感器，借助机器人控制系统读取传感器的数据。所述机器人控制系统的功能一般包括：接收外部控制命令以控制机器人进行运动；读取传感器的状态数据。所以此处的工业机器人控制系统可视为带有控制功能和读取传感器功能的机器人控制系统。

进一步地，步骤S3的采集过程如下：

利用工业机器人中的工业传感器，按照采样周期T_S,在机器人运动过程中进行关节变量数据和关节转矩数据的采集，则采样频率

在时间[0,T_traj]中，采样次数为M＝f_s*T_traj采集得到的数据如下：

关节运动变量原始数据，其中，t表示时间变量，q_raw(t)表示关节角度的原始数据，

表示关节角速度的原始数据，

表示关节角加速度的原始数据：

关节电机转矩原始数据：

τ_raw(n) n＝[1,2,…,M] (7)

从机器人控制系统采集得到的原始数据进行预处理，预处理如下：

采集得到的关节运动变量为在运动过程中工业机器人每个关节的角位移离散数据，角位移数据先经过一个低通滤波器去除高频噪声，得到滤波后的关节角度q_f(t)，再通过一阶差分求取各关节角速度

二阶差分求取各关节角加速度

其中，t表示时间变量。关节角度q_f(t)，关节角速度

和角加速度

组成公式(2)的关节运动变量向量x(t)：

采集得到的关节电机驱动转矩原始离散数据，同样经过一个低通滤波器去除高频噪声得到滤波后的关节电机转矩τ_f(t)，即公式(2)的关节电机转矩向量

进一步地，步骤S4使用的列文伯格-马夸尔特学习算法(Levenberg-MarquardtAlgorithm)如下：

设近似模型的损失函数为均方根误差(Mean Square Error,MSE)函数：

其中，t表示时间变量，τ(t)表示关节电机转矩真值，

表示关节电机转矩预测值；N表示训练数据离散点个数；t_N表示对应离散时间向量；残差

计算残差e(t)对于所述非线性自回归神经网络模型的参数：循环神经网络中的权重向量W和偏置向量WB＝[W,b]的一阶微分作为雅可比矩阵：

所述列文伯格-马夸尔特学习算法的对近似模型的参数WB更新规则为：

WB′＝WB-(J^TJ+μI)^-1Je (12)

其中，μ表示惩罚因子，在近似模型更新过程中会根据近似模型效果进行增大或减小；I为单位矩阵；

按照所述的动力学模型，其参数按照公式(12)进行更新，直至公式(10)表示的损失函数值满足给定拟合要求；损失函数值满足拟合要求表明，工业机器人在辨识轨迹运动过程中，动力学模型根据轨迹计算得到的转矩估计值序列与转矩真实值序列的均方根误差满足给定的误差范围。

进一步地，步骤S5的模型验证即对近似模型进行评价，给定一段在可行工作空间中的任意轨迹，通过近似模型计算的估计转矩与电机输出转矩真值之间的均方根误差满足给定的拟合要求

给定一个运动轨迹，例如工业机器人在生产线上完成某工艺任务需要完成的运动轨迹，工业机器人在该运动轨迹对应的关节运动变量序列输入至近似模型，进行近似模型的仿真，得到关节驱动转矩序列的估计值。关节转矩估计值序列与真实值序列，利用式(16)计算两者之间的均方根误差。若两者的均方根误差在可接受的误差范围内，则近似模型通过验证。实际验证中可基于多个不同运动轨迹进行近似模型的验证。

优点和有益效果

本发明方法与现有技术相比，具有如下优点和有益效果：

1、本发明选用神经网络作为工业机器人动力学的近似模型。根据机器学习中的万能近似定理，一个足够大的多层神经网络模型理论上能够以任何想要的误差量近似任何从一个有限维度的空间映射到另一个有限维度空间的函数。换言之，具有的高度非线性和耦合性的现代工业机器人控制系统，将其关节运动变量和关节电机转矩看作一个动力学系统，其系统函数表示能够用一个神经网络进行近似。因此，本发明方法对于不同工业机器人的动力学建模具有通用性，从而保证了本发明方法的有效性和实用性。

2、与现有技术相比，本发明方法所需要的传感器数量减少，只需要测量关节位移的编码器与测量关节转矩(或等价物理量)的传感器即可，从而降低了实验开销。

附图说明

图1是本实施例所述一种基于神经网络的工业机器人动力学辨识方法的结构框图；

图2是本实施例所述实验内容中的方案步骤流程图；

图3是本实施例所述循环神经网络的结构框图；

图4是本实施例所述数据采集方案示意框图；

图5是本实施例所述列文伯格-马夸尔特学习算法流程图；

图6是本实施例所述辨识实验轨迹的关节角位移曲线图；

图7是本实施例所述辨识实验轨迹的关节角速度曲线图；

图8是本实施例所述辨识实验轨迹的关节角加速度曲线图；

图9是本实施例所述在0-30秒内关节角位移原始数据曲线图；

图10是本实施例所述在0-30秒内关节电机驱动转矩原始数据曲线图；

图11是本实施例近似模型在关节3的转矩估计值与电机转矩真实值的比较示例图；

图12是本实施例近似模型关节3的转矩估计值与电机转矩真实值之间的残差示例图。

具体实施方式

下面结合实施例及附图对本发明作进一步详细的描述，但本发明的实施方式不限于此。

如图1所示的一种基于神经网络的工业机器人动力学辨识方法，本发明的实施例基于一个六自由度工业机器人，KUKA KR6 R700工业机器人，该机器人的系统配置为KUKAC4控制柜和KUKA系统软件，图2为该工业机器人近似模型的辨识实施流程，具体包括以下步骤：

S1、选用循环神经网络作为工业机器人动力学的近似模型；

在建模阶段，首先选择如图3所示的循环神经网络-带外部输入的非线性自回归神经网络模型作为该工业机器人动力学的近似模型，其数学表述：

其中，f_NARX表示NARX循环神经网络的映射关系。W,b分别表示循环神经网络中的权重向量和偏置向量，其中包括：隐藏层的输入权重向量W_h1，隐藏层的历史输出权重向量W_h2，隐藏层的偏置向量b_h，隐藏层的激活函数tanh；输出层的权重向量W_o，输出层的偏置向量b_o，输出层的激活函数为线性函数，线性函数的输出等于输入。

表示在时刻t每个关节组成的关节运动变量，其中q(t)为关节角位移，

为关节角速度，

为关节角加速度。实际运算中，连续时间会被离散化成N个离散时刻[t₁,t₂…t_N]，t_n表示第n个离散时刻；x(t-t_n)＝[x(t-t₁),x(t-t₂),…,x(t-t_n)]表示在历史时刻[t-t₁,t-t₂,…,t-t_n]的关节运动变量向量；同理，

表示在时刻t所述的动力学模型输出的电机驱动转矩估计值，

表示在历史时刻[t-t₁,t-t₂,…,t-t_n]的关节电机转矩向量。选择经过低通滤波的关节运动变量序列作为近似模型输入，关节电机驱动转矩序列作为近似模型输出。近似模型结构确定为：输入层和输出层大小均为6×1，隐藏层大小分别设置为15，延时向量为D₁＝D₂＝[1,2]。

S2、辨识实验轨迹，具体如下：

在工业机器人的关节空间，选择傅里叶级数轨迹为：

其中，i表示第i个关节的变量，q_l0为偏移项，q_i(t)为关节角位移，

为关节角速度，

为关节角加速度，N_f,i为第i个关节傅里叶级数轨迹的项数N_f，l为表示第l项傅里叶级数，，a_l,i和b_l,i为正余弦函数的幅值，选取基础频率f_f＝0.1,基础角频率w_f＝2πf_f，即单个激励轨迹的周期为10s；傅里叶级数项数N_f＝5。KUKA KR6机器人的关节转角范围为：

关节角速度范围为：

角加速度最大值统一设置为

根据上述机器人的工作范围，选择辨识实验轨迹参数如表1所示。其中，参考式(23)，每一列表示每一个关节的辨识轨迹参数，在同一列中，不同的行表示同一关节辨识轨迹的不同参数；由于傅里叶级数的项数为N_f＝5；对应每个关节，a₁～a₅表示轨迹正弦分量的赋值，b₁～b₅表示轨迹余弦分量的赋值，q₀为轨迹的偏移项。

表1辨识实验轨迹参数

根据辨识实验轨迹参数得到的机器人六个关节在0-10秒内的运动轨迹如图6、图7和图8所示，其中图6为工业机器人关节角位移曲线、图7为关节角速度曲线、图8为关节角加速度曲线。选定激励轨迹总次数为10次，即对KUKA KR6机器人编程使其运行连续激励轨迹10次；在实际的轨迹过程中，项数N_f和基础频率w_f根据经验设置，轨迹参数[a_l,i,b_l,i,q_l0]满足辨识轨迹在工业机器人设置的工作范围内即可。

S3、数据采集和预处理，采集机器人再运动过程中的每个关节的运动变量：关节角位移、关节角速度、关节角加速度，以及每个关节电机的驱动转矩；

所述的采集是利用工业机器人控制系统中的传感器接口模块即传感器组；传感器组实时测量工业机器人的当前状态并存储在机器人控制系统的本地存储器中，机器人状态数据从机器人控制系统，经由以太网线和TCP/IP传输协议，被读取至其他运算设备中；运算设备为个人电脑或者带有网卡设备的嵌入式运算设备；机器人控制系统作为服务器端，运算设备作为客户端；按照固定的采样周期进行读取。

所述机器人控制系统是工业机器人自带集成的控制系统，每个厂商的控制系统都不同，例如Kawasaki机器人、KUKA机器人、UR机器人等都有自己的机器人控制系统。传感器也是机器人自带的传感器，借助机器人控制系统读取传感器的数据。所述机器人控制系统的功能一般包括：接收外部控制命令以控制机器人进行运动；读取传感器的状态数据。所以此处的工业机器人控制系统可视为带有控制功能和读取传感器功能的机器人控制系统。

图4为本实施例KUKA KR6机器人实时数据的采集，利用TCP/IP协议，对KUKA KR6机器人数据进行实时读取。在机器人端，在控制柜的操作系统中部署一个通讯代理，在运算设备端，通过TCP/IP通讯，编程实时读取KUKA KR6机器人的实时关节转矩，关节角度数据，每一次读取间隔0.020秒。程序的伪代码如下所示：

采集得到的原始数据，前三个运动周期(0-30s，一个周期10s)的角位移曲线，以及关节转矩曲线分别如图9和图10所示。关节角位移和关节转矩的原始数据都存在不同程度的高频噪声，需要使用数字低通滤波器去除高频噪声的影响。在傅里叶级数轨迹中，设定的基频[0.1,0.2,0.3,0.4,0.5]频率具有较高的幅值，说明机器人按照傅里叶级数轨迹进行运动；但除了基频外，在大于0.5的区间外还存在幅值较小的高频噪声，高频噪声造成了角位移原始数据的抖动，因此需要利用低通滤波器尽量去除大于0.5的区间的高频噪声，同时平滑角位移曲线。同理，对转矩原始数据作同样的高频滤波处理。

基于原始数据的高频噪声，以低通数字滤波器去除高频噪声：

表2低通滤波器属性

滤波器类型	低通滤波器
		截止频率	0.5
阶数	10

对6个关节的关节角位移原始数据和关节转矩数据，利用上述低通数字滤波器进行滤波。滤波后的关节角位移数据，对其进行二阶中心差分法，求出实际的关节角速度和关节角加速度。轨迹包含8093个时刻的关节角位移和关节电机转矩数据，即有8093个离散时序数据点。

S4、模型参数辨识；

利用列文伯格-马夸尔特学习算法，基于滤波后的关节运动变量和电机转矩数据对所述近似模型进行参数辨识。近似模型参数学习算法流程如图5所示，具体描述如下：

①给定离散时序训练数据：[x(t),y(t)]，其中t_n∈[t₁,t₂…t_N]，N为离散时序数据的个数。

给定优化目标，通常为近似模型的损失函数

②初始化惩罚因子：μ＝μ₀，步长v，迭代次数iter＝1；

③在每个迭代iter中，对所有的训练数据[x(t),y(t)]，前馈计算得到

并计算误差e和损失函数L；

④计算误差e关于模型参数WB＝[W_h1,W_h2,W_o,b_h,b_o]的导数，其中包括：隐藏层的输入权重向量W_h1，隐藏层的历史输出权重向量W_h2，隐藏层的偏置向量b_h；输出层的权重向量W_o，输出层的偏置向量b_o，即模型参数的雅可比矩阵J

⑤模型参数的更新值ΔWB

ΔWB＝-(J^TJ+μI)^-1Je (18)；

⑥更新模型新的误差参数e'

WB′＝WB+ΔWB＝WB-(J^TJ+μI)^-1Je (19)；

⑦使用更新后的模型参数WB′进行前馈计算，并计算新的误差e′和损失函数值L′；

⑧比较更新后的网络损失L′和更新前的网络损失L：

如果L′≥L，即参数更新后的网络效果没有改善，则增大μ，μ＝μ*v，L＝L′,e＝e′，跳至步骤⑤；

如果L′<L，检查损失函数值L′是否满足需求：若否，则减小μ，μ＝μ/v，迭代次数iter＝iter+1，跳至步骤③，往下执行；若是，则终止迭代，算法结束。

上述步骤①-⑧为动力学模型参数利用学习算法得到最优动力学模型参数的过程，动力学模型参数最优表示，工业机器人在辨识轨迹运动过程中，动力学模型根据轨迹计算得到的转矩估计值序列与转矩真实值序列的均方根误差最小。设置初始惩罚因子μ₀＝1e-3，步长v＝10。停止条件为均方根误差MSE小于等于1e-3，即当近似模型输出的转矩估计值与转矩真实值的均方根误差小于1e-3(单位：牛)时，算法终止，参数停止更新，近似模型确定。

S5、模型验证；

模型验证阶段，在工业机器人工作空间随机产生一条末端测试轨迹，测试轨迹一方面转换成关节空间中的关节运动轨迹输入至所述近似模型进行仿真，近似模型输出在此关节运动轨迹中的关节转矩序列；另一方面测试轨迹输入至机器人控制系统，令机器人按照测试轨迹进行运动，并采集运动过程中的关节电机输出转矩。近似模型的估计转矩与实际测量的真实转矩比较如图11和图12所示，其中，图11为所述近似模型的估计转矩与工业机器人真实转矩的在0-30秒的比较图；图12为两者的残差。表格3列出了，在近似模型验证中，KUKA KR6机器人近似模型的估计转矩序列与转矩真实值之间的均方根误差，可以看出，在均方根误差的可接受范围在1e-3时，本发明方法所述的近似模型是有效的。

表3 KUKA KR6机器人近似模型的测试效果

关节1

关节2

关节3

关节4

关节5

关节6

均方根误差

1.38e-03

9.20e-04

2.41e-03

2.39e-03

9.17e-04

9.32e-04

上述实施例为本发明较佳的实施方式，但本发明的实施方式并不受上述实施例的限制，其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化，均应为等效的置换方式，都包含在本发明的保护范围之内。

Claims (7)

1.一种基于神经网络的工业机器人动力学辨识方法，其特征在于，包括以下步骤：

S1、选用循环神经网络作为工业机器人动力学的近似模型；

S2、设置辨识实验轨迹，利用周期性的激励轨迹控制机器人进行辨识实验运动；

S3、数据采集和预处理，采集机器人再运动过程中的每个关节的运动变量：关节角位移、关节角速度、关节角加速度，以及每个关节电机的驱动转矩；

S4、模型参数辨识，使用列文伯格-马夸尔特算法训练近似模型的参数；

S5、模型验证，利用近似模型的预测误差验证近似模型的效果；

S6、根据步骤S5验证后的近似模型，预测和控制机器人。

2.根据权利要求1所述的一种基于神经网络的工业机器人动力学辨识方法，其特征在于，工业机器人传统的动力学模型即原模型表示为：

其中，t表示时间变量，动力学方程的变量包括关节角位移q(t)、角速度

角加速度

关节电机转矩τ(t)；方程参数：M(q(t))为惯性矩阵，与角位移q(t)有关；

为离心力和哥氏力矩阵，与角位移q(t)和角速度

有关；G(q(t))为重力矩阵，与角位移q(t)有关；

步骤S1具体是选用循环神经网络-带外部输入的非线性自回归神经网络模型(Nonlinear AutoRegressive with eXternal input neural network，NARX neuralnetwork，NARX循环神经网络，下文统称为近似模型)，对原模型进行近似，近似模型的数学表述：

其中，f_NARX表示NARX循环神经网络的映射关系，W,b分别表示NARX循环神经网络中的权重向量和偏置向量，

表示在时刻t每个关节组成的关节运动变量，其中q(t)为关节角位移，

为关节角速度，

为关节角加速度；实际运算中，连续时间会被离散化成N个离散时刻[t₁,t₂…t_n]，t_n表示第n个离散时刻；x(t-t_n)＝[x(t-t₁),x(t-t₂),…,x(t-t_n)]表示在历史时刻[t-t₁,t-t₂,…,t-t_n]的关节运动变量向量；同理，

表示在时刻t所述的动力学模型输出的电机驱动转矩估计值，

表示在历史时刻[t-t₁,t-t₂,…,t-t_n]的关节电机转矩向量；

根据式(2)的模型数学表述，关节运动变量x(t)为动力学模型的外部输入；电机驱动转矩

既是近似模型当前时刻的估计输出，又在下一时刻作为近似模型的输入；W,b为近似模型参数，该参数通过列文伯格-马夸尔特学习算法调整至最优参数值。

3.根据权利要求1所述的一种基于神经网络的工业机器人动力学辨识方法，其特征在于，步骤S2的辨识实验轨迹设置具体如下：

对于机器人的每个关节，采用有限项傅里叶级数组成的周期性关节角度激励轨迹，作为控制信号控制工业机器人进行辨识实验运动，周期性的激励轨迹能提高实验数据的信噪比，更易于通过差分从关节角度数据求得关节角速度和关节角加速度，周期性的激励如式(3～5)所示，其中i表示第i个关节，N_f,i为第i个关节傅里叶级数轨迹的项数N_f，l为表示第l项傅里叶级数，w_f＝2πf_f为基础角频率，f_f为基础频率，a_l,i和b_l,i为正余弦函数的幅值，q_l0为偏移项，q_i(t)为关节角位移，

为关节角速度，

为关节角加速度

式(3)为傅里叶级数关节的轨迹，关节的轨迹即角位移变化主要由幅值a_l,i和b_l,i、偏移q_l0、项数N_f,i以及基频w_f决定。

4.根据权利要求1所述的一种基于神经网络的工业机器人动力学辨识方法，其特征在于，步骤S3所述的采集是利用工业机器人中的传感器接口模块即传感器组；传感器组实时测量工业机器人的当前状态并存储在机器人控制系统的本地存储器中，机器人状态数据从机器人控制系统，经由以太网线和TCP/IP传输协议，被读取至其他运算设备中；运算设备为个人电脑或者带有网卡设备的嵌入式运算设备；机器人控制系统作为服务器端，运算设备作为客户端；按照固定的采样周期进行读取。

5.根据权利要求1所述的一种基于神经网络的工业机器人动力学辨识方法，其特征在于，步骤S3的采集过程如下：

利用工业机器人中的工业传感器，按照采样周期T_S,在机器人运动过程中进行关节变量数据和关节转矩数据的采集，则采样频率

在时间[0,T_traj]中，采样次数为M＝f_s*T_traj采集得到的数据如下：

关节运动变量原始数据，其中，t表示时间变量，q_raw(t)表示关节角度的原始数据，

表示关节角速度的原始数据，

表示关节角加速度的原始数据：

关节电机转矩原始数据：

τ_raw(t)t∈[t₁,t₂…t_n] (7)

从机器人控制系统采集得到的原始数据进行预处理，预处理如下：

采集得到的关节运动变量为在运动过程中工业机器人每个关节的角位移离散数据，角位移数据先经过一个低通滤波器去除高频噪声，得到滤波后的关节角度q_f(t)，再通过一阶差分求取各关节角速度

二阶差分求取各关节角加速度

其中，t表示时间变量，关节角度q_f(t)，关节角速度

和角加速度

组成公式(2)的关节运动变量向量x(t)：

采集得到的关节电机驱动转矩原始离散数据，同样经过一个低通滤波器去除高频噪声得到滤波后的关节电机转矩τ_f(t)，即公式(2)的关节电机转矩向量

6.根据权利要求1所述的一种基于神经网络的工业机器人动力学辨识方法，其特征在于，步骤S4使用的列文伯格-马夸尔特学习算法(Levenberg-Marquardt Algorithm)如下：

设近似模型的损失函数为均方根误差(Mean Square Error,MSE)函数：

其中，t表示时间变量，τ(t)表示关节电机转矩真值，

表示关节电机转矩预测值；N表示训练数据离散点个数；t_N表示对应离散时间向量；残差

计算残差e(t)对于所述非线性自回归神经网络模型的参数：循环神经网络中的权重向量W和偏置向量WB＝[W,b]的一阶微分作为雅可比矩阵：

所述列文伯格-马夸尔特学习算法的对近似模型的参数WB更新规则为：

WB′＝WB-(J^TJ+μI)^-1Je (12)

其中，μ表示惩罚因子，在近似模型更新过程中会根据近似模型效果进行增大或减小；I为单位矩阵；

按照所述的动力学模型，其参数按照公式(12)进行更新，直至公式(10)表示的损失函数值满足给定拟合要求；损失函数值满足拟合要求表明，工业机器人在辨识轨迹运动过程中，动力学模型根据轨迹计算得到的转矩估计值序列与转矩真实值序列的均方根误差满足给定的误差范围。

7.根据权利要求1所述的一种基于神经网络的工业机器人动力学辨识方法，其特征在于，步骤S5的模型验证即对近似模型进行评价，给定一段在可行工作空间中的任意轨迹，通过近似模型计算的估计转矩与电机输出转矩真值之间的均方根误差满足给定的拟合要求。

Images