smart_hand

第3章:连杆驱动机构

章节大纲

  1. 四连杆机构:曲柄摇杆与双摇杆设计
    • 基本类型与格拉肖夫判据
    • 运动特性分析
    • 灵巧手中的应用
  2. 平行四边形机构与远程中心机构
    • 平行四边形的运动传递特性
    • 远程中心(RCM)机构原理
    • 手术机器人中的应用
  3. 凸轮机构与槽轮机构
    • 凸轮轮廓设计
    • 槽轮间歇运动
    • 精确运动控制
  4. 运动综合:图解法与解析法
    • 两位置、三位置综合
    • 函数生成与轨迹生成
    • 优化目标函数
  5. 机构优化:避免奇异位形与死点
    • 奇异性分析
    • 传动角优化
    • 动力学性能指标
  6. 工业案例:DLR Hand III的连杆传动系统

  7. 高级话题:基于遗传算法的机构综合

引言

连杆机构作为机械传动的基础形式,在灵巧手设计中扮演着至关重要的角色。相比于齿轮传动和腱绳传动,连杆机构具有结构简单、传动可靠、易于实现复杂运动规律等优势。本章将系统介绍连杆机构的设计原理、分析方法和优化技术,并结合灵巧手的具体应用场景,探讨如何通过巧妙的机构设计实现精确的指尖运动控制。

学习目标:

3.1 四连杆机构:曲柄摇杆与双摇杆设计

3.1.1 基本类型与格拉肖夫判据

四连杆机构是最基本的平面连杆机构,由四个刚性杆件通过转动副连接而成。根据各杆件的相对长度关系,四连杆机构可分为三种基本类型:

  1. 曲柄摇杆机构:一个连架杆作整周转动(曲柄),另一个连架杆作往复摆动(摇杆)
  2. 双曲柄机构:两个连架杆均可作整周转动
  3. 双摇杆机构:两个连架杆均作往复摆动

格拉肖夫判据(Grashof’s Criterion)决定了四连杆机构的类型:

设四杆长度分别为 $l_1, l_2, l_3, l_4$,其中 $l_{min}$ 为最短杆,$l_{max}$ 为最长杆,则:

\[l_{min} + l_{max} \leq l_{other1} + l_{other2}\]

3.1.2 运动特性分析

四连杆机构的运动分析包括位置、速度和加速度分析。以曲柄摇杆机构为例:

     B
    /|\
   / | \
  /  |  \
 l2  |  l3
/    |    \
A----+----C
    l1    D
    机架l4

位置分析: 给定曲柄转角 $\theta_2$,求摇杆转角 $\theta_4$

采用矢量环方程: \(\vec{l_2} + \vec{l_3} = \vec{l_1} + \vec{l_4}\)

投影到x、y轴: \(l_2\cos\theta_2 + l_3\cos\theta_3 = l_1 + l_4\cos\theta_4\) \(l_2\sin\theta_2 + l_3\sin\theta_3 = l_4\sin\theta_4\)

速度分析: 对位置方程求导,得到速度关系: \(\omega_4 = \frac{l_2\sin(\theta_2-\theta_3)}{l_4\sin(\theta_4-\theta_3)}\omega_2\)

传动角与压力角: 传动角 $\gamma$ 是连杆与从动件之间的夹角,直接影响机构的传力性能: \(\gamma = |\theta_3 - \theta_4|\)

理想情况下,传动角应保持在 $40° \leq \gamma \leq 140°$ 范围内。

3.1.3 灵巧手中的应用

在灵巧手设计中,四连杆机构主要用于:

  1. 指节耦合运动:通过单一驱动器驱动多个指节协调运动
  2. 力放大机构:利用杠杆原理实现力的放大
  3. 运动缩放:将大行程运动转换为小行程精确运动

设计实例:手指MCP关节的曲柄摇杆机构

   指尖
     |
   DIP关节
     |
   PIP关节  
     |
   连杆l3
    / \
   /   \
  /     \
驱动曲柄 摇杆(指节)
   l2      l4

设计参数选择:

验证格拉肖夫条件: \(10 + 25 = 35 < 15 + 20 = 35\) 临界情况,需要仔细设计避免死点。

3.2 平行四边形机构与远程中心机构

