934无刷直流电机速度闭环控制系统_第1页
934无刷直流电机速度闭环控制系统_第2页
934无刷直流电机速度闭环控制系统_第3页
全文预览已结束

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

1、CALC_ACT_RPMmovffVELOCITY_READH,ARG2HmovffVELOCITY_READL,ARG2LmovlwHIGH(RPM_CONSTANT_HALL)movwfARG1HmovlwLOW(RPM_CONSTANT_HALL)movwfARG1LcallDIVISION_15BY15movffRESL,SPEED_FEEDBACKLmovffRESH,SPEED_FEEDBACKH/Timer5计数值高位导入/Timer5计数值低位导入/常数导入除法运算/15位/15位除法运算/运算结果为实际RPM值/存入到SPEED_FEEDBACKreturnCALCULATE

2、_SPEED_ERRORmovlwLOW(SPEED_REF_RATIO)mulwfSPEED_REFH/读取速度给定值movffPRODH,TEMP/从ADC读取速度给定值movlwHIGH(SPEED_REF_RATIO)mulwfSPEED_REFH/在简化计算中读取8位movfPRODL,WaddwfTEMP,FclrfWREGaddwfcPRODH,W/低8位被丢弃movwfSPEED_REF_RPMH/速度参考值被导入movffTEMP,SPEED_REF_RPML/速度给定值低8位导入RETURNSpeedError=SPEED_REF_RPM-SPEED_FEEDBACK/计算

3、速度偏差bsfSTATUS,CmovfSPEED_REF_RPML,WsubfwbSPEED_FEEDBACKL,WmovwfSPEED_ERRORLmovfSPEED_REF_RPMH,WsubfwbSPEED_FEEDBACKH,WmovwfSPEED_ERRORHbcfFLAGS,NEGATIVE_ERROR/Error是负值?bsfpid_stat1,err_sign,1/Error符号是正值btfssSPEED_ERRORH,7/如果Error是负值补足ErrorbraPOSITIVE_ERRORcomfSPEED_ERRORH,FcomfSPEED_ERRORL,FbsfFLAGS,NEGATIVE_ERRORbcfpid_stat1,err_sign,1POSITIVE_ERRORErrorPWM=Error_PWM_constant(8bit)movlw(ERROR_PWM_CONSTANT)mulwfSPEED_ERRORLmovffPRODH,TEMPmovffPRODL,ERROR_PWMLmovlw(ERROR_PWM_CONSTANT)mulwfSPEED_ERRORHmovfPRODL,WaddwfTEMP,WmovwfERROR_PWMHCallPID_ALGORITHMRETURN/设置Error标志位来指示

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论