基于DSP和FPGA的四關(guān)節(jié)實驗室機(jī)器人控制器的研制.pdf

1、在機(jī)器人學(xué)的研究領(lǐng)域中，如何有效地提高機(jī)器人控制系統(tǒng)的控制性能始終是研究學(xué)者十分關(guān)注的一個重要內(nèi)容。在分析了工業(yè)機(jī)器人的發(fā)展歷程和機(jī)器人控制系統(tǒng)的研究現(xiàn)狀后，本論文的主要目標(biāo)是針對四關(guān)節(jié)實驗室機(jī)器人特有的機(jī)械結(jié)構(gòu)和數(shù)學(xué)模型，建立一個新型全數(shù)字的基于DSP和FPGA的機(jī)器人位置伺服控制系統(tǒng)的軟、硬件平臺，實現(xiàn)對四關(guān)節(jié)實驗室機(jī)器人的精確控制。 本論文從實際情況出發(fā)，首先分析了所研究的四關(guān)節(jié)實驗室機(jī)器人的本體結(jié)構(gòu)，并對其抽象簡化得到了

2、它的運(yùn)動學(xué)數(shù)學(xué)模型。在明確了實現(xiàn)機(jī)器人精確位置伺服控制的控制原理后，我們對機(jī)器人控制系統(tǒng)的諸多可行性方案進(jìn)行了充分論證，并最終決定采用了三級CPU控制的控制體系結(jié)構(gòu)：第一級CPU為上位計算機(jī)，它實現(xiàn)對機(jī)器人的系統(tǒng)管理、協(xié)調(diào)控制以及完成機(jī)器人實時軌跡規(guī)劃等控制算法的運(yùn)算；第二級CPU為高性能的DSP處理器，它輔之以具有高速并行處理能力的FPGA芯片，實現(xiàn)了對機(jī)器人多個關(guān)節(jié)的高速并行驅(qū)動；第三級CPU為交流伺服驅(qū)動處理器，它實現(xiàn)了機(jī)器人關(guān)節(jié)

3、伺服電機(jī)的精確三閉環(huán)誤差驅(qū)動控制，以及電機(jī)的故障診斷和自動保護(hù)等功能。此外，我們采用比普通UART速度快得多的USB來實現(xiàn)上位計算機(jī)．與下位控制器之間的數(shù)據(jù)通信，這樣既保證了兩者之間連接方便，又有效的提高了控制系統(tǒng)的通信速度和可靠性。 機(jī)器人系統(tǒng)的軟件設(shè)計包括兩個部分：一是采用VC++實現(xiàn)的上位監(jiān)控軟件系統(tǒng)，它主要負(fù)責(zé)機(jī)器人實時軌跡規(guī)劃等控制算法的運(yùn)算，同時完成用戶與機(jī)器人系統(tǒng)之間的信息交互；二是采用C語言實現(xiàn)的下位DSP控制程