第2章：机械系统设计与运动学

本章深入探讨3D打印机的机械系统设计原理，从运动学方程到动力学分析，建立精确的数学模型。我们将分析不同运动架构的优劣，推导误差传播规律，并通过振动模态分析优化结构设计。掌握这些内容后，您将能够设计高精度、高速度的3D打印运动系统，并对现有系统进行精确的性能评估与优化。

2.1 笛卡尔系统运动学方程

笛卡尔坐标系统是最直观的3D打印机架构，其X、Y、Z三轴相互正交且运动独立。这种解耦特性简化了控制算法，但对机械精度要求更高。

2.1.1 坐标系定义与齐次变换

建立打印机坐标系，原点位于打印平台左前角，X轴向右，Y轴向后，Z轴向上（右手坐标系）。这种坐标系定义遵循CNC机床的G-code标准，确保了与切片软件和控制固件的兼容性。理解坐标变换的数学基础对于实现精确的多轴插补和误差补偿至关重要。

对于任意点P，其位置向量表示为：

$$\mathbf{p} = \begin{bmatrix} x \\ y \\ z \\ 1 \end{bmatrix}$$ 采用齐次坐标的优势在于将平移和旋转统一为矩阵乘法运算，简化了复合变换的计算。各轴运动可用齐次变换矩阵描述： $$T_x(\Delta x) = \begin{bmatrix} 1 & 0 & 0 & \Delta x \\ 0 & 1 & 0 & 0 \\ 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 1 \end{bmatrix}$$ 类似地定义 $T_y(\Delta y)$ 和 $T_z(\Delta z)$。打印头从初始位置 $\mathbf{p}_0$ 移动到目标位置 $\mathbf{p}_f$ 的总变换为： $$\mathbf{p}_f = T_z(\Delta z) \cdot T_y(\Delta y) \cdot T_x(\Delta x) \cdot \mathbf{p}_0$$ 由于平移变换的可交换性（阿贝尔群性质），变换顺序不影响最终结果： $$T_x(a) \cdot T_y(b) = T_y(b) \cdot T_x(a)$$ 这一性质极大简化了路径规划算法，允许各轴独立计算运动轨迹。然而，当引入旋转变换（如5轴打印机或床面自动调平）时，变换顺序变得至关重要，需要仔细处理欧拉角的万向锁问题。

2.1.2 正运动学推导

正运动学建立了从关节空间（电机转角）到笛卡尔空间（打印头位置）的映射关系。这一映射的精度直接决定了打印的几何保真度。在实际系统中，还需要考虑传动链的非理想特性，如齿隙、弹性变形和热膨胀等因素。

给定各轴电机转角 $\theta_x, \theta_y, \theta_z$，计算打印头位置。设步进电机步距角为 $\alpha$（典型值1.8°），细分数为 $n$，传动比为 $r$（皮带轮直径或丝杠导程）：

对于皮带传动的X、Y轴： $$x = \frac{\theta_x}{\alpha} \cdot \frac{\alpha}{n_x} \cdot \frac{\pi d_x}{360°/\alpha} = \frac{\theta_x \cdot \pi d_x}{360° \cdot n_x}$$ $$y = \frac{\theta_y \cdot \pi d_y}{360° \cdot n_y}$$ 对于丝杠传动的Z轴： $$z = \frac{\theta_z}{360°} \cdot \frac{p_z}{n_z}$$ 其中 $d_x, d_y$ 为皮带轮直径，$p_z$ 为Z轴丝杠导程（mm/转）。

步进脉冲数与位置的关系更为直接： $$x = N_x \cdot \frac{\pi d_x}{S_x \cdot n_x}$$ 其中 $N_x$ 为脉冲数，$S_x = 360°/\alpha$ 为电机每转步数（如200步/转）。

逆运动学（从位置求脉冲数）： $$N_x = \frac{x \cdot S_x \cdot n_x}{\pi d_x}$$ 这个公式是固件中steps_per_mm参数的理论基础。实际标定时，还需要考虑皮带节距、齿形误差等因素，通过打印标准测试件进行经验修正。

2.1.3 工作空间分析

工作空间定义了打印机的物理能力边界，但实际可用空间受多种因素制约。深入理解这些限制有助于优化打印策略和避免机械冲突。工作空间的形状和大小不仅影响可打印物体的尺寸，还影响打印速度和精度的空间分布。

物理工作空间由机械限位决定： $$W = \{(x,y,z) | 0 \leq x \leq X_{max}, 0 \leq y \leq Y_{max}, 0 \leq z \leq Z_{max}\}$$ 然而，有效打印空间需要考虑多个约束因素：

1. 喷嘴偏移与多头打印 对于双喷头系统，偏移量$(x_{nozzle}, y_{nozzle})$会减少可用空间： $$W_{dual} = W \cap (W - (x_{offset}, y_{offset}, 0))$$

2. 床面形变补偿 实际打印平台存在翘曲，通过网格测量获得高度场$z_{bed}(x,y)$： $$z_{bed}(x,y) = \sum_{i,j} w_{ij}(x,y) \cdot z_{ij}$$ 其中$w_{ij}$为双线性插值权重。

3. 动态安全边界 安全边界$\delta_{safety}$应考虑速度相关的超程： $$\delta_{dynamic}(v) = \delta_{static} + \frac{v^2}{2a_{max}}$$

4. 热膨胀修正 温度变化引起的工作空间变化： $$W_T = W_0 \cdot [1 + \alpha(T - T_0)]$$ 实际可打印空间的完整表达： $$W_{print} = \{(x,y,z) | \delta(v) \leq x \leq X_{max}-\delta(v), \delta(v) \leq y \leq Y_{max}-\delta(v), z_{bed}(x,y)+h_{first} \leq z \leq Z_{max}\}$$ 其中$h_{first}$为首层高度。

工作空间利用率优化 定义利用率指标： $$\eta = \frac{V_{object}}{V_{workspace}} \cdot \frac{t_{print}}{t_{total}}$$ 通过智能排布算法（如2D装箱问题的底左算法BL、最佳适应算法BF）可以提高空间利用率。对于打印农场，还需要考虑多机协同的全局优化。

