1 动力学模型
机械臂的动力学模型包含正向动力学与逆向动力学,其主要的动力学体现如下所示:
其中
和分别为动摩擦和库伦摩擦。
对于 每个刚体,其主要的动力学参数为质量 ,质心位置(COM)
相对于质心的惯量矩阵的参数如下所示:
为了辨识参数,采用“barycentric parameters”, 因此每个连杆的动力学参数分别为质量,, The first moment of inertia, ;
相对于连杆坐标系的惯量张量为:
;
The first moment of inertia相当于质量与质心位置的乘积
;
由此,基于Huygens-Steiner理论
其中S(r_k)为向量的反对称矩阵。
由此,机器人的动力学参数可以表示如下所示:
除了多刚体动力学,机器人还受到关节层其他因素的影响,额外的动力学可以归纳为:
由此,机器人的完整的动力学参数向量可以表示如下
因此,机械臂的动力学方程可以表示如下所示:
进一步进行分离:
上式中,是回归矩阵。
2 机械臂动力学参数辨识概述
机器人动力学参数可以通过以下三种模式获得:
- 通过计算机CAD模型得到;
- 单个部件的动力学实验标定;
- 通过整个模型回归矩阵的辨识;
常规的回归矩阵辨识方法涉及到采集大量的实验数据,在每个采集周期中,机械臂沿着特定的激励轨迹运动,且需要采集到关节位置以及力。经过次测量(),可以得到:
回归向量:
由此机械臂的动力学可以表示为:
采用最小二乘(ordinary least squares,OLS)得到局部最优解:
然而,除了一些非常特殊的例外,所有机器人都具有回归功能一些空列和一些线性地依赖于它们之间的列。这些列对应于标准动态参数,没对动力学的影响以及对具有比例贡献的参数的影响.
are linearly independent columns of , are the remain null and dependent columns
因而系统辨识任务转化为:
采用最小二乘得到局部最优解:
新的回归矩阵有:
因而