smart_hand

第1章:灵巧手概述与基础理论

本章概要

本章系统介绍灵巧手的发展历程、基础理论框架以及核心数学模型。通过学习本章,读者将建立对灵巧手技术的全局认识,掌握运动学、动力学建模的基本方法,理解抓取理论的数学基础。这些知识将为后续章节的机构设计、控制算法学习奠定坚实基础。

学习目标:


1.1 灵巧手的历史演进与技术路线

1.1.1 发展历程

灵巧手技术的发展可以追溯到20世纪60年代。1962年,Tomovic和Boni开发了Belgrade手,这是最早的仿生机械手之一,采用简单的连杆机构实现手指弯曲。这一时期的设计主要受限于驱动技术和控制理论的不成熟。

70-80年代,随着微处理器的普及,灵巧手进入快速发展期。代表性成果包括:

90年代至今,灵巧手技术向着高集成度、智能化方向发展:

1.1.2 技术路线分类

现代灵巧手的技术路线可从多个维度进行分类:

按驱动方式:

┌─────────────────────────────────────────────┐
│             灵巧手驱动方式分类               │
├─────────────────────────────────────────────┤
│                                             │
│  ┌──────────┐    ┌──────────┐    ┌────────┐│
│  │ 腱驱动   │    │ 直接驱动 │    │ 混合   ││
│  │ (Tendon) │    │ (Direct) │    │(Hybrid)││
│  └──────────┘    └──────────┘    └────────┘│
│       ↓              ↓              ↓       │
│   远程驱动      关节集成电机    刚柔结合    │
│   高力重比      高精度控制      优势互补    │
└─────────────────────────────────────────────┘

按控制策略:

1.1.3 性能指标体系

评价灵巧手性能的关键指标包括:

  1. 运动能力
    • 自由度数量(DoF):决定了操作的灵活性
      • 人手:约24个主动自由度
      • 典型灵巧手:12-24个自由度
      • 简化设计:9-12个自由度
    • 工作空间体积:可达点的三维空间范围
      • 定量计算:$V = \int_{\Theta} \det(J(\theta)) d\theta$
      • 相对工作空间:与手掌尺寸的比值
    • 最大关节速度/加速度
      • 速度:典型值 180-360°/s
      • 加速度:典型值 1000-5000°/s²
    • 运动分辨率:最小可控角度增量(典型值:0.1-1°)
  2. 力能力
    • 指尖力(典型值:10-40N)
      • 精确操作:2-5N
      • 一般抓取:10-20N
      • 力量抓取:20-40N
    • 抓取力(典型值:50-200N)
      • 与负载能力直接相关
      • 安全系数:通常取2-3倍工作负载
    • 力控制精度(典型值:0.1-1N)
      • 取决于传感器分辨率和控制算法
      • 带宽:力控制环路的响应频率(10-100Hz)
    • 力矩能力:关节级扭矩输出
      • MCP关节:1-5 Nm
      • PIP/DIP关节:0.5-2 Nm
  3. 感知能力
    • 触觉分辨率
      • 空间分辨率:1-2mm(接近人手水平)
      • 力分辨率:0.01-0.1N
      • 温度感知:精度±1°C(如需要)
    • 采样频率(典型值:100-1000Hz)
      • 位置反馈:>1000Hz
      • 力/触觉反馈:100-500Hz
      • 视觉反馈:30-60Hz
    • 多模态融合能力
      • 视触觉融合:提高抓取成功率20-30%
      • 本体感知+外部感知融合
    • 滑动检测能力:检测延迟<50ms
  4. 系统性能
    • 响应时间(典型值:10-100ms)
      • 控制环路延迟:<10ms
      • 感知-动作延迟:50-100ms
      • 任务级响应:100-500ms
    • 功重比
      • 整手重量:0.5-2kg
      • 峰值功耗:50-200W
      • 持续功耗:20-100W
    • 可靠性(MTBF)
      • 商用产品:>10,000小时
      • 研究原型:>1,000小时
      • 关键部件寿命:>100万次循环
    • 成本效益
      • 材料成本:$1,000-50,000
      • 制造复杂度:标准机加工vs增材制造
      • 维护成本:年度维护费用占比