2.1.4 运动解耦优势与实现

笛卡尔系统的运动解耦是其最大的架构优势，这种解耦不仅简化了控制算法，还提供了模块化升级的灵活性。深入理解解耦的数学本质和工程实现，对于系统优化至关重要。

解耦的数学定义

系统解耦的充要条件是雅可比矩阵为对角阵： $$\mathbf{J} = \begin{bmatrix} \frac{\partial x}{\partial \theta_x} & \frac{\partial x}{\partial \theta_y} & \frac{\partial x}{\partial \theta_z} \\ \frac{\partial y}{\partial \theta_x} & \frac{\partial y}{\partial \theta_y} & \frac{\partial y}{\partial \theta_z} \\ \frac{\partial z}{\partial \theta_x} & \frac{\partial z}{\partial \theta_y} & \frac{\partial z}{\partial \theta_z} \end{bmatrix} = \begin{bmatrix} J_{xx} & 0 & 0 \\ 0 & J_{yy} & 0 \\ 0 & 0 & J_{zz} \end{bmatrix}$$ 这意味着： $$\frac{\partial x}{\partial \theta_y} = \frac{\partial x}{\partial \theta_z} = 0$$ $$\frac{\partial y}{\partial \theta_x} = \frac{\partial y}{\partial \theta_z} = 0$$ $$\frac{\partial z}{\partial \theta_x} = \frac{\partial z}{\partial \theta_y} = 0$$ 工程优势分析

1. 控制器设计简化 各轴可独立设计PID控制器： $$u_i(t) = K_{p,i}e_i(t) + K_{i,i}\int e_i(t)dt + K_{d,i}\frac{de_i(t)}{dt}$$ 无需考虑交叉耦合项，大幅降低调参复杂度。

2. 误差传播隔离 位置误差的协方差矩阵为对角阵： $$\mathbf{\Sigma}_{xyz} = \begin{bmatrix} \sigma_x^2 & 0 & 0 \\ 0 & \sigma_y^2 & 0 \\ 0 & 0 & \sigma_z^2 \end{bmatrix}$$ 各轴误差统计独立，简化了误差分析和补偿。

3. 计算效率提升 直线插补只需独立计算各轴步数： $$N_i = \lfloor |\Delta_i| \cdot steps_per_mm_i + 0.5 \rfloor$$ 相比耦合系统的矩阵运算，计算复杂度从O(n³)降至O(n)。

4. 模块化与可维护性 - 单轴故障不影响其他轴 - 可独立升级某一轴的电机或传动系统 - 标定过程可分解为三个独立的一维问题

解耦的限制与补偿

实际系统中完全解耦是理想化的，存在以下耦合因素：

1. 结构柔性耦合：框架变形导致的轴间干扰 $$\Delta x_{flex} = \frac{F_y \cdot L^3}{3EI_{frame}}$$

2. 热膨胀耦合：温度场不均匀导致的几何变化 $$\delta_{thermal} = \int_0^L \alpha(T(s) - T_0)ds$$

3. 动态耦合：高加速度下的惯性力交互 $$F_{coupling} = m_{moving} \cdot a_{perpendicular}$$ 通过前馈补偿可部分消除这些耦合效应： $$u_{compensated} = u_{nominal} + K_{coupling} \cdot \hat{d}_{coupling}$$

2.2 Delta并联机构正逆解

Delta打印机采用并联机构，三个伺服臂协同运动控制打印头位置。其高速度、高精度特性适合大批量生产。与串联机构相比，并联机构的惯量集中在基座，运动部件轻量化，使得Delta打印机能够实现极高的加速度（可达20000mm/s²）和打印速度（可达500mm/s）。然而，这种架构的运动学复杂性也带来了独特的挑战，需要深入理解其数学原理才能充分发挥其性能优势。

2.2.1 几何模型建立

Delta机构的几何配置直接决定了其工作空间形状和运动特性。通过精心设计几何参数，可以优化速度、精度和工作空间的平衡。标准Delta配置采用120°对称分布，但也存在非对称变体以适应特殊需求。

定义关键几何参数：

• $R$：上平台（电机安装）半径 - 决定机构整体尺寸
• $r$：下平台（打印头）半径 - 影响工作空间中心区域
• $L$：主动臂长度 - 电机驱动的垂直运动臂
• $l$：从动臂长度 - 万向节连接的被动臂
• $h$：零位时平台间距 - 影响Z向工作范围

建立坐标系，原点在上平台中心，Z轴向下为正。三个电机按120°均布： $$A_1 = (R, 0, 0)$$ $$A_2 = (-R/2, R\sqrt{3}/2, 0) = R(\cos(120°), \sin(120°), 0)$$ $$A_3 = (-R/2, -R\sqrt{3}/2, 0) = R(\cos(240°), \sin(240°), 0)$$ 打印头连接点相对于打印头中心，保持相同的120°对称： $$B_1 = (r, 0, 0)$$ $$B_2 = (-r/2, r\sqrt{3}/2, 0)$$ $$B_3 = (-r/2, -r\sqrt{3}/2, 0)$$ 几何参数优化准则：

• 工作空间最大化：$l/L \approx 2.5-3$
• 灵巧度优化：$r/R \approx 0.2-0.3$
• 刚度考虑：$L$ 不宜过长，避免弯曲变形
• 干涉避免：确保臂间最小夹角 > 15°

2.2.2 逆运动学解析解

逆运动学是Delta控制的核心，其解析解的存在使得实时控制成为可能。与正运动学需要迭代求解不同，逆运动学可以直接计算，这是Delta机构的重要优势。解的唯一性和连续性保证了运动的平滑性。

给定打印头位置 $P = (x, y, z)$，求解三个电机的垂直位移 $d_1, d_2, d_3$。

约束方程推导

对于第i个运动链，从动臂长度恒定构成球面约束： $$|\mathbf{C}_i - \mathbf{E}_i| = l$$ 其中：

• $\mathbf{C}_i = \mathbf{A}_i + d_i \mathbf{\hat{z}}$ 为主动臂末端（肘关节）位置
• $\mathbf{E}_i = \mathbf{P} + \mathbf{B}_i$ 为打印头上的连接点位置

