一种足式机器人动力学参数辨识方法技术

本发明专利技术公开了一种足式机器人动力学参数辨识方法，属于机器人动力学参数辨识领域，该辨识方法具体步骤如下：(1)通过常规机械尺寸测量技术获取各连杆及基座或浮动基座几何尺寸，再对机器人建立动力学模型；(2)根据基本代数原理将所述动力学模型写为线性形式并提取最简惯性参数集相关部分，保留与基座相关部分；(3)设计普通运动逐项测试和激励轨迹两种可选用的实验方法进行激励测试；(4)根据两种可选用的实验方法进行摩擦辨识和足端与环境间摩擦辨识；本发明专利技术能够独立辨识机器人的惯性参数、摩擦参数以及机器人与环境间的摩擦参数，其参数准确程度与机器人精度相同，为足式机器人控制提供了准确的模型参数。

【技术实现步骤摘要】
一种足式机器人动力学参数辨识方法
本专利技术涉及机器人动力学参数辨识领域，包含各类多刚体或单刚体构造的、固定基座或浮动基座的双足机器人和四足机器人等多足机器人的动力学参数辨识方法，尤其涉及一种面向足式多体机器人的动力学参数辨识方法。
技术介绍
经检索，中国专利号CN109773794A公开了一种基于神经网络的6轴机器人动力学参数辨识方法，该专利技术辨识精度较低，且通用性差；基于机器人动力学模型的控制方法是与环境交互的机器人控制的必须方法，这类方法依赖于准确的动力学参数，目前国内外尚未出现公开的参数辨识方法，相关参数仍通过CAD模型虚拟测量，或将机器人拆卸后使用外部仪器测量，通过CAD模型虚拟测量因建模误差、加工误差、软件准确度、材料属性准确度、及存在不可建模或未知属性的构造模块(如集成电路、线材等)，而导致虚拟测量结果与实际机器人间存在不可避免的差异，且误差随机器人结构复杂度增加而增大，造成测量参数不准，拆卸后使用外部仪器测量因存在不可完全拆卸部件(如轴承内外环)、拆解后不可测量的参数(如关节摩擦)、每次安装存在位置差异(如线材等)、测量仪器精度不足，以及部件本身存在难以通过仪器测量的参数(如不规则曲面的重心位置及转动惯量等)而导致测量参数不完整、不准确；因此专利技术出一种面向足式多体机器人的动力学参数辨识方法变得尤为重要。
技术实现思路
本专利技术的目的是为了解决现有技术中存在的缺陷，而提出的一种足式机器人动力学参数辨识方法。为了实现上述目的，本专利技术采用了如下技术方案：一种足式机器人动力学参数辨识方法，该辨识方法具体步骤如下：(1)通过常规机械尺寸测量技术获取各连杆及基座或浮动基座几何尺寸，再对机器人建立动力学模型；(2)根据基本代数原理将步骤(1)中所述动力学模型写为线性形式并提取最简惯性参数集相关部分，保留与基座相关部分；(3)设计普通运动逐项测试和激励轨迹两种可选用的实验方法进行激励测试；(4)根据步骤(3)两种可选用的实验方法进行摩擦辨识和足端与环境间摩擦辨识，同时通过数学优化的数据处理方法得到机器人的惯性参数、摩擦参数以及机器人与环境间的摩擦参数。进一步地，步骤(1)所述动力学模型可以针对机器人整体进行建立，也可以针对机器人简化模型进行建立，且仅考虑有效连杆，即不包含虚自由度连杆，对于虚自由连杆进行单独处理。进一步地，步骤(2)所述线性形式如下：式中：是关于θ1,θ2及其各阶导数以及各连杆长度的回归矩阵，其行数为关节数量，列数为10倍有效连杆数量(每个连杆含10个待辨识参数)；是惯性参数向量，Φi维度为10，每个维度上分别为一个待辨识参数；所述Φi具体公式如下：Φi＝[mi，pxi，pyi，pzi，iixx，iiyy，iizz，iixy，iixz，iiyz](2)式中：m为连杆质量；p为质心位置分量；i为转动惯量分量；将线性形式化为最简惯性参数集：式中：B是最简惯性参数的个数；φB是最简参数向量；Y1BY2B分别是最简惯性参数的回归矩阵；取出最简参数集中和基连杆相关的部分：写为：YmotionΦ＝fmotion(5)所述回归矩阵公式如下：式中：字母左上角标表示所在的连杆坐标系，右下角标表示连杆序数，回归矩阵内各子矩阵由通用机器人运动学动力学求得。进一步地，所述普通运动逐项测试的实验方法过程如下：S1：让机器人特定关节进行特定运动；S2：根据运动结果和关节力矩结果，得到动力学参数特性；所述激励轨迹的实验方法过程如下：SS1：通过构建求解优化问题得到可激励各参数的激励轨迹，控制机器人按该轨迹运动；SS2：根据激励轨迹测量数据；所述优化问题具有约束条件，主要包括关节角位置约束和关节角速度约束硬件约束，其具体形式如下：式中：Φij是φ的第(i，j)个元素，λ1λ2是权重项；所述优化问题在得到关于YmotionΦ＝fmotion足够多的数据，进行数据预处理，得到最优化问题，去具体形式如下：式中：ΦCAD是通过CAD获取的参数值，α||Φ-ΦCAD||2一项是对CAD模型的兼顾，α是CAD模型所占权重；所述最优化问题的约束条件主要包括每一连杆质量非负数；所有连杆质量和与总质量相等；连杆质心处于连杆上各点组成凸集内；转到惯量矩阵各元素均正定；机器人的对称设计处动力学参数对称；当不考虑CAD模型时，取α＝0，所述优化问题变为最小二乘优化问题，此时公式如下：Φ＝(YTmotionYmotion)-1YTmotionfmotion(10)。进一步地，所述摩擦辨识过程如下：SSS1：建立模型：将复杂的关节摩擦抽象象为库仑摩擦和粘摩擦两部分的和，为每个关节建立如下摩擦力模型：式中：Fc表示库伦摩擦，Fv表示粘摩擦，角标i表示第i个关节；表示关节速度；SSS2：实验方法：各个关节逐个测量，测量第i个关节时，将机器人固定至该关节轴线与重力方向相同姿态，消除重力影响，通过控制该关节执行以正弦波轨迹为代表的速度轨迹运动，或简单的匀速运动等，记录关节加速度为0时的关节力矩与关节速度；SSS3：数据处理：建立如下摩擦参数模型：进一步地，所述足端与环境间摩擦辨识过程如下：SSSS1：建立模型：考虑当前控制方法，建立如下足端与环境之间的摩擦模型为摩擦锥模型：式中：μ为摩擦系数；SSSS2：实验方法：使机器人站立在待测量表面上，将机器人基连杆在与待测量表面平行方法被固定，其他方向不固定，控制机器人足端施加与接触面平行的力，记录刚刚发生打滑时的足端力或关节力矩和关节运动参数；SSSS3：数据处理：用所记录的足端力带入模型中求出摩擦系数μ，或用所记录关节力矩和关节运动参数求出足端力，再带入模型中求出摩擦系数μ。进一步地，所述动力学模型形式如下：式中：M(θ)是惯性矩阵，包含科里奥利力、离心力和重力，θ是关节角向量，τ是关节力矩向量，f是与外部环境接触力，JT是把接触力映射为关节力矩的雅可比矩阵；所述动力学模型形式是当前通用动力学模型形式，同时符合单连杆动力学模型、多连杆动力学模型和机器人整体的浮动基座动力学模型，其中各项的维度、计算方式和所处坐标系根据实际情况决定。进一步地，所述浮动基座动力学模型公式如下：式中：第一行表达浮动基座动力学模型，第二行表达其他部分动力学模型，Mij是惯性矩阵；是描述浮动基座位置和方向的向量，是描述子连杆运动自由度上的位置向量；H1,H2分别是基连杆和子连杆的离心力、科里奥利力和重力的合力；τ是关节的力或力矩；fk是作用在第k个与环境接触点的外力；Nc是接触点的个数；J1,J2是在第k个接触点的把外力映射到关节空间和基座的雅可比矩阵。相比于现有技术，本专利技术的有益效果在于：本文档来自技高网...

