基于DSP和CAN總線的步進電機控制系統(tǒng)研究_圖文

1、 嵌入式技術(shù) 電 子 測 量 技 術(shù) EL ECTRON IC M EASU REM EN T TECHNOLO GY第 32卷 第 1期2009年 1月 基于 DSP 和 CAN 總線的步進電機控制系統(tǒng)研究王 瑾(陜西紡織服裝職業(yè)技術(shù)學院 咸陽 712000摘 要 :為了提高步進電機控制系統(tǒng)的動態(tài)性能和控制精度 , 提出基于數(shù)字信號處理器 TMS320L F2407A 的步進電 機控制系統(tǒng)設(shè)計方法 , 包括系統(tǒng)硬件 、 軟件及加減速控制算法的設(shè)計 ; 并運用 CAN 總線技術(shù)實現(xiàn)了 DSP 與工控機之 間的數(shù)據(jù)通信 。 通過實驗測試 , 結(jié)果驗證了步進電機加減速控制算法的正確性和有效性 。

2、關(guān)鍵詞 :步進電機 ; 數(shù)字信號處理器 ; CAN 總線 ; 加減速控制 中圖分類號 :TP273 文獻標識碼 :AStudy on stepping motor control system based on DSP busWang Jin(Shaanxi Textile and Garment Abstract :In order to improve dynamic and stepping motor control system ,this paper brings forward stepping TMS320L F2407A DSP , including hardware de

3、sign , software of and deceleration. Data communication between DSP and industrial the use of CAN bus. Through experimental test , the results prove that control algorithm of and deceleration is correct and effective.K eyw ords :stepping motor ; DSP ; CAN bus ; control of acceleration and decelerati

4、on0 引 言步進電機是一種將電脈沖信號轉(zhuǎn)換成角位移的執(zhí)行機構(gòu) , 其轉(zhuǎn)子角位移與輸入脈沖的個數(shù)成正比 , 其轉(zhuǎn)動速 度與輸入脈沖的頻率成正比 , 通過改變脈沖頻率可以實現(xiàn) 大范圍內(nèi)的調(diào)速 ; 同時 , 步進電機易于與計算機和其它數(shù) 字元件接口 , 因此被應(yīng)用于各種數(shù)字控制系統(tǒng)中 1。隨著微電子技術(shù)的發(fā)展 , 數(shù)字信號處理器以其強大的 運算處理功能、 較高的控制精度而在自動控制系統(tǒng)中普遍 使用。 在眾多 DSP 型號中 , TMS320L F2407A 作為 TI 公 司的一款新型 16位定點數(shù)字信號處理器 , 以其外設(shè)集成 度高、 A/D 轉(zhuǎn)換速度快等特點 , 而被廣泛用于電機數(shù)字化 控制。

5、為了 提 高 步 進 電 機 的 控 制 性 能 和 精 度 , 本 文 以 TMS320L F2407A 為核心 , 實現(xiàn)了三相步進電機控制系統(tǒng) 的設(shè)計 ; 并運用 CAN 總線技術(shù) , 完成了上位機與步進電機 控制系統(tǒng)之間的數(shù)據(jù)通信。1 系統(tǒng)結(jié)構(gòu)基于 DSP 和 CAN 總線的步進電機控制系統(tǒng)結(jié)構(gòu)框圖 如圖 1所示。 整個系統(tǒng)主要由數(shù)字信號處理器、 CAN 總線及其接口電路、 工控機、 步進電機等部分組成。本系統(tǒng)上位機經(jīng) CAN 接口適配卡與總線相連 , 實現(xiàn) 對下位機的監(jiān)控和管理 。 下位機選用 TMS320L F2407A , 通過 CAN 驅(qū)動器 PCA82C250連接至 CAN 物

6、理總線 2; DSP 用于接收上位機指令 , 實現(xiàn)對步進電機的控制及向 上位機發(fā)送電機運行狀態(tài)和各種參數(shù) 。在此網(wǎng)絡(luò)系統(tǒng) 中 , 可配置多個節(jié)點 , 各節(jié)點之間都能通過 CAN 總線交 換信息 。圖 1 系統(tǒng)結(jié)構(gòu)框圖211 王瑾 等 :基于 DSP 和 CAN 總線的步進電機控制系統(tǒng)研究第 1期2 系統(tǒng)硬件設(shè)計2. 1 DSP 與 CAN 總線接口電路DSP 與 CAN 總線接口電路主要用于完成工控機與步進電機控制系統(tǒng)的數(shù)據(jù)通信 , 電路如圖 2所示。圖 2 DSP 與 CAN 總線接口電路電路選用 PCA82C250作為 CAN 控制器和 CAN 間的接口 , 統(tǒng)抗干擾性能 , 在 DSP

7、與 離電路 , , 10M Hz 。電 , 輸 出 引 腳 CAN H 和 CANL 120終端匹配電阻 ; 否則 , 會降低 總線 數(shù) 據(jù) 通 信 的 可 靠 性 3。并 將 RS 引 腳 接 地 , 使 PCA82C250工作于高速通信方式。 2. 2 脈沖分配器電路步進電機輸出接口電路包括脈沖分配器電路和功率 驅(qū)動電路 2部分。脈沖分配器根據(jù)指令將脈沖按一定邏輯關(guān)系加到各 相繞組的功率放大器上 , 使步進電機按一定方式運行 4。 系統(tǒng)采用專為三相步進電機脈沖控制而設(shè)計的接口芯片 C H250作為脈沖分配器 , 電路如圖 3所示。圖 3 脈沖分配器電路圖中 CH250接成三相六拍工作方式

8、, TMS320L F2407A的 PWM1、 T1PWM 腳分別與 CH250的 J6r 、 CP 端相連。PWM1腳的電平高、 低控制步進電機的旋轉(zhuǎn)方向 ; T1PWM 腳輸出脈沖的個數(shù)決定步進電機旋轉(zhuǎn)角度 ; 其輸出脈沖的 頻率控制電機的加、 減速運動。 2. 3 功率驅(qū)動電路脈沖分配器 CH250的 A 、 B 、 C 三端輸出電流很小 , 為 200400A ; 而所用三相反應(yīng)式步進電機驅(qū)動電流較大 , 每相靜態(tài)電流約 3A 。 為滿足驅(qū)動要求 , 系統(tǒng)設(shè)計了步進 電機功率驅(qū)動電路 , 如圖 4所示 (以 A 相為例 。電路采用三級晶體管放大 , 第 1級用 3D G6小功率管 ,

9、第 2級用 3D K4中功率管 , 第 3級用 3DD15大功率管。 L A 為步進電機 A 相繞組。 R15為限流電阻 , 保證電流穩(wěn) 態(tài)值為額定值 ;D2為續(xù)流二極管 , 防止 3DD15關(guān)斷時繞組 反電勢擊穿管子。 C9為加速電容 , 動態(tài)工作時 , 利用其旁 路作用 , 使電機繞組電流上升加快 , 沿 , 提高電機高頻性能 5。圖 4 步進電機功率驅(qū)動電路3 系統(tǒng)軟件設(shè)計步進電機存在啟動時的失步、 停止時的過沖現(xiàn)象 , 這 是影響步進電機位置控制精度的主要原因。因此 , 軟件設(shè) 計主要介紹步進電機加減速控制算法及程序?qū)崿F(xiàn)。3. 1 加減速控制算法設(shè)計在位置控制時 , 對步進電機的加減速

10、有嚴格要求 , 就 是在不失步和過沖的前提下 , 用最短的時間移動到指定位 置 6。 為滿足加減速控制要求 , 本系統(tǒng)步進電機按照指數(shù) 加減速曲線進行控制 , 如圖 5所示。圖 5 指數(shù)加減速曲線311 第 32卷 電 子 測 量 技 術(shù)系統(tǒng)按指數(shù)曲線加減速時 , 驅(qū)動脈沖的頻率 f 與升速時間 t 的關(guān)系如下 7:f =f m -f m e-t/(1式中 :f m 為步進電機最高運行頻率 ; 是決定升速快慢的 時間常數(shù) , 實際工作中可由實驗來確定。實際運行中 , 若 步進電機運行頻率為 f g , 由式 (1 可算出升速時間為 :t r =ln f m -ln f m -f g (2 由于

11、 DSP 是用定時器比較中斷方式來控制步進電機速度的 , 電機的加減速控制實際上是不斷地改變定時器周 期寄存器的裝載值。 為了編程方便 , 可用階梯曲線來擬合 加速曲線 , 將升速段按照速度等間距均勻地離散為 n 檔 , 如 圖 6所示。f g , 穩(wěn)定運行最高頻率為f c , 則相鄰兩速度級的頻率變化為 :f =(f c -f q /n (3則每一檔頻率 f k 為 :f k =f q +f k -(k =1,2, , n 每一檔運行時間 Tk 為 :T k =t r f k+1-t r f k(k =1,2, , n 式中 :t r f k 、 t r f k+1分別為運行頻率為 f k

12、及 f k +1時 的升速時間。各分檔速度內(nèi)運行步數(shù) N k 為 :N k =f k T k(4 則加速過程總步數(shù) N r 為 :N r = nk =1Nk(5執(zhí)行加速控制時 , 對每檔速度都要計算在此臺階上應(yīng) 走步數(shù) , 然后以遞減方式查詢。當減至 0時 , 表明該速度 檔步數(shù)已走完 , 進入下一檔速度。同時 , 遞減加速過程總 步數(shù) , 直到加速過程走完。以上就是對步進電機加速過程 的處理方法 , 減速過程的處理同加速過程。 3. 2 加減速控制程序?qū)崿F(xiàn)采用指數(shù)加減速曲線控制步進電機運行時 , 需要通過 計算來獲得 PWM 輸出頻率 ; 為提高程序執(zhí)行效率 , 系統(tǒng)采 用圖 6所示近似指數(shù)

13、加速曲線 8。即用速度級數(shù) M 與 1個常數(shù) C 的乘積來模擬在該速度級上保持的時間 , 并且保持時間用步數(shù)來代替 ; 因此 , 在每個速度級上 , 步進電機都要走 MC 步。本系統(tǒng)步進電機工作時 , 啟動頻率為 400Hz , 最高頻 率 3200Hz ; 取電機速度級數(shù) M =7, 常數(shù) C =2。 當外部時 鐘頻率為 10M Hz , 經(jīng) DSP 內(nèi)部鎖相環(huán) 4倍頻 , 且通用定時 器 1的預(yù)分頻因子為 64時 , 可求出各速度級上 PWM 信號 頻率所對應(yīng)的定時器 1周期寄存器值 T1PR , 如表 1所示。 程序運行時 , 可通過查表來改變 T1PR 的裝載值 , 控制輸 出 PWM

14、 信號的頻率 ; 這樣可以大幅減少占用 CPU 的時 間 , 提高系統(tǒng)響應(yīng)速度。表 1 加速時各級頻率及 T 1PR 值對照表速度 級數(shù)M 頻率 /Hz 每級脈沖個數(shù)周期 寄存器T1PR 值 速度級 數(shù) M頻率 /Hz每級 脈沖個數(shù) 周期 寄存器T1PR 值1400261A H 500010138H2800430D H 12104H 31 2006140DF H1DSP 定時器 1的 1次 該程序 , 也即步進電機每走一步調(diào)用 1次 ; 并按照加減速 控制要求經(jīng)查表裝入 T1PR 值 , 在緊接著的下 1個周期中 相應(yīng)地控制步進電機運動速度。加減速控制程序流程圖 如圖 7所示。圖 7 加減速控

15、制程序流程圖4 實驗結(jié)果在實 驗 過 程 中 , 系 統(tǒng) 選 用 三 相 反 應(yīng) 式 步 進 電 機70BF003, 其額定激勵電壓 27V , 每相靜態(tài)電流 3A , 步距 角 =1. 5°, 最大靜轉(zhuǎn)矩 0. 784N m 。 系統(tǒng)工作時 , 使步411 王瑾 等 :基于 DSP 和 CAN 總線的步進電機控制系統(tǒng)研究第 1期進電機啟動頻率為 400Hz , 最高工作頻率 3200Hz , 取速度級數(shù) M =7, 常數(shù) C =2, 分別用示波器對步進電機加、 減速 過程中 TMS320L F2407A 的 T1PWM 引腳輸出信號頻率 進行檢測 , 其波形如圖 8所示。圖 8 實

16、驗結(jié)果由圖 可 知 , 步 進 電 機 在 進 行 速 度 控 制 時 , DSP 的T1PWM 引腳輸出頻率可變的 PWM 信號 ; 且步進電機速 度并非一直上升 (或下降 , 而是每升 1級 (或每降 1級 都 要在該速度級上保持一段時間 , 即實際加、 減速軌跡呈階 梯狀 , 并在速度級上按 2、 4、 6、 等步數(shù)變化 ; 同時 , 輸出波 形最低頻率 400Hz , 最高頻率 3200Hz 。 以上情況均表明 系統(tǒng)設(shè)計的步進電機加、 減速控制算法得以有效實施。5 結(jié)束語本文以 TMS320L F2407A 為控制核心 , 實現(xiàn)了三相步進電機控制系統(tǒng)的設(shè)計 ; 運用 CAN 總線技術(shù)

17、, 完成了工控 機與步進電機控制系統(tǒng)之間的數(shù)據(jù)通信 ; 重點介紹了步進 電機加減速控制算法及其程序?qū)崿F(xiàn)。通過實驗 , 結(jié)果驗證 了步進電機加減速控制算法設(shè)計的正確性和有效性 ; 同 時 , 系統(tǒng)所采取的軟、 硬件設(shè)計措施及步進電機控制算法 具有一定通用性 , 也可用于其他步進電機控制系統(tǒng)中。參 考 文 獻1 劉亞東 , 李從心 , 王小新 . 步進電機速度的精確控制J.上海交通大學學報 ,2001,35(10 :151721520.2 孫兵 , 何瑾 , 陳廣廈 . 基于 DSP 的 CAN 總線與以太網(wǎng)互聯(lián) 系 統(tǒng) 研 制 J .儀 器 儀 表 學 報 , 2008, 29(2 :3772380.3 李星林 , 黃石生 . 高速雙絲脈沖 MIG 焊的研究 J.電力電子技術(shù) ,2008,42(3 :39240.4 王輝堂 , 顏自勇 , 陳文薌 . 模塊單片機的分 技 國 外 電 子 測 量 技 術(shù) , 3 :92.