🏗

Input Shaper

Dynamics
运行在线示例 免费 · 无需注册 · 直接在浏览器中运行

InputShaper 模块实现零振动(ZV)与零振动微分(ZVD)前馈输入整形算法,用于消除柔性机械系统中的残余结构抖动与吊钩摆动。通过将任意运动轨迹控制指令与一组精心计算的离散脉冲序列进行卷积,首个脉冲激发的残余振荡可被后续具有特定延迟的次级脉冲在反相状态下完全抵消。属性编辑器配备了实时脉冲序列图预览(InputShaperInsights),直观显示各脉冲归一化幅度 A1,A2,(A3)A_1, A_2, (A_3)、时间延迟 t1,t2,(t3)t_1, t_2, (t_3)、阻尼振荡周期 TdT_d 及总整形延迟 ΔT\Delta T。

数学模型

设柔性振动模态的无阻尼固有频率为 naturalFreq(ωn\omega_n),阻尼比为 damping(ζ\zeta)(0≤ζ<10 \le \zeta < 1)。阻尼振荡固有频率 ωd\omega_d、半周期延迟时间 tdt_d 及脉冲衰减比 KK 为:

ωd=ωn1−ζ2,td=πωd,K=exp⁡(−ζπ1−ζ2)\omega_d = \omega_n \sqrt{1 - \zeta^2}, \quad t_d = \frac{\pi}{\omega_d}, \quad K = \exp\left(-\frac{\zeta \pi}{\sqrt{1 - \zeta^2}}\right)

整形后的目标输出控制量 y(t)y(t) 根据所选 shaperType 生成:

零振动 (ZV) 整形器 (2 脉冲):

y(t)=u(t)+K⋅u(t−td)1+Ky(t) = \frac{u(t) + K \cdot u(t - t_d)}{1 + K}

脉冲发射时间点为 {0,td}\{0, t_d\},归一化脉冲幅度为 A1=11+K,A2=K1+KA_1 = \frac{1}{1 + K}, A_2 = \frac{K}{1 + K}。

零振动微分 (ZVD) 整形器 (3 脉冲):

y(t)=u(t)+2K⋅u(t−td)+K2⋅u(t−2td)(1+K)2y(t) = \frac{u(t) + 2K \cdot u(t - t_d) + K^2 \cdot u(t - 2t_d)}{(1 + K)^2}

脉冲发射时间点为 {0,td,2td}\{0, t_d, 2t_d\},归一化幅度为 A1=1(1+K)2,A2=2K(1+K)2,A3=K2(1+K)2A_1 = \frac{1}{(1 + K)^2}, A_2 = \frac{2K}{(1 + K)^2}, A_3 = \frac{K^2}{(1 + K)^2}。

延迟信号值 u(t−ktd)u(t - k t_d) 通过线性插值从底层循环历史缓冲区中精密提取。

输入与输出

Direction ID Label 类型 Status
→ In in1 Cmd number Required
← Out shaped Shaped number Output
← Out pulse1 A₁ number Output
← Out pulse2 A₂ number Output
← Out pulse3 A₃ number Output
← Out shaperTime T number Output

参数

参数 Label 类型 默认值 描述
naturalFreq Natural Frequency (ωₙ) number 0.5 Undamped natural frequency of the load; √(g/L) for a pendulum of length L
damping Damping Ratio (ζ) number 0.05 Damping ratio of the load; crane pendulums are typically 0.01 to 0.1
shaperType Shaper Type select ZV ZV is fastest but sensitive to a wrong frequency; ZVD takes twice as long and tolerates about 15 % error

使用示例

示例 1: 门式集装箱起重机小车无摆动快速平移定位

吊运重型集装箱,钢缆长度 L=39.2 mL = 39.2\text{ m}(ωn=9.81/39.2=0.5 rad/s\omega_n = \sqrt{9.81 / 39.2} = 0.5\text{ rad/s}),ζ=0.02\zeta = 0.02。配置 ZV 整形器:naturalFreq = 0.5、damping = 0.02、shaperType = "ZV"。当输入 10 m10\text{ m} 的平移阶跃指令时,整形器将指令切分为相隔 td≈6.28 st_d \approx 6.28\text{ s} 的两组平衡步阶;小车到位时吊具完全无残留晃动。

示例 2: 变负载工况下柔性机械臂末端抖动抑制

在末端执行器负载质量多变(导致 ωn∈[18,22] rad/s\omega_n \in [18, 22]\text{ rad/s} 不确定)时驱动机械臂运动。配置 naturalFreq = 20.0、damping = 0.05、shaperType = "ZVD"。三脉冲 ZVD 整形器提供宽陷波容差,在抓取不同负载时均能将末端振动衰减至 2%2\% 以下。

说明与最佳实践

  • 实时脉冲序列图: 属性编辑器在调节 ωn\omega_n 与 ζ\zeta 时即时绘制 2 脉冲(ZV)或 3 脉冲(ZVD)的针状图,标注精准的时间与振幅百分比。
  • 纯前馈工作机理: 输入整形完全置于反馈回路前馈通道上。它防止运动自身激发机械共振,但无法抑制外部阵风或突发碰撞造成的受迫扰动。
  • 延迟与鲁棒性权衡: ZV 引入半个振动周期(tdt_d)的系统延迟;ZVD 引入一个完整周期(2td2t_d)的延迟,但换取了极宽的频率容错度。
  • 执行机构平滑性: 阶跃输入整形后的曲线呈现阶梯形态。若伺服驱动器无法承受阶跃跳变,可在整形器后串联 RateLimiter 或一阶低通滤波环节。
  • 内部状态缓冲区: 在 WebAssembly 中由环形延迟缓冲队列实现,并在仿真离散步长之间进行精确的线性内插。

常见工程问题解答 (FAQ)

Q: How does Zero Vibration (ZV) input shaping eliminate structural vibration in cranes and robots?

ZV input shaping convolves the motion command with a sequence of two impulses whose amplitudes A1=11+K,A2=K1+KA_1 = \frac{1}{1 + K}, A_2 = \frac{K}{1 + K} (where K=e−ζπ/1−ζ2K = e^{-\zeta \pi / \sqrt{1-\zeta^2}}) and time spacing ΔT=πωn1−ζ2\Delta T = \frac{\pi}{\omega_n \sqrt{1-\zeta^2}} equal half the damped oscillation period. The second impulse induces an oscillation exactly 180∘180^\circ out of phase with the first, canceling residual vibration completely without reducing maximum actuator acceleration.

相关模块

  • SecondOrderSystem: 标准连续二阶振荡动力学模型。
  • RateLimiter: 限制指令信号的变化率以保护执行器。
  • Delay: 纯传输时滞模块。
  • LeadLag: 一阶动态超前滞后相位校正器。