2、3D打印基础：FDM/SLA等主流打印技术原理、机械结构（笛卡尔、CoreXY、Delta）对运动规划的影响

3D打印机的运动规划与轨迹生成算法，其核心目标是在满足打印质量、表面光洁度、尺寸精度和打印速度的前提下，为电机驱动器生成平滑、连续且可执行的运动指令序列。然而，运动规划算法并非在“真空”中运行，它必须深度适配底层打印技术（FDM、SLA等）的物理成型机理，以及机械结构（笛卡尔、CoreXY、Delta）的运动学与动力学特性。本章将首先剖析主流打印技术的工艺约束，随后深入探讨三种典型机械结构的运动学模型及其对轨迹生成、速度规划和加速度前馈控制的直接影响，为后续章节的算法设计奠定坚实的物理与数学基础。

上图清晰地展示了打印技术、机械结构与运动规划三者之间的耦合关系。工艺约束决定了轨迹的“形状”与“速度包络”，而运动学模型则决定了如何将规划器输出的笛卡尔空间轨迹（X, Y, Z, E）映射到各电机的关节空间指令。下面我们将逐一展开分析。

2.1 主流打印技术原理与工艺约束

2.1.1 FDM（熔融沉积建模）技术原理与运动规划约束

FDM技术通过加热喷嘴将热塑性丝材（如PLA、ABS、PETG）熔融，并按照预设路径逐层挤出，堆积成型。其运动规划的核心挑战在于“挤出量”与“运动轨迹”的严格同步。挤出电机（E轴）的脉冲频率必须与喷嘴的移动速度、层高和线宽精确匹配，否则会出现“欠挤出”（拉丝、层间空洞）或“过挤出”（堆料、表面粗糙）。

从运动规划角度看，FDM工艺引入了以下关键约束：

• 挤出速度与移动速度的比值（流量率）：规划器必须限制最大移动速度，以确保熔融塑料能够及时从喷嘴中流出。通常，最大体积流量（mm³/s）是材料与喷嘴直径的函数，规划器需据此反推最大进给速度。
• 回抽（Retraction）动作：在空行程或切换打印区域时，需要反向旋转挤出机以拉回丝材，防止滴料。回抽动作是典型的“点对点”运动，其加速度和速度规划不当会导致“回抽过冲”或“回抽不足”，产生拉丝或漏料。
• 最小层间时间：对于小面积截面，如果打印速度过快，上一层尚未冷却固化，下一层就会将其压塌。因此，规划器需要引入“最小层时间”约束，必要时自动降低该层的移动速度或插入“等待”指令（Z-hop）。
• 振动与共振抑制：FDM打印机的结构刚度有限，过高的加速度会激发机械共振，在打印表面产生“振纹”（Ghosting）。因此，运动规划中的加速度曲线必须经过平滑处理（如S曲线），并可能结合输入整形（Input Shaping）技术。

2.1.2 SLA/DLP（光固化）技术原理与运动规划约束

SLA使用紫外激光或DLP投影仪逐层固化光敏树脂。与FDM不同，SLA的成型过程是“面”或“线”的扫描，而非“点”的挤出。其运动规划主要涉及振镜（Galvanometer）的偏转运动和Z轴平台的升降运动。

SLA对运动规划的影响体现在：

• 光斑补偿与滞后：激光光斑在扫描高速拐角时，由于振镜的惯性，实际轨迹会滞后于指令轨迹，导致拐角处过固化或欠固化。规划器需对路径进行“光斑半径补偿”，并限制振镜的角加速度。
• Z轴升降与剥离力：每层固化后，平台需要上升一定高度，使固化层与离型膜（或玻璃底）分离。这个“剥离”过程需要精确的Z轴运动控制——通常采用“先下降再上升”的曲线，以减小剥离力，防止模型变形。这要求Z轴运动规划具备多段速度切换能力。
• 层间等待时间：树脂流动需要时间，规划器需在每层之间插入等待指令，确保树脂液面平整。

2.1.3 技术对比与规划策略

2.2 机械结构对运动规划的影响

机械结构决定了电机如何驱动工具头（或打印平台）在空间中运动。不同的结构具有不同的运动学方程，这直接影响规划器的输出坐标类型和速度映射关系。

2.2.1 笛卡尔结构（XYZ）

笛卡尔结构是最直观的，三个线性轴（X, Y, Z）相互垂直，电机直接驱动各轴移动。其运动学是解耦的，即X轴的运动不影响Y轴。

• 规划优势：轨迹生成简单，笛卡尔空间的速度/加速度可直接映射到各轴电机。例如，规划器设定X轴速度为100mm/s，则X电机直接执行该速度。
• 规划挑战：由于运动质量大（龙门架或十字滑台），有效加速度受限。此外，在打印圆形或斜线时，各轴需要协同运动，但各轴的动态响应差异（如摩擦、皮带弹性）可能导致轮廓误差。

