摘 要：運動控制系統(tǒng)的核心控制對象是軸。采用面向?qū)ο蠓椒?，建立軸對象的類結(jié)構(gòu)、狀態(tài)轉(zhuǎn)移圖和數(shù)據(jù)流圖，在該模型的基礎(chǔ)上，可以進行軸控制參數(shù)的設(shè)置，運動控制庫函數(shù)的規(guī)劃和控制算法與控制方案的擬定。

關(guān)鍵詞：運動控制 軸 建模

0.引言

　　軸是運動控制系統(tǒng)的核心控制對象。在應(yīng)用系統(tǒng)中，軸的種類很多，如數(shù)控機床的坐標軸、主軸，繞線機的張力控制軸等，它們都是運動控制的對象。運動控制系統(tǒng)向著開放式、可重構(gòu)和網(wǎng)絡(luò)化方向發(fā)展，控制系統(tǒng)與控制對象的標準化是實現(xiàn)上述發(fā)展的關(guān)鍵。

　　面向?qū)ο蠼＜夹g(shù)已經(jīng)是一種成熟的建模技術(shù)。采用面向?qū)ο蠹夹g(shù)對軸的結(jié)構(gòu)、行為和功能進行抽象，全面地描述軸的屬性與操作，可以為軸控制對象的標準化奠定基礎(chǔ)。 　　

　　劉泉斌，陳虎等人總結(jié)了各種受控軸的共性屬性，采用Rational Rose建立了軸的面向?qū)ο竽Ｐ?，并實現(xiàn)了該運動控制系統(tǒng)[1];作者也對自動機床的UML建模方法進行過研究，對機床控制軸進行了類似的建模[2]。國際組織PLCopen的技術(shù)委員在IEC61131標準的框架下，對軸的行為模型作了細致的描述[3]。這些工作對運動控制系統(tǒng)的開放性與控制程序的可重用性都有積極的意義。但現(xiàn)行的研究工作多集中在軸的類結(jié)構(gòu)與行為模型上，軸的功能模型少有研究，模型不夠完整;并且這類研究工作多針對于面向?qū)ο蟮某绦蛟O(shè)計，其類結(jié)構(gòu)設(shè)計往往過于復雜，面MCU和DSP硬件平臺上的運動控制系統(tǒng)，目前還不支持C++。本文軸對象建模目的是為軸控制系統(tǒng)參數(shù)設(shè)置、運動控制庫函數(shù)規(guī)劃和控制方案設(shè)計服務(wù)。

　　面向?qū)ο竽Ｐ椭饕惤Y(jié)構(gòu)模型、行為模型和功能模型[4]，類結(jié)構(gòu)模型主要描述對象的屬性與操作，定義對象實例間的關(guān)聯(lián)關(guān)系，便于控制程序的可重用;行為模型描述狀態(tài)與狀態(tài)轉(zhuǎn)移，即輸入與響應(yīng)的關(guān)系和對象間作用，便于控制程序的標準化;功能模型主要描述系統(tǒng)的輸入數(shù)據(jù)及數(shù)據(jù)轉(zhuǎn)化形式，它是控制算法方案設(shè)計與調(diào)度的基礎(chǔ)。

1. 軸的類結(jié)構(gòu)模型

　　運動控制系統(tǒng)中，軸的屬性最為復雜，文獻[1]將軸的類對象定義成復雜的繼承結(jié)構(gòu)，盡管它符合面向?qū)ο笤O(shè)計方法，但它的狀態(tài)切換要占用系統(tǒng)時間（實驗測試時延為采樣周期的0.2%，最壞5%），而運動控制系統(tǒng)是一個強實時系統(tǒng)，狀態(tài)切換頻繁發(fā)生。關(guān)鍵是多數(shù)的運動控制平臺采用MCU和DSP，尚沒有C++支持，這種面向?qū)ο竽Ｐ蛯CU和DSP型的運動控制系統(tǒng)沒有實用意義。本文提出的軸控制類采用簡明的結(jié)構(gòu)定義軸類的屬性與操作，重點在于類的屬性參數(shù)設(shè)置與分析。

