FOC 位置环 PI 调参实战：让电机指哪停哪

阅读约 11 分钟 | 适合：电流环和速度环都调好了，想让电机精确控制角度的兄弟

一、速度环稳了，但你能让电机停在 37度 吗？

上篇我们把速度环调好了。给定一个转速，电机转得稳稳当当，加负载也不掉速。你的电机终于像个听话的伺服了。

现在老板说：让电机转到 37度，误差不超过 0.5度。

你设了个目标位置，电机转过去了——然后它越过 37度，冲到 45度，又倒回来，又冲过去，来回晃了七八次才勉强停住。或者更惨：根本停不住，一直在目标附近来回抽搐。

你的速度环没问题，你的位置环没调。

速度环只管转多快。它不在乎停在哪。但真要精确停在某个角度，必须上位置环。

二、位置环在三环结构里的位置

目标角度 θ_ref │ ▼ ┌─────────────────┐ │ 位置环 (P) │ ← 最外层，最慢 │ 输入：角度误差 │ │ 输出：速度指令 │ └────────┬────────┘ omega_ref │ ▼ ┌─────────────────┐ │ 速度环 (PI) │ ← 中层 │ 输入：速度误差 │ │ 输出：电流指令 │ └────────┬────────┘ i_q_ref │ ▼ ┌─────────────────┐ │ 电流环 (PI) │ ← 最内层，最快 │ 输入：电流误差 │ │ 输出：电压 → SVPWM → 电机 └────────┬────────┘ │ ▼ 编码器反馈（角度、速度）

关键理解：位置环的输出是速度环的目标值。

• 目标角度 = 37度
• 当前角度 = 0度，误差 = 37度
• 位置环输出 omega_ref = 20 rad/s（让速度环用这个速度转过去）
• 接近目标时，位置环自动降低 omega_ref，减速
• 到达 37度，位置环输出 omega_ref = 0，停住

位置环是导航员，速度环是司机，电流环是油门。

三、位置环为什么只需要 P（大多数情况）

电流环用 PI，速度环用 PI——惯性思维觉得位置环也该用 PI。

错。大多数伺服应用里，位置环只需要 P 控制器。

为什么不用 I？

位置误差的积分意味着：如果电机被挡了一下没转到目标，I 项会一直累积。障碍物消失时，I 项已经积得巨大，电机会猛冲过去撞到机械限位。这叫积分饱和（Integral Windup），在位置环里破坏力最强。

那没有 I，位置误差怎么消除？

靠速度环的 I 项接力：

位置误差小 → 位置环 P 输出小 → 速度环收到很小的速度指令 → 速度环 P 也输出小，但速度环 I 持续积分 → I 项积累出额外的转矩，把最后那点角度误差推过去

换句话说：位置环 P 把电机"带到附近"，速度环 I 负责"推进门里"。两个环分工协作，不需要位置环自己再叠一个 I。

位置环 P 负责大方向，速度环 I 负责精细到位。

四、位置环 P 值怎么调

4.1 物理含义

P_position = 角度误差 1 rad 时，输出多大的速度指令。

物理量纲：rad/s ÷ rad = 1/s，单位是 Hz。

如果你的速度环额定转速是 50 rad/s：

希望在 0.5 rad (≈28.6°) 的误差时，位置环输出满速 50 rad/s → P = 50 / 0.5 = 100

P 值越大，相同角度误差下速度指令越大 → 转得越快 → 到位越快。但如果 P 太大，惯性会让电机冲过目标，来回振荡。

SimpleFOC 代码：

// 位置环 P 控制器配置motor.controller=MotionControlType::angle;motor.PID_angle.P=20;// 位置环 P 增益（从 5 开始试）motor.PID_angle.I=0;// 绝大多数情况不需要 Imotor.PID_angle.D=0;// 位置环一般不加 Dmotor.velocity_limit=50;// 速度限幅，保护电机不过速

4.2 三步调 P

Step 0：验证下层环。先确认速度环在工作、编码器读数正常。