展开约束方程： $$|\mathbf{P} + \mathbf{B}_i - (\mathbf{A}_i + d_i \mathbf{\hat{z}})| = l$$

$$(x + B_{ix} - A_{ix})^2 + (y + B_{iy} - A_{iy})^2 + (z - d_i)^2 = l^2$$ 记 $K_{ix} = x + B_{ix} - A_{ix}$，$K_{iy} = y + B_{iy} - A_{iy}$，整理为标准二次方程： $$d_i^2 - 2zd_i + (K_{ix}^2 + K_{iy}^2 + z^2 - l^2) = 0$$ 解的判别与选择

判别式： $$\Delta_i = 4z^2 - 4(K_{ix}^2 + K_{iy}^2 + z^2 - l^2) = 4(l^2 - K_{ix}^2 - K_{iy}^2)$$ 解存在条件：$\Delta_i \geq 0$，即 $K_{ix}^2 + K_{iy}^2 \leq l^2$

解为： $$d_i = z \pm \sqrt{l^2 - K_{ix}^2 - K_{iy}^2}$$ 物理可行解的选择：

• 工作模式（elbow-down）：取负号，$d_i = z - \sqrt{l^2 - K_{ix}^2 - K_{iy}^2}$
• 倒置模式（elbow-up）：取正号，较少使用

计算优化

为提高实时性，可预计算常量： $$K_{const,i} = (B_{ix} - A_{ix})^2 + (B_{iy} - A_{iy})^2$$ 运行时只需计算： $$d_i = z - \sqrt{l^2 - (x - A_{ix})^2 - (y - A_{iy})^2 - K_{const,i} - 2x B_{ix} - 2y B_{iy}}$$

2.2.3 正运动学数值解

正运动学问题在Delta机构中没有封闭解析解，必须采用数值方法。这在标定和仿真中经常需要，虽然不用于实时控制，但对系统分析至关重要。选择合适的数值方法和初值策略对收敛速度和稳定性影响很大。

问题表述

给定 $d_1, d_2, d_3$，求解打印头位置 $\mathbf{P} = (x, y, z)$，等价于解非线性方程组： $$f_i(x,y,z) = (x + B_{ix} - A_{ix})^2 + (y + B_{iy} - A_{iy})^2 + (z - d_i)^2 - l^2 = 0, \quad i=1,2,3$$ 牛顿-拉弗森方法

迭代公式： $$\mathbf{P}_{k+1} = \mathbf{P}_k - \mathbf{J}^{-1} \mathbf{f}(\mathbf{P}_k)$$ 雅可比矩阵元素： $$J_{ij} = \frac{\partial f_i}{\partial p_j}$$ 其中： $$\frac{\partial f_i}{\partial x} = 2(x + B_{ix} - A_{ix})$$ $$\frac{\partial f_i}{\partial y} = 2(y + B_{iy} - A_{iy})$$ $$\frac{\partial f_i}{\partial z} = 2(z - d_i)$$ 简化后： $$\mathbf{J} = 2\begin{bmatrix} K_{1x} & K_{1y} & z - d_1 \\ K_{2x} & K_{2y} & z - d_2 \\ K_{3x} & K_{3y} & z - d_3 \end{bmatrix}$$ 收敛性分析

收敛条件：

1. 初值足够接近真解：$||\mathbf{P}_0 - \mathbf{P}^*|| < \rho$
2. 雅可比矩阵非奇异：$\det(\mathbf{J}) \neq 0$
3. Lipschitz连续性满足

收敛速度：二次收敛 $$||\mathbf{P}_{k+1} - \mathbf{P}^*|| \leq C ||\mathbf{P}_k - \mathbf{P}^*||^2$$ 初值选择策略

1. 几何中心法： $$\mathbf{P}_0 = (0, 0, \bar{d})$$ 其中 $\bar{d} = (d_1 + d_2 + d_3)/3$

2. 线性近似法： 在工作空间中心附近线性化，得到近似解作为初值

3. 查表插值法： 预计算网格点的正解，运行时插值获得初值

替代方法

1. 最小二乘法： $$\min_{\mathbf{P}} \sum_{i=1}^3 f_i^2(\mathbf{P})$$ 使用Levenberg-Marquardt算法求解

2. 几何迭代法： 利用三球交点的几何意义，通过构造辅助平面简化计算

典型收敛判据： $$||\mathbf{f}(\mathbf{P}_k)|| < \epsilon_f = 10^{-6}$$ $$||\mathbf{P}_{k+1} - \mathbf{P}_k|| < \epsilon_p = 10^{-9}$$

2.2.4 奇异位形与工作空间

奇异位形是并联机构的固有特性，在这些位置机构失去某些自由度或获得额外自由度。理解奇异性对于路径规划和工作空间设计至关重要。Delta机构的工作空间呈现独特的倒置圆锥形状，这种形状由机构几何和运动约束共同决定。

奇异位形的数学条件

奇异发生在雅可比矩阵行列式为零时： $$\det(\mathbf{J}) = 0$$ 对于Delta机构，雅可比矩阵： $$\mathbf{J} = \begin{bmatrix} \vec{s}_1^T \\ \vec{s}_2^T \\ \vec{s}_3^T \end{bmatrix}$$ 其中$\vec{s}_i$为第i条从动臂的单位方向向量。

奇异位形分类

1. 输入奇异（逆运动学奇异） - 发生条件：某个从动臂完全伸展 - 物理表现：无法到达目标位置 - 数学表达：$l^2 = (x + B_{ix} - A_{ix})^2 + (y + B_{iy} - A_{iy})^2$

2. 输出奇异（正运动学奇异） - 发生条件：三条从动臂共面 - 物理表现：获得额外自由度（旋转） - 判断条件：$(\vec{s}_1 \times \vec{s}_2) \cdot \vec{s}_3 = 0$

3. 组合奇异 - 同时满足输入和输出奇异条件 - 极少出现，但最危险

工作空间计算

工作空间定义为所有可达位置的集合： $$W = \{\mathbf{P} \in \mathbb{R}^3 | \exists d_i \in [d_{min}, d_{max}], f_i(\mathbf{P}) = 0\}$$ 边界确定方法

