单电阻采样 基于单电阻采样的相电流重构算法 keil完整工程。 单电阻采样 f103的单电阻...

单电阻采样 基于单电阻采样的相电流重构算法 keil完整工程。 单电阻采样 f103的单电阻完整工程带文档带硬件资料。 f3平台的单电阻完整工程代码详细注释。 还有微芯的单电阻smo代码加文档 具体如截图请看下一、工程概述本工程是基于dsPIC33CK256MP508微控制器的单电阻采样相电流重构算法完整实现主要面向中小功率永磁同步电机PMSM的矢量控制系统。工程整合了电机控制核心算法、硬件抽象层驱动、诊断监控模块及用户交互逻辑支持MCLV2中低压电机、MCHV2/MCHV3高压电机多种硬件平台通过单电阻采样方案实现三相电流的精确重构同时具备开环启动、闭环矢量控制、弱磁扩速等核心功能可广泛应用于家电、工业驱动、电动交通工具等领域。单电阻采样 基于单电阻采样的相电流重构算法 keil完整工程。 单电阻采样 f103的单电阻完整工程带文档带硬件资料。 f3平台的单电阻完整工程代码详细注释。 还有微芯的单电阻smo代码加文档 具体如截图请看下工程核心特点如下硬件兼容性适配dsPIC33CK256MP508微控制器支持内部运算放大器OPAMP和外部信号调理电路兼容单电阻/双电阻采样方案。控制算法采用磁场定向控制FOC架构包含Clark变换、Park变换、PI调节器、反电动势观测器、弱磁扩速等核心算法。诊断与监控集成X2CScope和RTDM两种实时监控方案支持电机运行参数可视化、故障诊断及数据日志功能。可靠性设计包含过流保护、死区补偿、电流偏移校准、Bootstrap电容充电管理等硬件安全机制。二、工程结构与核心模块划分工程文件总数108个按功能可划分为8大核心模块模块间通过全局变量和函数接口实现数据交互整体架构采用分层设计应用层-算法层-硬件抽象层便于维护和扩展。一核心模块清单模块名称核心文件主要功能硬件抽象层HALadc.c/.h、pwm.c/.h、uart1.c/.h、port_config.c/.h、clock.c/.h外设初始化与驱动ADC、PWM、UART、GPIO、时钟电机控制核心算法pmsm.c、estim.c/.h、fdweak.c/.h、motor_control/*FOC控制、速度/角度估算、弱磁扩速、坐标变换数据采集与处理meascurr.c/.h、readadc.c/.h、singleshunt.c/.h电流采样、偏移校准、单电阻电流重构控制参数配置control.c/.h、userparms.h、general.h控制参数结构体、PI参数、电机参数定义诊断与监控diagnostics.c/.h、X2CScope.h、rtdm.c/.h实时数据监控、故障诊断、日志存储板级支持board_service.c/.h、delay.h按键交互、LED指示、延时函数数学工具q15sqrt.s、motor_control/*定点数学运算开方、三角函数、矩阵变换主程序pmsm.cmain函数系统初始化、主循环、中断服务程序二核心模块依赖关系主程序pmsm.c ├─ 硬件初始化HAL模块时钟、GPIO、ADC、PWM ├─ 算法初始化控制参数、PI调节器、估算器、弱磁参数 ├─ 主循环按键处理、诊断任务、电机启停控制 └─ 中断服务ADC采样中断电流采集与重构→ 坐标变换 → 速度/电流调节 → PWM占空比更新三、核心模块功能详细说明一硬件抽象层HAL硬件抽象层是工程与硬件交互的桥梁负责微控制器外设的底层配置与驱动屏蔽硬件差异为上层算法提供统一接口。1. 时钟模块clock.c/.h功能配置dsPIC33CK256MP508的PLL锁相环生成系统核心时钟。关键参数外部晶振/内部FRC时钟输入8MHzPLL倍频/分频配置M150N11N23N31最终输出时钟FOSC200MHz振荡器频率FCY100MHz指令周期频率核心函数InitOscillator()- 初始化PLL并等待时钟稳定为所有外设提供时钟源。2. ADC模块adc.c/.h功能实现电机相电流、母线电压、速度参考电位器等模拟信号的采样。关键配置采样分辨率12位 fractional数据格式采样触发方式PWM触发同步采样避免PWM开关噪声干扰采样通道单电阻模式母线电流采样通道AN0/AN17双电阻模式A相/B相电流采样通道AN1、AN4速度参考电位器输入通道AN19核心函数InitializeADCs()- 配置ADC核心、采样时间、触发源及中断优先级。3. PWM模块pwm.c/.h功能生成三相PWM波形驱动电机逆变器支持死区补偿、Bootstrap电容充电。关键配置工作模式中心对齐PWM减小电机转矩脉动PWM频率20kHzLOOPTIME_MICROSEC50死区时间1.0μsDDEADTIME100由FCY100MHz计算输出模式互补输出上下桥臂核心函数InitPWMGenerators()- 初始化PWM发生器、周期、死区、触发配置。ChargeBootstarpCapacitors()- 上电时充电Bootstrap电容确保高边MOS管正常导通。4. UART模块uart1.c/.h功能提供串行通信接口支持X2CScope和RTDM监控功能。关键配置波特率115200X2CScope/57600RTDM数据格式8位数据位1位停止位无校验中断模式接收/发送中断支持异步通信核心接口UART1DataWrite()/UART1DataRead()- 字节收发函数UART1_InterruptEnable()- 使能中断接收。5. GPIO模块port_config.c/.h功能配置GPIO引脚为输入/输出/模拟模式映射外设功能如PWM、UART。关键配置电机控制引脚PWM输出RB10-RB15、电流采样模拟输入AN0、AN1、AN4等用户交互引脚按键输入RE5、RD5等、LED输出RE8、RE9外设引脚映射UART1映射到RP70/RP71PIM引脚49/50核心函数SetupGPIOPorts()- 初始化所有GPIO端口为默认状态MapGPIOHWFunction()- 映射外设功能到GPIO引脚。二数据采集与处理模块该模块负责从硬件获取原始数据并进行校准、滤波、重构等预处理为控制算法提供可靠的输入数据。1. 电流采样与校准meascurr.c/.h功能采集电流采样通道的原始ADC数据进行偏移校准和增益缩放转换为标准化电流值。核心流程1. 偏移校准上电时采集多个空闲样本计算偏移量Offseta/Offsetb补偿零点漂移。2. 增益缩放通过校准系数qKa/qKb将ADC原始值转换为q15格式的电流值-1~1对应实际电流范围。核心函数MeasCurrOffset()- 校准电流采样偏移量。MeasCompCurr()- 补偿偏移并缩放ADC数据输出标准化电流值。2. 单电阻电流重构singleshunt.c/.h功能在单电阻采样模式下通过PWM周期内的两次采样重构三相相电流Ia、Ib、Ic。核心原理利用PWM不同矢量区间的母线电流与相电流关系在PWM上下桥臂导通时刻采样母线电流。通过Clark变换约束IaIbIc0重构第三相电流。核心函数SingleShunt_PhaseCurrentReconstruction()- 根据采样时刻的PWM状态重构三相电流。SingleShunt_CalculateSpaceVectorPhaseShifted()- 生成适配单电阻采样的SVPWM波形。3. ADC数据读取readadc.c/.h功能读取电位器等模拟信号转换为速度参考值。核心函数ReadADC0()- 读取ADC采样值缩放后存储到速度参考变量qAnRef。三电机控制核心算法模块该模块是工程的核心实现永磁同步电机的磁场定向控制FOC包含坐标变换、PI调节、速度/角度估算、弱磁扩速等关键算法。1. 坐标变换motor_control/*功能实现三相静止坐标系与两相旋转坐标系之间的转换是FOC控制的基础。核心变换Clark变换将三相电流Ia、Ib、Ic转换为两相静止坐标系电流Iα、Iβ。Park变换将Iα、Iβ转换为两相旋转坐标系电流Id、Iq便于独立控制磁通和转矩。逆Park/逆Clark变换将控制量Vd、Vq转换为三相PWM占空比。实现方式采用汇编语言实现mcclarkedspic.s、mcparkdspic.s兼顾运算效率和精度。2. PI调节器pmsm.c、motor_control/*功能实现速度环、d/q轴电流环的闭环调节抑制扰动跟踪参考值。调节器结构速度环PI输入速度误差参考速度-估算速度输出q轴电流参考值Iq_ref。Id轴电流环PI输入Id误差Id_ref-实际Id输出Vd控制量。Iq轴电流环PI输入Iq误差Iq_ref-实际Iq输出Vq控制量。关键特性抗积分饱和通过输出限幅outMax/outMin防止积分累积。系数配置通过InitControlParameters()初始化PI参数kp、ki、kc。核心函数MCControllerPIUpdateAssembly()- 汇编实现的PI调节算法运算高效。3. 速度/角度估算estim.c/.h功能无传感器控制核心基于反电动势BEMF估算电机电气角度和转速无需位置传感器。核心原理1. 根据定子电压方程计算反电动势BEMF U - RsI - LsdI/dt。2. 对反电动势进行Park变换得到d/q轴反电动势Esd、Esq。3. 通过一阶滤波和积分运算估算电机电气角速度OmegaMr和角度Rho。关键优化高低速自适应低速时增大电流采样间隔提高差值计算精度高速时减小间隔保证响应速度。角度偏移补偿初始化时设置角度偏移qRhoOffset优化开环到闭环的切换过程。核心函数InitEstimParm()- 初始化估算器参数滤波系数、电流限制等。Estim()- 核心估算函数在ADC中断中执行更新速度和角度估算值。4. 弱磁扩速fdweak.c/.h功能当电机转速超过额定转速时通过减小d轴电流Id削弱定子磁场提高电机最高转速弱磁扩速。核心逻辑1. 预设弱磁曲线根据转速分段设置Id参考值qFwCurve、反电动势系数qInvKFiCurve、定子电感系数qLsCurve。2. 转速判断当电机转速超过额定转速FWONSPEED时启动弱磁控制。3. 插值计算根据当前转速在预设曲线中插值得到实时Id参考值。核心函数InitFWParams()- 初始化弱磁曲线参数。FieldWeakening()- 输入电机转速输出弱磁后的Id参考值。5. 开环启动与闭环切换pmsm.c功能解决无传感器电机启动难题通过开环控制使电机加速到一定转速后平滑切换到闭环控制。核心流程1. 开环对齐电机上电后输出固定角度的电压矢量使转子对齐到指定位置startupLock阶段。2. 开环加速逐步增加电压矢量的旋转速度驱动电机加速startupRamp阶段。3. 闭环切换当转速达到阈值END_SPEED时切换到基于反电动势的闭环控制。核心函数CalculateParkAngle()- 生成开环控制的电气角度或使用估算器角度闭环模式。四诊断与监控模块该模块负责电机运行状态的实时监控、数据日志和故障诊断便于调试和维护。1. X2CScope监控X2CScope.h、diagnostics_x2cscope.c功能通过UART与PC端X2CScope软件通信实时上传电机运行参数电流、转速、角度等支持参数在线调整。核心配置波特率115200由X2CBAUDRATEDIVIDER54计算。通信接口UART1支持发送/接收中断。核心函数X2CScope_Init()- 初始化X2CScope挂钩UART收发函数。X2CScope_Update()- 在ADC中断中更新监控数据。X2CScope_Communicate()- 在主循环中处理PC端命令和数据传输。2. RTDM诊断rtdm.c/.h、rtdm_select_channels.c功能实时诊断与数据日志模块支持通过UART与MPLAB DMCI软件通信实现内存读写、状态查询、数据录制。核心特性数据录制支持4路数据同时录制默认配置Ia、Ib、估算转速、估算角度。故障诊断支持非法命令、校验错误等故障反馈。缓冲区管理循环缓冲区存储录制数据支持连续采样。核心函数RTDM_Start()- 初始化RTDM模块和UART。RTDM_ProcessMsgs()- 处理PC端命令读内存、写内存、 sanity检查等。RTDM_SelectChannels()- 配置需要录制的数据通道。五板级支持与用户交互模块1. 按键与LED控制board_service.c/.h功能提供用户交互接口支持电机启停、速度切换。关键功能按键防抖软件防抖BUTTONDEBOUNCECOUNT30ms。按键功能按键1START/STOP启动/停止电机。按键2SPEEDHALFDOUBLE切换电机速度仅MCLV2平台。LED指示LED1指示电机运行状态亮运行LED2指示系统上电状态。核心函数BoardServiceInit()- 初始化按键和LED引脚。BoardService()- 主循环中调用扫描按键状态。2. 延时函数delay.h功能提供微秒级和毫秒级延时用于硬件初始化如Bootstrap电容充电。实现方式基于FCY100MHz的指令周期计算延时计数通过delayus()和delayms()实现。四、核心工作流程一系统初始化流程1. 上电复位 → 调用main()函数 2. 时钟初始化InitOscillator() → 配置PLL生成100MHz指令周期时钟 3. GPIO初始化SetupGPIOPorts() → 配置PWM、ADC、按键、LED引脚 4. 外设初始化InitPeripherals() → 初始化ADC、PWM、UART 5. 电流偏移校准MeasCurrOffset() → 采集空闲状态下的ADC偏移值补偿零点漂移 6. 诊断模块初始化DiagnosticsInit() → 初始化X2CScope或RTDM 7. 控制参数初始化 - InitControlParameters() → 初始化PI参数、PWM周期、电流增益等 - InitEstimParm() → 初始化速度/角度估算器参数 - InitFWParams() → 初始化弱磁扩速参数 8. 等待用户按键 → 启动电机二电机控制主流程中断驱动工程采用ADC采样中断作为控制周期的触发源中断优先级最高IPL7确保控制实时性。中断服务程序ISR流程如下ADC采样中断20kHz周期 ├─ 1. 读取ADC数据 - 单电阻模式读取母线电流重构三相电流Ia、Ib、Ic - 双电阻模式直接读取A/B相电流计算C相电流IaIbIc0 ├─ 2. 电流校准与缩放MeasCompCurr() → 补偿偏移并转换为标准化电流值 ├─ 3. 坐标变换 - Clark变换Ia、Ib → Iα、Iβ - Park变换Iα、Iβ → Id、Iq使用当前估算角度 ├─ 4. 速度/角度估算Estim() → 更新估算转速qVelEstim和角度qRho ├─ 5. 闭环控制DoControl() - 速度环PI计算Iq参考值Iq_ref - 弱磁扩速计算Id参考值Id_ref - 电流环PI计算Vd、Vq控制量 ├─ 6. 逆坐标变换 - 逆Park变换Vd、Vq → Vα、Vβ - 逆Clark变换Vα、Vβ → Va、Vb、Vc ├─ 7. PWM占空比计算MC_CalculateSpaceVectorPhaseShifted_Assembly() → 生成SVPWM占空比 ├─ 8. 更新PWM输出PWMDutyCycleSet() → 写入PWM寄存器驱动电机 ├─ 9. 诊断与监控 - DiagnosticsStepIsr() → 更新X2CScope/RTDM数据 - BoardServiceStepIsr() → 扫描按键状态计数器 └─ 10. 清除中断标志 → 等待下一次中断三开环到闭环切换流程1. 用户按下启动按键 → 使能PWM输出EnablePWMOutputsInverterA() 2. 开环控制阶段 - 转子对齐startupLock计数到LOCK_TIME转子对齐到指定位置 - 开环加速startupRamp逐步增加生成旋转角度thetaElectricalOpenLoop - 输出固定Vq参考值驱动电机加速 3. 切换判断当startupRamp达到END_SPEED → 触发闭环切换 4. 闭环切换 - 设置uGF.bits.OpenLoop0闭环模式 - 设置uGF.bits.ChangeMode1模式切换标志 - 角度同步将估算器角度与开环角度对齐 5. 闭环控制阶段使用估算器角度和转速执行FOC闭环控制五、关键参数配置一电机参数userparms.h需根据实际电机调整参数名称含义示例值NOMINALSPEEDRPM电机额定转速rpm3000NOPOLESPAIRS电机极对数2NORM_RS定子电阻标准化q15格式0x0400NORM_LSDTBASE定子电感/采样周期标准化0x0200NORM_INVKFIBASE反电动势系数标准化0x1000二PI调节器参数userparms.h调节器比例系数kp积分系数ki输出限幅outMax速度环SPEEDCNTR_PTERMSPEEDCNTR_ITERMSPEEDCNTR_OUTMAXId电流环DCURRCNTRPTERMDCURRCNTRITERMDCURRCNTROUTMAXIq电流环QCURRCNTRPTERMQCURRCNTRITERMQCURRCNTROUTMAX三弱磁扩速参数userparms.h参数名称含义示例值FWONSPEED弱磁启动转速电气转速NOMINALSPEEDRPM*NOPOLESPAIRSIDREF_BASESPEED额定转速下的Id参考值0x0000IDREF_SPEEDx不同转速下的Id参考值x0~17预设曲线数组六、工程编译与适配说明一编译环境编译器XC16 Compiler版本≥1.30开发工具MPLAB X IDE版本≥5.00调试工具MPLAB ICD 3/RealICE支持dsPIC33CK系列二硬件适配开关工程通过宏定义支持不同硬件配置可在userparms.h或相关头文件中修改宏定义含义取值SINGLE_SHUNT单电阻采样模式1启用0双电阻模式MCLV2中低压电机平台1启用0禁用MCHV2/MCHV3INTERNALOPAMPPIM内部运算放大器1启用0外部运算放大器TUNING调试模式1启用软件速度斜坡0禁用OPENLOOPFUNCTIONING强制开环1强制开环0支持闭环切换三注意事项电流偏移校准电机未运行时执行确保采样通道无电流否则会导致偏移补偿错误。电机参数匹配需根据实际电机修改userparms.h中的电机参数电阻、电感、极对数等否则控制性能会严重下降。弱磁曲线调整弱磁扩速的效果依赖于预设的qFwCurve、qInvKFiCurve、qLsCurve数组需根据电机特性调整。中断优先级ADC采样中断优先级需设为最高IPL7避免被其他中断打断影响控制周期稳定性。七、总结本工程是一套完整的基于dsPIC33CK256MP508的单电阻采样无传感器FOC控制方案通过高度优化的算法和硬件驱动实现了电机的高效、稳定控制。工程具备以下优势成本优势单电阻采样方案相比三电阻采样减少了采样电阻和信号调理电路成本。性能优势采用汇编优化的核心算法控制周期可达20kHz响应迅速无传感器估算精度高支持宽转速范围运行。灵活性优势支持多种硬件平台MCLV2/MCHV2/MCHV3可通过宏定义快速适配不同电机和硬件配置。可维护性优势分层设计架构清晰模块间接口统一便于后续功能扩展和bug修复。工程可直接用于家电空调压缩机、洗衣机电机、工业驱动小型泵、风机、电动交通工具电动自行车、滑板车等领域的电机控制方案开发也可作为学习无传感器FOC控制的参考案例。