
您的位置:首頁 > 技術(shù)文獻 > 技術(shù)交流 > 基于CAN總線伺服控制系統(tǒng)的設計及控制方法
系統(tǒng)的主要功能是采集電機運動的實時信息,并根據(jù)所得信息發(fā)送控制命令來控制電機運動.
上位機(PC機或工控機)通過CAN接口適配卡與各節(jié)點通信,規(guī)劃步態(tài)、啟停電機,應用閉環(huán)控制算法計算并發(fā)送控制信號,完成總體決策與控制;智能控制節(jié)點接收上位機發(fā)送的控制信號,將其轉(zhuǎn)換成模擬信號驅(qū)動速度單元,實現(xiàn)對速度單元的控制;智能傳感器節(jié)點以定時中斷的方式周期性編碼粗、精自整角機傳送的信號,得到負載的軸角信號并通過CAN總線發(fā)送給上位機用于控制決策.這樣就組成了一個基于CAN總線的分布式運動控制系統(tǒng).
智能節(jié)點中,作為微處理器的單片機負責CAN控制器的初始化,通過控制CAN控制器實現(xiàn)數(shù)據(jù)的接收和發(fā)送等通信任務;CAN總線驅(qū)動器提供了CAN控制器與物理總線之間的接口,提供對總線的發(fā)送和接收功能;D/A轉(zhuǎn)換器和自整角機-數(shù)字轉(zhuǎn)換器及其外圍電路分別構(gòu)成了控制系統(tǒng)的模擬量輸出通道和模擬量輸入通道.
采用在PC總線中插入CAN通信適配卡,由單片機、CAN通信電路、信號檢測、A/D、D/A及它們的接口電路等構(gòu)成智能控制器節(jié)點和智能傳感器節(jié)點,各部分通過CAN總線連接在一起構(gòu)成實驗系統(tǒng).這樣,一方面可實現(xiàn)系統(tǒng)各功能的模塊化分離和設計,另一方面有助于網(wǎng)絡系統(tǒng)的組建.
選用工業(yè)PC機作為主控機,完成規(guī)劃步態(tài)、啟停電機、實現(xiàn)閉環(huán)控制算法等.采用80C196作為智能節(jié)點的微處理器,智能控制節(jié)點通過CAN總線接收上位機傳送的控制信號,由DACl210完成D/A轉(zhuǎn)換,實現(xiàn)對電機的驅(qū)動;智能傳感器節(jié)點通過電子斯科特變壓器以及RDC完成A/D轉(zhuǎn)換,得到軸角信號并通過CAN總線傳送給上位機.至此,基于CAN總線的電機位置閉環(huán)運動控制系統(tǒng)搭建完成.
2.1 問題描述
傳統(tǒng)的控制系統(tǒng)為點對點控制,傳感器采集到的數(shù)據(jù)直接反饋到控制器,控制器將計算得到的控制量直接輸出到D/A,得到的電壓控制信號立即作用于被控對象完成閉環(huán)控制.系統(tǒng)中的延時主要來自于控制算法的計算時間和硬件電路的延遲時間在將CAN總線引入閉環(huán)控制系統(tǒng)之后,系統(tǒng)結(jié)構(gòu)的改變帶來了控制行為的巨大差異,傳感器節(jié)點采集到的數(shù)據(jù)通過總線傳遞到控制器節(jié)點,反饋回路中的數(shù)據(jù)傳輸延時使得控制器無法實時獲得被控對象的狀態(tài)信息.同樣,控制器節(jié)點產(chǎn)生的控制信號必須通過總線傳遞到執(zhí)行器節(jié)點,傳輸延時的存在使得控制信號亦無法及時作用于被控對象.此種情況下,數(shù)據(jù)傳輸延時變?yōu)橛绊懴到y(tǒng)性能和破壞系統(tǒng)穩(wěn)定性的主要因素,因此,必須采取能夠有效補償傳輸延時的控制算法.
統(tǒng)進行控制,從而有效地克服了純滯后的影響.
在本系統(tǒng)中,CAN總線的波特率和傳輸數(shù)據(jù)的字節(jié)數(shù)為固定值,在不考慮算法計算時間和硬件電路延遲時間的情況下,系統(tǒng)中的延時可以近似地用純滯后來模擬.由于通過Smith預估器的補償,可以近似地認為廣義被控對象中已不含有時滯部分.控制器采用大誤差、中誤差、小偏差三段控制算法,其中,大誤差時數(shù)字控制器輸出飽和值(即D/A飽和輸出),這樣伺服系統(tǒng)的速度環(huán)將以最大加速度啟動直到最大速度,并以這個速度恒速運動;到達中等誤差以后,控制器按最大減速度規(guī)律ω=(2еε)1/2給出,引導伺服系統(tǒng)以最大減速度制動,平穩(wěn)地到達協(xié)調(diào)點.式中:ε為減加速度;e為誤差.小偏差時控制算法采用加前饋及積分分離的PID位置算法實現(xiàn)對被控對象的位置閉環(huán)控制.
由于Smith預估控制器是基于被控對象精確數(shù)學模型之上的,所以需要對被控對象的數(shù)學模型進行精確辨識.
圖中:減速器的減速比i=69.47;k,kl,k2為待辨識參數(shù).將上述被控對象的連續(xù)狀態(tài)方程給出,以采樣周期Ts=5 ms離散化,再利用最小二乘法辨識,最終可得k=69 354,k1=35.10,k2=4 254.10,則被控對象的傳遞函數(shù)為998.33/(s3+35.1 s2+4 254.1s).
圖4~圖6中縱坐標單位為“碼”,(1碼=360°/65 536).圖4中階躍輸入給定值為16.5°,直接采用三段控制算法時系統(tǒng)動態(tài)過程中產(chǎn)生超調(diào)并有明顯震蕩過程.在采用Smith預估算法以后,系統(tǒng)的穩(wěn)定性增強,動態(tài)過程無超調(diào),階躍響應的動態(tài)性能明顯改善,穩(wěn)態(tài)誤差的絕對值小于1mrad,滿足精度要求.圖5為等速跟蹤情況.角速度給定值為30°/s,由于系統(tǒng)中數(shù)據(jù)傳輸延時的影響,系統(tǒng)跟蹤誤差較大,跟蹤精度降低.
采用Smith預估算法可顯著減小系統(tǒng)的跟蹤誤差,提高跟蹤精度,保證跟蹤過程的準確度和平穩(wěn)性.圖6給定測試信號最大角速度為30°/s,最大角加速度為30°/s2的正弦信號,未采用Smith預估算法時,受總線傳輸延時影響,系統(tǒng)誤差值和誤差變化幅度較大.Smith預估算法一定程度上有效地補償了延時影響,從而使得系統(tǒng)誤差顯著減小,電機運動過程中振動隨之減小,系統(tǒng)性能有了較大提高.
關鍵詞:
① 凡本網(wǎng)注明"來源:易推廣"的所有作品,版權(quán)均屬于易推廣,未經(jīng)本網(wǎng)授權(quán)不得轉(zhuǎn)載、摘編或利用其它方式使用。已獲本網(wǎng)授權(quán)的作品,應在授權(quán)范圍內(nèi)
使用,并注明"來源:易推廣"。違者本網(wǎng)將追究相關法律責任。② 本信息由注冊會員:佛山市賀迪傳感儀器有限公司 發(fā)布并且負責版權(quán)等法律責任。
易推廣客服微信