Step 1：从小 P 开始。
P=5 时看表现：慢慢转到位无过冲 -> P偏小，翻倍。快速到位 -> 接近了，微调。

Step 2：找到临界震荡值。每次翻倍：5->10->20->40->80。P 太大时电机会位置过冲振荡，肉眼可见的低频晃动。记下 P_osc，取 40%：
P_final = P_osc * 0.4 （位置环比速度环更保守）

Step 3：速度前馈（Feedforward）。纯 P 的缺点：越接近目标越慢，最后几度跟蜗牛爬。加前馈后到位时间直接砍半。

// 速度前馈：给位置环输出加一个预估速度偏置floatff_velocity=5.0;// 根据目标距离估算的前馈速度motor.move(ff_velocity);// SimpleFOC 的 move() 支持直接传速度值// 注意：move(vel) 会绕过位置环，需要自己在外层叠加 P 控制

五、实战：完整代码

#include<SimpleFOC.h>// 硬件配置BLDCMotor motor=BLDCMotor(7);// 7对极BLDCDriver3PWM driver=BLDCDriver3PWM(9,10,11);// PWM引脚MagneticSensorI2C sensor=MagneticSensorI2C(AS5600);// 磁编码器// 串口调参Commander command=Commander(Serial);voiddoTarget(char*cmd){command.motor(&motor,cmd);}voidsetup(){// 1. 初始化编码器sensor.init();motor.linkSensor(&sensor);// 2. 初始化驱动driver.voltage_power_supply=12;driver.init();motor.linkDriver(&driver);// 3. 位置环配置motor.controller=MotionControlType::angle;motor.PID_angle.P=20;// 位置环 P → 从 5 开始，按 4.2 节步骤调motor.PID_angle.I=0;// 不加 Imotor.velocity_limit=50;// 速度限幅 rad/s，取额定转速 80%// 4. 启动motor.useMonitoring(Serial);motor.init();motor.initFOC();// 校准传感器零位// 5. 串口命令command.add('T',doTarget,"target angle");Serial.println("FOC Position Control Ready.");Serial.println("Commands: T3.14 (set target to pi rad = 180°)");Serial.println(" P30 (change P to 30)");}voidloop(){motor.loopFOC();// 执行 FOC 电流控制motor.move();// 执行位置环 + 速度环command.run();// 处理串口命令}

在线调参（串口直接敲）：T3.14设目标180度，P30改P值。

六、三个常见翻车现场

6.1 定位精度不够，总差一点点

现象：转到目标后差 0.5~2 度，回不来。
原因：纯 P 的静差，被摩擦力和齿槽转矩吃掉了。

对策（按优先级）：

1. 加很小的 I：I=0.5，不超过 P 的 10%（注意是 I 不是 P！别加错了）
2. 提高电流环增益：让极低速也能稳定出力
3. 换高分辨率编码器

6.2 大角度转动时过冲到离谱

现象：转 360 度，冲到 420 度才回来。
原因：大角度误差 x P 值 = 超大速度指令，速度环来不及减速。

对策：

1. 设合理限幅：limit = 速度环额定转速 80%
2. 启用 output_ramp：限制输出变化率

6.3 停住以后来回抖

现象：到目标后在几度范围内来回摆。
原因：编码器分辨率不够 + P 太大。

对策：

1. 降 P 到不抖为止
2. 加死区：误差小于阈值时不输出

七、位置环合格标准

八、三环总结

记住优先级：

电流环是地基，不稳则全塌。
速度环是骨架，不硬则无力。
位置环是外皮，不准则白费。

调参顺序永远从内到外：电流环 -> 速度环 -> 位置环。

九、下一步

三环调完，你的电机已经是完整伺服系统。进阶方向：

• 轨迹跟踪：S 曲线加减速
• 力矩控制：力反馈方向盘
• 多电机协同：双驱 AGV
• 无感 FOC：不装编码器，反电动势估算角度

先把三环跑稳，你已经是一个合格的 FOC 玩家了。

下一篇：FOC三环联调实战：手搓一个指哪打哪的伺服电机

关注「困困困困好困啊」，嵌入式干货 定时更新。