cbb/Motor_v2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
66 Commits 1 Branch 0 Tags
7c4aaa5ee66a381cb214430907b5d3e4250e3fa8
Commit Graph
16 Commits
Author SHA1 Message Date
cbb 7c4aaa5ee6 feat(FOC): 优化FOC控制算法并修复多个控制环路问题 
- 重构cal_Iq_Id函数，移除电角度参数传递，改用预计算的sin/cos值
  以避免重复三角函数计算，提升性能约15-300周期
- 修复角度同步Uq前馈学习中的运动方向判断逻辑，解决反转时的
  震荡问题和正转正常反转震荡的根本原因
- 实现低速缩放因子函数get_mode3_velocity_scale，改进静摩擦
  hunting抑制效果
- 优化电压检测逻辑，将阻塞式ADC读取改为连续模式零等待，
  提升实时性能
- 修复初始化期间电压分母为零的问题，添加下限保护防止P增益
  无穷大
- 实现PID控制器测量微分功能，消除目标阶跃时的微分冲击
- 改进积分抗饱和策略，添加外部饱和泄放功能，优化到位稳定
  性能

perf(Filter): 优化中值滤波算法性能

- 针对ADC_FILTER_SIZE=6的固定场景实现最优排序网络，
  用12次比较替代通用std::nth_element算法，显著提升性能
- 保留通用回退路径处理其他尺寸情况
 2026-09-01 02:46:25 +08:00
cbb b71fba2016 feat(FOC): 添加角度同步Uq前馈补偿和速度环优化 
- 实现update_angle_sync_uq_feedforward函数，支持mode2和mode3的角度同步  Uq前馈补偿，按物理360°查表学习负载/阻力差异
- 实现get_mode3_velocity_p函数，mode3低速时降低速度环P参数减少抖动
- 在velocity_control和angle_control_with_velocity_limit中集成Uq前馈补偿
- 优化normalizeAngle360函数，大角度时先扣整圈数避免while循环过多
- 调整配置参数，降低DEFAULT_vel_loop_p并添加详细的Uq前馈补偿配置
- 更新电源电压参数使用本周期采样值，避免电压滞后影响
 2026-05-24 04:56:33 +08:00
cbb e646544f7f refactor(FOC): 重构齿槽转矩校准状态机为独立函数 
- 将原本在 calibrate_cogging_tick 中的大函数拆分为多个职责单一的函数
- 新增 start_cogging_calibration、cogging_settling_tick、cogging_sampling_tick、
  cogging_stopping_tick、cogging_done_tick 等状态处理函数
- 添加 process_cogging_run_data、start_next_cogging_run、build_cogging_tables、
  print_cogging_table、print_cogging_c_array 等辅助函数
- 移动全局 FOC 控制器单例注释到更合适位置
- 添加齿槽转矩校准参数常量定义和详细注释
- 添加防御性编程处理默认状态分支，避免状态机卡死
- 提高代码可读性和维护性

feat(tasks): 添加任务头文件到项目配置

- 在 Robot_V2.cproject.yml 中添加 tasks.h 和 tasks.cpp 文件引用

docs(ADC): 添加ADC转换常量说明注释

- 在 ADC.cpp 中添加关于ADC换算常量的详细注释
- 说明全局采样器单例的初始化和使用方式
 2026-05-24 01:21:41 +08:00
cbb 4c4e47e9e3 refactor(FOC): 添加Doxygen文档注释并优化SVPWM算法性能 
添加了完整的Doxygen文档注释到FOC算法模块的所有函数、类和变量，提升了代码可读性和维护性。同时优化了SVPWM算法实现，将atan2f替换为符号法扇区判断，显著提升计算效率（约15周期vs atan2f 300周期），并改进了arm_sin_cos_f32替代sqrtf提高性能。

feat(FOC): 统一电气角度计算避免重复运算

重构代码以统一电气角度计算，在各个控制循环中只计算一次电气角度并传递给需要的函数，避免了多次重复的fmodf运算和角度归一化操作，提升了实时控制性能。

refactor(Filter): 改进α-β观测器角度处理精度

修改角度卡尔曼滤波器在归一化角度空间[0,360)内工作，避免大累积角度的浮点精度损失问题，确保静止状态下不会产生虚假速度，同时保持与下游代码的兼容性。

