閱讀 | 訂閱
閱讀 | 訂閱
控製係統

基於CAN總線的分布式位置伺服係統設計

星之球激光 來源:電子技術應用2011-12-10 我要評論(0 )   

伺服係統(servo system)亦稱隨動係統,其在軍(jun) 事、工業(ye) 和日常生活中都有著廣泛的應用。隨著計算機技術和現場總線技術的發展和成熟,也促使伺服係統的實現方式和體(ti) 係結...

  伺服係統(servo system)亦稱隨動係統,其在軍(jun) 事、工業(ye) 和日常生活中都有著廣泛的應用。隨著計算機技術和現場總線技術的發展和成熟,也促使伺服係統的實現方式和體(ti) 係結構在不斷地發展,將現場總線應用於(yu) 運動控製,構成分布式控製的數字控製伺服係統日益受到人們(men) 的重視。基於(yu) 現場總線的分布式伺服係統有很多優(you) 點,如連線少、可靠性高、易於(yu) 係統的維護和擴展等。目前,國外的Siemens、ORM EC Systems、Rexroth等公司已經有各自的分布式伺服係統產(chan) 品推出;國內(nei) 有一些單位和學者也進行了該方麵的研究,但相關(guan) 的論文並不多,更沒有形成係列產(chan) 品[1]。

    分布式伺服係統中,電機控製性能和多電機間協調控製性能的好壞直接影響生產(chan) 過程質量,如何實現係統的高效管理、方便應用和實時控製都是需要解決(jue) 的關(guan) 鍵問題。CAN總線是一種有效支持分布式控製或實時控製的串行通信局域網絡,以其結構簡單、可靠性高、成本低廉等優(you) 點非常適合分布式伺服係統中數據通信的實現。通過CAN總線進行數據傳(chuan) 輸與(yu) 控製,使伺服電機的性能更加穩定,能更好、更靈活地應用於(yu) 分布式運動控製係統中[2]。

1 係統的總體(ti) 結構和原理

    本文設計的分布式伺服係統的總體(ti) 結構如圖1所示。係統由主控製器PLC、CAN總線和現場伺服單元節點組成。PLC是整個(ge) 係統的主控製器,除了對各個(ge) 伺服電機發送實時控製命令外,還需要接收各驅動器節點的工作狀態信息,並進行判斷給操作人員以提示或報警。係統中所有的伺服電機係統都有各自的CAN接口,都掛接在CAN總線上構成如圖1所示的分布式控製係統。係統中若有節點同時向總線發送CAN信息時,根據每條信息的標識符(ID)進行仲裁,決(jue) 定占用總線的優(you) 先級,信息的ID越小優(you) 先級越高。這就是CAN總線的非破壞性總線仲裁機製,由此決(jue) 定同時發送到總線上的不同報文對總線的占用權[3-4]。

2 係統硬件構成

2.1 主控製器PLC模塊

    本係統的主控製器PLC選用的是芬蘭(lan) EPEC公司生產(chan) 的EPEC 3G係列控製模塊中的一種,該模塊功能強大,性能優(you) 越;堅固、體(ti) 積小、耐低溫、抗振動、抗強電磁幹擾,並具有高壓、過載、過熱和輸出短路保護功能;16位的高性能微處理器和超大容量的內(nei) 存空間使其具有很強的數字處理能力,可以完成較複雜的算法;具有豐(feng) 富的I/O口資源,包括AI、DI、DO和PWM輸出等,還具有CANopen和CAN2.0B 兩(liang) 個(ge) 總線接口,可以與(yu) 很多標準的CAN總線產(chan) 品直接連接,而且接線簡單方便,可靠性高。本係統利用的是該模塊的CAN2.0B總線接口。

