cbb
7354a71c51
- 在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头文件包含以支持新增系统初始化逻辑
104 lines
3.1 KiB
C++
104 lines
3.1 KiB
C++
#include "health.h"
|
|
#include "Can.h"
|
|
#include "DengFOC.h"
|
|
#include "adc.h"
|
|
#include "flash.h"
|
|
#include <stdint.h>
|
|
|
|
extern sampler sampler;
|
|
extern CAN_transmiter CAN0_transmiter;
|
|
extern FOC_Controlroller FOC;
|
|
extern FlashEEPROM flashEEP;
|
|
ThermalController thermalController; // 热量控制器初始化
|
|
|
|
#define max(a, b, c) \
|
|
((a) > (b) ? ((a) > (c) ? (a) : (c)) : ((b) > (c) ? (b) : (c)))
|
|
constexpr u16 PROTECT_TIME = 6000; // 过热保护时间，单位*10ms
|
|
/**
|
|
** @brief 热能计算
|
|
** @param None
|
|
** @retval 热量值
|
|
*/
|
|
u32 ThermalController::update() {
|
|
thermal_value = Q16_16_MUL(thermal_value, thermalRate);
|
|
// 添加温度积累
|
|
int drv_temp = (int)sampler.get_drv_temp();
|
|
int mcu_temp = (int)sampler.get_mcu_temp();
|
|
if (drv_temp == 255)
|
|
drv_temp = 0;
|
|
if (mcu_temp == 255)
|
|
mcu_temp = 0;
|
|
thermal_value += drv_temp * drv_temp + mcu_temp * mcu_temp;
|
|
|
|
if (remainingTime10Ms) {
|
|
// 过热停机状态
|
|
// 检查是否可以恢复
|
|
q16_16_t recovery_threshold =
|
|
Q16_16_MUL(thermal_capacity, recoveryRate);
|
|
if (thermal_value < recovery_threshold) {
|
|
remainingTime10Ms = 1; // 可以恢复工作
|
|
}
|
|
if (remainingTime10Ms == 1) { // 过热恢复
|
|
FOC.resume();
|
|
CAN0_transmiter.ThermalStatus = 0;
|
|
return --remainingTime10Ms;
|
|
}
|
|
return --remainingTime10Ms;
|
|
} else {
|
|
// 当前没有过热停机
|
|
// 添加电流热积累
|
|
u32 currents[3] = {(u32)(sampler.get_current('U') * 1000),
|
|
(u32)(sampler.get_current('V') * 1000),
|
|
(u32)(sampler.get_current('W') * 1000)};
|
|
|
|
// 找最大电流（原始ADC值）
|
|
current_max = max(currents[0], currents[1], currents[2]);
|
|
if (current_max < 2000) {
|
|
thermal_value += current_max * current_max * gapTimeMs *
|
|
0.00007f; // 计算当前电流热积累值
|
|
} else if (current_max > 3800) {
|
|
thermal_value += current_max * current_max * gapTimeMs *
|
|
0.01f; // 添加当前电流热积累值
|
|
} else if (current_max > 3400) {
|
|
thermal_value += current_max * current_max * gapTimeMs *
|
|
0.005f; // 计算当前电流热积累值
|
|
} else if (current_max > 3000) {
|
|
thermal_value += current_max * current_max * gapTimeMs *
|
|
0.0002f; // 计算当前电流热积累值
|
|
} else if (current_max > 2000) {
|
|
thermal_value += current_max * current_max * gapTimeMs *
|
|
0.0001f; // 计算当前电流热积累值
|
|
}
|
|
}
|
|
|
|
if (thermal_value > thermal_capacity) {
|
|
FOC.shut_down();
|
|
remainingTime10Ms = PROTECT_TIME; // 过热停机
|
|
CAN0_transmiter.ThermalStatus = 1;
|
|
return remainingTime10Ms;
|
|
}
|
|
return thermal_value;
|
|
}
|
|
/**
|
|
** @brief 温度检测
|
|
** @param None
|
|
*/
|
|
void angsens_MG_check(void) {
|
|
bool MGH = gpio_input_bit_get(GPIOB, GPIO_PIN_10);
|
|
bool MGL = gpio_input_bit_get(GPIOB, GPIO_PIN_11);
|
|
CAN0_transmiter.MagStatus = MGH or MGL;
|
|
}
|
|
|
|
void power_manage(void) {
|
|
float last_vbus = sampler.get_vbus_voltage();
|
|
sampler.update_vbus_voltage();
|
|
FOC.update_power();
|
|
float vbus = sampler.get_vbus_voltage();
|
|
if ((vbus < 22.0f) and (last_vbus > vbus) and vbus > 8.0f) {
|
|
FOC.shut_down();
|
|
flashEEP.save_angle(true);
|
|
flashEEP.save_system_config(true);
|
|
} else {
|
|
FOC.resume();
|
|
}
|
|
} |