refactor: 为算法模块添加完整文档注释

为所有算法模块(FOC、Filter、pid、thermal)添加了详细的Doxygen文档注释，包括函数说明、参数描述、返回值说明等，便于代码理解和API文档生成。
 2026-05-23 22:46:32 +08:00
cbb 94d5fda0b6 feat: 更新CMSIS和GD32C10x_DFP包版本并优化代码 
- 升级ARM::CMSIS从4.5.0到6.1.0版本
- 添加ARM::CMSIS-DSP@1.16.2依赖包
- 升级GigaDevice::GD32C10x_DFP从1.0.1到1.5.0版本
- 移除FOC.cpp中未使用的systick.h头文件
- 移除pid.cpp中未使用的<algorithm>头文件
- 更新GD32C10x固件库至V1.7.0版本(2026-01-30)
- 修复ADC驱动中的无符号整数运算问题
- 优化BKP、CAN、CTC等外设驱动中的FlagStatus返回逻辑
- 改进CAN驱动的消息发送和传输停止函数实现
- 修复CRC、DMA、FMC等驱动中的数据类型和变量声明问题
- 清理和修正各驱动文件中的文档注释
 2026-05-06 00:14:16 +08:00
cbb f4fb23d640 feat(FOC): 添加快速电压检测功能和PWM调试模式 
新增基于跌幅检测的快速电压保护机制，在100us周期内响应电压异常，
当电压跌幅超过阈值或低于绝对下限时立即关机保护。同时添加PWM输出
调试模式便于硬件测试。

BREAKING CHANGE: 重构了电压检测逻辑，采用峰值跟踪算法替代固
定阈值检测，提高在动态供电环境下的可靠性
 2026-04-26 03:36:21 +08:00
cbb a26dd1cc8e feat(can): 增强CAN通信缓冲区管理机制 
- 实现循环缓冲区队列管理CAN消息接收
- 添加缓冲区满/空状态检查函数
- 实现消息出队列dequeue_rx_message功能
- 在中断处理程序中添加消息入队列机制
- 优化CAN消息处理流程，支持批量处理

refactor(motor): 优化电机控制类结构和安全机制
- 重命名PID控制器参数变量名以提高可读性
- 添加过热关机标志位thermal_shutdown和相关处理函数
- 实现过热关机shut_down_thermal和过热恢复resume_from_thermal功能
- 调整关机逻辑，添加drv_stop调用确保电机完全停止
- 修正电流环控制中的占空比设置，改为单相保持

feat(motor): 实现FOC控制算法改进和零点校准功能
- 实现电机零点校准函数calibrate_zero_position用于位置补偿
- 修正FOC控制器中的电气角度计算，集成KTH7823校准角度补偿
- 新增d轴电流计算功能
- 重构PID参数初始化方式，使用统一的电压限制配置
- 更新SVPWM相电压设置算法，改进角度归一化处理
- 修改缺省扇区输出占空比从0.0f改为0.5f以提高稳定性

fix(control): 修复控制回路方向和频率计算问题
- 修正角度控制回路中的误差计算方向
- 修正开环速度控制中的频率参数使用
- 修正速度环控制中的误差计算方向
- 修正MIT模式下多级PID控制器的参数设置和误差计算

refactor(filter): 修正编码器速度计算算法
- 移除速度计算中的冗余乘法因子2

feat(pid): 扩展PID控制器功能
- 添加reset方法用于重置PID内部状态

chore(build): 更新开发工具版本和ADC配置
- 更新csolution版本至2.13.0
- 调整ADC采样时间配置以优化性能
 2026-03-09 01:35:26 +08:00
cbb 173fadadd2 feat(FOC): 重构FOC控制器实现并修复SVPWM算法支持 
- 修复类名拼写错误：FOC_Controlroller -> FOC_Controller
- 移除不必要的角度归一化函数，直接使用fmod优化性能
- 添加完整的SVPWM算法实现，提高电机控制效率
- 重构PID参数配置，使用动态参数调整机制
- 增加电流反馈功能，实时监测电机运行状态
- 优化电压安全限制，提高系统稳定性
- 更新控制模式映射，支持更多控制策略
- 改进CAN通信协议，增加电流反馈传输
 2026-02-02 02:23:16 +08:00
