基于DSP仿人機器人關(guān)節控制器設計

發(fā)布時(shí)間:2010-11-29 19:12    發(fā)布者:conniede
關(guān)鍵詞: 485 , dsp , 機器人 , 驅動(dòng)器
1 引 言

仿人機器人具有可移動(dòng)性,具有很多的自由度,包括雙臂、頸部、腰部、雙腿等,可以完成更復雜的任務(wù),這些關(guān)節要連接在一起,進(jìn)行統一的協(xié)調控制,就對控制系統的可靠性、實(shí)時(shí)性提出了更高的要求,以往采用的集中控制系統,控制功能高度集中。局部的故障就可能造成系統的整體失效,降低了系統的可靠性和穩定性,因此考慮采用分布式的控制系統來(lái)實(shí)現系統的控制功能。

考慮到機械臂控制系統控制算法的計算量以及多軸協(xié)調控制等問(wèn)題,采用基于RS 485總線(xiàn)的分布式控制的體系結構,見(jiàn)圖1所示。運動(dòng)規劃算法由主計算機來(lái)實(shí)現,同時(shí)主計算機還將通過(guò)RS 485總線(xiàn)與各關(guān)節控制器通信,負責各關(guān)節控制器的協(xié)調工作。每個(gè)關(guān)節控制器和一臺電機、驅動(dòng)器、檢測反饋裝置等構成一個(gè)位置伺服系統,負責機械臂某一個(gè)關(guān)節變量的具體控制任務(wù)。


2 仿人機器人分布式控制器的硬件設計

2.1 關(guān)節控制器硬件電路設計

該設計選用TI公司的2000系列DSPTMS320F240作為控制單元。其時(shí)鐘頻率可達20 MHz,具有高速的處理能力,片內資源豐富,特別是它特有的內置事件管理器模塊,使其在電機控制領(lǐng)域具有非常廣泛的應用。該芯片本身尺寸很小,需要外擴的資源不多,節省了電路板的空間。關(guān)節控制器硬件電路原理圖框圖如圖2所示。


2.2 電機驅動(dòng)器的接口電路

驅動(dòng)器的控制模式可以分為兩種:速度控制模式和位置控制模式(通常用電位器作為電機的位置傳感器)。這里采用它的速度控制模式,輸入的指令信號是0~10 V的模擬量。因此需要用D/A轉換電路,把DSP輸出的數字量給定轉變?yōu)槟M信號,電路圖如圖3所示。DAC7621為12 b并行輸入的D/A轉換器,它內置參考源,輸出范圍:0~4.095 V。它的12位輸入接DSP數據總線(xiàn)中的D0到D11。它的片選輸入管腳可以接DSP的I/O控制線(xiàn)/IS。為了得到0~10 V的模擬信號,還要利用LM358中的一片運算放大器構成的同相比例放大電路,把0~4.095 V的信號放大2.5倍。


如果驅動(dòng)和控制器不進(jìn)行隔離,尖峰將破壞控制器電路中的器件,例如RAM。因此,設計了基于線(xiàn)形光耦HCNR201的隔離電路,如圖4所示。


線(xiàn)形光耦HCNR201只能起到隔離電流的關(guān)系,且輸入電流和輸出電流呈線(xiàn)性關(guān)系。U6B是圖3芯片LM358中的另外一片運算放大器,它將輸入0~10 V電壓轉換成20 mA以?xún)鹊碾娏餍盘,輸入線(xiàn)形光耦HC-NR201。HCNR201輸出電流再經(jīng)過(guò)一個(gè)由單電源軌到軌運放AD8519構成的電壓跟隨器轉換成0~10 V電壓信號,作為驅動(dòng)器的模擬信號輸入。顯然,HCNR201兩側電路應采用不同的電源和地。LM358中的兩片運算放大器采用控制器輸入的12 V電源供電,而AD8519則采用驅動(dòng)器輸入端提供的10 V電壓供電。

2.3 增量式編碼器信號處理電路

增量式編碼器信號處理電路如圖5所示。J8是MR編碼器的信號輸入接口,采用AM26C32把MR編碼器輸出三個(gè)通道的RS 422差分信號轉換成TTL電平,得到A,B,Z三路信號。


2.4 RS 485總線(xiàn)通信電路