1. 解析法（简化情况） 对于对称Delta，工作空间轴对称，可在子空间求解

2. 离散化方法 网格化空间，检查每个点：

for x in x_range:
  for y in y_range:
    for z in z_range:
      if inverse_kinematics_exists(x,y,z):
        workspace.add((x,y,z))

3. 蒙特卡洛法 随机采样估计体积： $$V_{workspace} = V_{box} \cdot \frac{N_{valid}}{N_{total}}$$ 收敛率：$\sigma_V = V_{box}\sqrt{\frac{p(1-p)}{N}}$ 其中$p = N_{valid}/N_{total}$

工作空间形状特征

1. 水平截面：随高度变化的圆形或六边形
2. 垂直截面：花瓣形或三叶草形
3. 体积比：$V_{useful}/V_{total} \approx 0.3-0.4$

工作空间优化

目标函数： $$\max J = w_1 V_{workspace} + w_2 \bar{\mu} - w_3 \sigma_{\mu}$$ 约束条件：

• 结构干涉：$\theta_{min} > 15°$
• 刚度要求：$\kappa_{max} < 100$
• 尺寸限制：$R + l < L_{max}$

2.2.5 灵巧度分析

灵巧度是评价机构运动性能的重要指标，反映了机构在不同方向上的运动能力均匀性。高灵巧度区域适合精密操作，低灵巧度区域则可能出现控制困难和精度下降。对于Delta打印机，灵巧度在工作空间中心最佳，向边缘递减。

灵巧度定义

条件数定义： $$\kappa(\mathbf{J}) = ||\mathbf{J}||_2 \cdot ||\mathbf{J}^{-1}||_2 = \frac{\sigma_{max}}{\sigma_{min}}$$ 其中$\sigma_{max}, \sigma_{min}$为雅可比矩阵的最大、最小奇异值。

灵巧度指标： $$\mu = \frac{1}{\kappa(\mathbf{J})} = \frac{\sigma_{min}}{\sigma_{max}} \in [0,1]$$ 物理意义

1. 速度各向同性 $$\frac{v_{max}}{v_{min}} = \kappa(\mathbf{J})$$ 条件数大表示某些方向速度受限。

2. 力传递效率 $$\eta_{force} = \frac{F_{output,min}}{F_{output,max}} = \mu$$ 灵巧度低时，某些方向力输出能力弱。

3. 误差放大系数 $$\frac{||\Delta \mathbf{P}||}{||\Delta \mathbf{d}||} \leq \kappa(\mathbf{J})$$ 条件数大时，输入误差被放大。

全局灵巧度指标

1. 全局条件指标（GCI） $$GCI = \frac{\int_W \mu dV}{\int_W dV} = \bar{\mu}$$

2. 全局梯度指标（GGI） $$GGI = \sqrt{\frac{\int_W ||\nabla\mu||^2 dV}{\int_W dV}}$$ 衡量灵巧度变化的剧烈程度。

3. 有效工作空间比 $$\eta_W = \frac{V(\mu > \mu_{threshold})}{V_{total}}$$ 通常取$\mu_{threshold} = 0.3$。

灵巧度分布特性

Delta机构的灵巧度分布：

1. 中心区域：$\mu \approx 0.7-0.9$，适合精密打印
2. 中间区域：$\mu \approx 0.3-0.7$，常规打印
3. 边缘区域：$\mu < 0.3$，避免使用

灵巧度等值面近似为同心球面： $$\mu(r) \approx \mu_0 \exp(-\alpha r^2)$$ 优化策略

1. 几何参数优化 $$\min_{R,r,L,l} \int_W [\mu_{target} - \mu(x,y,z)]^2 dV$$ 约束：

• $V_{workspace} > V_{required}$
• $\mu_{min} > 0.2$
• 结构不干涉

2. 工作点选择 优先在高灵巧度区域安排打印任务： $$\mathbf{P}_{optimal} = \arg\max_{\mathbf{P} \in W} \mu(\mathbf{P})$$

3. 路径规划优化 考虑灵巧度的路径代价： $$C_{path} = \int_0^T \frac{1}{\mu(s(t))} \cdot ||\dot{s}(t)|| dt$$ 实际应用建议

• 将复杂细节放置在工作空间中心
• 避免在$\mu < 0.3$区域进行精细操作
• 使用动态速度限制：$v_{max}(\mathbf{P}) = v_0 \cdot \mu(\mathbf{P})$
• 定期标定系统以补偿低灵巧度区域误差

2.3 CoreXY运动耦合分析

CoreXY是一种巧妙的皮带传动方案，通过两个电机的协同运动实现XY平面内的快速定位。其特点是打印头质量轻、电机固定安装，适合高速打印。这种设计最早由MIT的Ilan Moyer提出，现已成为高端3D打印机的主流架构。CoreXY的精髓在于通过运动耦合换取机械简洁性和动态性能，但这种耦合也带来了独特的控制挑战和调试要求。理解其工作原理对于发挥其性能潜力至关重要。

2.3.1 皮带路径设计原理

CoreXY的皮带路径设计是其核心创新，通过巧妙的几何配置实现了运动的优雅耦合。理解皮带路径不仅是装配调试的基础，也是分析系统动力学特性的关键。正确的皮带张紧和路径设置直接影响打印精度和速度上限。

CoreXY采用单根长皮带（或两根独立皮带），通过特殊的绕线方式实现运动耦合：

    M1 ←─────────────────────→ M2
     ↑                           ↑
     │     ┌─────────────┐      │
     │     │             │      │
     └─────┤  Carriage   ├──────┘
           │             │
           └─────────────┘

  详细皮带路径（8字形交叉）：
     M1 ──→ A ──→ B ──→ C ──→ D
              ╲  ╱ ╲  ╱
               ╳   ╳  (crossing)
              ╱  ╲ ╱  ╲
     M2 ←── H ←── G ←── F ←── E

关键设计原则：

