【正文】 ....................15 本章小結(jié) ...................................................................................................15 第 3 章 DSP 伺服控制器總體結(jié)構(gòu) ..................................................................17 伺服控制器的總體結(jié)構(gòu) ....................................................................17 處理器模塊電路設(shè)計 ........................................................................18 芯片 TMS320F206 簡介 ................................................................18 處理器電路 .....................................................................................18 看門狗電路 ............................................................................................21 輸出控制模塊電路設(shè)計 ...........................................................................22 采樣控制模塊電 路設(shè)計 ...........................................................................24 伺服控制器的實物圖 ...............................................................................25 本章小結(jié) ...................................................................................................27 第 4 章 基于 DSP 的數(shù)字伺服系統(tǒng)軟件的實現(xiàn) ...............................................27 系統(tǒng)軟件的總體結(jié)構(gòu) ...............................................................................27 基于 DSP 的數(shù)字伺服系統(tǒng)的主程序 ......................................................27 基于 DSP 的數(shù)字伺服系統(tǒng)的中斷服務(wù)程序 ..........................................30 基于 DSP 的數(shù)字伺服系統(tǒng)的子程序 ......................................................30 獲取指令子程序 ....................................................................................30 采樣實際架位子 ....................................................................................30 哈爾濱理工大學(xué)遠(yuǎn)東學(xué)院學(xué)士學(xué)位論文 VI 本章小結(jié) ...................................................................................................33 第 5 章 系統(tǒng)控制算法設(shè)計 ...............................................................................33 常規(guī) PID 控制算法 ...................................................................................33 復(fù)合控制 ...................................................................................................35 PID 的控制算法 ...............................................................................38 控制算法流程 ...........................................................................................42 控制算法仿真 ...........................................................................................43 本章小結(jié) ...................................................................................................45 第 6 章 系統(tǒng)的調(diào)試及結(jié)果分析 .......................................................................45 數(shù)字伺服系統(tǒng)監(jiān)控測試儀 .......................................................................45. 跟蹤等速信號 ...........................................................................................46. 實驗結(jié)果 ...................................................................................................53 結(jié)束語 .................................................................................................................54 致謝 .....................................................................................................................55 參考文謝 .............................................................................................................56 附錄 .....................................................................................................................59 千萬不要刪除行尾的分節(jié)符，此行不會被打印。 哈爾濱理工大學(xué)遠(yuǎn)東學(xué)院學(xué)士學(xué)位論文 II 哈爾濱理工大學(xué)遠(yuǎn)東學(xué)院學(xué)士學(xué)位論文 III DSPbased digital servo system and control algorithm development research Abstract 錯誤 !未找到引用源。信號采集和發(fā) 送包括與計算機之間的信息交換，以及實際架位信號的采集 。 摘要 隨著各種高新技術(shù)應(yīng)用到巡航導(dǎo)彈、隱形飛機、激光武器、無人駕駛偵察機、雷達(dá)，其目標(biāo)識別能力、隱蔽程度、攻擊能力、 .目標(biāo)命中精度均大大提高，對防空體系中的伺服系統(tǒng)提出了更高、更新的要求。最后從控制系統(tǒng)出發(fā)，設(shè)計了 DSP 伺服控制器的總體結(jié)構(gòu)，并圍繞主控芯片 TMS320FZO6 詳細(xì)介紹了伺服控制器、采樣控制電路、輸出控制電路及外圍接口電路的具體設(shè)計。本文所設(shè)計的數(shù)字伺服系統(tǒng)在跟蹤各種典型信號時取得了令人滿意的控 制效果，系統(tǒng)運行穩(wěn)定，滿足技術(shù)指標(biāo)要求。DSP。如 :俄羅斯亞速海光學(xué)機械制造廠和諾德爾曼國家精密機械設(shè)計局聯(lián)合研制推出的“斑蛙蛇”防空導(dǎo)彈系統(tǒng)，性能指標(biāo)己臻國際一流 。 本論文主要工作 本文的主要工作如下 :. 第 1 章 ： 引言主要給出了工程背景，介紹了課題的來源和本文的主要研究內(nèi)容 ； 第 2 章 ： 基于 DSP 的數(shù)字伺服系統(tǒng)總體設(shè)計。 哈爾濱理工大學(xué)遠(yuǎn)東學(xué)院學(xué)士學(xué)位論文 9 第 2章 基于 DSP 數(shù)字伺服系統(tǒng)總體設(shè)計 錯誤 !未找到引用源。本項目的設(shè)計思想 :數(shù)字伺服系統(tǒng)測試儀根據(jù)監(jiān)控測試軟件的角度指令信號和測角傳感系統(tǒng) (旋轉(zhuǎn)變壓器與軸角編碼器 )檢測到的位置反饋信號 (當(dāng)前角度信號 )之間的誤差角，以一定 的控制算法計算得出控制量，輸出相應(yīng)的電壓模擬控制信號給電機驅(qū)動器驅(qū)動電機，帶動負(fù)載運動。 d)、輸出控制模塊 :該模塊采用美國 AD 公司的 AD767 芯片，它是 12位的數(shù)字量轉(zhuǎn)換模擬量模塊，具有片內(nèi)放大輸出，高穩(wěn)定性的參考大壓，高速寫入周期。 SERVOSTARCD 系列為高性能的數(shù)字伺服電機驅(qū)動器，支持電流、速度或位置模式，可提供眾多的控制選項，從典型的 10VDC 指令，到編碼跟隨以及脈沖和方向，一直到 SynqNet 和 SERC0s控制。但是位置環(huán)所產(chǎn)生的控制量也必須要通過速度環(huán)和電流環(huán)才能作用于電機，因此速度環(huán)和電流環(huán)是位置環(huán)的基礎(chǔ)，對它們的參數(shù)進行合理設(shè)置將對系統(tǒng)性能有重要的影響 [10]。圖 和圖 是 Kv 取不同值時，利用 MO 叨 [ONLINK 軟件對電機的轉(zhuǎn)速進行控制的結(jié)果，指令要求電機以 20(刃 RP]班的速度轉(zhuǎn)動 5s 后停下，所有測試均是在電機帶負(fù)載的情況下完成的。本節(jié)討論選用絕對位置量測部件 — 雙通道旋轉(zhuǎn)變壓器檢測角度，用軸角編碼器進行軸角編碼，將系統(tǒng)輸出軸的位置轉(zhuǎn)換成 16 位二進制碼送給數(shù)字伺服系統(tǒng)測試儀，以實現(xiàn)位置反饋。并采用二階伺服回路，輸出具有三態(tài)鎖存功能，輸出與 TTL 兼容的并行自然二進制編碼，用于角度位移量的測量。和數(shù)字伺服系統(tǒng)測試儀進行通訊 。 DSP芯片 TMS320F206 簡介 TMS320 凡 06 芯片作為 DSP 控制器， CZxx 系列中惟一具有片內(nèi)FLASH 存儲器的 DSP，也是 TMS320 系列數(shù)字信號處理器中的一種定點DSP 芯片。這樣可以減少伺服控制器在正常工作時，因為機械振動引起的不穩(wěn)定因素。燒寫完成后，關(guān)閉伺服控制器電源，拔下跳線帽，再次開啟電源時， FZO6 就會自動運行 FLASH 中的程序了。例如設(shè)定，則溢出時間為 : 。只要凡 06 在 5874us 內(nèi)給出一個脈沖信號，看門狗就不會向FZO6 發(fā)出復(fù)位信號。將跳線帽接通后，看門狗不再起作用，程序可以單步調(diào)試。伺服控制器中的 D/A 芯片 AD767 按照圖 所示接線，就可以得到雙極性的輸出， .輸出電壓范圍 :一 10V 到+1OV。 采樣控制模塊的設(shè)計 采樣信號是關(guān)系到系統(tǒng)誤差精度的一個重要信號，采樣位置信號選用的是中船的 1ZXSZ，是一種超小型化、采用跟蹤轉(zhuǎn)換技術(shù)的 12 位自整角枷旋轉(zhuǎn)變壓器 — .數(shù)字轉(zhuǎn)換器。CLK 是數(shù)據(jù)鎖存信號，上升沿時鎖存數(shù)據(jù)。轉(zhuǎn)換完成后， BUSY 引腳變成低電平。 d)采集控制模塊 :采用兩片軸角編碼芯片 12XSZ，得到角位置值，分辨率為 12 位。就本系統(tǒng)來說，雖然采用數(shù)模混合式微機控制系統(tǒng)，電流控制環(huán)節(jié)由模擬電路實現(xiàn)，以實現(xiàn)電流快速控制。在 F206 片內(nèi)程序的開始，將這兩個信號置為 00，表明伺服控制器已經(jīng)啟動，并將進入初始化階段。在哈爾濱理工大學(xué)遠(yuǎn)東學(xué)院學(xué)士學(xué)位論文 31 本系統(tǒng)中， DSP 外部晶振頻率為 1OMHz，經(jīng)過跳線選擇倍頻后為40MHz ， 哈爾濱理工大學(xué)遠(yuǎn)東學(xué)院學(xué)士學(xué)位論文 32 因此設(shè)定珊 DR 為 9， PRD 為 9999，代入 nNT 速率計算公式有 : 哈爾濱理工大學(xué)遠(yuǎn)東學(xué)院學(xué)士學(xué)位論文 33 設(shè)置好定時時間后，需要將定時中斷打開，否則凡 06 不會響應(yīng)定時中斷處理程序。 基于 DSP 數(shù)字伺服系統(tǒng)的子程序 獲取指令子程序 數(shù)字伺服系統(tǒng)測試儀和伺服控制器之間通過并行口來交換信息。讀取實際架位信號時的濾波流程如圖 所示 :采取的濾波方法是，通過讀取兩次值，來判斷這兩次值是否相等。 第 5 章 系統(tǒng)控制算法設(shè)計