PLC 与工业控制 / 系统课时

用直线插补规划双轴联动轨迹

用直线插补规划双轴联动轨迹

双轴滑台从起点移动到终点时,分别给 X、Y 轴下发定位命令,不一定能走出直线。本课通过一个带具体坐标、速度和加减速时间的算例,计算两轴同步位置与速度指令,并建立可检查的路径误差和到位验收方法。

学习目标

  • 根据二维起终点和路径速度计算运动距离、总时间及两轴速度分量。
  • 使用统一路径参数生成双轴直线插补轨迹,并加入同步加减速。
  • 区分独立轴定位与协调插补,检查路径误差、同步性和安全边界。

为什么两轴同时到位不等于走直线

假设一台 XY 十字滑台需要从 A(10, 20) mm 移动到 B(110, 80) mm,两个轴的位移分别为 100 mm 和 60 mm。

如果 X、Y 轴都以 100 mm/s 独立运动,X 轴需要 1 s,Y 轴只需要 0.6 s。忽略加减速时,经过 0.6 s,滑台到达 (70, 80) mm,之后只剩 X 轴移动。实际轨迹由两段折线组成,而不是 A 到 B 的直线。

协调直线插补要求两轴共享同一个路径进度 s(t)s(t),在任意时刻满足:

x(t)=x0+Δx s(t)x(t)=x_0+\Delta x\,s(t)
y(t)=y0+Δy s(t)y(t)=y_0+\Delta y\,s(t)

其中 s(t)s(t) 从 0 单调变化到 1。只要两轴使用同一进度,无论整体是匀速还是加减速,理想指令点始终位于目标直线上。

独立双轴定位与协调直线插补路径对比

从起终点计算路径与轴速度

设起点为 (x0,y0)(x_0,y_0),终点为 (x1,y1)(x_1,y_1),路径速度为 FF,单位 mm/s。首先计算位移向量和直线长度:

Δx=x1−x0,Δy=y1−y0\Delta x=x_1-x_0,\quad \Delta y=y_1-y_0
L=Δx2+Δy2L=\sqrt{\Delta x^2+\Delta y^2}

当 L>0L>0 且采用匀速插补时,总运动时间 T=L/FT=L/F,两轴速度为:

vx=FΔxL,vy=FΔyLv_x=F\frac{\Delta x}{L},\quad v_y=F\frac{\Delta y}{L}

对本例取 F=100F=100 mm/s,可以得到:

计算项目 结果
X 轴位移 100 mm
Y 轴位移 60 mm
路径长度 116.619 mm
X 轴速度 85.749 mm/s
Y 轴速度 51.450 mm/s
匀速运动时间 1.16619 s

两轴在相同的 1.16619 s 内完成各自位移,速度比例始终为 100:60100:60。例如运动到一半时,路径参数为 0.5,对应位置是 (60, 50) mm。

需要注意,100 mm/s 是合成路径速度,不是两轴都设为 100 mm/s。任何一轴的允许速度、加速度或行程不足,都必须重新限制整条路径,而不是单独截断该轴速度。

用统一路径参数生成同步指令

实际设备通常不能在起点瞬间达到 100 mm/s,需要规划加速、匀速和减速阶段。下面采用路径方向的对称梯形速度规划,假设合成加速度为 200 mm/s²,起止速度均为零,暂不考虑加加速度限制。

加速时间为 ta=F/a=0.5t_a=F/a=0.5 s,加速距离为 da=Fta/2=25d_a=Ft_a/2=25 mm。两端合计 50 mm,小于总路径长度 116.619 mm,因此可以达到指定的最高路径速度。

匀速段长度为 66.619 mm,匀速时间约 0.66619 s,总时间约为 1.66619 s。三个阶段共用路径标量位移 q(t)q(t),令 s(t)=q(t)/Ls(t)=q(t)/L,再映射成各轴位置。

双轴直线插补的梯形速度与同步路径进度

下面的 Python 3 示例可以直接执行,不依赖第三方库。它按 10 ms 周期采样轨迹,打印关键时刻的两轴位置和路径速度,并检查采样点是否落在目标直线上。

python
import math

x0, y0 = 10.0, 20.0
x1, y1 = 110.0, 80.0
feed, accel = 100.0, 200.0  # 合成速度与加速度,单位mm/s及mm/s²
dt = 0.01  # 双轴共享的插补采样周期,单位s

dx, dy = x1 - x0, y1 - y0
length = math.hypot(dx, dy)
if length == 0:
    raise ValueError("起点与终点相同,无需直线插补")
if feed <= 0 or accel <= 0 or dt <= 0:
    raise ValueError("速度、加速度和周期必须大于零")

# 短路径无法达到设定速度时,自动退化为三角速度规划
peak = min(feed, math.sqrt(accel * length))
ta = peak / accel
da = 0.5 * accel * ta * ta
tc = (length - 2 * da) / peak
total = 2 * ta + tc