1. 90°夹角原则 皮带在打印头处形成90°夹角，确保X、Y方向力的正交分解： $$\vec{F}_x = F_{belt1} \cos(45°) + F_{belt2} \cos(45°)$$ $$\vec{F}_y = F_{belt1} \sin(45°) - F_{belt2} \sin(45°)$$

2. 长度补偿原则 打印头移动时，一侧皮带缩短的长度等于另一侧延长的长度： $$\Delta L_1 + \Delta L_2 = 0$$ 这保证了皮带总长度恒定，避免张力变化。

3. 对称性原则 左右对称的布局确保了系统的各向同性，避免了方向依赖的误差。

皮带张力分析

理想张力设定： $$T_{optimal} = \sqrt{\frac{m_{carriage} \cdot a_{max} \cdot L}{2 \cdot \delta_{allowable}}}$$ 其中：

• $m_{carriage}$：打印头质量
• $a_{max}$：最大加速度
• $L$：皮带跨度
• $\delta_{allowable}$：允许变形量

典型值：T = 60-80N，产生约6-8Hz的基频。

2.3.2 运动方程推导

CoreXY的运动方程揭示了其耦合控制的数学本质。通过线性变换，两个旋转自由度被映射为两个平移自由度，这种优雅的数学关系使得控制算法相对简单，同时保持了高动态性能。深入理解这些方程对于优化运动规划和故障诊断都很重要。

基本运动学关系

设电机M1、M2的转角为 $\theta_1, \theta_2$，皮带轮半径为 $r$（或节圆半径 $r = N_{teeth} \cdot pitch / (2\pi)$）。

通过分析皮带长度变化，可得打印头位置与电机转角的关系：

当M1转动$\theta_1$，M2静止：打印头沿45°方向移动 当M2转动$\theta_2$，M1静止：打印头沿-45°方向移动

叠加原理给出： $$x = \frac{r}{\sqrt{2}}(\theta_1 \cos(45°) + \theta_2 \cos(45°)) = \frac{r}{2}(\theta_1 + \theta_2)$$ $$y = \frac{r}{\sqrt{2}}(\theta_1 \sin(45°) - \theta_2 \sin(45°)) = \frac{r}{2}(\theta_1 - \theta_2)$$ 矩阵表示

变换矩阵： $$\mathbf{T} = \frac{r}{2} \begin{bmatrix} 1 & 1 \\ 1 & -1 \end{bmatrix}$$ 正运动学： $$\begin{bmatrix} x \\ y \end{bmatrix} = \mathbf{T} \begin{bmatrix} \theta_1 \\ \theta_2 \end{bmatrix}$$ 逆运动学： $$\begin{bmatrix} \theta_1 \\ \theta_2 \end{bmatrix} = \mathbf{T}^{-1} \begin{bmatrix} x \\ y \end{bmatrix} = \frac{1}{r} \begin{bmatrix} 1 & 1 \\ 1 & -1 \end{bmatrix} \begin{bmatrix} x \\ y \end{bmatrix}$$ 注意：$\mathbf{T}^{-1} = \frac{2}{r} \mathbf{T}^T / 2$，变换矩阵近似正交（差一个缩放因子）。

速度和加速度关系

速度雅可比： $$\begin{bmatrix} \dot{x} \\ \dot{y} \end{bmatrix} = \mathbf{T} \begin{bmatrix} \omega_1 \\ \omega_2 \end{bmatrix}$$ 加速度关系： $$\begin{bmatrix} \ddot{x} \\ \ddot{y} \end{bmatrix} = \mathbf{T} \begin{bmatrix} \alpha_1 \\ \alpha_2 \end{bmatrix}$$ 力矩与力的关系

根据虚功原理： $$\begin{bmatrix} \tau_1 \\ \tau_2 \end{bmatrix} = \mathbf{T}^T \begin{bmatrix} F_x \\ F_y \end{bmatrix} = \frac{r}{2} \begin{bmatrix} 1 & 1 \\ 1 & -1 \end{bmatrix} \begin{bmatrix} F_x \\ F_y \end{bmatrix}$$ 这表明：

• X方向力由两电机均担
• Y方向力造成差动力矩

步进电机控制的离散化

步数计算： $$N_1 = \frac{(x + y) \cdot steps_per_mm}{\sqrt{2}}$$ $$N_2 = \frac{(x - y) \cdot steps_per_mm}{\sqrt{2}}$$ 其中 $steps_per_mm = \frac{n \cdot S}{\pi d}$，$n$为细分数，$S$为每转步数。

2.3.3 电机同步要求

对角线运动时（$\dot{x} = \dot{y}$），需要： $$\omega_1 = \frac{2\dot{x}}{r}, \quad \omega_2 = 0$$ 纯X轴运动（$\dot{y} = 0$）： $$\omega_1 = \omega_2 = \frac{\dot{x}}{r}$$ 纯Y轴运动（$\dot{x} = 0$）： $$\omega_1 = -\omega_2 = \frac{\dot{y}}{r}$$ 同步误差对位置的影响： $$\Delta x = \frac{r}{2}(\Delta\theta_1 + \Delta\theta_2)$$ $$\Delta y = \frac{r}{2}(\Delta\theta_1 - \Delta\theta_2)$$

2.3.4 张力分析

皮带张力影响定位精度和响应速度。设初始张力为 $T_0$，弹性模量为 $E$，横截面积为 $A$，皮带段长度为 $L_i$。

运动时的张力变化： $$T_i = T_0 + EA \cdot \frac{\Delta L_i}{L_i}$$ 打印头受力平衡： $$F_x = T_1 \cos\alpha_1 + T_2 \cos\alpha_2 - T_3 \cos\alpha_3 - T_4 \cos\alpha_4$$ $$F_y = T_1 \sin\alpha_1 + T_2 \sin\alpha_2 - T_3 \sin\alpha_3 - T_4 \sin\alpha_4$$ 其中 $\alpha_i$ 为各段皮带与X轴的夹角。

张力不均匀导致的位置误差： $$\varepsilon_x = \frac{L_{total}}{EA} \cdot \Delta T_{net}$$ 优化目标：最小化张力波动 $$\min \sum_{i=1}^{4} (T_i - T_0)^2$$

2.4 步进电机细分与微步控制

