基于LSTM工业机器人柔性关节迟滞误差补偿控制方法

技术领域

本发明涉及工业机器人技术领域，具体涉及一种基于LSTM工业机器人柔性关节迟滞误差补偿控制方法。

背景技术

工业机器人具有重复精度高、自动化、安全且适用性强等优势。在智能制造的背景之下，工业机器人的功能越来越强，同时对工业机器人的执行精度也提出了更高的要求。近年来，出现的轻型机器人、协作机器人等机器人采用谐波驱动器驱动其关节运动。由电机与谐波减速器等组成的工业机器人柔性关节所表现出的复杂非线性迟滞特性，常常影响关节的转换精度，也直接影响工业机器人定位精度。对柔性关节的非线性迟滞特性进行建模，从控制角度，基于迟滞模型，通过补偿控制削弱关节的迟滞特性的影响，成为提高工业机器人柔性关节转换精度的一个重要技术。在基于模型的柔性关节补偿控制中，降低迟滞特性对关节执行精度的影响，建立迟滞模型是实现转换误差补偿控制的先决条件。关于迟滞特性建模，已有提出了多种典型方案：如Bouc-Wen模型、Preisach模型等，然而这类模型结构较复杂，逆模型不易求解，且参数在线计算困难，难以在实时控制系统中实施。

发明内容

本发明所要解决的是现有工业机器人中关节复杂迟滞特性未进行准确地补偿处理，导致关节转换精度下降的问题，提供一种基于LSTM工业机器人柔性关节迟滞误差补偿控制方法。

为解决上述问题，本发明是通过以下技术方案实现的：

基于LSTM工业机器人柔性关节迟滞误差补偿控制方法，包括步骤如下：

步骤1、采集柔性关节在当前时刻t的实际转矩x

步骤2、采集柔性关节在上一时刻t-1的实际输出角度y

步骤3、计算柔性关节在下一时刻t+1的补偿后设定输入角度

式中，p

步骤4、将下一时刻t+1的补偿后设定输入角度

上述方案中，柔性关节包括电机和谐波加速器；电机的输出端与谐波加速器的输入端连接；电机的控制端形成柔性关节的驱动端。

与现有技术相比，本发明具有如下特点：

1、对电机与谐波减速器构成的工业机器人柔性关节所表现出特殊非线性特性——非光滑迟滞特性在线高精度建模，基于该模型的关节传递误差补偿控制与近似补偿控制不同，通过基于柔性关节的高精度迟滞模型，实现转换误差有效补偿，提高工业机器人关节的转换精度。

2、所发明的迟滞模型具有在线学习能力，不仅在线补偿工业机器人关节本身结构带来传递非线性误差，而且，同时可补偿工业机器人关节在长时间运行下的慢漂移特性带来转换误差，提高关节长期运行的保持高精度下的稳定性。

附图说明

图1为LSTM单元基本结构图。

图2为LSTM迟滞模型。

图3为改进的LSTM神经网络结构图。

图4为改进的LSTM迟滞模型。

图5为基于改进的LSTM迟滞模型的关节补偿控制实现结构图。

具体实施方式

为使本发明的目的、技术方案和优点更加清楚明白，以下结合具体实例，对本发明进一步详细说明。

考虑到工业机器人柔性关节的输出与历史输入有关的记忆特性，本发明采用了能保存和长时间的传递信息、具有记忆特点的短时记忆神经网络(Long Short-Term MemoryModel，LSTM)，对工业机器人柔性关节所表现出的复杂非线性迟滞特性进行建模。为了进一步提高建模精度，本发明提出了基于改进的LSTM的工业机器人柔性关节迟滞建模，并基于该模型设计工业机器人柔性关节转换误差的补偿控制方法，实现工业机器人关节高精度角度定位。