3.2.1 平行四边形机构的运动传递特性

平行四边形机构是一种特殊的四连杆机构,其对边相等且平行。这种机构具有独特的运动传递特性:

  1. 平动传递:连杆始终保持平行移动,无旋转
  2. 1:1传动比:输入输出角速度相等
  3. 高刚度:结构对称,受力均匀

运动学特性: \(\theta_{output} = \theta_{input}\) \(\omega_{output} = \omega_{input}\)

在灵巧手中的典型应用是远距离运动传递

  电机侧              手指侧
    A ——————————— B
    |              |
    |              |
    |              |
    D ——————————— C
  (驱动)          (从动)

优势:

3.2.2 远程中心机构(RCM)原理

远程中心机构能够实现绕空间某一固定点的纯旋转运动,该点称为远程运动中心。在手术机器人和精密操作中应用广泛。

基本原理:通过多个平行四边形机构的组合,使末端执行器绕远程中心点旋转。

双平行四边形RCM机构:

        RCM点
          *
         /|\
        / | \
       /  |  \
      A===B===C
      |   |   |
      |   |   |
      D===E===F
     驱动  中间  末端

运动学分析: 设第一个平行四边形转角为 $\alpha$,第二个为 $\beta$,则末端姿态角: \(\theta_{end} = \alpha + \beta\)

RCM点到基座的距离: \(d_{RCM} = l_1\cos\alpha + l_2\cos(\alpha+\beta)\)

3.2.3 手术机器人中的应用

DaVinci手术机器人的腕部机构就采用了RCM设计,实现了高精度的微创手术操作。

设计要求:

  1. RCM点位置固定(皮肤切口处)
  2. 工作空间大(体内操作)
  3. 运动精度高(亚毫米级)

关键设计参数:

3.3 凸轮机构与槽轮机构

3.3.1 凸轮轮廓设计

凸轮机构能够实现复杂的运动规律,特别适合需要精确运动控制的场合。

基本参数:

常用运动规律:

  1. 等速运动规律: \(s = \frac{h}{\delta}\theta \quad (0 \leq \theta \leq \delta)\)

  2. 等加速等减速运动规律: \(s = \begin{cases} 2h(\frac{\theta}{\delta})^2 & 0 \leq \theta \leq \frac{\delta}{2} \\ h[1-2(1-\frac{\theta}{\delta})^2] & \frac{\delta}{2} \leq \theta \leq \delta \end{cases}\)

  3. 简谐运动规律: \(s = \frac{h}{2}[1-\cos(\frac{\pi\theta}{\delta})]\)

凸轮轮廓设计步骤:

  1. 确定从动件运动规律
  2. 计算压力角,确保 $\alpha_{max} < 30°$
  3. 反转法求轮廓曲线
  4. 检查曲率半径,避免尖点

3.3.2 槽轮机构的间歇运动

槽轮机构(Geneva mechanism)实现间歇转动,常用于需要精确分度的场合。

基本参数:

运动特性:

设计约束: \(r_1 = a\sin(\frac{\pi}{z})\) \(r_2 = a\cos(\frac{\pi}{z})\)

3.3.3 在灵巧手中的精确运动控制

凸轮-槽轮组合机构可实现复杂的手指运动模式:

   凸轮(输入)
      |
   推杆系统
      |
   槽轮(分度)
    / | \
   /  |  \
 指1 指2 指3

应用实例:多指协调抓取机构

3.4 运动综合:图解法与解析法

运动综合是根据预定的运动要求设计机构尺寸的过程。主要分为三类问题:函数生成、轨迹生成和刚体导引。

3.4.1 两位置综合

两位置综合是最基本的综合问题,要求设计四连杆机构使连杆或摇杆通过两个指定位置。

图解法步骤

  1. 给定两个位置 $P_1$、$P_2$ 及对应角度 $\theta_1$、$\theta_2$
  2. 任选基准点 $A$ 作为曲柄固定铰链
  3. 作角平分线确定动铰链 $B$ 的轨迹圆
  4. 选择合适的 $B$ 点位置,完成机构设计