1.1.4 技术发展趋势

当前灵巧手技术的发展呈现以下趋势:

智能化趋势:

材料与制造革新:

系统集成优化:

应用领域拓展:


1.2 人手生物力学与仿生设计原理

1.2.1 人手解剖结构

人手包含27块骨骼、39块肌肉、众多韧带和肌腱,是自然界最精妙的操作器官。从工程角度分析其结构特征:

骨骼系统:

      掌骨(Metacarpals)
           │
    ┌──────┼──────┐
    │      │      │
 近节骨  中节骨  远节骨
  (PP)    (MP)    (DP)
    │      │      │
    └──────┴──────┘
       指骨链

每个手指(除拇指外)具有3个指骨,通过关节连接:

肌腱系统:

人手采用了巧妙的远程驱动策略,主要肌肉位于前臂,通过肌腱传递力量。这种设计带来的优势:

1.2.2 生物力学特性

关节耦合:

人手指存在自然的关节耦合关系,最典型的是PIP和DIP关节的耦合:

\[\theta_{DIP} \approx \frac{2}{3} \theta_{PIP}\]

这种耦合由肌腱结构决定,简化了控制复杂度。

抓取模式分类:

根据Cutkosky的分类法,人手抓取可分为:

  1. 力量抓取(Power Grasp)
    • 圆柱抓取
    • 球形抓取
    • 钩形抓取
  2. 精确抓取(Precision Grasp)
    • 指尖捏取
    • 三指抓取
    • 侧捏

触觉感知:

人手皮肤包含四种主要机械感受器:

感受器密度分布:

1.2.3 仿生设计原则

基于人手生物力学的理解,仿生设计应遵循以下原则:

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. 安全性设计

本质安全设计理念:


1.3 运动学建模:D-H参数法与螺旋理论

1.3.1 D-H参数法

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\)

1.3.2 螺旋理论

螺旋理论提供了统一描述刚体运动的数学框架,特别适合分析灵巧手的复杂运动。

螺旋表示:

一个螺旋$$可表示为:

\[\$ = \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]\)

1.3.3 工作空间分析

可达工作空间:

手指末端能够到达的所有位置集合:

\[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\]

奇异位形的类型:


1.4 动力学建模:拉格朗日与牛顿-欧拉方法

1.4.1 拉格朗日方法

拉格朗日方法基于能量原理,适合推导闭式动力学方程。

拉格朗日函数:

\[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\]

其中:

1.4.2 牛顿-欧拉方法

牛顿-欧拉方法基于力和力矩平衡,适合递归计算。

前向递归(速度、加速度传播):

\[\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\]

1.4.3 摩擦与非线性效应

实际系统中需考虑多种非线性效应:

摩擦模型:

库仑+粘性摩擦: \(\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\)


1.5 抓取理论基础:力闭合、形闭合与抓取质量度量

1.5.1 接触模型

点接触类型:

  1. 无摩擦点接触(PwoF):只能施加法向力
  2. 有摩擦点接触(PwF):可施加摩擦锥内的力
  3. 软指接触(SF):可施加力和绕法向的力矩

摩擦锥:

库仑摩擦模型下,接触力必须位于摩擦锥内:

\[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\}\]

1.5.2 抓取分析

抓取映射:

从接触力到物体扳手的映射:

\[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\]

形闭合条件:

形闭合要求至少:

有摩擦时数量可减少。

1.5.3 抓取质量度量

力闭包空间:

\[W = \{w | w = G^Tf_c, f_c \in FC\}\]

质量度量指标:

  1. 最小最大扳手: \(Q_1 = \min_{||w||=1} \max\{k | kw \in W\}\)

  2. 抓取矩阵最小奇异值: \(Q_2 = \sigma_{min}(G)\)

  3. 力传递效率: \(Q_3 = \frac{||w||}{||f_c||}\)

  4. 抓取稳定性裕度: \(Q_4 = \min_{i} d(f_i, \partial FC_i)\)