【技术保护点】
1.一种足式机器人动力学参数辨识方法，其特征在于，该辨识方法具体步骤如下：/n(1)通过常规机械尺寸测量技术获取各连杆及基座或浮动基座几何尺寸，再对机器人建立动力学模型；/n(2)根据基本代数原理将步骤(1)中所述动力学模型写为线性形式并提取最简惯性参数集相关部分，保留与基座相关部分；/n(3)设计普通运动逐项测试和激励轨迹两种可选用的实验方法进行激励测试；/n(4)根据步骤(3)两种可选用的实验方法进行摩擦辨识和足端与环境间摩擦辨识，同时通过数学优化的数据处理方法得到机器人的惯性参数、摩擦参数以及机器人与环境间的摩擦参数。/n

【技术特征摘要】
1.一种足式机器人动力学参数辨识方法，其特征在于，该辨识方法具体步骤如下：
(1)通过常规机械尺寸测量技术获取各连杆及基座或浮动基座几何尺寸，再对机器人建立动力学模型；
(2)根据基本代数原理将步骤(1)中所述动力学模型写为线性形式并提取最简惯性参数集相关部分，保留与基座相关部分；
(3)设计普通运动逐项测试和激励轨迹两种可选用的实验方法进行激励测试；
(4)根据步骤(3)两种可选用的实验方法进行摩擦辨识和足端与环境间摩擦辨识，同时通过数学优化的数据处理方法得到机器人的惯性参数、摩擦参数以及机器人与环境间的摩擦参数。