　　歸納起來，軸共有五類屬性，40多個參數(shù)。限于篇幅的原因，只列出軸類屬性參數(shù)分類如表1所示： 　　表1 軸屬性參數(shù)分類表

　　軸的操作是運動控制的核心，運動控制系統(tǒng)的庫函數(shù)主要由軸操作函數(shù)構(gòu)成，這些操作函數(shù)由軸的狀態(tài)轉(zhuǎn)移圖中抽?。ê笪臄⑹觯?，在類結(jié)構(gòu)中它們表現(xiàn)為對軸屬性參數(shù)的修改與刷新。軸的操作可為分四類，共16個函數(shù)，其類別如表2所示：

　　表2 軸操作函數(shù)

　　在運動控制系統(tǒng)中，除軸類外，還有邏輯控制器、傳感器等類，由這些類可以構(gòu)成最終的控制對象操作器類，其類關(guān)聯(lián)如圖1所示：

[align=center]

圖1 軸控制類和其它類的關(guān)聯(lián)關(guān)系[/align]

　　操作器可以由多個軸、傳感器和一個邏輯控制器實例組成，操作器控制實際成為軸和邏輯控制器的控制。 2. 軸的行為模型

　　PLCopen組織的技術(shù)委員會遵照開放式性原則，定義了8種軸的狀態(tài)，即不可用態(tài)、靜止態(tài)、停止過程態(tài)、出錯停止態(tài)、返回參考點態(tài)、連續(xù)運動態(tài)、同步運動態(tài)、離散運動態(tài)。其中連續(xù)運動態(tài)指速度和力矩控制模式，不涉及位置要求，離散運動態(tài)指有軌跡與位置要求的運動，如直線、圓弧運動;同步運動態(tài)指電子齒輪和電子凸輪運動模式。其狀態(tài)轉(zhuǎn)移如圖2所示

： [align=center]

圖2 軸控制狀態(tài)轉(zhuǎn)移圖[/align]

　　軸狀態(tài)轉(zhuǎn)移圖是規(guī)劃和評價運動控制函數(shù)的重要工具。例如，能否從連續(xù)運動態(tài)直接向離散運動態(tài)轉(zhuǎn)移，中間是否要插入一個停止過程態(tài)，這個控制函數(shù)的設(shè)立對其它軸狀態(tài)有何影響，都可以使用軸狀態(tài)轉(zhuǎn)移圖，從狀態(tài)轉(zhuǎn)移、激發(fā)事件、轉(zhuǎn)移條件和引發(fā)事件進行規(guī)劃和評價。

3. 軸功能模型

　　軸的功能模型主要是數(shù)據(jù)流圖。數(shù)據(jù)流圖由接口，數(shù)據(jù)加工和數(shù)據(jù)存貯三種元素組成，接口指明數(shù)據(jù)的來源和去向，加工指明數(shù)據(jù)的處理算法，數(shù)據(jù)存貯指明數(shù)據(jù)的存貯緩沖區(qū)。

　　運動控制系統(tǒng)的軸控制運算包括插補運算與伺服運算兩大部分，插補運算給出每一個采樣周期的目標位置，伺服運算實現(xiàn)軸對目標位置的跟蹤。實際執(zhí)行時，必須先進行運動控制命令的譯碼與預(yù)處理，對高精度的位置控制，還要在插補后進行陷波濾波，消除某些頻率成份，減少激振因素，如果將速度控制劃歸到插補運算過程中，則軸控制處理過程包括控制命令譯碼、插補計算、陷波濾波、跟蹤控制四部分內(nèi)容。其數(shù)據(jù)流圖如圖3所示：

[align=center]

圖3 軸控制的數(shù)據(jù)流圖[/align]