def sample(t):
    t = min(max(t, 0.0), total)
    if t <= ta:
        q, v = 0.5 * accel * t * t, accel * t
    elif t <= ta + tc:
        q, v = da + peak * (t - ta), peak
    else:
        remaining = total - t
        q = length - 0.5 * accel * remaining * remaining
        v = accel * remaining
    ratio = q / length  # 两轴必须共享同一个归一化进度
    return x0 + dx * ratio, y0 + dy * ratio, v

count = math.ceil(total / dt)
for i in [0, count // 2, count]:
    t = min(i * dt, total)
    x, y, v = sample(t)
    error = abs(dx * (y - y0) - dy * (x - x0)) / length
    print(f"t={t:.3f}s X={x:.3f} Y={y:.3f} v={v:.3f} error={error:.6f}")

预期输出(浮点数保留三位或六位小数):

text
t=0.000s X=10.000 Y=20.000 v=0.000 error=0.000000
t=0.830s X=60.000 Y=50.000 v=100.000 error=0.000000
t=1.666s X=110.000 Y=80.000 v=0.000 error=0.000000

以上输出展示的是理想数学轨迹,采样程序最后一次输出会将时间限制在实际终点时间。实际控制器应使用同一插补时钟计算两轴目标点,并在最终周期明确下发终点坐标。不得依靠两个互不关联的定时任务各自累计浮点位移。

处理轴限速、短路径和离散采样

实际选型时,应先检查直线方向在各轴约束下是否可执行。设 X、Y 最大速度分别为 80、70 mm/s,最大加速度分别为 150、120 mm/s²。

路径方向单位向量为 (ux,uy)=(0.85749,0.51450)(u_x,u_y)=(0.85749,0.51450)。因此合成路径允许速度必须满足各轴限值:

Fmax⁡=min⁡(80∣ux∣,70∣uy∣)=93.30 mm/sF_{\max}=\min\left(\frac{80}{|u_x|},\frac{70}{|u_y|}\right)=93.30\ \text{mm/s}

同理,合成路径允许加速度为:

amax⁡=min⁡(150∣ux∣,120∣uy∣)=174.93 mm/s2a_{\max}=\min\left(\frac{150}{|u_x|},\frac{120}{|u_y|}\right)=174.93\ \text{mm/s}^2

因此原先 100 mm/s、200 mm/s² 的规划会超过 X 轴限制,必须将两者降低至上述上限或留出工程裕量。若路径方向某分量为零,则该轴不参与对应方向的速度或加速度约束,不能直接除以零。

如果路径很短,满足 L<F2/aL< F^2/a,说明来不及加速到给定速度,应该改用三角速度曲线,其峰值为 aL\sqrt{aL}。例如移动距离只有 20 mm、加速度 200 mm/s² 时,最高路径速度约为 63.246 mm/s。

采样周期也影响实际轨迹。10 ms、100 mm/s 时,相邻匀速采样点的路径间距为 1 mm;改用 1 ms 则为 0.1 mm。更短的周期能提高指令更新密度,但无法消除机械跟随误差,且应遵守运动控制器支持的插补周期。

用实际反馈验收直线精度

指令点位于直线上,不代表实际负载一定沿直线运动。两轴伺服带宽不同、通信更新时间不一致、机械反向间隙或跟随误差,都可能造成路径偏离。

对于本例,目标直线的单位法向量可以取 (−0.51450,0.85749)(-0.51450,0.85749)。实际反馈点 (xf,yf)(x_f,y_f) 相对目标无限延长直线的垂直距离为:

e⊥=∣Δx(yf−y0)−Δy(xf−x0)∣Le_\perp=\frac{|\Delta x(y_f-y_0)-\Delta y(x_f-x_0)|}{L}

例如在预期位置 (60, 50) mm 附近,实际反馈为 (60.2, 49.7) mm,则横向路径误差约为 0.360 mm。仅检查两个轴最终到位,发现不了中途出现过的这一偏差。

建议在调试阶段按以下顺序验收:

  1. 先核实回零完成、坐标系、软限位、驱动使能以及硬件安全回路,选择远离机械边界的测试路径。
  2. 在低速下执行双轴插补,使用统一时间戳记录两轴实际位置、指令位置和跟随误差。
  3. 逐采样点计算横向路径误差,并单独检查终点位置偏差和运动时间。
  4. 根据设备工艺制定阈值,例如教学测试可暂设最大横向误差不超过 0.10 mm、终点各轴误差不超过 0.05 mm;这些数值不是通用工业标准,应按机构精度和工艺需求重新确定。
  5. 若中途路径误差大而终点正确,优先检查两轴是否真正共享插补周期、速度前馈与跟随响应,而不是单纯收紧到位窗口。

双轴直线插补的验收必须同时覆盖路径、速度和最终位置:同一进度参数保证理想几何直线,统一运动时基与合理的轴约束保证指令协调,实际反馈数据才能证明机械系统满足路径精度。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

用直线插补规划双轴联动轨迹

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通