从电流闭环到速度闭环的无缝切换示例代码，优化传统三段式启动方式，实现自适应负载的平稳顺滑启动（...
电流闭环到速度闭环无缝切换__示例代码 ，它特别适合对传统的三段式启动方式 定位——>电流闭环强拖——>速度闭环进行优化，它能够自适应各种负载大小的情况，切换过程中电流和速度连续不突变，启动平稳顺滑。 发送切换的示例代码，代码已经过产品上千次启动验证，注释清楚，完全可以自行理解。
一、功能概述
本程序实现电机从电流闭环启动阶段到速度闭环运行阶段的平滑过渡控制。通过状态机管理电机运行过程，分阶段完成控制模式切换，核心目标是在切换过程中避免电机运行状态的突变，实现无冲击过渡。
二、核心变量说明
- 状态变量
-MotorRunState：电机运行状态枚举变量，包含MOTORPOSITION（定位）、STARTUPACCELERATION（启动加速）、STARTUPIQREFREDUCE（Iq基准值递减）、RUN_CLOSELOOP（速度闭环运行）四种状态
- 角度相关变量
-ParkParm.qAngle：FOC控制中使用的角度值
-smc1.Theta：观测器输出的电机角度
-thetaerror：强制累加角度与观测器角度的差值
-thetaerror_done：角度误差的绝对值
- 速度相关变量
-MotorParm.endspeed：根据强制累加角度计算的实时速度
-speedloopref：速度闭环的参考速度值
- 电流相关变量
-CtrlParm.IqRef：电流环的Iq基准值
-iq_min：Iq基准值的最小值限制
- 计数变量
-Iqrefreducecounter：Iq基准值递减控制的计数器
-iqmin_counter：Iq基准值达到最小值后的持续时间计数器
三、核心参数定义
| 参数名称 | 设定值 | 说明 |
|---|---|---|
TRANSFERSPEEDSTART | 600 | 进入Iq基准值递减阶段的速度阈值 |
TRANSFERSPEEDEND | 1500 | 目标速度阈值 |
TRANSFERFINISHANGLE | 10 | 判定切换完成的角度差阈值（度） |
ANGLE_BASE | 180 | 角度基准值，用于角度差的标幺化计算 |
IQREFCOUNTER_MAX | 1000 | Iq基准值递减的时间间隔计数最大值 |
TRANSFER_KP | 550 | Iq基准值递减控制的比例系数 |
DEGREEQ15_0POINT025 | 4 | 角度误差的渐变步长（对应0.025度） |
IQMINCOUNTER_MAX | 2000 | Iq基准值达到最小值后的最大持续计数 |
四、核心控制流程（calculate_angle_process函数）
程序通过状态机实现分阶段控制，各阶段逻辑如下：
1. 启动加速阶段（STARTUP_ACCELERATION）
- 执行强制角度累加，生成
ParkParm.qAngle - 计算当前速度
MotorParm.end_speed - 当
MotorParm.endspeed达到TRANSFERSPEED_START时： - 初始化
Iqrefreduce_counter为0 - 初始化
iqmincounter为0 - 设定
iq_min初始值 - 状态切换至
STARTUP_IQREFREDUCE
2. Iq基准值递减阶段（STARTUP_IQREFREDUCE）
- 继续进行角度累加，更新
ParkParm.qAngle - 基于加速度参数
accret和系数coeff更新MotorParm.end_speed - 计算角度误差
thetaerror（强制角度 - 观测器角度）及绝对值thetaerror_done - 计算标幺化角度误差
thetaerrornorm（thetaerrordone * 1000 / ANGLE_BASE） - Iq基准值调整逻辑：
Iqrefreducecounter累加，达到IQREFCOUNTERMAX时：- 重置
Iqrefreduce_counter为0 - 计算Iq调整量（
TRANSFERKP * thetaerror_norm / 1000） - 更新
CtrlParm.IqRef（当前值减去调整量） - 若
CtrlParm.IqRef小于iqmin，则强制设为iqmin，并累加iqmincounter - 切换判定（满足任一条件即切换至
RUN_CLOSELOOP）： - 角度误差条件：
thetaerrordone<TRANSFERFINISHANGLE - 超时条件：
iqmincounter≥IQMINCOUNTER_MAX
3. 速度闭环运行阶段（RUN_CLOSELOOP）
- 设置
speedloopref为目标速度TRANSFERSPEED_END - 角度切换逻辑：
ParkParm.qAngle= 观测器角度smc1.Theta+ 角度误差theta_error - 角度误差渐变处理：
- 若
thetaerror>DEGREEQ150POINT025，则减去该步长 - 若
thetaerror< -DEGREEQ150POINT025，则加上该步长 - 否则，将
theta_error清零
五、程序核心意图
- 通过分阶段控制实现从电流闭环到速度闭环的平滑过渡
- 利用角度误差反馈动态调整电流基准值，逐步降低强制控制比重
- 采用双重切换条件（角度误差达标或超时）确保系统可靠性
- 引入角度误差渐变机制，避免切换瞬间的角度突变
- 通过计数器控制参数调整频率，保证系统稳定性
该程序通过上述机制，最终实现电机从启动阶段的强制电流控制，平稳过渡到稳定运行阶段的速度闭环控制，避免切换过程中的冲击和震荡。
电流闭环到速度闭环无缝切换__示例代码 ，它特别适合对传统的三段式启动方式 定位——>电流闭环强拖——>速度闭环进行优化，它能够自适应各种负载大小的情况，切换过程中电流和速度连续不突变，启动平稳顺滑。 发送切换的示例代码，代码已经过产品上千次启动验证，注释清楚，完全可以自行理解。