步进电机是3D打印机的执行核心，其控制精度直接决定打印质量。通过细分驱动技术，可以实现远超电机物理步距的定位精度。

2.4.1 步进电机工作原理

两相混合式步进电机的数学模型。设A、B两相电流为 $i_A, i_B$，转子位置角为 $\theta$，齿数为 $N_r$（通常为50）。

电磁转矩： $$T = K_t[i_A \sin(N_r \theta) + i_B \cos(N_r \theta)]$$ 其中 $K_t$ 为转矩常数。

静态位置由电流比例决定： $$\tan(N_r \theta) = \frac{i_A}{i_B}$$ 全步进模式的四个状态：

1. $(i_A, i_B) = (I_{max}, 0)$ → $\theta = 0°$
2. $(i_A, i_B) = (0, I_{max})$ → $\theta = 90°/N_r = 1.8°$
3. $(i_A, i_B) = (-I_{max}, 0)$ → $\theta = 180°/N_r = 3.6°$
4. $(i_A, i_B) = (0, -I_{max})$ → $\theta = 270°/N_r = 5.4°$

2.4.2 细分驱动数学模型

细分通过调制两相电流的幅值和相位，在物理步距间创建中间位置。对于n细分，第k个微步位置： $$\theta_k = \frac{k \cdot 1.8°}{n}, \quad k = 0, 1, ..., n-1$$ 对应的相电流： $$i_A(k) = I_{max} \sin\left(\frac{k \pi}{2n}\right)$$ $$i_B(k) = I_{max} \cos\left(\frac{k \pi}{2n}\right)$$ 电流矢量保持恒定幅值： $$\sqrt{i_A^2 + i_B^2} = I_{max}$$

2.4.3 力矩特性分析

保持力矩（Holding Torque）： $$T_h = K_t I_{max}$$ 定位力矩（Detent Torque）- 无电流时的齿槽效应： $$T_d = T_{d,max} \sin(4N_r \theta)$$ 动态力矩与速度的关系： $$T(\omega) = \frac{T_h}{1 + (\omega/\omega_c)^2}$$ 其中 $\omega_c$ 为转折频率，由电感和电阻决定： $$\omega_c = \frac{R}{L}$$

2.4.4 共振与失步分析

转子运动方程： $$J\ddot{\theta} + B\dot{\theta} + K\sin(N_r\theta - \phi) = 0$$ 其中：

• $J$：转动惯量
• $B$：阻尼系数
• $K$：刚度系数
• $\phi$：电气角

固有频率： $$f_n = \frac{1}{2\pi}\sqrt{\frac{K}{J}}$$ 中频共振（200-500Hz）的抑制策略：

1. 避开共振频率运行
2. 增加机械阻尼
3. 使用S型加减速曲线

失步临界条件： $$T_{load} > T_h \sin(\delta_{max})$$ 其中 $\delta_{max} \approx 90°/N_r$ 为最大负载角。

2.4.5 微步精度限制

理想vs实际微步位置偏差： $$\Delta\theta = \theta_{actual} - \theta_{ideal}$$ 主要误差源：

1. 电流控制精度：DAC分辨率限制
2. 磁路非线性：磁饱和效应
3. 摩擦力矩：静摩擦导致的死区
4. 齿槽效应：周期性位置偏差

有效分辨率估算： $$Resolution_{effective} = \frac{360°}{N_r \cdot n_{effective}}$$ 其中 $n_{effective} \approx \sqrt{n}$（经验公式）。

2.5 传动系统误差传播模型

传动系统将电机运动转换为打印头位移，每个环节都会引入误差。建立完整的误差传播模型对于预测和补偿系统精度至关重要。

2.5.1 误差源分类与量化

系统误差源的分类框架：

确定性误差：

• 几何误差：制造公差、装配偏差
• 热变形：温度梯度引起的尺寸变化
• 弹性变形：负载下的结构变形

随机误差：

• 振动：外部扰动和内部激励
• 间隙：齿轮啮合间隙、轴承游隙
• 控制噪声：编码器量化、电流纹波

总误差模型： $$e_{total} = e_{systematic} + e_{random} + e_{dynamic}$$

2.5.2 齿轮传动误差分析

齿轮传动的传递误差（TE）： $$TE = \theta_{out} - \frac{\theta_{in}}{i_{gear}}$$ 其中 $i_{gear}$ 为传动比。

周期性误差分解（傅里叶级数）： $$TE(\theta) = \sum_{k=1}^{n} [a_k \cos(kZ\theta) + b_k \sin(kZ\theta)]$$ $Z$ 为齿数，$k$ 为谐波次数。

齿形误差的影响： $$\Delta_{profile} = \frac{f_{profile}}{cos(\alpha)}$$ 其中 $f_{profile}$ 为齿形偏差，$\alpha$ 为压力角。

累积误差预算： $$\sigma_{gear}^2 = \sigma_{pitch}^2 + \sigma_{runout}^2 + \sigma_{backlash}^2$$

2.5.3 皮带传动弹性模型

皮带的弹性伸长： $$\Delta L = \frac{FL}{EA}$$ 其中：

• $F$：张力
• $L$：皮带长度
• $E$：弹性模量（玻璃纤维增强：~3000 MPa）
• $A$：横截面积

动态刚度： $$k_{belt} = \frac{EA}{L}$$ 位置误差： $$\Delta x = \frac{F_{load}}{k_{belt}}$$ 皮带打滑条件（Euler-Eytelwein公式）： $$\frac{T_{tight}}{T_{loose}} \leq e^{\mu\beta}$$ 其中 $\mu$ 为摩擦系数，$\beta$ 为包角。

2.5.4 丝杠传动精度

滚珠丝杠的导程误差： $$e_p(x) = \frac{\Delta p}{p} \cdot x$$ 其中 $\Delta p$ 为导程偏差，$p$ 为标称导程。

温度补偿： $$L_T = L_0[1 + \alpha(T - T_0)]$$ 线膨胀系数 $\alpha \approx 11.7 \times 10^{-6}/°C$（钢）。