cbb 1596b2beb0 DRV8313兼容版 
refactor(algorithm): 移除冗余头文件
移除不必要的stdint.h头文件引用，统一使用<cstdint>

refactor(sys): 清理系统级头文件依赖
移除未使用的头文件引用，统一整型类型定义，优化初始
化过程中的GPIO配置
 2026-01-24 01:50:39 +08:00
cbb d0198fdff7 更新OTA功能，config独立成文件统一定义 
refactor(build): 更新项目配置和链接器设置
- 修改GD32C103CB的ROM基地址和大小配置
- 更新系统时钟向量表偏移量设置
- 在cproject.yml中添加BIN输出格式支持
- 增加-O3优化级别和代码移除选项
- 更新csolution版本依赖

feat(device): 优化ADC采样和配置管理
- 将DengFOC依赖替换为FOC模块
- 从config.h引入配置常量
- 重命名FILTER_SIZE为ADC_FILTER_SIZE以提高清晰度
- 优化温度和电流采样滤波实现

refactor(algorithm): 简化FOC控制函数接口
- 为angle_control、velocity_control等函数移除不必要的参数
- 统一函数指针类型定义
- 优化电流计算函数的代码格式
- 调整PID控制器初始化参数
 2026-01-04 22:26:22 +08:00
cbb 8732174855 refactor(flash): 重构EEPROM数据存储逻辑以提升可靠性 
- 修改FlashEEPROM类的数据读写流程，优化地址掩码和数据对齐方式
- 引入新的宏定义和常量用于数据校验及地址解析
- 调整系统配置保存函数，支持更精确的CRC校验机制
- 移除旧的角度保存接口，统一通过系统配置保存函数处理
- 在CAN通信检查中替换save_angle调用为format操作
- 增加调试开关EEPDEBUG控制打印信息输出
- 更新健康管理和系统休眠时的EEPROM保存策略
 2025-12-22 02:20:25 +08:00
cbb 7354a71c51 feat(can): 增加CAN睡眠与唤醒功能并优化通信检查逻辑 
- 在CAN通信类中添加了CAN_Sleep()和CAN_Wakeup()方法，支持设备进入低功耗模式
- 优化CAN通信检查逻辑，通过解析接收数据的首字节和末字节实现多种控制命令
- 支持远程复位电机、保存角度、清零角度、进入睡眠等操作
- 解决CAN发送邮箱满时可能导致的通信阻塞问题，增加重初始化机制
- 调整mailbox不可用计数逻辑，防止持续打印错误信息

refactor(flash): 移除软件CRC计算模块，改用硬件CRC外设
- 删除自定义CRC.cpp和CRC.h文件及其相关类实现
- 使用GD32硬件CRC模块替代软件算法，提高效率和可靠性
- 更新FlashEEPROM类中的CRC校验方式，调用crc_block_data_calculate进行计算
- 修正Flash地址遍历范围以适配新CRC逻辑及页面管理策略
- 修改save_angle接口签名，不再手动传入角度值，改为内部读取FOC实时角度

feat(timer): 新增RTC闹钟中断处理函数声明

- 在Timer.h中声明rtc_set_wakeup_interval和RTC_ALARM_IRQHandler
- 为后续实现基于RTC的定时唤醒功能做准备

chore(config): 同步csolution工具版本更新并调整组件配置

- 更新RTE_Components.h生成工具版本至2.12.0
- 启用BKP、CRC、RTC等标准外设组件宏定义
- 从项目配置文件中移除旧CRC源文件引用
- 添加SystemCoreClockUpdate调用确保系统时钟同步

refactor(main): 主循环任务调度重构并增强初始化流程

- 将主循环中的任务处理提取为独立do_task函数，提升代码可读性
- 提前执行电机初始化，并根据看门狗复位标志决定是否立即进入深度睡眠
- 调整EEPROM初始化顺序，保证依赖关系正确
- 添加sys/initial.h头文件包含以支持新增系统初始化逻辑
 2025-12-20 19:53:52 +08:00
