模塊化機(jī)器人嵌入式多核主控制器設(shè)計(jì)

協(xié)處理器總體設(shè)計(jì)框架如圖3所示。GDB、GAB、GCB分別表示外部的數(shù)據(jù)、地址和控制總線(xiàn)。協(xié)處理器主要包含輸入／輸出接口邏輯、機(jī)器人參數(shù)存儲(chǔ)區(qū)、協(xié)處理器運(yùn)算控制模塊、運(yùn)算處理模塊、命令字寄存器、協(xié)處理器狀態(tài)字寄存器和輸入／輸出FIFO構(gòu)成。

在本設(shè)計(jì)中，協(xié)處理器作為一個(gè)I／O設(shè)備與主處理器之間連接，協(xié)處理器完全接受主處理器的調(diào)度和支配。由于機(jī)器人控制算法的調(diào)度與計(jì)算是一個(gè)周期性過(guò)程，因此采用I／O設(shè)備方式即可滿(mǎn)足要求。采用此方式系統(tǒng)雖然增加了協(xié)處理器，但卻沒(méi)有增加復(fù)雜度，利于保證核心部件的可靠性且易于實(shí)現(xiàn)和管理，能夠簡(jiǎn)化軟件設(shè)計(jì)。針對(duì)該接口模式的設(shè)計(jì)，協(xié)處理器與主處理器之間的硬件接口結(jié)構(gòu)框圖如圖4所示。

協(xié)處理器面向Nios II處理器接口分為參數(shù)區(qū)和寄存器區(qū)，通過(guò)寫(xiě)命令寄存器來(lái)識(shí)別。通常情況下，給出的CMD為正常計(jì)算模式，默認(rèn)選擇寄存器區(qū)；當(dāng)需要對(duì)基本參數(shù)進(jìn)行訪(fǎng)問(wèn)／修改時(shí)，給出的CMD為修改參數(shù)模式。其中寄存器區(qū)包括各類(lèi)寄存器和輸入輸出FIFO。圖4中各信號(hào)含義在表1內(nèi)進(jìn)行了介紹。

4 片上多核結(jié)構(gòu)

利用SOPC技術(shù)把Nios II軟核、專(zhuān)用協(xié)處理器、存儲(chǔ)器控制IP、CAN總線(xiàn)控制邏輯、內(nèi)部計(jì)數(shù)器等全部集成到FPGA芯片上?；赟OPC的多核控制器的系統(tǒng)結(jié)構(gòu)如圖5所示。

整個(gè)分布式控制系統(tǒng)結(jié)構(gòu)如圖6所示，多核主控制器通過(guò)CAN總線(xiàn)與各關(guān)節(jié)控制器通信并對(duì)反饋信息進(jìn)行處理，進(jìn)行路徑規(guī)劃，下發(fā)關(guān)節(jié)角。各關(guān)節(jié)控制器采集電機(jī)當(dāng)前角度信息并通過(guò)電機(jī)驅(qū)動(dòng)模塊控制電機(jī)運(yùn)動(dòng)。