轴向刚度模型： $$k_{screw} = \frac{1}{\frac{1}{k_{shaft}} + \frac{1}{k_{nut}} + \frac{1}{k_{bearing}}}$$ 反向间隙补偿量： $$C_{backlash} = \Delta_{measured} + \frac{F_{preload}}{k_{screw}}$$

2.5.5 误差传播矩阵

建立从电机到打印头的误差传播矩阵： $$\mathbf{e}_{output} = \mathbf{J}_{error} \cdot \mathbf{e}_{input}$$ 其中雅可比误差矩阵： $$\mathbf{J}_{error} = \begin{bmatrix} \frac{\partial x}{\partial \theta_1} & \frac{\partial x}{\partial \theta_2} & \cdots \\ \frac{\partial y}{\partial \theta_1} & \frac{\partial y}{\partial \theta_2} & \cdots \\ \frac{\partial z}{\partial \theta_1} & \frac{\partial z}{\partial \theta_2} & \cdots \end{bmatrix}$$ 误差灵敏度分析： $$S_i = \frac{\partial e_{total}}{\partial p_i} \cdot \frac{p_i}{e_{total}}$$ 其中 $p_i$ 为第i个设计参数。

蒙特卡洛仿真估计总误差分布： $$P(|e| < \epsilon) = \int_{-\epsilon}^{\epsilon} f_e(x) dx$$ 设计目标：6σ精度 < 0.1mm。

2.6 刚度分析与振动模态

结构刚度和振动特性直接影响打印精度和速度上限。通过有限元分析和模态测试，可以识别薄弱环节并优化设计。

2.6.1 结构刚度矩阵

对于框架结构，总体刚度矩阵由各构件刚度矩阵组装： $$\mathbf{K} = \sum_{e=1}^{n} \mathbf{T}_e^T \mathbf{k}_e \mathbf{T}_e$$ 其中 $\mathbf{k}_e$ 为单元刚度矩阵，$\mathbf{T}_e$ 为坐标变换矩阵。

梁单元刚度矩阵（局部坐标）： $$\mathbf{k}_e = \frac{E}{L} \begin{bmatrix} A & 0 & 0 & -A & 0 & 0 \\ 0 & \frac{12I}{L^2} & \frac{6I}{L} & 0 & -\frac{12I}{L^2} & \frac{6I}{L} \\ 0 & \frac{6I}{L} & 4I & 0 & -\frac{6I}{L} & 2I \\ -A & 0 & 0 & A & 0 & 0 \\ 0 & -\frac{12I}{L^2} & -\frac{6I}{L} & 0 & \frac{12I}{L^2} & -\frac{6I}{L} \\ 0 & \frac{6I}{L} & 2I & 0 & -\frac{6I}{L} & 4I \end{bmatrix}$$ 静态挠度计算： $$\mathbf{K} \mathbf{u} = \mathbf{F}$$ 打印头位置的静态刚度： $$k_{tip} = \frac{F_{applied}}{\delta_{tip}}$$

2.6.2 模态分析理论

自由振动方程： $$\mathbf{M}\ddot{\mathbf{u}} + \mathbf{K}\mathbf{u} = 0$$ 特征值问题： $$(\mathbf{K} - \omega_i^2 \mathbf{M})\boldsymbol{\phi}_i = 0$$ 其中 $\omega_i$ 为第i阶固有频率，$\boldsymbol{\phi}_i$ 为对应模态振型。

模态质量和模态刚度： $$m_i = \boldsymbol{\phi}_i^T \mathbf{M} \boldsymbol{\phi}_i$$ $$k_i = \boldsymbol{\phi}_i^T \mathbf{K} \boldsymbol{\phi}_i$$ 模态参与因子： $$\Gamma_i = \frac{\boldsymbol{\phi}_i^T \mathbf{M} \mathbf{1}}{m_i}$$

2.6.3 共振频率计算

简化模型的解析解：

悬臂梁（Z轴）第一阶频率： $$f_1 = \frac{1.875^2}{2\pi} \sqrt{\frac{EI}{mL^4}}$$ 简支梁（龙门横梁）第一阶频率： $$f_1 = \frac{\pi}{2} \sqrt{\frac{EI}{mL^4}}$$ 集中质量系统： $$f = \frac{1}{2\pi} \sqrt{\frac{k_{eq}}{m_{eq}}}$$ 等效刚度（串联）： $$\frac{1}{k_{eq}} = \frac{1}{k_1} + \frac{1}{k_2} + ... + \frac{1}{k_n}$$

2.6.4 阻尼设计策略

瑞利阻尼模型： $$\mathbf{C} = \alpha\mathbf{M} + \beta\mathbf{K}$$ 阻尼比： $$\zeta_i = \frac{\alpha}{2\omega_i} + \frac{\beta\omega_i}{2}$$ 目标阻尼比：$\zeta = 0.02-0.05$（轻阻尼）。

增加阻尼的方法：

1. 约束层阻尼：粘弹性材料夹层
2. 调谐质量阻尼器：$f_{TMD} = f_{structure}/(1+\mu)$
3. 摩擦阻尼：接头预紧力优化
4. 主动阻尼：输入整形、陷波滤波

2.6.5 动态顺应性分析

频率响应函数（FRF）： $$H(\omega) = \frac{X(\omega)}{F(\omega)} = \sum_{i=1}^{n} \frac{\phi_{ix}\phi_{if}}{k_i(1 - r_i^2 + 2j\zeta_i r_i)}$$ 其中 $r_i = \omega/\omega_i$ 为频率比。

动态刚度： $$K_{dynamic}(\omega) = |H(\omega)|^{-1}$$ 临界速度（避免共振）： $$v_{critical} = f_1 \cdot \lambda$$ 其中 $\lambda$ 为激励波长（如丝杠导程）。

优化目标函数： $$\min J = \sum_{i=1}^{n} w_i \cdot \max_{\omega \in \Omega_i} |H(\omega)|$$

约束条件：

• 第一阶频率 > 50 Hz
• 静态刚度 > 100 N/mm
• 质量 < 设计限值

本章小结

本章系统分析了3D打印机的机械系统设计原理：

核心概念：