传统循环神经网络(RNN)由输入层x＝(x

g

g′

其中，W

为了解决传统RNN网络中存在的梯度消失与梯度爆炸问题，出现LSTM代替RNN中的隐含层神经元。LSTM单元基本结构如图1所示。

其数学模型如下：

其中，x

考虑到迟滞表现为与输入信号的历史值有关的记忆特性，所以，本发明先利用具有记忆特性的LSTM构建工业机器人柔性关节的迟滞模型。由LSTM单元构建的LSTM迟滞模型如图2所示。图2中，输入层为工业机器人柔性关节的转矩x＝(x

h′

其中，W

为了提高LSTM迟滞模型对关节迟滞特性的描述精度，从在幅值和相位上存在的误差角度考虑，在LSTM迟滞模型后串联一个RBF动态神经网络，称为改进的LSTM迟滞模型。

RBF神经网络具有计算量少、学习速度快、学习方法简单等优点，同时具有良好的数据局部逼近能力以及泛化能力。改进的LSTM神经网络结构如图3所示。图3中，RBF动态神经网络是一种三层前馈神经网络：输入层、隐含层和输出层。输入向量u为：

u＝[h′

其中，y

RBF动态神经网络模型如下：

其中，c

当损失函数过大时，RBF动态神经网络通过梯度下降法调整网络权值。网络的损失函数E

其中，y

网络权值调节：

其中，0＜η＜1为学习速率，0＜α＜1为动量因子，Δw

改进的LSTM迟滞模型及参数学习如图4所示，模型由两部分串联组成：第一部分是LSTM迟滞模型，其输入信号为柔性关节当前时刻t的实际转矩x

柔性关节设定理想的输入角度为p

其中，p是转矩的函数，表现为复杂非线性迟滞特性。

通过所建立的改进的LSTM迟滞模型，得到柔性关节在下一时刻t+1时刻角度的预测输出角度p

其中，p

将关节输出端误差折算到关节输入端，机器人关节驱动电机角度设定值控制补偿后，其补偿后设定输入角度

其中，p

由于本发明的迟滞模型具有在线学习功能，所以，由于机械摩擦、加工工艺因素等影响，柔性关节特性出现的慢漂移，通过转换误差补偿控制，同样对关节慢漂移带来的关节传递误差，实现有效补偿，以提要关节长期运行的稳定性。

本发明所提出的一种基于LSTM工业机器人柔性关节迟滞误差补偿控制方法，包括步骤如下：

步骤1、采集柔性关节在当前时刻t的实际转矩x

步骤2、采集柔性关节在上一时刻t-1的实际输出角度y

步骤3、计算柔性关节在下一时刻t+1的补偿后设定输入角度

式中，p

步骤4、将下一时刻t+1的补偿后设定输入角度

实现上述方法的一种基于LSTM工业机器人柔性关节迟滞误差补偿控制，如图5所示，包括编码角度检测器、转矩检测器、模数转换器和微控制器。编码角度检测器和转矩检测器设置在柔性关节上，其中编码角度检测器用于采集柔性关节在各时刻的实际输出角度，转矩检测器用于采集柔性关节在各时刻的实际转矩。编码角度检测器和转矩检测器的输出端均经由模数转换器与控制器的输入端连接。微控制器接受到关节转矩信息和角度信息，建立转矩与角度的迟滞预测模型(改进的LSTM迟滞模型)，通过迟滞预测模型，预测当前下一时刻，即t+1时刻的角度，并计算转换误差补偿量，结合关节在理想情况下关节驱动端设定输入角度，得到补偿后关节驱动电机实际的输入角度，微控制器的输出是关节的驱动电机端角度补偿后输入角度设定值。转矩与角度的迟滞模型具有在线学习能力，不仅能在线补偿工业机器人柔性关节本身结构带来传递非线性误差，而且同时能补偿工业机器人关节在长时间运行下的慢漂移特性带来转换误差。基于改进的LSTM迟滞模型的关节补偿控制实现结构图如图5所示。

针对工业机器人柔性关节的复杂迟滞特性，本发明搭建了一个基于改进的LSTM的工业机器人柔性关节迟滞特性模型，并基于迟滞模型的预测输出，设计在线非线性补偿控制方法。该模型在线预测机器人关节输出角度，通过与理想关节输出比较，计算得到输出扭矩角，对应得到关节输入端的角度补偿量，对关节输入端设定输入角度进行补偿，从关节的电机驱动端，实现对关节复杂迟滞特性抵消，有效提高工业机器人关节转换精度。迟滞模型具有在线学习能力，不仅在线补偿工业机器人关节本身结构带来传递非线性误差，同时可补偿工业机器人关节在长时间运行下的慢漂移特性带来转换误差，提高了关节长期运行的保持高精度下的稳定性。所发明的柔性关节传递非线性误差补偿控制方法易于与工业机器人产品配合，提高工业机器人整体执行精度。

需要说明的是，尽管以上本发明所述的实施例是说明性的，但这并非是对本发明的限制，因此本发明并不局限于上述具体实施方式中。在不脱离本发明原理的情况下，凡是本领域技术人员在本发明的启示下获得的其它实施方式，均视为在本发明的保护之内。