2.2 伺服驅動器節點硬件原理

  本係統目前的工程應用是控製油門閥的開度,圖1中的每1個(ge) 伺服電機係統就是一個(ge) 集成的直流電動推杆,其包括DC 24 V直流電機、推杆機構和推杆位置傳(chuan) 感器。通過電機的正反轉帶動推杆機構直線運動從(cong) 而控製某型號油門閥的開度大小。

  伺服驅動器的CAN節點主要由單片機AT89C52、AD芯片、CAN控製器82527、收發器PCA82C250和繼電器構成,其硬件原理如圖2所示。單片機從(cong) CAN總線上接收PLC發送的位置給定命令,推杆位置傳(chuan) 感器的反饋電壓信號經AD轉換後進入單片機,與(yu) 位置給定量進行比較,然後完成推杆位置的閉環控製算法。控製量通過單片機的I/O_1和I/O_2輸出,經過驅動芯片後,I/O_1的信號控製1個(ge) 雙刀雙擲繼電器實現電機的正反轉切換,I/O_1的信號控製1個(ge) 單刀繼電器以控製電機的啟動和停止[5]。

3 係統軟件設計

  係統CAN總線網絡的通信協議是按照CAN2.0B標準設計的,采用11位標識符的標準幀格式,初始波特率為(wei) 250 Kb/s(可修改),各節點的數據發送方式都采用廣播式,接收數據時采用報文標識符過濾的方式從(cong) 總線上接收本地所需要的數據。

3.1 PLC控製程序

  係統選用的PLC的軟件開發環境是CoDeSys,它是德國3S公司開發的一種可視化PLC編程環境,支持IEC11311-3標準的指令表、梯形圖、功能模塊圖、順序流程圖、結構化文本、連續功能圖等6種編程語言,用戶可在同1個(ge) 項目中選擇不同的語言編寫(xie) 程序。CoDeSys以工程文件的形式組織程序的各個(ge) 對象。1個(ge) 工程文件包含PLC程序裏的所有對象:POUs(Program Organization Units)、數據類型和資源。1個(ge) POUs包括主程序(PLC_PRG)、子程序(PRG)、功能塊(FB)、函數(FUN)及語句,其中主程序必須命名為(wei) PLC_PRG。子程序可以調用函數和功能塊,但函數和功能塊不能調用子程序,且當程序在線運行時,子程序中的中間變量值是可視的。另外,CoDeSys還具有豐(feng) 富的庫文件資源,編程過程中可以靈活調用,大大節省了軟件開發時間。

    根據CoDeSys程序編寫(xie) 的特點,係統的PLC程序是用結構化文本語言編寫(xie) 的。程序的主要功能是把由AI口輸入的油門控製腳踏板的模擬電壓進行一定調理後通過CAN總線發送給各個(ge) 被控節點,並從(cong) CAN總線上接收各節點的狀態信息,進行判斷後對操作人員給出提示或報警信號。PLC的CAN總線通信初始化的主要設置有:波特率等相關(guan) 參數、報文濾波參數、創建接收報文的數據緩存區等,這些設置都可以直接調用CAN2.0的庫函數實現,十分方便。PLC在發送數據時,調用庫函數CAN_IITX(),設置ID、DLC等參數,把數據打包給每幀數據段的相應字節即可;接收數據時,需要先調用庫函數CAN_II_GET_MSG()創建接收數據緩存區,設置OBJ、ID等參數(OBJ是緩存初始化序號, ID是接收數據的標識符),實現報文過濾。然後調用庫函數GET_MSG(),其參數MESSAGE必須與(yu) 緩存區初始化序號OBJ相等,才能讀入相應緩存區的數據。函數GET_MSG()讀數據是分字節讀取的,可以很容易實現數據的字節操作和位操作,可為(wei) 數據的計算和處理提供方便。順序循環執行PLC程序,本係統設計的循環周期為(wei) 10 ms,可以滿足控製係統實時性的要求。

