本章系统介绍灵巧手的发展历程、基础理论框架以及核心数学模型。通过学习本章,读者将建立对灵巧手技术的全局认识,掌握运动学、动力学建模的基本方法,理解抓取理论的数学基础。这些知识将为后续章节的机构设计、控制算法学习奠定坚实基础。
学习目标:
灵巧手技术的发展可以追溯到20世纪60年代。1962年,Tomovic和Boni开发了Belgrade手,这是最早的仿生机械手之一,采用简单的连杆机构实现手指弯曲。这一时期的设计主要受限于驱动技术和控制理论的不成熟。
70-80年代,随着微处理器的普及,灵巧手进入快速发展期。代表性成果包括:
90年代至今,灵巧手技术向着高集成度、智能化方向发展:
现代灵巧手的技术路线可从多个维度进行分类:
按驱动方式:
┌─────────────────────────────────────────────┐
│ 灵巧手驱动方式分类 │
├─────────────────────────────────────────────┤
│ │
│ ┌──────────┐ ┌──────────┐ ┌────────┐│
│ │ 腱驱动 │ │ 直接驱动 │ │ 混合 ││
│ │ (Tendon) │ │ (Direct) │ │(Hybrid)││
│ └──────────┘ └──────────┘ └────────┘│
│ ↓ ↓ ↓ │
│ 远程驱动 关节集成电机 刚柔结合 │
│ 高力重比 高精度控制 优势互补 │
└─────────────────────────────────────────────┘
按控制策略:
评价灵巧手性能的关键指标包括:
| 定量计算:$V = \int_{\Theta} | \det(J(\theta)) | d\theta$ |
当前灵巧手技术的发展呈现以下趋势:
智能化趋势:
材料与制造革新:
系统集成优化:
应用领域拓展:
人手包含27块骨骼、39块肌肉、众多韧带和肌腱,是自然界最精妙的操作器官。从工程角度分析其结构特征:
骨骼系统:
掌骨(Metacarpals)
│
┌──────┼──────┐
│ │ │
近节骨 中节骨 远节骨
(PP) (MP) (DP)
│ │ │
└──────┴──────┘
指骨链
每个手指(除拇指外)具有3个指骨,通过关节连接:
肌腱系统:
人手采用了巧妙的远程驱动策略,主要肌肉位于前臂,通过肌腱传递力量。这种设计带来的优势:
关节耦合:
人手指存在自然的关节耦合关系,最典型的是PIP和DIP关节的耦合:
\[\theta_{DIP} \approx \frac{2}{3} \theta_{PIP}\]这种耦合由肌腱结构决定,简化了控制复杂度。
抓取模式分类:
根据Cutkosky的分类法,人手抓取可分为:
触觉感知:
人手皮肤包含四种主要机械感受器:
感受器密度分布:
基于人手生物力学的理解,仿生设计应遵循以下原则:
1. 功能优先原则
不必完全复制人手结构,而应根据任务需求进行功能抽象:
\[\text{设计目标} = \text{任务需求} \cap \text{生物启发} \cap \text{工程约束}\]功能映射策略:
案例:抓取圆柱体
2. 欠驱动设计
利用机械智能减少控制复杂度:
数学描述: \(n_{actuator} < n_{DOF}\) \(\tau = J^T(\theta)f_{actuator}\)
其中通过机械设计使$J^T$具有特定结构,实现期望的运动模式。
3. 模块化与标准化
采用模块化设计提高可维护性:
设计准则: \(\text{模块粒度} = \frac{\text{功能独立性}}{\text{接口复杂度}}\)
4. 刚柔并济
结合刚性骨架与柔性元素:
刚度设计原则: \(K_{effective} = \frac{K_{rigid} \cdot K_{soft}}{K_{rigid} + K_{soft}}\)
通过串并联配置实现可变刚度。
5. 感知驱动设计
将感知能力作为设计的核心考虑:
6. 安全性设计
本质安全设计理念:
Denavit-Hartenberg(D-H)参数法是描述机器人运动链的标准方法。对于灵巧手的每个手指,可建立连续的坐标系。
D-H参数定义:
齐次变换矩阵:
\[^{i-1}T_i = \begin{bmatrix} \cos\theta_i & -\sin\theta_i\cos\alpha_i & \sin\theta_i\sin\alpha_i & a_i\cos\theta_i \\ \sin\theta_i & \cos\theta_i\cos\alpha_i & -\cos\theta_i\sin\alpha_i & a_i\sin\theta_i \\ 0 & \sin\alpha_i & \cos\alpha_i & d_i \\ 0 & 0 & 0 & 1 \end{bmatrix}\]手指运动学示例:
以典型的3自由度手指为例:
| Link | $a_i$ | $\alpha_i$ | $d_i$ | $\theta_i$ |
|---|---|---|---|---|
| 1 | 0 | 90° | 0 | $\theta_1$ |
| 2 | $l_1$ | 0 | 0 | $\theta_2$ |
| 3 | $l_2$ | 0 | 0 | $\theta_3$ |
末端位置: \(^0T_3 = ^0T_1 \cdot ^1T_2 \cdot ^2T_3\)
螺旋理论提供了统一描述刚体运动的数学框架,特别适合分析灵巧手的复杂运动。
螺旋表示:
一个螺旋$$可表示为:
\[\$ = \begin{bmatrix} \omega \\ v \end{bmatrix}\]其中$\omega$是角速度,$v$是线速度。
旋量指数映射:
刚体运动可通过指数映射表示:
\[T = e^{[\$]\theta} = I + [\$]\sin\theta + [\$]^2(1-\cos\theta)\]其中$[$]$是螺旋的李代数表示。
雅可比矩阵:
空间雅可比矩阵描述了关节速度与末端速度的映射关系:
\[V = J_s\dot{\theta}\]其中: \(J_s = [\$_1 | \text{Ad}_{T_1}\$_2 | \cdots | \text{Ad}_{T_1\cdots T_{n-1}}\$_n]\)
可达工作空间:
手指末端能够到达的所有位置集合:
\[W_r = \{p \in \mathbb{R}^3 | p = f(\theta), \theta \in \Theta\}\]灵巧工作空间:
末端能以任意姿态到达的位置集合:
\[W_d = \{p \in \mathbb{R}^3 | \forall R \in SO(3), \exists \theta: f(\theta) = (p, R)\}\]奇异性分析:
当雅可比矩阵降秩时出现奇异性:
\[\det(J) = 0\]奇异位形的类型:
拉格朗日方法基于能量原理,适合推导闭式动力学方程。
拉格朗日函数:
\[L = K - P\]其中$K$是动能,$P$是势能。
对于n自由度系统:
\[K = \frac{1}{2}\sum_{i=1}^{n}\sum_{j=1}^{n}M_{ij}(\theta)\dot{\theta}_i\dot{\theta}_j\] \[P = \sum_{i=1}^{n}m_ig^Tp_{ci}(\theta)\]动力学方程:
\[\frac{d}{dt}\left(\frac{\partial L}{\partial \dot{\theta}_i}\right) - \frac{\partial L}{\partial \theta_i} = \tau_i\]展开后得到标准形式:
\[M(\theta)\ddot{\theta} + C(\theta,\dot{\theta})\dot{\theta} + G(\theta) = \tau\]其中:
牛顿-欧拉方法基于力和力矩平衡,适合递归计算。
前向递归(速度、加速度传播):
\[\omega_{i+1} = R_{i+1}^i\omega_i + \dot{\theta}_{i+1}z_{i+1}\] \[\dot{\omega}_{i+1} = R_{i+1}^i\dot{\omega}_i + R_{i+1}^i\omega_i \times \dot{\theta}_{i+1}z_{i+1} + \ddot{\theta}_{i+1}z_{i+1}\]后向递归(力、力矩传播):
\[f_i = R_{i+1}^if_{i+1} + m_i\dot{v}_{ci}\] \[n_i = R_{i+1}^in_{i+1} + p_{ci} \times m_i\dot{v}_{ci} + I_i\dot{\omega}_i + \omega_i \times I_i\omega_i\]关节力矩:
\[\tau_i = n_i^Tz_i\]实际系统中需考虑多种非线性效应:
摩擦模型:
库仑+粘性摩擦: \(\tau_f = F_c \text{sgn}(\dot{\theta}) + F_v\dot{\theta}\)
Stribeck效应: \(\tau_f = [F_c + (F_s - F_c)e^{-|\dot{\theta}/v_s|^2}]\text{sgn}(\dot{\theta}) + F_v\dot{\theta}\)
柔性效应:
关节柔性模型(Spong): \(M(\theta)\ddot{\theta} + h(\theta,\dot{\theta}) = K(\theta_m - \theta)\) \(J_m\ddot{\theta}_m + K(\theta_m - \theta) = \tau_m\)
点接触类型:
摩擦锥:
库仑摩擦模型下,接触力必须位于摩擦锥内:
\[FC = \{f \in \mathbb{R}^3 | f_n > 0, \sqrt{f_t^2 + f_o^2} \leq \mu f_n\}\]线性化摩擦锥(m面体近似):
\[FC_{lin} = \{f | Af \leq 0\}\]抓取映射:
从接触力到物体扳手的映射:
\[w = G^Tf_c\]其中$G$是抓取矩阵:
\[G = \begin{bmatrix} I & I & \cdots & I \\ r_1 \times & r_2 \times & \cdots & r_n \times \end{bmatrix}\]力闭合条件:
抓取实现力闭合当且仅当:
\[\text{rank}(G) = 6 \quad \text{且} \quad \exists f_c > 0: G^Tf_c = 0\]形闭合条件:
形闭合要求至少:
有摩擦时数量可减少。
力闭包空间:
\[W = \{w | w = G^Tf_c, f_c \in FC\}\]质量度量指标:
最小最大扳手: \(Q_1 = \min_{||w||=1} \max\{k | kw \in W\}\)
抓取矩阵最小奇异值: \(Q_2 = \sigma_{min}(G)\)
力传递效率: \(Q_3 = \frac{||w||}{||f_c||}\)
抓取稳定性裕度: \(Q_4 = \min_{i} d(f_i, \partial FC_i)\)