从理论到代码：准PR控制器在微控制器上的高效实现

在电力电子系统中，实现对特定频率参考信号的精确跟踪是控制算法的核心挑战。尤其在单相逆变器、储能变流器等应用中，要求电流输出严格跟随50Hz/60Hz正弦波，且无稳态误差。比例谐振（PR）控制器凭借其在目标频率处的高增益特性，成为解决该问题的关键方案。然而，如何将连续域的数学模型转化为可在资源受限的嵌入式平台稳定运行的代码，是工程落地的关键。

本文以STM32和TI C2000系列DSP为硬件基础，详细解析准PR控制器的离散化过程、代码结构设计、定点运算优化及常见调试陷阱。重点聚焦于可移植性强、计算效率高的实现方式，避免冗余运算与浮点开销。

1. 准PR控制器的数字实现原理

理想PR控制器在谐振频率处具有无限增益，这在实际数字系统中会导致数值溢出或振荡。因此，引入带宽限制的"准PR"控制器更为实用。其传递函数如下：

$$ G_{QPR}(s) = K_p + \frac{2K_r\omega_c s}{s^2 + 2\omega_c s + \omega_0^2} $$

其中：

• $K_p$：比例增益
• $K_r$：谐振增益
• $\omega_0$：目标角频率（如 $2\pi \times 50$）
• $\omega_c$：截止带宽，通常取 $\omega_0$ 的0.5%~5%

为了适配数字采样系统，采用双线性变换进行离散化，保持关键频率点的响应特性。变换关系为：

$$ s = \frac{2}{T_s} \cdot \frac{1 - z^{-1}}{1 + z^{-1}} $$

代入后经代数整理，得到差分方程形式：

$$ y_r[k] = b_0 e[k] + b_2 e[k-2] - a_1 y_r[k-1] - a_2 y_r[k-2] $$

系数计算公式如下（归一化处理）：

// 离散化系数生成
float a = 2.0f / Ts;
float a_sq = a * a;
float w0_sq = w0 * w0;

float b0 = 2.0f * Kr * wc * a;

float denom = a_sq + 2.0f * wc * a + w0_sq;

float a1 = (-2.0f * a_sq + 2.0f * w0_sq) / denom;
float a2 = (a_sq - 2.0f * wc * a + w0_sq) / denom;
float b0_prime = b0 / denom;
float b2_prime = -b0 / denom;  // 因e[k-2]项系数为负

该方法有效降低动态范围，提升数值稳定性，特别适合在无FPU的MCU上运行。

2. 嵌入式代码结构与状态管理

为提高模块复用性和可维护性，建议使用结构体封装控制器状态与参数：

typedef struct {
    float Kp;           // 比例增益
    float Kr;           // 谐振增益
    float w0;           // 谐振角频率 (rad/s)
    float wc;           // 截止带宽 (rad/s)
    float Ts;           // 采样周期 (s)

    float b0;           // b0' 系数
    float b2;           // b2' 系数
    float a1;           // a1' 系数
    float a2;           // a2' 系数

    float error_prev1;  // e[k-1]
    float error_prev2;  // e[k-2]
    float output_prev;  // yr[k-1]
} QPR_Controller_t;

初始化函数示例：

void QPR_Init(QPR_Controller_t* ctrl, float kp, float kr, float w0, float wc, float ts) {
    ctrl->Kp = kp;
    ctrl->Kr = kr;
    ctrl->w0 = w0;
    ctrl->wc = wc;
    ctrl->Ts = ts;

    float a = 2.0f / ts;
    float a_sq = a * a;
    float w0_sq = w0 * w0;
    float b0_val = 2.0f * kr * wc * a;

    float denom = a_sq + 2.0f * wc * a + w0_sq;

    ctrl->b0 = b0_val / denom;
    ctrl->b2 = -b0_val / denom;
    ctrl->a1 = (-2.0f * a_sq + 2.0f * w0_sq) / denom;
    ctrl->a2 = (a_sq - 2.0f * wc * a + w0_sq) / denom;

    // 初始化状态变量
    ctrl->error_prev1 = 0.0f;
    ctrl->error_prev2 = 0.0f;
    ctrl->output_prev = 0.0f;
}

3. 实时执行与定点数优化建议

若需在无浮点单元的芯片上部署，可考虑使用定点数缩放。例如将所有参数乘以 $2^{12}$（4096），在计算中使用整型运算，最后再右移还原。

此外，注意以下工程细节：

• 采样周期必须严格一致，推荐使用定时器中断触发。
• 输入误差应做限幅处理，防止积分饱和。
• 输出值需根据电机驱动或逆变桥的电压范围进行裁剪。

4. 调试要点与性能验证

典型问题包括：

• 输出震荡：检查 $wc$ 是否过小，或 $Kr$ 过大。
• 静差未消除：确认 $Kp$ 和 $Kr$ 设置合理，且采样率足够高。
• 数值溢出：启用边界保护，避免中间结果超限。

可通过示波器观察电流波形与参考信号的相位一致性，或使用频谱分析工具验证是否在目标频率处有显著增益。