精密運動(dòng)控制器LM628的應用設計(圖)
關(guān)鍵詞:精密運動(dòng)控制器 pid lm628
引言
神經(jīng)網(wǎng)絡(luò )技術(shù)是自動(dòng)控制方法發(fā)展的重要方向之一,目前已廣泛地應用于過(guò)程控制、機器人控制、生產(chǎn)制造、模式識別等領(lǐng)域。由于神經(jīng)網(wǎng)絡(luò )理論的計算量較大,對硬件的要求較高,神經(jīng)網(wǎng)絡(luò )理論系統一般十分昂貴。近年來(lái)隨著(zhù)集成電路飛速發(fā)展,基于神經(jīng)網(wǎng)絡(luò )理論的控制系統可以用微處理器和專(zhuān)用的大規模集成電路來(lái)實(shí)現。這樣就大大降低了系統的成本。大規模集成芯片lm628是美國國家半導體公司生產(chǎn)的專(zhuān)用精密運動(dòng)控制器,具有16位的可編程數字pid調節器,可經(jīng)增量碼盤(pán)反饋構成位置閉環(huán),并能對位置誤差實(shí)行pid運算。利用lm628和微處理器可實(shí)現低成本、高精度神經(jīng)元pid伺服系統。
lm628主要特點(diǎn)如下:32bit位置、速度、加速度寄存器;16bit的可編程數字化pid調節器;可編程微分采樣周期;8bit或12bit dac輸出;8bit pwm輸出;內部梯形速度特性產(chǎn)生器;在運動(dòng)期間速度、目標位置和濾波器參數可以改變;具有位置和速度兩種操作模式;實(shí)時(shí)可編程的中斷;8bit異步并行接口;用于積分增量編碼器標準脈沖輸入接口。
表1 lm628引腳說(shuō)明
引腳號 | 引腳名稱(chēng) | 功能 |
1 | index(in) | 積分增量編碼器標準脈沖輸入選擇端,如該引腳不用必須保持為高 |
2 | a | 編碼器信號輸入 |
3 | b | 編碼器信號輸入 |
4~11 | d7~d0 | 用于與微處理器接口的雙向數據總線(xiàn). |
12 | cs | 片選端,低有效 |
13 | rd | 讀許,低有效 |
14 | gnd | 電源地 |
15 | wr | 寫(xiě)許,低有效 |
16 | ps | 端口選擇,低為命令狀態(tài),高為數據狀態(tài) |
17 | hi | 中斷輸出 |
18~25 | dac7~dac0 | 輸出端口 |
26 | clk | 系統時(shí)鐘 |
27 | rst | 復位端,低有效 |
28 | vdd | 電源 |
內部結構及工作機理 lm628為28腳雙列直插封裝形式,引腳功能如表1所示,圖1所示為其內部功能框圖。
lm628通過(guò)8bit并行i/o口與微處理器進(jìn)行數據交換,微處理器可以以命令的形式對lm628的梯形速度特性和pid數字濾波器進(jìn)行參數設定。用于檢測電機旋轉位置的增量編碼器的輸出信號通過(guò)編碼器輸入接口送入lm628,在lm628中與設定的位置信號相減,形成位置誤差信號,該信號送入pid數字濾波器進(jìn)行處理后形成控制信號,通過(guò)8bitdac并行接口以數字化的形式輸出,然后就可以通過(guò)數模轉換器和功率放大電路驅動(dòng)伺服電機完成精密的運動(dòng)。
微處理器通過(guò)命令的方式對lm628進(jìn)行控制和參數設定和讀取,在這些命令中,一般可分為兩大類(lèi),一類(lèi)只有命令代碼,而另一類(lèi)在命令代碼后還要加上相應的數據代碼(例如:設定的參數值)。lm628的命令集如表2所示。
lm628主要參數為:最高工作電壓7v;最大功耗為605mw;工作溫度范圍是-40℃~+85℃;電源電壓為:4.5~5.5v;存儲溫度范圍為-60℃~+150℃。
表2 lm628命令集
命令 | 類(lèi)型 | 說(shuō)明 | 對應的16進(jìn)制數 | 數據字節數 |
reset | 初始化 | 復位lm628 | 00 | 0 |
port8 | 初始化 | 選擇8bit輸出 | 05 | 0 |
dfh | 初始化 | 定義原始位置 | 02 | 0 |
sip | 中斷 | 設定標志位置 | 03 | 0 |
lpei | 中斷 | 錯誤時(shí)中斷 | 1b | 2 |
lpes | 中斷 | 錯誤時(shí)停止 | 1a | 2 |
sbpa | 中斷 | 設置絕對斷電 | 20 | 4 |
sbpa | 中斷 | 設置相對斷電 | 21 | 4 |
mski | 中斷 | 屏蔽中斷 | 1c | 2 |
rsti | 中斷 | 復位中斷 | 1d | 2 |
lfil | 濾波器 | 裝載軌跡線(xiàn) | 1f | 2~10 |
udf | 濾波器 | 更新濾波器 | 04 | 0 |
ltrj | 軌跡 | 裝載軌跡線(xiàn) | 1f | 2~14 |
stt | 軌跡 | 開(kāi)始運動(dòng) | 01 | 0 |
rdstat | 報告 | 讀狀態(tài)字節 | 無(wú) | 1 |
rdsigs | 報告 | 讀信號寄存器 | 0c | 2 |
rdip | 報告 | 讀標志位置 | 09 | 4 |
rddp | 報告 | 讀期望位置 | 08 | 4 |
rdrp | 報告 | 讀實(shí)時(shí)位置 | 0a | 4 |
rddv | 報告 | 讀期望速度 | 07 | 4 |
rdrv | 報告 | 讀實(shí)時(shí)速度 | 0b | 2 |
rdsum | 報告 | 讀積分和 | 0d | 2 |
lm628在神經(jīng)元pid伺服系統中的應用
以89c52單片機為核心的伺服系統如圖2所示,在該系統中89c52實(shí)現用戶(hù)的接口,如顯示、鍵盤(pán)等,并完成神經(jīng)元的學(xué)習算法及在線(xiàn)調整lm628的參數。lm628作為伺服控制調節器,接收89c52單片機傳送的控制指令及位置、速度、加速度三個(gè)運動(dòng)參數和數字濾波器的參數kp,ki,kd,n(微分采樣周期),同時(shí)lm628對碼盤(pán)輸出的信號進(jìn)行處理,獲得位置信號,經(jīng)數字pid運算后,由dac端口以8bit方式輸出,經(jīng)數模轉換器dac0800轉換為模擬信號,再經(jīng)lm12cl組成的放大電路輸出,用于驅動(dòng)電動(dòng)機完成精密的運動(dòng)。lm628的輸出與誤差的關(guān)系式如下式所示。
上式中,u(n)為第n個(gè)采樣周期的控制輸出;e(n)為第n個(gè)采樣周期的位置誤差;n為正常采樣周期;n為微分采樣周期;kp為比例增益;ki為積分比例增益;kd為微分比例增益。
比例增益kp提供了一個(gè)與位置誤差成正比的輸出,積分比例增益ki提供了隨時(shí)間增長(cháng)的輸出,因此保證了靜態(tài)位置誤差為0。微分比例增益kd提供了與位置變化率成正比的輸出,起到了超前控制的作用,減小了系統的超調,保證了系統的動(dòng)態(tài)特性良好。式(1)與神經(jīng)元pid算法的表達形式一致,因此在lm628中實(shí)現了神經(jīng)元的狀態(tài)量變換,狀態(tài)量加權求和的功能,也就是實(shí)現了神經(jīng)元pid伺服系統。
結束語(yǔ)
本文設計的基于lm628神經(jīng)元pid伺服系統具有性能穩定可靠,成本低廉等一系列優(yōu)點(diǎn)。系統的動(dòng)態(tài)性能好,啟動(dòng)速度快,超調良好,具有較高的實(shí)用價(jià)值。
1. lm628 data sheet,1995
2. 陳粵初等,單片機應用系統設計與實(shí)踐,北京航空航天大學(xué)出版社,1992
3. 王修才、劉祖望,單片機接口技術(shù),復旦大學(xué)出版社,1995
評論