实时输入整形轨迹规划实现方法介绍

在高精度运动控制系统中，实时输入整形（Real-Time Input Shaping）是一种有效抑制机械系统残余振动的前馈控制技术。其核心思想是在原始指令信号上叠加若干个经过时延和幅值调制的脉冲序列，使得系统在完成运动后残余振动被显著削弱甚至完全消除。

1. 基本原理
输入整形器通常由一组脉冲组成，表示为：

uₛₕₐₚₑ𝒹(t) = Σᵢ₌₀ⁿ⁻¹ Aᵢ · u(t − tᵢ)

其中：

• Aᵢ 为第 i 个脉冲的幅值，
• tᵢ 为其施加时刻，
• u(t) 为原始输入指令。

设计目标是使系统对 uₛₕₐₚₑ𝒹(t) 的响应在稳态时振动为零，即满足以下约束条件：

Σᵢ₌₀ⁿ⁻¹ Aᵢ · e^(−ζωₙtᵢ) · cos(ω_d tᵢ − φ) = 0

其中：

• ζ 为阻尼比，
• ωₙ 为无阻尼自然频率，
• ω_d = ωₙ√(1 − ζ²) 为有阻尼振荡频率，
• φ = arctan( √(1 − ζ²) / ζ )。

2. 实时实现方法
为满足工业现场对低延迟、高可靠性的要求，实时输入整形通常采用以下策略：

• 预计算整形器参数：根据已知或在线辨识的系统模态参数（如固有频率和阻尼比），离线计算最优 Aᵢ 和 tᵢ（例如 ZV、ZVD 或 EI 整形器）。
• 卷积式实时滤波：将整形器建模为 FIR 滤波器，在每个控制周期对参考轨迹进行实时卷积运算。
• 动态更新机制：当系统参数变化（如负载改变）时，通过轻量级在线辨识模块更新整形器参数，确保鲁棒性。
• 与轨迹规划融合：将输入整形嵌入 S 型或 jerk-limited 轨迹生成器中，避免引入额外时延，同时保证运动平滑性与振动抑制性能。

3. 应用优势

• 无需反馈传感器即可有效抑制残余振动；
• 计算开销小，适合嵌入式控制器部署；
• 可与现有运动控制框架无缝集成。