RS 485總線(xiàn)是一種通信總線(xiàn),TMS320F240 DSP芯片本身不具備RS 485總線(xiàn)接口,采用兩個(gè)485通信芯片MAX485可以的把TMS320F240的串口RXD和TXD的TTL電平轉換為RS 485電平,TMS320F240DSP的RXD和TXD引腳分別連接到第一片485通信芯片RO和第2片485通信芯片DI的引腳。TMS320F240 DSP 的SPISIMO和SPISOMI連接到MAX485的使能引腳RE,用于控制TMS320F240 DSP芯片的數據發(fā)送口掛接到總線(xiàn)上或和總線(xiàn)分離,電路如圖6所示。


3 仿人機器人控制器的軟件設計

3.1 關(guān)節控制器主程序

主程序的流程見(jiàn)圖7。


寄存器初始化操作主要包括:設置CPU CLK為外部晶振的2倍頻,即16 MHz;設置串口通信波特率為:38.4 Kb/s;設置定時(shí)器/計數器相關(guān)寄存器;設置QEP電路單元相關(guān)寄存器;設置中斷控制寄存器等。

3.2 串口數據接收中斷服務(wù)程序

串口數據接收中斷服務(wù)程序流程圖見(jiàn)圖8。在中斷服務(wù)程序中,讀取數據接收寄存器中的數據,存入數據接收區,而并不做任何進(jìn)一步分析和處理。數據接收區是內存中暫時(shí)存放數據的區域,當存滿(mǎn)一條完整指令信息后,由主程序分析和處理。


3.3 控制周期定時(shí)中斷服務(wù)服務(wù)程序

控制周期2 ms定時(shí)中斷服務(wù)程序的流程見(jiàn)圖9。定時(shí)器/計數器為位置環(huán)和速度環(huán)控制周期定時(shí)2 ms,每2 ms進(jìn)入定時(shí)中斷服務(wù)程序1次,讀取位置反饋值和速度反饋值,進(jìn)行積分分離PID運算,最后輸出給D/A轉換成模擬量。


每一個(gè)插補周期(50 ms),主計算機向關(guān)節控制器發(fā)送1次運動(dòng)規劃后的目標位置。該目標位置是以增量編碼器信號四倍頻后的脈沖數為單位,以前一次的目標位置作為脈沖計數的零點(diǎn)。因此,關(guān)節控制器在讀取新的目標位置后,也應該以前一次的目標位置作為新的增量碼盤(pán)脈沖計數零點(diǎn),測量實(shí)際的電機位置,與新的目標位置比較、運算。主計算機根據需要可以查詢(xún)當前電機運行的實(shí)際位置,關(guān)節控制器返回的位置則是關(guān)節角的絕對位置,單位是0.1°。

4 結 語(yǔ)

仿人機器人機械臂分布式關(guān)節控制器研究與設計,對于提高仿人機器人總體性能與人機交互能力,具有重要科研價(jià)值與現實(shí)意義。機械臂分布式控制器的高度實(shí)時(shí)性、容錯性、可靠性、擴充性,為仿人機器人系統提供了先進(jìn)的網(wǎng)絡(luò )體系結構與通信標準,實(shí)踐表明應用前景極為廣闊。
本文地址:http://selenalain.com/thread-42956-1-1.html     【打印本頁(yè)】

本站部分文章為轉載或網(wǎng)友發(fā)布,目的在于傳遞和分享信息,并不代表本網(wǎng)贊同其觀(guān)點(diǎn)和對其真實(shí)性負責;文章版權歸原作者及原出處所有,如涉及作品內容、版權和其它問(wèn)題,我們將根據著(zhù)作權人的要求,第一時(shí)間更正或刪除。
您需要登錄后才可以發(fā)表評論 登錄 | 立即注冊

相關(guān)視頻

關(guān)于我們  -  服務(wù)條款  -  使用指南  -  站點(diǎn)地圖  -  友情鏈接  -  聯(lián)系我們
電子工程網(wǎng) © 版權所有   京ICP備16069177號 | 京公網(wǎng)安備11010502021702
快速回復 返回頂部 返回列表
午夜高清国产拍精品福利|亚洲色精品88色婷婷七月丁香|91久久精品无码一区|99久久国语露脸精品|动漫卡通亚洲综合专区48页