logo资料库

步进电机得建模仿真-基于Simulink仿真的步进电机闭环控制系统分析.pdf

第1页 / 共6页
第2页 / 共6页
第3页 / 共6页
第4页 / 共6页
第5页 / 共6页
第6页 / 共6页
资料共6页,全文预览结束
· 44· 《测控技术))2009年第 28卷第 1期 基于 Simulink仿真 的 步进 电机 闭环控制 系统分析 刘 川 ,刘景林 (西北工业大学 自动化学 院 ,陕西 西安 710072) 摘要 :步进 电机通 常 以开环 方式 应 用于精 度要 求不 高 的位 置伺 服 系统 中。通 过位 置反馈 ,可 以实现 步进 电机 的高精度 闭环定位控制。建立的步进 电机数学模型,显示了其 高度非线性的特点,为此设计 了应用 于步进 电机 闭环控 制 的参数 模 糊 自整 定 PID控 制 器。通 过 Simulink仿 真 ,分 别分 析 了 PID控 制 、模 糊 PID控制在步进 电机跟踪给定位置时系统的响应情况。并通过分析转速输 出曲线 ,提 出了加入模糊速 度 前馈 控制 环 的 系统 改进 方案 ,系统稳定 性得 到较 大提 高。 关键词 :步进 电机 ;PID;参数模糊 自整定;模糊速度前馈 中图分 类号 :TM301.2;TP273 文献 标识码 :A 文章 编号 :1000—8829(2009)01—0044—06 Analysis of Stepper M otor Close—Loop Control System Based on Simulink (School of Automation,Northwestern Polytechnical University,Xi’an 7 10072,China) LIU Chuan,LIU Jing—lin Abstract:Stepper motor is extensively applied in low—precision position servo system with open—loop contro1. High—precision close—loop orientation control is achieved with stepper motor position ~edback.The characteris- tics of strong non—linearity is shown with the mathematical model of stepper motors,for which fuzzy parameter self-modulated PID controller is designed to apply in stepper motor close—loop contro1.Th e responses of PID control and fuzzy PID control are respectively analyzed when the motors tracks desired position via computer simulation.An improvement which adds fuzzy speed feedforward controller to the system is described after ana- lyzing the output Clll-ve of rotor speed.Remarkably,the stability of system is enhanced. Key words:stepper motor;PID;fuzzy parameters self-modulation;fuzzy speed feedforward 步进电机作为数字控制 系统 中的一种执行元件 , 非常适合在精度和稳定性要求不高的位置或速度控制 系统 中开 环运行 ,且控 制 方 式 简 单 。步 进 电机控 制 原 理和开环控制方法见文献 [1]。步进电机开环控制 的 缺点是无法知道 电机是 否失步或者超步,在高精度 的 好 的 PID参 数 实施控 制很 难达 到理 想 的控 制效 果 。 而 模糊控制主要是模仿人的控制经验而不依赖于控制对 象的模型 ,主要研究那些在现实生活中广泛存在的、定 性 的、模糊的、非精确 的信息系统的控制 问题 ,但 由于 它对信息进行简单的模糊处理会导致被控系统控制精 位置伺 服 系统 中 ,这 一 缺点 将 直 接 影 响 系统 性 能 。位 置闭环控制通过在步进 电机转轴上安装位 置传感器 , 可将位置信号实时地传给控制核心 ,然后根据位置偏 差 控制 电机 运行 。 闭环控制算法常用的 PID控制方法主要是针对有 确切模型的线性过程 ,其 PID参数一经确定后无法随 着对象的变化而调整。而实际上 由步进 电机构成的调 速系统存在着非线性 、时变、干扰等特性 ,用原先整定 度 的降低 和动 态 品质 变 差 。针 对 这种 情 况 ,把 模 糊 控 制和常规 PID控制有机地结合在一起 ,即采用 了模糊 PID控制方案对步进电机进行控制。本文对两种控制 方法进行了比较,并对模糊 PID控制方法进行 了改进 , 提出了一种位置速度双闭环 的步进 电机控制系统 ,进 一 步提高系统性能。 1 混合式步进 电机模型 1.1 数 学模 型 收稿 日期 :2008—08—28 作者简介 :刘川 (1983一 ),男,山东青 岛人 ,在读硕 士,主要研 究 方向为步进 电机 控 制 与应 用 ;刘景 林 (1964一 ),男 ,河 南开封 人 ,教授 ,博士 生导 师,主要 研究方 向为 电机设计与控制 。 对于两相混合式步进 电机 ,在不计定子极 间和端 部 的漏磁、不计永磁体 回路的漏磁 、忽略磁滞和涡流的 影响、忽略饱和的影响、忽略定子线圈 自感 的谐波分量 时,两相混合式步进电机的电压平衡方程为
基 于 Simulink仿真 的 步进 电机 闭环控 制 系统分 析 ·45· Ua=Ri。“警 in( ) u6=Ri6“警+K toc0s(㈣ 式 中 ,u , 和 。,i 分 别为 A、B两 相 的 电压 和 电流 ;R 为绕组电阻 ; 为绕组 电感 ; 为反 电势系数; 为电 机转 速 ; 为转 子齿数 。 电机 转矩 方程 为 = .,警+Bw+ 一Kmi。(sinⅣ, )+KmibCoS(Ⅳ )(2) 式 中, 为 电磁转矩 ;J为转动惯量 ;B为粘滞摩擦系 数 , 为负载 转矩 。 转速 和 角度关 系方 程 d t : ~ (3) 、 式(1)、(2)、(3)组成两相混合式步进 电机的数学 模 型 ,其微 分 方程 形式 为 d ∞ l警=[一 in( )+Kzi s( )一 ]/J I警= 一瓯+K n( ) 【 dib= 一 一Km~COS( 圳儿 (4) 模型要求较 高的控制 方法 ,就必须对 其进行线性化 。 步进 电机线性化的方法较多且 比较复杂 ,目前 尚没有 一 种统一、简单易行的化简办法 。这时 ,模糊控制的优 势 就体 现 出来 了。 1.2 仿 真模 型 根 据 电机数 学 模 型 建 立 混 合 式 步 进 电机 非 线 性 Simulink仿 真模 型如 图 1所 示 。 该 电机 模 块有 u。,u 两个 输 入 , 。,i , ,∞ 4个 输 出量 ,子模块 是电磁转矩模块 。由于实际应用 中, 无论绕组电流流向如何 ,都用其绝对值 ,所 以输 出电流 后接绝对值模块输 出。 2 步进 电机 PID控 制 在 工业 过程 控 制 中 ,应 用 最 广 泛 的控 制 器 是 PID 控制器 ,它是按偏差的比例(P)、积分(I)、微分 (D)组 合 而成 的控制 规律 。合 理地 调节 PID控制 器 的参 数 就 能 获得满 意 的系 统性 能 。计 算 机 技 术 的 发 展 ,不仅 能 将模拟 PID控制器改为数 字实现 ,并且利用计算机的 强大功能,不断改进数字 PID控制规律 ,朝着更加灵活 和智 能 化的方 向发 展 。 模拟 PID控制器的算式为 u = (e+ 出+ de) (5) 离散 化后得 L =1.5 mH ,R =0.55 n ,J=4.5×10~ kg·m。,K = 0.19 N ·m/A,Ⅳr--50,B =8.0 x 10~ N ·/11·s/rad。 从 步 进 电机 的数 学模 型 可 以看 出 ,步进 电机 是 一 个高度非线性被控对象。如果要采用对被控对象数学 r k ,IT 、 “( ) ie(Jj}) 寺 e( ) 等[e( )一e(|j}一1)]j (6) 式 (5)为位置式 PID算法 。实 际操 作 中 ,如果 计 图 1 混合 式步进电机仿真模型
· 46· 《测控技术}2009年第 28卷第 1期 算机出故障 ,“(k)突变会造成执行机构位置 的突变 。 精度位置伺服系统 ,减小步距角有利于提高系统精度 。 增量 式算 法克 服 了上述 缺点 ,实 际 中多被采 用 ,其算 法 如下 Au(k)= [e( )一e(k一1)]+K,E e(k)+ [e(j})一2e(k一1)+e(k一2)] (7) 目前 最 常用 的细分 控制 方 法 为 “正 弦 阶梯 波 ”法 , 使绕组电流近似成为正弦波的形式 ,这样可 以更好地 降低电机 的低频振荡现象。在仿真中,采用 l6细分控 制 ,仿真结果如图 2所示 。图 2是在位置开环 ,步进脉 步进 电机 本身 具有 低频 振荡 的 问题 。要 消除这 一 冲频 率 为 50 Hz时 ,直 接驱 动和 采用 细分 控制 ,步 进 电 影 响 ,最好 的办法 是 减 小 电 机 每步 前 进 的角 度 。 由于 机 角位移 输 出波形 对 比 。从 图 中可 以看 出 ,采 用 细 分 受到 制作 工艺 的 限制 ,电机转 子齿 数 不可能 无 限增多 , 控 制后 ,电机 输 出 角位 移更 加 平 稳 ,低 频 振 荡 明显 降 所 以只 能通过 细 分控 制 减 小 步 进 角 度 。 同时 ,对 于 高 低。同时较小 的步距角能够提高系统定位精度。 O一8 O·6 鼍 0· ‘ 。 , . ’ 一 / ./ 0·8 O·6 黾 o·4 O-2 / / / ./ / / / /- / 0 0 0.1 0.2 0.3 0.4 0.5 时间 /s (b) 细 分 后 图 2 细分前后 电机输 出角位移 由于细分 控制 仅 仅采 用 电流 闭环 ,故 可 以将 其 作 输 出如 图 4所示 ,PID系统 响应 时间 为 4.2 S。为 了消 为位 置 闭环控 制 的一个 内环 ,加 入 到 步 进 电 机 PID控 除超 调 ,系统 响应 时 问较长 ,而 输 出在平衡 位 置有 轻微 制系 统 中。如 此可 以将 开环 步进 电机控 制 系统改 造 为 的抖 动 。 闭环 系统 ,缩短 了设 计周 期 ,降低 了设计 费用 。 步进 电机 PID控制 系统 结构 框 图如 图 3所示 。图 中输入为 10 rad的位置给定 ,期望位置和实际位置相 3 步进 电机 模 糊 PID控 制 3.1 参数模 糊 自整定 PID控 制 系统结构 减 之后 到 Saturation模 块 之 间部 分 为 PID控 制器 。Sat. 普通的 PID控制器 ,对于像步进电机这种参数时 uration模 块 限 定 电机 最 高 转 速 。Subsystem 模 块 为 细 分 控制 与 脉 冲 环 形 分 配 模 块 ,stepper motor模 块 为 步 进 电机模 块 ,这两 部 分 组 成 原有 开环 控 制 系 统 。系 统 输 出为 角位 移 seta,绕 组 电流 i。,i ,转 速 。位置 仿 真 变 的非线性被控对象 ,其控制效果往往不是特别理想 。 而参数模糊 自整定 PID控制是模糊 PID控制的一种 , 它 针对 这一 缺点 ,对 PID控 制 进 行 的改 进 。控 制 系 统 结 构如 图 5所 示 。 图 3 步进 电机 PID控制 系统结 构
基 于 Simulink仿 真 的 步进 电机 闭环控 制 系统分 析 ·47· 2 O 8 6 4 2 O 口g\咖 / / / / 7 | / 0 1 2 3 4 4.2 5 6 时 间/s 图 4 PID控制位置响应 曲线 图 5 参数模糊 自整定 PID控制系统结构 为 了满 足 在不 同偏 差 E 和偏差 变 化 率 EC对 PID 参数 自整定的要求 ,利用模糊控制规则在线对 PID参 ㈦ (9) , △ hKpm“ 丁 AKf.~ AK l raa x 丁 : . △^ AKDm 丁 数 进行 修改 ,便 构 成 了参 数 模 糊 自整 定 PID控 制 器 。 隶属 函数 选用 三 角形 和梯 形 隶 属 函数 ,如 图 6所 其 实现思 想是 先 找 出 PID 3个 参数 与偏 差 E和偏 差 变 刀 。 化 率 EC之 问 的模 糊 关 系 ,在 运 行 中 通 过 不 断 检 测 E 和 EC,再 根据 模糊控 制 原理来 对 3个参 数进 行在 线 修 改 ,以满 足在 不 同 E和 EC时对 控 制参 数 的不 同要 求 , 使被控对象具有 良好的动、静态性能。 在 不 同 E和 EC下 ,被控 过程 对参 数 ,K,, 的 自整定要 求 可简单 地 总结 出以下 规律 J: - 8 B IM s o .s P M f B J × V V × -2 4 U 2 -6 -4 6 8 ① 当 l E l较大 时,应取较大 的 和较小的 , 以使 系统 响应 加快 ,且 为避免 较 大超调 ,使 Kz=0。 ② 当 lEl中等时 ,应取较小 的 使系统响应具 有较 小 的超 调 ,适 当的 和 。 ③ 当 }E}较小 时,应取较大的 和 K,,使系统 响应具 有较 好 的稳 态 性 能 , 的取 值 要 恰 当 ,以避 免 在 平衡 点 附近 出现振 荡 。 3.2 模糊控制规则 参 数模 糊 自整定 PID控制 器 的输入 为 位 置偏 差 E 和位置偏差的变化率 EC,输出为 PID 3个参数的变化 量 △ 、△ 、△ 。通 过 比较 选 用 3个 语 言 变 量 、5个 语 言变量 、7个 语 言 变 量 和 9个 语 言 变 量 时 的模 糊 控 制 器输 出情 况发 现 ,选 用 3个 语 言 变 量 和 5个 语 言 变 量 时 ,控制 器输 出超 调较 大 ,并 伴 随 明显 振 荡 ,收敛 较 N B NM NS ZO PS PM PB 图 6 E、EC、△ 、AKz、AKo隶属 函数 模 糊条 件语 句格 式为 if E=A&EC=B,then AKp = X& A ,=Y& AKo=Z。据此格 式 以及 3.1中所述 参数 自整 定规 律 ,可建立模 糊 控 制规 则 ],如 表 1、2、 3中所示 。 表 1 AKp的模糊控制规则表 PS PS PS Z0 NS NS NM NM
· 48· 《测控技 术 )2009年 第 28卷 第 1期 表 2 △ 的 模 糊 控 制 规 则 表 模糊控制器输 出是一个模糊集合 ,必须对该集合 判决 出一 个精 确 的控 制量 。输 出信息 的模 糊判 决方 法 主要有最大隶属度法、中位数法 、加权平均法 。一般来 说 ,加权平均法优于另外两种方法,故在此选用。 器经模糊 整定后 的 3个 参数 , , 。其 中 , ,KD。为 常 规 PID控 制 中得 到 的 PID 3个参 数 ,以此 作为 参数 模糊 自整 定 PID控 制参 数 的初始 值 。 K ~ = K p o + ' AK p (1()) . 。 — — . 口 。 … £ 由以上方法建立参数模糊 自整定 PID位置跟踪系 统 ,在 给定 位置输 人 同样 为 10 rad的情 况下 ,系统 响应 曲线如 图 7所示 。系统 响应 时 间 为 3.5 s,响 应 迅 速 , 响应过程平滑无超调 ,但在平衡位置仍然存在轻微 的 / —一 / l/ | } / 0 1 2 3 3.5 4 5 6 时 间/s 4 仿 真 结 果 分 析 与 系统 改 进 对 比图4和图 7可 以看出 ,模糊控制器 的加入使 得 系统 响应 时 间 比单纯 PID控制 系统 有所 提高 。这 是 由于在 起始 阶段 (O一0.6 s期 问 ),模 糊 自整定 控 制 器 使 值较之常规 PID更大 ,而 相对变小 ,这使得 在起 始 阶段 ,步 进 电机 以较 高 速 度 向 期 望 位 置 运 行 。 随着偏差 的减小(0.6—2.4 S期间),模糊整定后的 值逐渐减小 , 和 逐渐接近于常规 PID值 ,系统响 应 曲线 趋 于 平 缓 。 当 响 应 偏 差 接 近 0时 (2.4 s以 后),K,的增大使得系统能够较平稳地 达到期望位置 而无振荡现象 。这相对于图 4中常规 PID响应 曲线 , 比较 明显 的提 高在 于起 始 阶段 ,系统 响应速 度更 快 ,最 后趋 于平 衡位 置 的 阶段 ,曲线 更加 平稳 。 图8为两个控制系统输出转速对比图。在起始 阶 段 ,PID控 制起 始转 速 约 为 11 rad/s,小 于 模糊 PID控 制起 始转 速 14.8 rad/s。在 偏 差 较 大 时 ,模 糊 PID 系 统以限定 的最高转速 运行 ,使得位置偏 差迅速减小。 6 8 2 在位 置偏 差较 小 时 ,转速 迅速 衰减 ,以消除超 调 。 l6 12 ll _ ■ 8 黾 一 . j ’『 ] 。r 一— 4 辩 0 — 4 r [ 。 … ] __ 一_ - O l 2 3 4 5 6 时 间/s (a) PID控制系统输出转速 I ‘▲ l … 1 _-_ 一__—● … 一 。 … … 1l ● __ 【 |_ . } . - r ’’ f I rr 1 - f— 一 … 一 0 1 2 3 4 5 6 时问/s (b) 模糊 PID控制 系统输 出转速 图 8 输 出转速对 比图 图 7 参数模糊 自整定 PID控 制响应 曲线 从 图 4、图 7、图 8中也 可 以看 出 ,在 系统 达到 平衡
基 于 Simulink仿 真 的 步进 电机 闭环控 制 系统分析 ·49· 位置 ,偏差 接 近 为 0时 ,位 置 和 转 速 仍 然 有 一 定 的 振 荡 ,而 PID控制中振荡更加明显。这主要有两方面原 因。第一 ,由于步 进 电机是 以离 散 的方式 运行 的 ,而非 连续 方式 ,所 以 电机 的步 进 角 即 为 电机 的最 小 前 进 角 度 。 因此 可 能 电机 无 法 完 全运 行 到 给 定 位 置 ,造 成 了 速度进行开环控制也会造成一定的振荡。针对第 1个 原因可通过加大电机细分控制 的细分数 ,减小步进角 度 ,提高电机步进运行精度 ;针对第 2个原因可对以上 建立的模糊 PID控制系统进行改进 ,在速度给定后增 加模糊速度前馈控制环节 j,实现速度闭环。其系统 转 子在平 衡 位置来 回振荡 ;第 二 ,在 给定位 置 系统 中对 结 构如 图 9所 示 。 系统响应 曲线如图 10(a)所示 。系统 响应速度 比 机是一类参数时变 的高度非线性被控对象。参数模糊 未加速度环之前稍有提高 ,在达到平衡位置后 ,速度振 自整定 PID控制在处理 这类 系统 时 ,明显优 于普 通 图 9 带速度控制 的参数模糊 自整定 PID控制 系统 荡 频率 和 幅度 明显 降 低 ,如 图 10(b)所 示 。 系统 能 够 在平衡位置达到稳定。系统性能得到进一步提高。 / ,一一 \ 黾 咖 翅 f } ~{ ,| PID控制 ,在加 人模 糊前 馈速 度控 制 环 后 ,系统 在 平衡 位置时的速度振荡得到降低 ,有利于高精度定位 的要 求。在实际应用 中,由于步进 电机最大启 动转速 这一参数 的存在 ,可以将步进 电机直接启动速度和停 转时速度设定为小 于 的某一个值 (具体大小 由负 载 和 电机 转 动 惯量 决 定 ),这 样 系 统 响应 速 度 可得 到 进 一步提 高 。 参 考文 献 : [1] 陈隆 昌.控制 电机 (第 3版 )[M].西安 :西安 电子科 技大 学 出版 社 ,2000-05. [2] Bodson M,Chiasson J N,Novotnak R T,Rekowski R B. High-performance nonlinear feedback control of a permanent magnetstepper motor[J].IEEE Trans.on Control Systems (a) 位置输 出 Technology,1993,1(1):5—14. ● ● ● l 16 13.6 12 ’三 8 ● 暑 4 群 O 一 4 I ‘ L _n rr’ . ■I-山山Il U I 。1一『 l I 『 [3] Ghafari A s,Masty A.Design and real—time experimental im— plementation of gain scheduling PID fuzzy controller for hy— brid stepper motor in micro—step operation[A].Proceedings of the IEEE International Conference on Mechatronics,2004: 421—426. [4] Betin F,Pinchon D,and Capolino G-A.Fuzzy logic applied to speed control of a stepping motor drive[J].IEEE Trans.on Industrial Electronics,2000,47(3):610—622. [5] 章卫 国 ,杨 向忠.模糊控 制理论 与应用 [M].西安 :西北 工 业 大学出版社 ,1999—10. U 1 2 3 4 5 6 [6] 史敬 灼.步进 电动机伺 服控制 技术 [M].北 京 :科 学 出版 时间/s (b) 速度输出 图 10 系统位置和速度输 出 5 结束语 通过 分析 步进 电机 的数 学 模 型 可 以看 出 ,步 进 电 社 ,2006. 口 欢迎订 阅 2009年《测控技 术》月刊 ● 订 阅代 号 :82—533 ● 定价 :l5.00歹己/期
分享到:
收藏