• 运动学解耦：笛卡尔系统通过轴独立实现控制简化，误差隔离
• 并联机构优势：Delta打印机以复杂运动学换取高速度、低惯量
• 耦合运动效率：CoreXY通过巧妙的皮带路径实现轻量化高速运动
• 微步控制精度：步进电机细分技术突破物理步距限制，但存在有效分辨率上限
• 误差传播规律：建立完整误差链模型，识别关键误差源并优化
• 动态特性优化：通过刚度设计和阻尼控制提升系统带宽

关键公式汇总：

• 笛卡尔正运动学：$x = \theta_x r_x / (360° \cdot n_x)$
• Delta逆运动学：$d_i = z - \sqrt{l^2 - (x+B_{ix}-A_{ix})^2 - (y+B_{iy}-A_{iy})^2}$
• CoreXY运动耦合：$x = r(\theta_1+\theta_2)/2$，$y = r(\theta_1-\theta_2)/2$
• 微步电流控制：$i_A = I_{max}\sin(k\pi/2n)$，$i_B = I_{max}\cos(k\pi/2n)$
• 误差传播：$\mathbf{e}_{output} = \mathbf{J}_{error} \cdot \mathbf{e}_{input}$
• 固有频率：$f = (1/2\pi)\sqrt{k/m}$

练习题

基础题

习题2.1 一台笛卡尔3D打印机，X轴使用GT2皮带（节距2mm），皮带轮20齿，步进电机1.8°步距角，16细分。计算： (a) X轴的理论分辨率（mm/步） (b) 若要达到0.01mm分辨率，需要多少细分？

习题2.2 Delta打印机参数：$R=150$mm，$r=50$mm，$L=200$mm，$l=400$mm。当打印头位于$(0,0,-300)$时，求三个电机的位移$d_1, d_2, d_3$。

习题2.3 CoreXY系统中，皮带轮半径10mm。若要实现打印头从$(0,0)$移动到$(30,40)$mm，计算两个电机需要转动的角度。

挑战题

习题2.4 推导证明：对于16细分的步进电机，当负载力矩达到保持力矩的70%时，实际可用的有效细分数约为4。考虑力矩-位置关系$T(\Delta\theta) = T_h\sin(N_r\Delta\theta)$。

习题2.5 设计一个打印机框架，要求工作空间200×200×200mm，第一阶固有频率>60Hz。若使用2020铝型材（$E=70$GPa，$I=1.7×10^4$mm$^4$，线密度0.5kg/m），估算最小框架尺寸。

习题2.6 一个传动系统包含：步进电机（步距角误差±5%）、GT2皮带（弹性模量3GPa，截面6mm²，长度500mm）、20齿皮带轮（齿距误差±0.02mm）。在100N打印力下，计算总位置误差（3σ）。

习题2.7（开放思考题）比较分析Prusa i3（笛卡尔）、Bambu Lab X1（CoreXY）、Anycubic Kossel（Delta）三种主流架构在以下方面的优劣：

• 可达到的最高打印速度
• 大批量生产时的装配难度
• 长期使用的维护成本
• 对不同材料的适应性

常见陷阱与错误

设计阶段

1. 过度依赖微步：32细分不等于32倍精度提升，实际有效细分通常仅4-8
2. 忽视热膨胀：300mm铝型材温升20°C膨胀0.14mm，超过打印精度要求
3. 刚度分配不均：Z轴刚度不足导致层纹，XY刚度不足导致振纹
4. 共振点选择不当：工作速度范围与结构固有频率重叠

装配调试

1. 皮带张力不一致：CoreXY两侧张力差导致矩形打印成平行四边形
2. 轴不垂直：XY轴垂直度误差1°在200mm行程产生3.5mm误差
3. 导轨平行度：双导轨不平行导致阻力增大、精度下降
4. 电机耦合不当：柔性联轴器引入额外柔度，刚性联轴器传递振动

参数设置

1. 加速度过高：超过$\sqrt{2\mu g} \approx 5000$mm/s²导致皮带打滑
2. 细分与速度矛盾：高细分限制最高速度（步进频率限制）
3. 未考虑电感影响：高速时力矩下降，按静态力矩设计会失步

故障诊断

1. 层移位：通常是机械松动而非电机失步
2. 周期性误差：检查皮带轮偏心、丝杠弯曲
3. 随机误差增大：轴承磨损、皮带老化
4. 振纹频率分析：$f_{pattern} = v_{print}/\lambda_{pattern}$可定位振源

最佳实践检查清单

机械设计审查

• [ ] 第一阶固有频率 > 2倍最高工作频率
• [ ] 静态刚度满足：挠度 < 0.1mm @ 额定负载
• [ ] 所有轴垂直度误差 < 0.05mm/100mm
• [ ] 导轨平行度 < 0.02mm/100mm
• [ ] 传动系统总间隙 < 0.05mm

电机与传动选型

• [ ] 静态力矩余量 > 50%（考虑动态衰减）
• [ ] 转动惯量匹配：$1 < J_{load}/J_{motor} < 10$
• [ ] 皮带预紧力：产生1-2%伸长量
• [ ] 丝杠精度等级：C5或更高（±0.023mm/300mm）
• [ ] 轴承配置：支撑端固定-自由或固定-支撑

控制参数优化

• [ ] 微步设置：16或32（更高无实际意义）
• [ ] 电流设置：额定值的70-85%（降低发热）
• [ ] 加速度限制：< 5000mm/s²（防止打滑）
• [ ] Jerk限制：10-30mm/s（平衡速度与振动）
• [ ] 共振频率标定并设置陷波滤波

装配与标定

• [ ] 使用扭矩扳手确保螺栓预紧一致
• [ ] 皮带张力计测量并记录张力值
• [ ] 千分表检查轴垂直度和平台平面度
• [ ] 激光干涉仪或球杆仪进行运动精度标定
• [ ] 振动测试识别共振频率

预防性维护

• [ ] 每500小时检查皮带张力
• [ ] 每1000小时润滑直线轴承
• [ ] 每2000小时检查丝杠预紧
• [ ] 定期检查电机联轴器
• [ ] 记录并趋势分析精度退化

继续学习：第3章：控制理论与固件架构