解析法公式: 设计变量:$(x_0, y_0, a, b, c, d)$ 约束方程: \(a\cos\theta_i + b\sin\theta_i + c\cos\phi_i + d\sin\phi_i = x_i - x_0\) \(-a\sin\theta_i + b\cos\theta_i - c\sin\phi_i + d\cos\phi_i = y_i - y_0\)

3.4.2 三位置综合

三位置综合要求机构通过三个指定位置,此时有唯一解。

圆点曲线与圆心曲线

三位置时,圆点曲线和圆心曲线都退化为圆。

Burmester理论: 对于给定的三个位置,存在无穷多个四连杆机构解,它们的铰链点分布在两个圆上。

设计步骤:

  1. 构造位移矩阵 $[D_i]$: \([D_i] = \begin{bmatrix} \cos\Delta\theta_i & -\sin\Delta\theta_i & \Delta x_i \\ \sin\Delta\theta_i & \cos\Delta\theta_i & \Delta y_i \\ 0 & 0 & 1 \end{bmatrix}\)

  2. 求解圆心和半径
  3. 在圆上选择合适的铰链点

3.4.3 函数生成与轨迹生成

函数生成: 实现输入输出角度的函数关系 $y = f(x)$

Chebyshev间距法: 选择精确点位置使误差最小化: \(x_i = \frac{x_{max} + x_{min}}{2} + \frac{x_{max} - x_{min}}{2}\cos\frac{(2i-1)\pi}{2n}\)

轨迹生成: 连杆上某点生成预定轨迹

优化目标函数: \(F = \sum_{i=1}^{n}[(x_i - x_{desired,i})^2 + (y_i - y_{desired,i})^2]\)

约束条件:

3.4.4 灵巧手指尖轨迹设计

设计目标:实现指尖椭圆形运动轨迹,适合包络抓取

设计参数:

采用双摇杆机构+连杆曲线:

  1. 主动摇杆提供基本摆动
  2. 从动摇杆调节轨迹形状
  3. 连杆上选择合适的点作为指尖连接点

优化过程:

初始设计 → 运动仿真 → 轨迹偏差计算 → 参数调整 → 收敛判断

3.5 机构优化:避免奇异位形与死点

3.5.1 奇异性分析

奇异位形是机构失去自由度或获得额外自由度的特殊位置。在这些位置,机构的雅可比矩阵秩降低。

奇异性分类

  1. 边界奇异:机构达到工作空间边界
  2. 内部奇异:机构在工作空间内部失去控制
  3. 构型奇异:多解情况下的分支点

雅可比矩阵分析: 对于四连杆机构: \(J = \frac{\partial(x,y)}{\partial(\theta_2)} = \begin{bmatrix} -l_2\sin\theta_2 - l_3\sin\theta_3\frac{\partial\theta_3}{\partial\theta_2} \\ l_2\cos\theta_2 + l_3\cos\theta_3\frac{\partial\theta_3}{\partial\theta_2} \end{bmatrix}\)

奇异条件:$\det(J) = 0$

3.5.2 死点位置与穿越策略

死点是从动件与连杆共线的位置,此时传动角为0°或180°,机构无法传递运动。

死点判别: \(\sin(\theta_3 - \theta_4) = 0\)

穿越策略

  1. 惯性穿越:利用飞轮储能
  2. 多机构并联:错开死点位置
  3. 辅助机构:在死点附近提供额外驱动

设计实例:曲柄摇杆机构的死点规避

方案1:双曲柄并联,相位差90°
方案2:添加弹簧辅助机构
方案3:优化杆长比,使死点位于不常用位置

3.5.3 传动角优化

传动角直接影响机构的传力性能和效率。

优化目标: \(\max \min_{\theta_2\in[0,2\pi]} |\gamma(\theta_2)|\)

约束条件

优化方法

  1. 解析法:拉格朗日乘数法
  2. 数值法:遗传算法、粒子群算法
  3. 图解法:传动角分布图

3.5.4 动力学性能指标

力传递率: \(\mu = \frac{F_{output}}{F_{input}} = \frac{l_2\sin(\theta_2-\theta_3)}{l_4\sin(\theta_4-\theta_3)}\)

机械效率: \(\eta = \frac{P_{output}}{P_{input}} = \mu \cdot \frac{\omega_4}{\omega_2}\)

