一种多手指机器人动力学解析模型及其建模方法

摘要

本发明的提供了一种多手指机器人动力学解析模型及其建模方法，首先建立系统约束表达式，获得系统虚位移与约束条件的关系；其次，求解虚位移向量通解，并将其带入虚功原理表达式，得到可以简化动力学模型中约束力的关系式；然后，采用简化关系式处理系统无约束时的运动方程，结合处理结果和约束表达式构造取代奇异质量矩阵的质量补充矩阵；最后，利用质量补充矩阵求解系统质量矩阵奇异时的手指机器人动力学解析模型，得到了质量矩阵奇异时的依然有解的模型。

主权项

一种多手指机器人动力学解析模型，其特征在于：所述的多手指机器人动力学解析模型为手指与抓取对象之间纯滚动约束条件下的动力学模型，具体模型如下所述：$\stackrel{··}{q}={\left[\begin{array}{c}(I-A^{+}(\stackrel{·}{q},q)A(\stackrel{·}{q},q))M\left(q\right)\\ A(\stackrel{·}{q},q)\end{array}\right]}^{+}\left[\begin{array}{c}\hat{Q}(\stackrel{·}{q},q)\\ b(\stackrel{·}{q},q)\end{array}\right]$式中：q为系统广义坐标向量；为系统广义速度向量；为系统广义加速度向量；I为单位矩阵；M(q)为系统质量矩阵；为系统约束二阶表达式系数矩阵；为系统约束二阶表达式常数项矩阵；为系统外力向量。