- 重构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算法,显著提升性能 - 保留通用回退路径处理其他尺寸情况
182 lines
5.4 KiB
C++
182 lines
5.4 KiB
C++
/**
|
||
* @file sys/flash.h
|
||
* @brief 系统服务与平台支持源文件
|
||
* @note 本文件仅补充 Doxygen 文档注释,不改变代码逻辑。
|
||
*/
|
||
|
||
#ifndef __FLASH_H
|
||
#define __FLASH_H
|
||
|
||
|
||
#include "config.h"
|
||
#include "gd32c10x.h" // 添加GD32主头文件以确保外设函数声明可用
|
||
#include <cstdint>
|
||
|
||
// 修改后 - 强制4字节对齐
|
||
/** @brief ALIGN_4BYTE 宏定义 */
|
||
#define ALIGN_4BYTE(addr) ((addr) & 0xFFFFFFFC) // 4字节对齐
|
||
|
||
// EEPROM操作状态
|
||
/**
|
||
* @brief 匿名枚举 枚举定义
|
||
*/
|
||
typedef enum {
|
||
FLASH_EEPROM_OK = 0, // 操作成功
|
||
FLASH_EEPROM_WRITE_ERROR, // 写入错误
|
||
FLASH_EEPROM_READ_ERROR, // 读取错误
|
||
FLASH_EEPROM_ERASE_ERROR, // 擦除错误
|
||
FLASH_EEPROM_INVALID_ADDR, // 无效地址
|
||
FLASH_EEPROM_DATA_NOT_FOUND, // 找不到数据
|
||
FLASH_EEPROM_CRC_ERROR, // CRC错误
|
||
FLASH_EEPROM_ALIGNMENT_ERROR, // 对齐错误
|
||
} FlashEepromStatus;
|
||
|
||
// Flash EEPROM类
|
||
/**
|
||
* @brief FlashEEPROM 类或结构体
|
||
*/
|
||
class FlashEEPROM {
|
||
public:
|
||
// EEPROM emulation constants
|
||
static constexpr u32 EEPROM_START_ADDRESS = 0x0801F800; // 第一页(1KB)
|
||
static constexpr u32 EEPROM_DATA_PAGE2_ADDRESS = 0x0801FC00; // 第二页(1KB)
|
||
static constexpr u32 EEPROM_END_ADDRESS = 0x08020000; // Flash结束地址
|
||
static constexpr u32 EEPROM_MAX_SIZE = 0x800; // EEPROM最大容量
|
||
static constexpr u32 EEPROM_DATA_START_ADDRESS =
|
||
0x0801F900; // DATA段开始地址
|
||
static constexpr u32 DATA_FLOAT_MASK = 0xFFFFFF00; // float存储地址掩码
|
||
static constexpr u32 DATA_U16_MASK = 0xFFFF0000; // u16存储地址掩码
|
||
static constexpr u32 DATA_ADDR_MASK = 0x000000FF; // 虚拟地址掩码
|
||
|
||
// 定义用户自定义的虚拟地址
|
||
static constexpr u8 ADDR_CONTROL_MODE = 0x0; // 控制模式
|
||
static constexpr u8 ADDR_ANGLE = 0x01; // 角度数据存储地址
|
||
static constexpr u8 ADDR_TARGET_ANGLE = 0x02; // 角度命令数据存储地址
|
||
static constexpr u8 ADDR_TARGET_VEL = 0x03; // 速度命令数据存储地址
|
||
static constexpr u8 ADDR_VOLTAGE_LIMIT = 0x4; // 电压限制
|
||
static constexpr u8 ADDR_VEL_LIMIT = 0x05; // 角度数据存储地址
|
||
static constexpr u8 ADDR_NODE_ID = 0x06; // 节点 ID 存储地址
|
||
static constexpr u8 ADDR_CALIBRATION_ANGLE = 0x07; // 电角度零位校准角存储地址
|
||
|
||
bool system_config_saved = false;
|
||
u8 EEPROMStatus;
|
||
// 构造函数
|
||
FlashEEPROM();
|
||
|
||
// 初始化Flash EEPROM模拟
|
||
/**
|
||
* @brief 初始化对象或模块
|
||
* @return u8 返回值
|
||
*/
|
||
u8 init();
|
||
|
||
// 从Flash EEPROM中读取数据
|
||
/**
|
||
* @brief 读取数据
|
||
* @param[in] virtualAddr 参数
|
||
* @param[in] data 参数
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus read(u8 virtualAddr, u16 *data) const;
|
||
// 向Flash EEPROM写入数据
|
||
/**
|
||
* @brief 写入数据
|
||
* @param[in] virtualAddr 参数
|
||
* @param[in] data 参数
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus write(u8 virtualAddr, u16 data);
|
||
// Float数据读相关函数
|
||
/**
|
||
* @brief 从 Flash EEPROM 读取浮点数据
|
||
* @param[in] virtualAddr 参数
|
||
* @param[in] data 参数
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus readFloat(u8 virtualAddr, float *data) const;
|
||
// Float数据存储相关函数
|
||
/**
|
||
* @brief 向 Flash EEPROM 写入浮点数据
|
||
* @param[in] virtualAddr 参数
|
||
* @param[in] data 参数
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus writeFloat(u8 virtualAddr, float data);
|
||
|
||
// 格式化Flash EEPROM页面
|
||
/**
|
||
* @brief 格式化存储区域
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus format();
|
||
|
||
/**
|
||
* @brief 保存系统配置参数
|
||
* @param[in] saved 参数
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus save_system_config(bool saved);
|
||
/**
|
||
* @brief 读取已保存的系统配置参数
|
||
* @return u8 返回值
|
||
*/
|
||
u8 read_saved_system_config(void);
|
||
/**
|
||
* @brief 保存电角度零位校准角到 Flash
|
||
* @param[in] angle 校准角(度)
|
||
* @return FlashEepromStatus 操作状态
|
||
*/
|
||
FlashEepromStatus save_calibration_angle(float angle);
|
||
|
||
// 节点 ID 独立读写函数(主/备双备份分属独立 Flash 页 + 魔数 + 计数器 + CRC)
|
||
// 从 Flash 读取节点 ID(双备份均有效取计数器最新,单份有效则回退)
|
||
/**
|
||
* @brief 读取节点 ID 配置
|
||
* @param[in] node_id 参数
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus readNodeId(u16 *node_id) const;
|
||
// 保存节点 ID 到 Flash(乒乓写入非最新页,另一页保有旧值,掉电安全)
|
||
/**
|
||
* @brief 写入节点 ID 配置
|
||
* @param[in] node_id 参数
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus writeNodeId(u16 node_id);
|
||
// 擦除节点 ID 双备份存储页(恢复默认值)
|
||
/**
|
||
* @brief 擦除节点 ID 配置
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus eraseNodeId();
|
||
|
||
private:
|
||
/**
|
||
* @brief 写入 writeCRC 相关数据
|
||
* @param[in] CRC_NUM 参数
|
||
* @param[in] saved 参数
|
||
* @return FlashEepromStatus 返回值
|
||
*/
|
||
FlashEepromStatus writeCRC(u32 CRC_NUM, bool saved);
|
||
};
|
||
|
||
/**
|
||
* @brief flash_eeprom_example_main 函数
|
||
* @return void
|
||
*/
|
||
void flash_eeprom_example_main(void);
|
||
u8 OTA_SET(u32 addr, u32 data);
|
||
/**
|
||
* @brief move_app_data 函数
|
||
* @return fmc_state_enum 返回值
|
||
*/
|
||
fmc_state_enum move_app_data(void);
|
||
/**
|
||
* @brief 写入 write_ADDRESS 相关数据
|
||
* @param[in] address 参数
|
||
* @param[in] data 参数
|
||
* @return fmc_state_enum 返回值
|
||
*/
|
||
fmc_state_enum write_ADDRESS(u32 address, u32 data);
|
||
|
||
#endif /* __FLASH_H */ |