动态性能指标

  1. 加速度波动系数: \(K_a = \frac{a_{max} - a_{min}}{a_{mean}}\)

  2. 惯性力平衡度: \(B = \frac{\sum F_{inertia}}{F_{driving}}\)

优化准则:

3.6 工业案例:DLR Hand III的连杆传动系统

3.6.1 系统概述

德国航空航天中心(DLR)开发的DLR Hand III是连杆驱动灵巧手的典范。该手具有15个自由度,采用创新的连杆-腱绳混合传动系统。

技术规格

创新设计特点

  1. 基关节采用万向节连杆机构
  2. 远端关节采用N+1腱绳耦合
  3. 集成式力/力矩传感器
  4. 模块化可更换指节

3.6.2 万向节基关节设计

DLR Hand III的基关节采用独特的万向节连杆设计,实现了2自由度运动:

      指节
        |
    万向节接头
      / | \
     /  |  \
连杆1  连杆2  连杆3
  |     |     |
电机1  电机2  锁定

运动学模型: \(\begin{bmatrix} \theta_{abd} \\ \theta_{flex} \end{bmatrix} = \begin{bmatrix} k_1 & k_2 \\ k_3 & k_4 \end{bmatrix} \begin{bmatrix} \phi_1 \\ \phi_2 \end{bmatrix}\)

其中:

设计优势

3.6.3 耦合传动机构

DIP和PIP关节采用耦合连杆设计,模拟人手的自然运动模式:

耦合关系: \(\theta_{DIP} = k_{couple} \cdot \theta_{PIP}\)

典型耦合系数:$k_{couple} = 0.67$

自适应抓取机制

  1. 初始阶段:PIP关节主导运动
  2. 接触后:DIP关节补偿运动
  3. 稳定抓取:力分配优化

连杆参数优化: 目标函数: \(\min J = w_1 \cdot \Delta_{trajectory} + w_2 \cdot \sigma_{force} + w_3 \cdot V_{mechanism}\)

其中:

3.6.4 性能分析与评估

工作空间分析

动力学性能

可靠性数据

实际应用效果: DLR Hand III在多个任务中展现优异性能:

3.7 高级话题:基于遗传算法的机构综合

3.7.1 问题定义与编码

传统的机构综合方法在处理多目标、多约束问题时存在局限。遗传算法(GA)提供了一种全局优化方案。

设计变量编码: 对于四连杆机构,染色体编码: \(\text{Chromosome} = [l_1, l_2, l_3, l_4, x_0, y_0, \theta_0]\)

适应度函数设计: \(f_{fitness} = \frac{1}{1 + \sum_{i=1}^{n} w_i \cdot e_i + \sum_{j=1}^{m} p_j \cdot c_j}\)

其中:

3.7.2 多目标优化策略

Pareto最优解集: 同时优化多个相互冲突的目标:

  1. 最小化轨迹误差
  2. 最大化传动效率
  3. 最小化机构尺寸
  4. 最大化工作空间

NSGA-II算法流程

1. 初始化种群 P(0)
2. 非支配排序
3. 计算拥挤度
4. 选择、交叉、变异
5. 精英保留策略
6. 迭代直至收敛

3.7.3 约束处理技术

约束类型

  1. 几何约束:格拉肖夫条件、干涉检查
  2. 运动约束:速度、加速度限制
  3. 动力约束:驱动力矩、惯性力
  4. 制造约束:标准件选用、公差配合

自适应惩罚函数: \(p(\vec{x}) = \sum_{i=1}^{m} \lambda_i(t) \cdot \max(0, g_i(\vec{x}))^2\)

其中 $\lambda_i(t)$ 随进化代数自适应调整: \(\lambda_i(t+1) = \begin{cases} \lambda_i(t) \cdot \beta_1 & \text{if best is feasible} \\ \lambda_i(t) \cdot \beta_2 & \text{if best is infeasible} \end{cases}\)

3.7.4 工程应用实例

案例:五指灵巧手的协调机构设计

设计需求:

优化结果:

代码框架(伪代码):

