点位运动控制基础：点位运动、轨迹规划、速度曲线与加减速控制原理

点位运动控制（Point-to-Point Motion Control）是工业自动化和精密装备中最基础、最普遍的运动形式。无论是PCB钻孔机、固晶机、贴片机，还是3D打印、激光切割和半导体封装设备，其核心动作都可以抽象为“从A点快速、准确地移动到B点”。然而，看似简单的“走一步”，背后却涉及轨迹规划、速度曲线生成、加减速控制等一系列关键问题。若处理不当，轻则产生机械振动和定位超调，重则导致电机失步、机构损伤甚至设备报废。本章将系统拆解点位运动的核心概念，重点剖析梯形速度曲线与S形速度曲线的数学本质、工程实现方法及其在FPGA加速方案中的映射逻辑，为后续章节的硬件架构设计奠定理论基础。

上图展示了点位运动控制从目标位置到执行机构的核心链路，以及梯形与S形速度曲线的直观对比。在FPGA实现中，我们需要将这条链路中的每一个环节转化为硬件逻辑，利用并行流水线架构实现微秒级的轨迹更新和脉冲输出。下面，我们将从核心原理、实现方法、实战案例和常见误区四个维度展开深入讨论。

2.1 点位运动与轨迹规划的核心原理

点位运动（Point-to-Point, PTP）的核心特征是：系统只关心起点和终点的位置精度，不关心中间路径的具体形状。这与连续轨迹运动（如CNC加工中的轮廓插补）有本质区别。PTP运动通常用于定位、搬运、点胶、锁付等场景，其性能指标主要包括：定位时间（节拍）、定位精度、重复定位精度和运动平稳性。

轨迹规划（Trajectory Planning）的任务是在给定起点、终点、最大速度、最大加速度等约束条件下，生成一条满足运动学限制的时间-位置函数。对于点位运动，轨迹规划的核心是确定速度曲线形状，即速度随时间变化的规律。常见的速度曲线包括：

• 梯形速度曲线（Trapezoidal Profile）：由匀加速、匀速、匀减速三段组成，加速度在切换点发生阶跃突变。
• S形速度曲线（S-Curve Profile）：加速度连续变化，通常由加加速、匀加速、减加速、匀速、加减速、匀减速、减减速七段组成，加速度的一阶导数（加加速度Jerk）受限。
• 指数型/抛物线型曲线：在特定场景下使用，但工程中较少见。

从控制理论角度看，梯形曲线是二阶系统（位置-速度）的最优时间控制，但加速度突变会激发机械谐振；S形曲线通过限制加加速度（Jerk）来平滑加速度变化，显著降低振动和冲击，但运动时间会略有增加。在高速高精设备中，S形曲线几乎是标配。

2.2 速度曲线生成与加减速控制方法

本节重点讨论梯形和S形曲线的数学描述及离散化实现方法，这是FPGA编码的基础。

2.2.1 梯形速度曲线的数学与离散化

梯形曲线分为三个阶段：加速段（时间T1）、匀速段（时间T2）、减速段（时间T3）。设最大速度为Vmax，加速度为A，减速度为D（通常A=D），总位移为S。则各阶段参数计算如下：

加速段位移 S1 = Vmax² / (2A)
减速段位移 S3 = Vmax² / (2D)
匀速段位移 S2 = S - S1 - S3
匀速段时间 T2 = S2 / Vmax
加速段时间 T1 = Vmax / A
减速段时间 T3 = Vmax / D

在FPGA中，我们通常使用增量式位置累加器实现梯形曲线。核心思路是：每个时钟周期根据当前阶段计算速度增量，然后累加位置。伪代码如下：

// 梯形曲线状态机（简化）
always @(posedge clk) begin
  case (state)
    ACCEL: begin
      velocity <= velocity + A_step;  // A_step = A * dt
      position <= position + velocity;
      if (velocity >= Vmax) state <= CRUISE;
    end
    CRUISE: begin
      position <= position + Vmax;
      if (remaining_distance <= S3) state <= DECEL;
    end
    DECEL: begin
      velocity <= velocity - D_step;
      position <= position + velocity;
      if (velocity <= 0) state <= STOP;
    end
  endcase
end

这种方法的优点是逻辑简单、资源占用少，适合对振动要求不高的场合。但需要注意，梯形曲线在加速到匀速、匀速到减速的切换点，加速度存在阶跃，会产生冲击力。

2.2.2 S形速度曲线的分段多项式实现

