cbb/Motor_v2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

feat(FOC): 优化SVPWM算法并重构角度控制逻辑

Browse Source 
- 引入新的三值约束宏 `_constrain3` 用于SVPWM计算优化
- 修改 `setPhaseVoltage` 函数签名，移除冗余的角度参数，内部自动计算电气角度
- 调整PWM占空比计算方式，提高电压利用率和控制精度
- 移除旧的DEG2RAD和RAD2DEG常量定义，改由initial.h统一管理
- 在initial.h中新增减速比常量REDUCTION_RATIO，并修正拼写错误
- 为角度传感器类更新速度滤波器尺寸，提升速度估算稳定性
- 更新PID控制器时间片常量，简化dt计算逻辑，提高执行效率
- 切换角度闭环控制至新NPID版本，增强系统响应性能
- 修正CAN通信中的目标角度解析逻辑，确保指令正确应用
This commit is contained in:
cbb
2025-11-08 02:15:14 +08:00
parent 971374d8ec
commit 99cc397931
8 changed files with 70 additions and 53 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Robot_V2/device/Can.cpp
+1 -1
View File
@@ -678,7 +678,7 @@ void CAN_transmiter::communication_check() {
}
target_angle_union.f =
unpack_bytes_to_float(receive_message.rx_data, 7).f;
FOC.target_angle = target_angle_union.f * ANGLE_FACTOR;
FOC.target_angle = target_angle_union.f;
target_velocity_union.f =
unpack_bytes_to_float(receive_message.rx_data, 11).f;