class LinkageGA:
    def __init__(self, pop_size, n_gen):
        self.population = self.init_population(pop_size)
        
    def fitness(self, chromosome):
        mechanism = decode(chromosome)
        trajectory_error = calc_trajectory_error(mechanism)
        efficiency = calc_efficiency(mechanism)
        constraints = check_constraints(mechanism)
        return multi_objective_fitness(
            trajectory_error, 
            efficiency, 
            constraints
        )
    
    def evolve(self):
        for gen in range(n_gen):
            fitness_vals = [self.fitness(ind) for ind in population]
            parents = selection(population, fitness_vals)
            offspring = crossover_mutation(parents)
            population = elitism(population, offspring)

3.7.5 未来发展方向

  1. 机器学习增强
    • 用神经网络学习适应度景观
    • 迁移学习加速收敛
  2. 拓扑优化结合
    • 同时优化机构拓扑和参数
    • 生成式设计方法
  3. 实时自适应
    • 在线参数调整
    • 根据任务动态重构机构

本章小结

本章系统介绍了连杆驱动机构在灵巧手设计中的应用。主要内容包括:

核心概念

  1. 四连杆机构:格拉肖夫判据决定机构类型,传动角影响传力性能
  2. 平行四边形与RCM:实现精确的运动传递和远程中心控制
  3. 凸轮槽轮机构:提供复杂运动规律和间歇运动
  4. 运动综合:图解法直观,解析法精确,优化法全面
  5. 机构优化:避免奇异位形,优化传动性能

关键公式

设计要点

练习题

基础题

题目1:判断四连杆机构类型 给定四杆长度:$l_1=30mm$(机架),$l_2=10mm$,$l_3=35mm$,$l_4=25mm$。判断该机构的类型。

Hint:应用格拉肖夫判据 找出最短杆和最长杆,检验格拉肖夫条件,根据机架位置判断类型。
答案 最短杆:$l_2=10mm$,最长杆:$l_3=35mm$ 格拉肖夫条件:$10+35=45 < 30+25=55$ ✓ 最短杆$l_2$为连架杆,机架$l_1$不是最短杆 因此该机构为曲柄摇杆机构。

题目2:传动角计算 曲柄摇杆机构中,当曲柄转角$\theta_2=60°$时,连杆与摇杆夹角$\theta_3-\theta_4=50°$。求此时的传动角和压力角。

Hint:传动角定义 传动角是连杆与从动件的夹角,压力角是其余角。
答案 传动角:$\gamma = |\theta_3 - \theta_4| = 50°$ 压力角:$\alpha = 90° - \gamma = 40°$ 该传动角在理想范围内(40°-140°)。

题目3:平行四边形机构设计 设计一个平行四边形机构,要求将手掌处的旋转运动传递到指尖,传动距离100mm。给出设计参数。

Hint:平行四边形特性 对边相等且平行,保持1:1传动比。
答案 设计参数: - 上连杆长度 = 下连杆长度 = 100mm - 左连架杆长度 = 右连架杆长度 = 30mm - 传动比 = 1:1 - 角位移传递无误差

题目4:凸轮升程设计 设计一个凸轮机构,基圆半径40mm,要求在120°转角内实现20mm升程,采用等加速等减速运动规律。求60°时的位移。

Hint:分段函数 等加速等减速规律在中点改变加速度方向。
答案 60°时恰好在转折点: 前半段:$s = 2h(\theta/\delta)^2 = 2×20×(60/120)^2 = 10mm$ 或用对称性:升程的一半 = 10mm

挑战题

题目5:机构综合问题 设计一个四连杆机构,使连杆上某点通过三个位置:$P_1(0,0)$,$P_2(30,20)$,$P_3(50,15)$,对应角度为0°、30°、45°。描述设计流程。

Hint:三位置综合理论 使用Burmester理论,构造位移矩阵,求解圆心圆点曲线。
答案 设计流程: 1. 构造位移矩阵$[D_{12}]$和$[D_{13}]$ 2. 求解圆点曲线方程(退化为圆) 3. 求解圆心曲线方程(退化为圆) 4. 在两圆上各选一点作为铰链 5. 验证格拉肖夫条件和传动角 6. 优化选择最佳铰链位置 实际计算需要数值方法求解非线性方程组。

题目6:死点分析与规避 某曲柄摇杆机构在曲柄转角$\theta_2=180°$时出现死点。提出三种不同的解决方案,并分析优缺点。