3.2 單片機程序

    單片機的主程序流程如圖3所示,包括單片機與(yu) 82527的初始化程序和各子程序。對反複執行的程序段利用主程序調用子程序的方式實現。子程序主要有閉環控製子程序、故障處理子程序和參數修改子程序[6]。

    係統的閉環控製采用的是Bang-Bang算法。該算法是一種時間最優(you) 控製,且算法簡單,便於(yu) 單片機實現,又能滿足係統控製精度的要求。設精度允許的推杆位置誤差帶為(wei) [-Δ1,Δ2],當前偏差為(wei) e(t),-Δ1≤e(t)≤Δ2時,可認為(wei) 推杆當前位置即為(wei) 給定要求的位置。若把控製量u(t)歸一化處理,則此算法可以表示為(wei) :
  
   由於(yu) 伺服電機正轉和反轉時推杆運動的慣性不同,所以正、反向最大誤差允許值Δ2和Δ1一般是不相等的。圖4是Bang-Bang算法子程序流圖。

    故障處理程序處理的故障包括CAN通信中斷故障、位置反饋斷線故障、電機堵轉故障等,通過對這些故障的自動處理或給出提示信息提高了係統的可靠性。控製器在不同場合使用時,對一些參數的要求也不相同,如控製器CAN報文的ID、通信波特率、控製死區、位置標定等參數的值都可以通過CAN總線報文進行人工修改。本設計選用的X5045芯片帶有512字節的E2PROM,可由單片機對其存儲(chu) 空間進行串行讀寫(xie) ,因此,X5045芯片除了實現單片機的上電複位和看門狗功能外,還可把需要進行修改的參數存放在其E2PROM空間中。對故障處理和參數修改子程序的具體(ti) 編寫(xie) 這裏不再詳述。#p#分頁標題#e#

4 實驗結果及分析

    本係統實現1個(ge) 腳踏板同時對2個(ge) 油門閥的控製,腳踏板電位器輸出的電壓信號經主控製器PLC的模擬量輸入口進行A/D轉換,再通過CAN總線接口發給2個(ge) 伺服驅動節點,控製油門閥的開度快速精確跟蹤腳踏板的運動變化。在實際應用過程中,PLC還用於(yu) 整車的其他控製功能。由於(yu) 通信線使用的是普通雙絞線的特征阻抗120 Ω,所以需要在CAN總線兩(liang) 端的CANH和CANL之間各加1個(ge) 120 Ω的終端電阻,使總線阻抗匹配,以較好地抑製幹擾。

   經過實驗,係統能夠達到以下要求:

   (1)在波特率250 Kb/s、總線長度100 m的情況下,各節點之間通信正常,2個(ge) 伺服驅動節點能正常工作。

   (2)推杆的有效運動長度約為(wei) 50 mm,5 s內(nei) 可實現全程運動,可滿足油門閥調節快速性的要求。

   (3)圖5是調試過程中通過CodeSys開發環境的變量觀察窗口繪出的2個(ge) 推杆運動的階躍響應曲線,其中圖5(a)是控製推杆伸出的情況,圖5(b)是縮回的情況。圖中,x表示位置給定量的階躍變化,y1、y2分別表示2個(ge) 推杆位置對階躍給定的動態響應曲線。由圖可以看出,2個(ge) 推杆的位置均能及時跟隨給定量的變化,並能達到控製精度的要求。

   本文設計的分布式直流電動伺服係統已經應用在某大型工程運輸車的油門閥控製中,其工作穩定可靠,與(yu) 氣動油門相比,大大提高了油門控製的響應速度和係統的可靠性。該係統的伺服驅動節點結構簡單、成本低廉,CAN總線網絡的應用使整個(ge) 係統具有很強的通用性和可擴展性,根據應用需要可以方便地增減驅動節點的數量,實現更多軸和多點的伺服控製係統,並進一步實現多電機的協同控製。

轉載請注明出處。

免責聲明

① 凡本網未注明其他出處的作品,版權均屬於(yu) fun88网页下载,未經本網授權不得轉載、摘編或利用其它方式使用。獲本網授權使用作品的,應在授權範圍內(nei) 使 用,並注明"來源:fun88网页下载”。違反上述聲明者,本網將追究其相關(guan) 責任。
② 凡本網注明其他來源的作品及圖片,均轉載自其它媒體(ti) ,轉載目的在於(yu) 傳(chuan) 遞更多信息,並不代表本媒讚同其觀點和對其真實性負責,版權歸原作者所有,如有侵權請聯係我們(men) 刪除。
③ 任何單位或個(ge) 人認為(wei) 本網內(nei) 容可能涉嫌侵犯其合法權益,請及時向本網提出書(shu) 麵權利通知,並提供身份證明、權屬證明、具體(ti) 鏈接(URL)及詳細侵權情況證明。本網在收到上述法律文件後,將會(hui) 依法盡快移除相關(guan) 涉嫌侵權的內(nei) 容。

網友點評
0相關評論
精彩導讀