[发明专利]一种基于神经网络的6轴机器人动力学参数辨识方法

摘要

本发明公开了一种基于神经网络的6轴机器人动力学参数辨识方法。步骤如下：第一步：机器人动力学建模以及线性化；第二步：激励轨迹优化，采用人工免疫算法来优化激励轨迹；第三步：实验采样，让机器人跟随激励轨迹运动，获取多组观测矩阵与关节力矩作为实验数据。第四步：数据处理，采用三标准差准则以及中位值平均滤波法对实验采集的数据进行预处理，降低数据噪声带来的影响。第五步：动力学参数估计，采用神经网络对动力学参数进行估计。第六步：参数验证，再让机器人跟随一条与激励轨迹不同的可执行轨迹，再次采样实验数据，根据辨识所得的动力学参数来预测理论关节力矩，用力矩残差根来评价辨识的动力学参数的可靠性。

主权项

1.一种基于神经网络的6轴机器人动力学参数辨识方法，其特征在于包括以下步骤：第一步 动力学建模建立6轴机器人的D‑H连杆坐标系，构建其动力学方程，因为后三轴主要影响机器人末端姿态，对关节力矩的影响小，故不予考虑，主要进行前三关节动力学参数的辨识；根据拉格朗日动力学方程，推导出机器人显性线性表达式，根据最小惯性原理将表达式简化成线性形式，给出需要辨识的动力学参数，观测矩阵；第二步 激励轨迹优化进行关节角度的傅里叶级数展开，为了得到边界连续，关节角速度，角加速度在周期起始等于0的傅里叶级数，需要对它进行优化，以五次多项式来代替常数项，得到改进的傅里叶级数如下：其中i为第i关节,w_f为傅里叶级数的基频，a_ik，b_ik为傅里叶级数，为常数项系数，M为傅里叶级数的阶数。以免疫克隆算法来优化得到傅里叶级数的系数，得到优化的激励轨迹；第三步 实验采样让机器人跟随激励轨迹运动，多个周期，不同时刻用光电编码器采集多组机器人的关节角度，得到多组关节力矩作为实验样本，同时得到电机反馈电流，根据转矩系数，求出电机输出力矩即为关节力矩；第四步 数据处理通过三标准差以及中位值平均滤波法对实验采集的数据进行数据预处理，来降低数据噪声对实验的影响；第五步 动力学参数估计根据实验得到的多组观测矩阵以及关节力矩，通过神经网络来辨识出动力学参数；第六步 参数验证给出一条不同于激励轨迹的可执行轨迹，机器人跟随轨迹运动，多个周期，不同时刻采集多组机器人的关节角度，电机反馈电流，根据所求的动力学参数得到理论的关节力矩与实验得到关节力矩做对比，用力矩残差根来评价动力学参数的可靠性。