　　從軸控制的數(shù)據(jù)流圖可以看出，該數(shù)據(jù)流是串行的。在各個數(shù)據(jù)加工點，不同的控制策略會選用不同的加工算法，其中插補運算、陷波濾波和跟蹤運算會占用較多的系統(tǒng)資源且時延較長。在CPU資源配置或分配上，應(yīng)保證這幾個數(shù)據(jù)加工串行工作。

　　另外，其中數(shù)據(jù)存貯的安排涉及到系統(tǒng)性能的發(fā)揮和對應(yīng)的硬件結(jié)構(gòu)。比如NURBS插補和PID+速度前饋+加速度前饋控制算法中，由于NURBS插補費時較多，在TMS320F2812DSP上，PID+速度前饋+加速度前饋的時延約為NURBS插補時延的1/4[5]，采用雙DSP流水線處理模式，將這個串行過程改為并行過程，由一片DSP作NURBS插補運算，另一片DSP作PID控制，安排一片雙口RAM作數(shù)據(jù)緩沖，采樣周期大為縮短。 　　數(shù)據(jù)流圖中的數(shù)據(jù)形式較為簡單，如表4所示：

　　表4 軸控制數(shù)據(jù)流圖的數(shù)據(jù)格式

　　圖中所有的緩沖區(qū)均為先進先出隊列。

　　圖據(jù)流圖的數(shù)據(jù)加工過程如表5所示：

　　表5 數(shù)據(jù)加工過程

4.軸對象模型應(yīng)用

　　本模型主要應(yīng)用于基于MCU和DSP的運動控制系統(tǒng)設(shè)計。采用多參數(shù)、多操作的簡明對象類結(jié)構(gòu)，有利于控制對象的理解和控制參數(shù)設(shè)置;狀態(tài)轉(zhuǎn)移圖定義軸的狀態(tài)，及在什么條件下，由何事件激發(fā)使軸由一種狀態(tài)向另一種狀態(tài)轉(zhuǎn)移，分析歸納這些激發(fā)事件，是運動控制庫函數(shù)設(shè)計的依據(jù);軸控制過程可以視為一個數(shù)據(jù)轉(zhuǎn)換的過程，從控制命令輸入，到控制信號生成，數(shù)據(jù)流圖表達了數(shù)據(jù)的流向與加式，它是確定控制方案、設(shè)計控制算法的基礎(chǔ)。

5. 結(jié)論

　　軸控制是運動控制系統(tǒng)的核心，采用面向?qū)ο蠓椒ǎ⒑喢鞯妮S對象類結(jié)構(gòu)、狀態(tài)轉(zhuǎn)移圖，并引用了結(jié)構(gòu)化分析的數(shù)據(jù)流圖，為運動控制系統(tǒng)設(shè)計的控制參數(shù)設(shè)置，運動控制庫函數(shù)規(guī)劃和控制方案與控制算法的擬定提供了有益的參考。

　　本文作者創(chuàng)新點：采用面向?qū)ο竽Ｐ筒⒔Y(jié)合結(jié)構(gòu)化模型的數(shù)據(jù)流圖，建立了簡明的軸對象分析模型，為軸狀態(tài)表達、軸運動控制函數(shù)分析、函數(shù)操作實現(xiàn)提供了依據(jù)。

參考文獻

　　[1] 劉泉斌，陳虎等。開放式控制器軸運動控制對象模型。制造業(yè)自動化。2005.4（27）,75-78.

　　[2] 柳寧. 用于控制系統(tǒng)設(shè)計的自動機床分析與建模方法的研究. 組合機床與自動化加工技術(shù).2006.4.27-29 　　[3] PLCopen. Technical Specification PLCopen-Technical Committee 2 –Task Force Function blocks for motion control Version 1.1. http://www.PLCopen.org.

　　[4] 王建軍. UML建模：實例分析.微計算機信息.2002.15.66-68.

　　[5] Ning Liu, Gao Wang,et al. “Research on a Real-time Interpolator DSPs Based for NURBS”,in Proceeding of the 6th World Congress on Control and Automation.June 21-23,2006. Dalian.China.8206-8210.