// 笛卡尔结构逆运动学（伪代码）
// 输入：目标点 (X, Y, Z)
// 输出：各轴位置指令
motor_x.position = X;
motor_y.position = Y;
motor_z.position = Z;
// 无需额外计算，直接映射

2.2.2 CoreXY结构

CoreXY通过两根同步带和两个固定电机（A和B）的协同运动来实现XY平面的移动。其运动学是耦合的：X轴的移动需要A和B电机同时同向旋转，Y轴的移动需要A和B电机同时反向旋转。

• 运动学方程：
  A = (X + Y) / 2
B = (X - Y) / 2
• 规划影响：规划器在笛卡尔空间规划的直线轨迹，映射到电机空间后，A和B电机的速度曲线可能完全不同。例如，纯X轴运动时，A和B同速；纯Y轴运动时，A和B反向。在45°方向运动时，一个电机速度为零，另一个电机全速。这意味着规划器必须考虑电机空间的速度/加速度限制，不能仅看笛卡尔空间的合成速度。
• 同步误差：如果A和B电机的编码器反馈不同步，或皮带张力不一致，会导致运动轨迹扭曲。因此，运动规划算法需要具备“电机同步误差检测”功能，并在必要时触发报警。

2.2.3 Delta结构（并联臂）

Delta结构通过三个并联的驱动臂控制末端执行器（打印头）在空间中移动。其运动学是强非线性的，且存在奇异点。

• 逆运动学：给定末端坐标 (X, Y, Z)，需要求解三个滑块的垂直位置 (Z1, Z2, Z3)。这通常需要求解一组非线性方程，计算量较大。
• 规划影响：由于运动学非线性，笛卡尔空间的匀速直线运动映射到关节空间后，各滑块的速度和加速度是时变的。规划器必须实时计算逆运动学，并确保关节空间的速度/加速度不超过电机能力。
• 奇异点规避：当末端执行器位于工作空间边缘或特定高度时，雅可比矩阵可能奇异，导致某个关节速度趋于无穷大。规划器必须提前识别并规避这些区域。

2.3 案例拆解：CoreXY结构下的高速打印“振纹”问题

背景与约束：某桌面级3D打印机采用CoreXY结构，目标将打印速度从60mm/s提升至150mm/s。初始现象是，在打印速度超过120mm/s时，模型表面出现明显的周期性“振纹”，尤其在45°斜线方向最为严重。

关键数据与指标：

• 电机加速度设定：笛卡尔空间 3000mm/s²
• 皮带张力：经测量，A/B轴皮带张力偏差约15%
• 振动频率：通过加速度计测量，共振频率约为45Hz

分析判断过程：

1. 首先怀疑是机械共振。45Hz的共振频率与打印速度120mm/s、层高0.2mm的激励频率（120/0.2=600Hz）不符，排除层间激励。
2. 检查运动规划参数。发现规划器仅限制了笛卡尔空间的合成加速度，未限制电机空间加速度。在45°方向运动时，A电机速度为零，B电机速度为合成速度的1.414倍。当合成加速度为3000mm/s²时，B电机实际加速度为4242mm/s²，超出了电机驱动器的最大无失步加速度（约3500mm/s²），导致B电机瞬间丢步，随后又恢复，产生振动。
3. 进一步检查皮带张力偏差，导致A/B电机在反向切换时存在时间差，加剧了振动。

实际操作步骤：

1. 修改运动规划算法：将加速度限制从笛卡尔空间转换到电机空间。设定电机空间最大加速度为3200mm/s²，并据此反推笛卡尔空间各方向的最大加速度。
2. 增加输入整形（Input Shaping）：针对45Hz共振频率，在规划器中加入二阶陷波滤波器，抑制该频段的激励。
3. 重新校准皮带张力，将偏差控制在5%以内。

结果对比：修改后，打印速度提升至150mm/s，表面振纹消失，尺寸精度从±0.3mm提升至±0.15mm。

复盘经验：在CoreXY等耦合结构中，运动规划必须基于“关节空间”而非“任务空间”进行约束。同时，机械系统的固有频率应作为规划器参数输入，用于生成陷波滤波器。

2.4 常见误区与总结复盘

常见误区：

• 误区一：忽略工艺约束。在FDM中，仅优化运动轨迹而不考虑挤出流量，导致“过挤出”或“欠挤出”。运动规划必须与挤出量规划联合进行。
• 误区二：将笛卡尔空间限制直接用于所有结构。如上述案例所示，这会导致电机丢步或共振。
• 误区三：忽视SLA的Z轴剥离过程。将Z轴运动视为简单的点对点运动，未规划剥离曲线，导致模型分层或损坏。