在機器人學的研究領(lǐng)域中,如何有效地提高機器人控制系統(tǒng)的控制性能始終是研究學者十分關(guān)注的一個重要內(nèi)容。在分析了工業(yè)機器人的發(fā)展歷程和機器人控制系統(tǒng)的研究現(xiàn)狀后,本論文的主要目標是針對四關(guān)節(jié)實驗室機器人特有的機械結(jié)構(gòu)和數(shù)學模型,建立一個新型全數(shù)字的基于DSP和FPGA的機器人位置伺服控制系統(tǒng)的軟、硬件平臺,實現(xiàn)對四關(guān)節(jié)實驗室機器人的精確控制。 本論文從實際情況出發(fā),首先分析了所研究的四關(guān)節(jié)實驗室機器人的本體結(jié)構(gòu),并對其抽象簡化得到了它的運動學數(shù)學模型。在明確了實現(xiàn)機器人精確位置伺服控制的控制原理后,我們對機器人控制系統(tǒng)的諸多可行性方案進行了充分論證,并最終決定采用了三級CPU控制的控制體系結(jié)構(gòu):第一級CPU為上位計算機,它實現(xiàn)對機器人的系統(tǒng)管理、協(xié)調(diào)控制以及完成機器人實時軌跡規(guī)劃等控制算法的運算;第二級CPU為高性能的DSP處理器,它輔之以具有高速并行處理能力的FPGA芯片,實現(xiàn)了對機器人多個關(guān)節(jié)的高速并行驅(qū)動;第三級CPU為交流伺服驅(qū)動處理器,它實現(xiàn)了機器人關(guān)節(jié)伺服電機的精確三閉環(huán)誤差驅(qū)動控制,以及電機的故障診斷和自動保護等功能。此外,我們采用比普通UART速度快得多的USB來實現(xiàn)上位計算機.與下位控制器之間的數(shù)據(jù)通信,這樣既保證了兩者之間連接方便,又有效的提高了控制系統(tǒng)的通信速度和可靠性。 機器人系統(tǒng)的軟件設(shè)計包括兩個部分:一是采用VC++實現(xiàn)的上位監(jiān)控軟件系統(tǒng),它主要負責機器人實時軌跡規(guī)劃等控制算法的運算,同時完成用戶與機器人系統(tǒng)之間的信息交互;二是采用C語言實現(xiàn)的下位DSP控制程序,它主要負責接收上位監(jiān)控系統(tǒng)或者下位控制箱發(fā)送的控制信號,實現(xiàn)對機器人的實時驅(qū)動,同時還能夠?qū)崟r的向上位監(jiān)控系統(tǒng)或者下位控制箱反饋機器人的當前狀態(tài)信息。 研究開發(fā)出來的四關(guān)節(jié)實驗室機器人控制器具有控制實時性好、定位精度高、運行穩(wěn)定可靠的特點,它允許用戶通過上位控制計算機實現(xiàn)對機器人的各種設(shè)定作業(yè)的控制,也可以讓用戶通過機器人控制箱現(xiàn)場對機器人進行回零、示教等各項操作。
標簽:
FPGA
DSP
實驗室
機器人控制器
上傳時間:
2013-06-11
上傳用戶:edisonfather