Hint:死点穿越策略 考虑惯性、并联、辅助等方法。
答案 方案1:飞轮储能 - 优点:结构简单,成本低 - 缺点:增加转动惯量,响应变慢 方案2:双机构并联,相位差90° - 优点:完全消除死点,传动平稳 - 缺点:机构复杂,成本翻倍 方案3:死点位置加装扭簧 - 优点:结构紧凑,可靠性高 - 缺点:扭簧疲劳,需要定期更换 最优方案取决于具体应用需求。

题目7:遗传算法优化设计 用遗传算法优化四连杆机构,目标是生成直线轨迹。设计染色体编码、适应度函数和约束处理方法。

Hint:多目标优化 考虑轨迹误差、机构紧凑性、传动性能等多个目标。
答案 染色体编码:$[l_1, l_2, l_3, l_4, \theta_{start}, \theta_{end}]$ 适应度函数: $f = \frac{1}{1 + w_1·\sum(y_i-y_{line})^2 + w_2·V + w_3·(1-\gamma_{min}/40°)}$ 约束处理: 1. 格拉肖夫条件:修复策略或惩罚函数 2. 杆长范围:$10mm \leq l_i \leq 100mm$ 3. 传动角:$\gamma \geq 40°$ 进化策略: - 选择:轮盘赌+精英保留 - 交叉:均匀交叉,概率0.8 - 变异:高斯变异,概率0.1

题目8:RCM机构在手术机器人中的应用 设计一个双平行四边形RCM机构用于微创手术,要求RCM点固定在皮肤表面下方50mm处,工作空间半径≥30mm。给出关键设计参数和验证方法。

Hint:RCM约束方程 RCM点位置由连杆长度和关节角度决定。
答案 设计参数: - 第一平行四边形:$l_1 = 80mm$ - 第二平行四边形:$l_2 = 60mm$ - 关节角度范围:$±45°$ RCM点位置验证: $d_{RCM} = l_1\cos\alpha + l_2\cos(\alpha+\beta) = 50mm$ 工作空间计算: $r_{max} = l_1\sin(45°) + l_2 = 96.6mm > 30mm$ ✓ 刚度分析: - 采用有限元分析验证变形< 0.5mm - 模态分析确保共振频率> 50Hz

常见陷阱与错误(Gotchas)

设计阶段常见错误

  1. 忽视制造公差
    • 错误:理论计算忽略公差累积
    • 正确:预留5-10%安全裕度
  2. 格拉肖夫条件误判
    • 错误:仅考虑理论长度
    • 正确:考虑关节间隙和弹性变形
  3. 死点位置设计不当
    • 错误:死点在常用工作区间
    • 正确:死点设置在极限位置或采用规避机制

分析阶段常见错误

  1. 运动分析符号错误
    • 错误:角度正负方向定义不一致
    • 正确:建立统一的坐标系和符号规则
  2. 忽略高阶运动特性
    • 错误:仅分析位置和速度
    • 正确:检查加速度突变和冲击
  3. 奇异性分析不全面
    • 错误:仅检查边界奇异
    • 正确:系统分析所有类型奇异点

优化阶段常见错误

  1. 局部最优陷阱
    • 错误:梯度法陷入局部最优
    • 正确:采用全局优化算法或多起点策略
  2. 约束处理不当
    • 错误:硬约束导致无解
    • 正确:采用软约束和惩罚函数

实施阶段常见错误

  1. 关节间隙补偿不足
    • 错误:理想刚性连接假设
    • 正确:预紧和间隙补偿设计
  2. 润滑维护考虑不足
    • 错误:封闭设计难以维护
    • 正确:预留润滑和检修接口

最佳实践检查清单

概念设计阶段

详细设计阶段

优化设计阶段

样机验证阶段

批量生产阶段

持续改进


通过本章学习,读者应该掌握了连杆机构设计的核心理论和实践方法。连杆机构作为机械传动的基础形式,在灵巧手设计中具有不可替代的作用。合理的机构设计不仅能实现复杂的运动规律,还能提供优异的传动性能和可靠性。下一章将介绍腱驱动系统,探讨如何通过柔性传动实现更加仿生的手部运动。