2.根据权利要求1所述的一种足式机器人动力学参数辨识方法，其特征在于，步骤(1)所述动力学模型可以针对机器人整体进行建立，也可以针对机器人简化模型进行建立，且仅考虑有效连杆，即不包含虚自由度连杆，对于虚自由连杆进行单独处理。


3.根据权利要求1所述的一种足式机器人动力学参数辨识方法，其特征在于，步骤(2)所述线性形式如下：



式中：是关于θ1,θ2及其各阶导数以及各连杆长度的回归矩阵，其行数为关节数量，列数为10倍有效连杆数量(每个连杆含10个待辨识参数)；是惯性参数向量，Φi维度为10，每个维度上分别为一个待辨识参数；
所述Φi具体公式如下：
Φi＝[mi，pxi，pyi，pzi，iixx，iiyy，iizz，iixy，iixz，iiyz](2)
式中：m为连杆质量；p为质心位置分量；i为转动惯量分量；
将线性形式化为最简惯性参数集：



式中：B是最简惯性参数的个数；φB是最简参数向量；Y1BY2B分别是最简惯性参数的回归矩阵；
取出最简参数集中和基连杆相关的部分：



写为：
YmotionΦ＝fmotion(5)
所述回归矩阵公式如下：






式中：字母左上角标表示所在的连杆坐标系，右下角标表示连杆序数，回归矩阵内各子矩阵由通用机器人运动学动力学求得。


4.根据权利要求1所述的一种足式机器人动力学参数辨识方法，其特征在于，所述普通运动逐项测试的实验方法过程如下：
S1：让机器人特定关节进行特定运动；
S2：根据运动结果和关节力矩结果，得到动力学参数特性；
所述激励轨迹的实验方法过程如下：
SS1：通过构建求解优化问题得到可激励各参数的激励轨迹，控制机器人按该轨迹运动；
SS2：根据激励轨迹测量数据；
所述优化问题具有约束条件，主要包括关节角位置约束和关节角速度约束硬件约束，其具体形式如下：



式中：Φij是φ的第(i，j)个元素，λ1λ2是权重项；
所述优化问题在得到关于YmotionΦ＝fmotion足够多的数据，进行数据预处理，得到最优化问题，去具体形式如下：



式中：ΦCAD是通过CAD获取的参数值，α||Φ-ΦCAD||2一项是对CA...

【专利技术属性】
技术研发人员：杨宏强，阮清源，王雍雯，李元基，姜杰翔，
申请(专利权)人：陕西知感通和物联科技有限公司，
类型：发明
国别省市：陕西;61