cbb 7c2860f302 feat(can): 增加EEPROM状态码和系统配置保存功能 
- 在CAN通信中增加EEPROM状态码字段，并通过CAN FD发送
- 实现Flash EEPROM对系统配置参数的CRC校验与保存
- 改进目标角度、速度等关键参数的读写逻辑，支持掉电保存
- 调整EEPROM地址映射，优化错误处理和状态反馈机制
- 修复CRC计算相关问题，增强数据可靠性
 2025-12-18 18:23:34 +08:00
cbb 7371f97882 feat(PID): 调整速度与角度环PID参数 
更新了FOC控制器中的速度环和角度环PID参数以改善控制响应，并微调电流环参数提升稳定性。

feat(Filter): 改进卡尔曼滤波器初始化逻辑及速度计算方式
引入系统运行时间计数器，修正编码器角度和速度卡尔曼滤波器的初始化流程，并基于实际时间间隔优化角速度估算精度。

refactor(Filter): 移动成员变量声明顺序
调整`EncoderAngleKalman`类中`last_angle`成员变量的访问权限和声明位置，增强封装性和可读性。

feat(Flash): 新增Flash EEPROM功能支持
添加FlashEEPROM类及相关头文件，支持电机角度等关键数据掉电保存，并在CAN通信复位时进行角度存储操作。

refactor(Timer): 优化定时器配置和中断优先级设置
删除冗余的TIMER3定义，修改TIMER1中断服务函数可见性，并调整NVIC子优先级分配，确保中断响应合理有序。

feat(AngleSensor): 完善角度传感器初始化与角度设定接口
重构角度传感器初始化方法并新增角度设置函数，支持从Flash读取初始角度值并与减速比结合应用。

feat(Health): 实现母线电压监测与保护策略
新增电源管理函数，在母线电压异常下降时自动关闭电机输出，防止因供电不足导致设备损坏。
 2025-12-16 22:39:39 +08:00
cbb 93cbf18f1f feat(FOC): 实现电流环控制并优化相关逻辑 
新增了电流环控制功能，包括通过三相电流计算 Iq 的 `cal_Iq_Id` 方法，并在 `current_control` 中实现了基于 PID 的电流控制逻辑。同时对电压设置、占空比计算等部分进行了调整与优化。

refactor(filter): 移除冗余的电流卡尔曼滤波器实现
删除了 `Filter.cpp` 和 `Filter.h` 中关于 `CurrentKalman` 类的冗余代码，统一外部定义，简化结构。

refactor(health): 改进热量控制器算法和数据类型
将热累积计算改为更精确的分段处理方式，并引入 Q16.16 定点数提升运算精度与性能；增加对异常温度值的判断修正。

fix(CAN): 调整电流发送顺序及标志位设置位置
修改 CAN 发送中 V 相与 W 相电流打包顺序，确保通信正确性；调整发送标志设置逻辑至主循环任务内触发。

chore(headers): 清理无用头文件引用和结构调整
移除了多个源文件中不必要的头文件包含（如 `<cstdio>`、`<array>`），并对部分全局变量声明做了 extern 处理以避免重复定义问题。
 2025-12-05 00:46:19 +08:00
cbb 59f161bd73 refactor(angle): 引入角度卡尔曼滤波器 EncoderAngleKalman 
新增 EncoderAngleKalman 类以处理编码器角度噪声，改善角度反馈质量，并配合速度滤波器提供更准确的速度估算。

perf(CAN): 优化CAN数据打包与状态标识字段
改进 pack_u16_to_bytes 等函数实现方式，使用 reinterpret_cast 提高效率；
扩展 Status_code 为多个独立状态位，增强诊断能力。

feat(FOC): 添加电机锁止和停止功能
新增 drv_stop 和 drv_hold 方法用于控制电机占空比，支持紧急制动与角度保持。优化了FOC控制器的接口设计，提升安全性和可控性。

fix(filter): 修正中值滤波器数组大小动态分配问题
将 medium_filter 函数中的排序数组改为使用传入参数 size 动态定义，避免固定大小带来的资源浪费或越界风险，提高滤波精度和稳定性。

chore(project): 移除冗余文件及代码清理
移除了 thermal.cpp/h 文件及相关引用，调整项目结构，删除未使用的全局变量定义、注释和头文件包含，精简系统初始化流程。
 2025-11-22 23:59:43 +08:00