S形曲线将加速度的变化率（Jerk）限制在Jmax以内，速度曲线呈S形。完整的S形曲线有7个阶段，其位移、速度、加速度公式如下（以加速段为例）：

阶段1（加加速）：a = J*t, v = v0 + 0.5*J*t², s = v0*t + J*t³/6
阶段2（匀加速）：a = Amax, v = v0 + Amax*t, s = v0*t + 0.5*Amax*t²
阶段3（减加速）：a = Amax - J*t, v = v0 + Amax*t - 0.5*J*t², s = v0*t + 0.5*Amax*t² - J*t³/6

在FPGA中直接计算三次多项式需要乘法器和除法器，资源消耗较大。工程上常用的替代方案是查表法（LUT）或CORDIC算法。查表法将归一化的S形曲线离散为256或1024个点，存储于ROM中，运行时通过线性插值获得当前速度值。这种方法精度高、速度快，但需要额外的存储资源。

2.3 案例拆解：高速固晶机点位运动优化

某半导体封装设备厂商开发高速固晶机，要求将芯片从供料器搬运至基板指定位置，单次运动距离为50mm，定位时间要求小于80ms，重复定位精度±5μm。初始方案采用梯形速度曲线，最大速度Vmax=1.2m/s，加速度A=30m/s²。实测发现：

• 设备在加减速切换点产生明显异响，振动传感器检测到8kHz~12kHz的谐振峰。
• 定位后残余振动时间长达15ms，导致实际节拍仅为90ms，不满足要求。

分析过程：梯形曲线的加速度突变（从0到30m/s²瞬间完成）激励了机械臂的固有模态。通过有限元分析，确认一阶固有频率为9.5kHz，正好落在激励频带内。解决思路是改用S形曲线，限制Jerk值。

实施步骤：

1. 将速度曲线改为S形，设定Jerk=1500m/s³（约为加速度的50倍）。
2. 重新计算运动参数：加速段时间T1=Vmax/A=40ms，加加速段时间Tj=Amax/J=20ms，总运动时间理论值约85ms。
3. 为满足80ms节拍，将Vmax提升至1.35m/s，A提升至35m/s²，Jerk=2000m/s³。
4. 在FPGA中实现S形曲线查表模块，ROM存储256点归一化速度表，插值输出。

结果对比：改进后，定位时间实测78ms，残余振动幅值降低70%，振动衰减时间缩短至3ms以内。设备异响消失，重复定位精度提升至±3μm。

2.4 常见误区与设计复盘

在点位运动控制的FPGA实现中，工程师常陷入以下误区：

• 误区一：盲目追求高加速度。加速度越高，定位时间越短，但驱动力矩需求呈平方增长，且振动加剧。应综合电机峰值扭矩、机械刚度和负载惯量进行匹配。
• 误区二：忽略加减速阶段的“零速过渡”。梯形曲线在启动瞬间速度从0跳变到A*t，虽然速度连续，但加速度阶跃。若机械间隙较大，会产生“叩击”现象。S形曲线同样需要确保起始和结束时的Jerk为0。
• 误区三：FPGA中直接使用浮点运算。浮点运算在FPGA中资源消耗大、延迟高。应使用定点数（Q格式）表示速度和位置，例如Q16.16格式，兼顾精度和范围。
• 误区四：忽视位置累加器的溢出。当运动距离很长（如超过2^31个脉冲）时，32位累加器可能溢出。需使用64位累加器或分段处理。

设计复盘清单：

1. 明确运动指标：定位时间、精度、振动容忍度。
2. 测量机械系统固有频率，确定Jerk上限。
3. 选择速度曲线类型，计算各阶段参数。
4. 在FPGA中搭建流水线：参数计算→曲线生成→位置累加→脉冲输出。
5. 使用仿真验证（ModelSim/Vivado Simulator）检查速度、加速度曲线是否连续。
6. 上机测试，用示波器或逻辑分析仪抓取脉冲序列，对比理论曲线。

本章从点位运动的基本概念出发，详细推导了梯形与S形速度曲线的数学原理和FPGA实现方法，并通过固晶机案例展示了从问题诊断到方案落地的完整闭环。掌握这些基础，是后续学习FPGA加速架构设计、多轴同步控制和高速脉冲生成模块的前提。在实际工程中，务必根据机械特性、电机性能和工艺要求，选择合适的速度曲线并精细调校参数，才能实现“快、准、稳”的点位运动控制。