專利名稱：一種足式機器人狀態(tài)感知系統(tǒng)的制作方法
技術(shù)領(lǐng)域：
本發(fā)明涉及一種足式機器人狀態(tài)感知系統(tǒng)。
背景技術(shù)：
高性能足式機器人是一個由很多部分組成的復(fù)雜系統(tǒng)，主要包括環(huán)境感知部分、狀態(tài)感知部分、行為規(guī)劃與協(xié)調(diào)部分、四肢伺服控制器部分、驅(qū)動裝置部分和機體機械部分。系統(tǒng)通過環(huán)境感知部分和狀態(tài)感知部分采集機器人周圍的環(huán)境信息和本體狀態(tài)信息，送至行為規(guī)劃與協(xié)調(diào)部分后，行為規(guī)劃與協(xié)調(diào)部分根據(jù)環(huán)境信息和狀態(tài)信息規(guī)劃機器人的行為，并將控制目標(biāo)序列送至四肢伺服控制器部分，四肢伺服控制器部分控制驅(qū)動裝置驅(qū)動機體機械部分做出相應(yīng)的動作。狀態(tài)感知部分作為足式機器人的檢測裝置，直接決定著足式機器人性能的高低，是系統(tǒng)的一個重要組成部分。 足式機器人的運動與作業(yè)環(huán)境具有未知、非結(jié)構(gòu)化、動態(tài)、不確定、復(fù)雜等特性，要完成其使命，必須配備具有多種類型的傳感器系統(tǒng)來感知其自身的狀態(tài)信息，如感知其位置、速度、姿態(tài)的組合導(dǎo)航傳感器系統(tǒng)，感知其動力裝置溫度、流量、壓力等的動力單元傳感器系統(tǒng)，還有根據(jù)步態(tài)生成需要獲取四肢狀態(tài)的傳感器系統(tǒng)，如線性電位器、力傳感器等。隨著傳感器數(shù)目和信息處理量的不斷增加，數(shù)據(jù)的復(fù)雜性和測量中的模糊性因素加大，要對這些傳感器的數(shù)據(jù)進行綜合處理采用一般的單片機很難滿足實時性和可靠性。目前的解決方法主要是采用ARM或者DSP來構(gòu)成數(shù)據(jù)采集和處理系統(tǒng)。這種方法的缺點主要有硬件電路復(fù)雜，結(jié)構(gòu)不緊湊，可靠性差，數(shù)據(jù)處理能力有限，無法滿足大數(shù)據(jù)量高速采集與處理的要求。因此，有必要設(shè)計一種新型的足式機器人狀態(tài)感知系統(tǒng)。

發(fā)明內(nèi)容
本發(fā)明所要解決的技術(shù)問題是提供一種足式機器人狀態(tài)感知系統(tǒng)，該足式機器人狀態(tài)感知系統(tǒng)具有高速數(shù)據(jù)采集和處理功能、硬件電路集成度高。發(fā)明的技術(shù)解決方案如下—種足式機器人狀態(tài)感知系統(tǒng)，包括嵌入式處理器模塊、組合導(dǎo)航傳感器數(shù)據(jù)采集模塊、組合導(dǎo)航傳感器、動力單元傳感器數(shù)據(jù)采集模塊、動力單元傳感器、人機交互模塊和通信模塊；組合導(dǎo)航傳感器通過組合導(dǎo)航傳感器數(shù)據(jù)采集模塊與嵌入式處理器模塊相連；動力單元傳感器通過動力單元傳感器數(shù)據(jù)采集模塊與嵌入式處理器模塊相連；人機交互模塊和通信模塊均與嵌入式處理器模塊相連； 通信模塊還與上位機通信連接；所述的嵌入式處理器模塊包括基于FPGA的雙端口 RAM和基于FPGA的兩個NIOSII嵌入式處理器核即A核和B核，兩個NIOS II嵌入式處理器核通過雙端口 RAM通信連接。
四肢伺服控制器和環(huán)境感知單元不屬于狀態(tài)感知系統(tǒng)。四肢伺服控制器和環(huán)境感知單元均與通信模塊相連。環(huán)境感知單元用于感知機器人的外界環(huán)境信息，與狀態(tài)感知相對(狀態(tài)感知用于感知機器人自身信息)，不隸屬于上位機；同時，四肢伺服控制器采集四肢傳感器數(shù)據(jù)，并控制四肢動作，它們會通過CAN總線向規(guī)劃與協(xié)調(diào)層(上位機)發(fā)送四肢傳感器數(shù)據(jù)，狀態(tài)感知通過監(jiān)聽CAN總線獲得這些傳感器數(shù)據(jù)。
所述的嵌入式處理器模塊還包括SDRAM控制器模塊、Flash控制器模塊、CAN控制器模塊、UART控制器模塊、LCD控制器模塊、PIO控制器模塊、SPI控制器模塊、定時器模塊、DMA模塊、總線橋(Pipeline Bridge)模塊、單端口 RAM模塊、向量中斷控制器模塊，嵌入式處理器模塊內(nèi)的各模塊之間由AVALON總線相連；A核采用的存儲器為SDRAM和Flash，B核采用的存儲器為單端口 RAM，利用向量中斷控制器模塊實現(xiàn)A核和B核的中斷系統(tǒng)。所述的通信模塊為CAN總線通信模塊；組合導(dǎo)航傳感器為慣性/衛(wèi)星組合導(dǎo)航傳感器由慣性檢測單元和GPS接收機組成，前者檢測機器人的加速度和角速度信息，后者檢測機器人的經(jīng)度、緯度和高度。動力單元傳感器包括四個流量傳感器、兩個壓力傳感器、三個溫度傳感器、一個轉(zhuǎn)速傳感器和一個電壓傳感器；人機交互模塊包括液晶顯示屏、蜂鳴器和無線射頻收發(fā)器。FPGA 為 Altera 公司生產(chǎn)的 EP3C25F256A7N動力單元傳感器數(shù)據(jù)采集模塊采用ADC芯片MAX188和參考源芯片MAX6350 ;組合導(dǎo)航傳感器數(shù)據(jù)采集模塊采用MAX3232芯片。本發(fā)明選擇FPGA作為足式機器人狀態(tài)感知的主芯片，在FPGA片內(nèi)構(gòu)建雙Nios II處理器系統(tǒng)，動力單元傳感器數(shù)據(jù)采集模塊將機器人動力單元傳感器輸出的模擬量轉(zhuǎn)換為數(shù)字量；組合導(dǎo)航傳感器數(shù)據(jù)采集模塊通過串口讀取慣性/衛(wèi)星組合導(dǎo)航傳感器的數(shù)據(jù)；CAN總線通信模塊包含六路CAN總線，四路與機器人四肢伺服控制器相連，用于接收四肢傳感器數(shù)據(jù)，另兩路分別與規(guī)劃與協(xié)調(diào)層即上位機和環(huán)境感知單元相連；嵌入式處理器模塊包括Nios II處理器A核和B核，B核接收動力單元傳感器數(shù)據(jù)采集模塊、組合導(dǎo)航傳感器數(shù)據(jù)采集模塊、CAN總線通信模塊的傳感器數(shù)據(jù)并進行預(yù)處理，A核處理傳感器數(shù)據(jù)獲得狀態(tài)信息，通過CAN總線通信模塊傳至規(guī)劃與協(xié)調(diào)層即上位機和環(huán)境感知單元；人機交互模塊用于顯示機器人開機自檢信息和故障報警信息，提供聲音報警信號，并接收無線射頻操控命令；電源模塊為電路板上其他部分和動力單元傳感器以及組合導(dǎo)航傳感器提供電源。所述FPGA內(nèi)部模塊劃分為Nios II處理器模塊(兩個)、SDRAM控制器模塊、Flash控制器模塊、CAN控制器模塊(六個)、UART控制器模塊(三個)、LCD控制器模塊、PIO控制器模塊、SPI控制器模塊(兩個)、定時器模塊、DMA模塊(兩個)、Pipeline Bridge模塊(兩個)、單端口 RAM模塊、雙端口 RAM模塊、向量中斷控制器模塊(兩個)，各模塊之間由AVALON總線連接起來。A核和B核采用獨立的存儲器，A核存儲器為SDRAM和Flash，B核存儲器為單端口RAM (或R0M)，雙核之間通過雙端口 RAM進行通信，利用向量中斷控制器實現(xiàn)A核和B核的中斷系統(tǒng)，這比由Nios II處理器直接處理中斷響應(yīng)快，效率高。
所述FPGA內(nèi)部模塊中的CAN控制器,是Opencores公司專為CAN總線通信而設(shè)計的IP核。這種CAN控制器IP核是仿SJA1000芯片設(shè)計的，編程方便，時鐘速度是SJA1000兩倍以上。利用六個CAN控制器IP核構(gòu)成六路CAN總線，處理器通過AVALON總線訪問CAN控制器，可以實現(xiàn)六路CAN總線高速并行收發(fā)。所述FPGA內(nèi)部模塊中的UART控制器IP核共三個，其中兩個用于接收慣性/衛(wèi)星組合導(dǎo)航傳感器數(shù)據(jù)，利用兩個DMA轉(zhuǎn)存這兩個UART控制器數(shù)據(jù)至B核存儲器單端口 RAM(或R0M)，以減輕處理器頻繁地轉(zhuǎn)存該數(shù)據(jù)的負(fù)擔(dān)，使處理器有更多的時間去處理其他的事情；另一個用于接收無線射頻操控命令。所述用硬邏輯電路定制關(guān)鍵算法指令，具體是在數(shù)據(jù)采集與處理控制器模塊中A核內(nèi)，用硬邏輯電路定制矩陣算法指令，用于加速機器人姿態(tài)估計時的坐標(biāo)變換運算，提高數(shù)據(jù)處理的實時性；在B核內(nèi)，用硬邏輯電路定制循環(huán)冗余碼校驗指令，用于四肢CAN總線 數(shù)據(jù)的校驗，提高數(shù)據(jù)采集的實時性。所述FPGA具體為Altera公司生產(chǎn)的EP3C25F256A7N。這種芯片具有快速的數(shù)字信號傳輸速度和豐富的可編程資源，其包括25K邏輯單元、608Kbits嵌入式存儲器以及4個PLL，能夠搭建雙Nios II處理器系統(tǒng)，并配置必要的處理器外設(shè)。同時，利用156個用戶I/O連接外圍芯片，可實現(xiàn)多種傳感器數(shù)據(jù)的并行采集和處理。其內(nèi)嵌的66個嵌入式18 X 18乘法器，可以輔助實現(xiàn)各種數(shù)字信號處理算法，提高數(shù)據(jù)處理速度。該芯片可正常工作于-40 125攝氏度，能保證足式機器人在很低和很高的溫度環(huán)境下工作不受影響。所述Nios II具體為Altera公司專為構(gòu)建片上系統(tǒng)而設(shè)計的32位RSIC嵌入式處理器Nios ΙΙ/f,其性能超過200DMIPS，擁有6級流水線，支持單周期硬件乘法/除法器、桶形移位器，帶有高速指令和數(shù)據(jù)緩存，有單片機無法比擬的運算速度。另外，可定制256個用戶指令，可采用硬件加速器提高軟件性能，這就可以利用FPGA并行計算的特點加速軟件關(guān)鍵算法，保證機器人狀態(tài)感知系統(tǒng)實時完成復(fù)雜的算法。有益效果本發(fā)明的足式機器人狀態(tài)感知系統(tǒng)，選擇FPGA作為足式機器人狀態(tài)感知的主芯片，為提高多傳感器數(shù)據(jù)采集和處理的速度，利用IP核構(gòu)成處理器外設(shè)，用硬邏輯電路定制關(guān)鍵算法指令，在FPGA片內(nèi)構(gòu)建雙Nios II處理器系統(tǒng)，分別完成異構(gòu)傳感器數(shù)據(jù)多時間尺度采集和高速處理傳感器數(shù)據(jù)獲得狀態(tài)信息。本發(fā)明的感知裝置包括數(shù)據(jù)采集與處理控制器模塊、動力單元傳感器數(shù)據(jù)采集模塊、組合導(dǎo)航傳感器數(shù)據(jù)采集模塊、CAN總線通信模塊、人機交互模塊和電源模塊。采用本發(fā)明制備的足式機器人狀態(tài)感知系統(tǒng)，電路的集成度高、體積和功耗小、成本低，具有可擴展性、升級性和較高的抗干擾性，數(shù)據(jù)處理速度快，便于機器人實時控制。


圖I為本發(fā)明足式機器人狀態(tài)感知裝置方框圖；圖2為本發(fā)明狀態(tài)感知裝置電源模塊電路原理圖；圖3為本發(fā)明狀態(tài)感知裝置FPGA片內(nèi)硬件原理圖；圖4為本發(fā)明狀態(tài)感知裝置數(shù)據(jù)采集與處理控制器模塊電路原理圖；圖5為本發(fā)明狀態(tài)感知裝置動力單元傳感器數(shù)據(jù)采集模塊電路原理圖6為本發(fā)明狀態(tài)感知裝置CAN總線通信模塊電路原理圖；圖7為本發(fā)明狀態(tài)感知裝置組合導(dǎo)航傳感器數(shù)據(jù)采集模塊電路原理圖；圖8為本發(fā)明狀態(tài)感知裝置人機交互模塊電路原理圖。
具體實施例方式以下將結(jié)合附圖和具體實施例對本發(fā)明做進一步詳細(xì)說明實施例I : I.如圖I所示，本發(fā)明用FPGA芯片——EP3C25F256A7N作為足式機器人狀態(tài)感知的主芯片，在FPGA片內(nèi)構(gòu)建雙Nios II處理器系統(tǒng)，分別完成異構(gòu)傳感器數(shù)據(jù)多時間尺度采集和高速地處理傳感器數(shù)據(jù)以獲得狀態(tài)信息，雙核之間通過片內(nèi)雙端口 RAM進行通信。數(shù)據(jù)采集與處理控制器模塊、動力單元傳感器數(shù)據(jù)采集模塊、組合導(dǎo)航傳感器數(shù)據(jù)采集模塊、CAN總線通信模塊、人機交互模塊和電源模塊一起組成足式機器人狀態(tài)感知裝置。動力單元傳感器數(shù)據(jù)采集模塊將機器人動力單元各個傳感器輸出的模擬量轉(zhuǎn)換為數(shù)字量，主要芯片是ADC芯片MAX188和參考源芯片MAX6350 ;組合導(dǎo)航傳感器數(shù)據(jù)采集模塊通過串口讀取慣性/衛(wèi)星組合導(dǎo)航傳感器IMU和GPS的數(shù)據(jù)，主要芯片是MAX3232 ；CAN總線通信模塊包含六路CAN總線，四路與機器人四肢伺服控制器相連，另兩路分別與規(guī)劃與協(xié)調(diào)層和環(huán)境感知單元相連，主要芯片是CTM8251D ；數(shù)據(jù)采集與處理控制器模塊由Nios II處理器A核和B核組成，具體為Nios 11/f，B核接收動力單元傳感器數(shù)據(jù)采集模塊、組合導(dǎo)航傳感器數(shù)據(jù)采集模塊、CAN總線通信模塊的傳感器數(shù)據(jù)并進行預(yù)處理，A核處理傳感器數(shù)據(jù)獲得狀態(tài)信息，通過CAN總線通信模塊傳至規(guī)劃與協(xié)調(diào)層和環(huán)境感知單元；人機交互模塊采用128X64點陣液晶顯示屏、蜂鳴器和無線射頻收發(fā)器組成，用于顯示機器人開機自檢信息和故障報警信息，提供聲音報警信號，并接收無線射頻操控命令；電源模塊采用線性穩(wěn)壓與開關(guān)穩(wěn)壓相結(jié)合的方式，降低電源功率損耗，為電路板上其他部分和動力單元傳感器以及組合導(dǎo)航傳感器提供低紋波電源。2.如圖2所示，系統(tǒng)供電電壓為+18 40V，采用寬電壓范圍，以消除供電電源波動對系統(tǒng)的影響。電源模塊所提供的電壓值有+15V、+5V、+3. 3V、+2. 5V和+1. 2V。輸入電壓經(jīng)開關(guān)穩(wěn)壓芯片LM2596-ADJ降為+15V，經(jīng)過線性穩(wěn)壓芯片LT1085-5降為+5V，然后經(jīng)過線性穩(wěn)壓芯片LT1085-3. 3降為+3. 3V和線性穩(wěn)壓芯片LMl 117-2. 5降為+2. 5V，+3. 3V經(jīng)過線性穩(wěn)壓芯片LMl 117-1. 2降為+1. 2V。3.如圖3所示，F(xiàn)PGA內(nèi)部模塊劃分為兩個Nios II處理器模塊、一個SDRAM控制器模塊、一個Flash控制器模塊、六個CAN控制器模塊、三個UART控制器模塊、一個LCD控制器模塊、一個PIO控制器模塊、兩個SPI控制器模塊、一個定時器模塊、兩個DMA模塊、兩個Pipeline Bridge模塊、一個單端口 RAM模塊、一個雙端口 RAM模塊、兩個向量中斷控制器模ik,各模塊之間由AVALON總線連接起來。A核的IP核外設(shè)兩個CAN控制器模塊、一個UART控制器模塊、一個IXD控制器模塊、一個PIO控制器模塊通過一個Pipeline Bridge模塊與A核相連；B核的IP核外設(shè)四個CAN控制器模塊、兩個SPI控制器模塊通過一個PipelineBridge模塊與B核相連，以簡化系統(tǒng)總線，提高系統(tǒng)可運行的頻率。A核存儲器為SDRAM和Flash，通過SDRAM控制器模塊和Flash控制器模塊三態(tài)橋訪問外接SDRAM和NOR Flash芯片。B核存儲器為片內(nèi)單端口 RAM (或R0M)，具有20kB存儲空間，它可以固化程序，同時系統(tǒng)運行時又作為數(shù)據(jù)存儲器。雙核之間通過雙端口 RAM進行通信，每個核通過AVALON總線訪問雙端口 RAM，數(shù)據(jù)位寬為32位，具有4kB存儲空間。利用兩個向量中斷控制器(VIC, Vectored Interrupt Controller)分別實現(xiàn)A核和B核的中斷系統(tǒng)，處理器IP核外設(shè)的中斷信號均送到VIC，由VIC判斷中斷標(biāo)志，對中斷優(yōu)先級進行仲裁，并處理中斷向量給處理器，支持中斷嵌套和可變優(yōu)先級，比由Nios II處理器直接處理中斷響應(yīng)快，效率高。FPGA內(nèi)部模塊中的CAN控制器，是Opencores公司專為CAN總線通信而設(shè)計的IP核。這種CAN控制器IP核是仿SJA1000芯片設(shè)計的，支持Basic CAN模式和Peli CAN模式，位速率可達1Mbps，編程方便，時鐘速度是SJA1000兩倍以上。利用六個CAN控制器IP核構(gòu)成六路CAN總線，處理器通過AVALON總線訪問CAN控制器，可以實現(xiàn)六路CAN總線高速并行收發(fā)。FPGA內(nèi)部模塊中的UART控制器IP核共三個，其中兩個用于接收慣性/衛(wèi)星組合 導(dǎo)航傳感器數(shù)據(jù)，利用兩個DMA轉(zhuǎn)存這兩個UART控制器數(shù)據(jù)至B核存儲器單端口 RAM (或ROM)。UART控制器每接收到一個字符，DMA就將其轉(zhuǎn)存至單端口 RAM (或R0M)，在批量接收數(shù)據(jù)時，減輕了處理器頻繁地轉(zhuǎn)存該數(shù)據(jù)的負(fù)擔(dān)，使處理器有更多的時間去處理其他的事情。另一個UART控制器用于接收無線射頻操控命令，操作員可通過無線射頻遙控器控制狀態(tài)感知裝置取消聲音報警和滾動屏幕顯示內(nèi)容。FPGA內(nèi)部模塊中的定時器模塊，其定時間隔設(shè)置為1ms，用于控制傳感器數(shù)據(jù)采集的時間節(jié)拍。LCD控制器模塊具體為LCD16207控制器，它提供了與LCD12864相兼容的引腳連接和訪問方式，能方便地實現(xiàn)12864液晶的刷新顯示。兩個SPI控制器模塊通過SPI總線分別控制兩片ADC芯片，完成通道選擇、時鐘輸入、轉(zhuǎn)換結(jié)果讀取。4. FPGA與SDRAM、Flash、配置芯片的連接方式如圖4所示。FPGA具體為Altera公司生產(chǎn)的EP3C25F256A7N。FPGA配置芯片采用EPCS16，具有16MBits的存儲空間。SDRAM采用 HY57V561620 芯片，具有 32Mbytes 存儲空間。NOR FLASH 采用 S29AL032N，具有 4Mbytes存儲空間。系統(tǒng)啟動后將固化程序從Flash調(diào)入SDRAM運行，SDRAM既是程序存儲器又是數(shù)據(jù)存儲器。5.如圖5所示，動力單元傳感器數(shù)據(jù)采集模塊采用兩片8通道12位串行ADC芯片MAX188，實現(xiàn)16路模擬信號的采集。MAX188支持8通道單端輸入，可以5V供電，支持SPI串行通信方式，通信速度為5Mbps，采樣率為133kHz。若16個通道同時采樣，則每個通道在Ims內(nèi)可采樣16次。兩片ADC共用一個5V參考源。參考源采用MAX6350芯片，輸入電壓為15V,輸出電壓為5. 000V,精度為±0. 001V,滿足采集變送器O 5V或I 5V輸出的要求。在12位的采樣精度下，ADC分辨率為I. 22mV。圖5中U5和U6的DIN、DOUT、SCLK、/CS引腳，分別連接至圖4中Ul的1/0引腳。FPGA芯片通過ADC芯片的DIN、DOUT、SCLK、/CS引腳訪問ADC，完成模數(shù)轉(zhuǎn)換過程。6.如圖6所示，CAN總線通信模塊采用三個雙路隔離CAN收發(fā)器CTM8251D，實現(xiàn)六路CAN總線數(shù)據(jù)收發(fā)。四路與機器人四肢伺服控制器相連，另兩路分別與規(guī)劃與協(xié)調(diào)層和環(huán)境感知單元相連。每個收發(fā)器外接兩個螺釘壓線框式接線端子，實現(xiàn)與CAN總線傳輸介質(zhì)雙絞線的連接。CTM8251D芯片內(nèi)部集成了所有必需的CAN隔離及CAN收發(fā)器件，將CAN控制器的邏輯電平轉(zhuǎn)換為CAN總線的差分電平并且具有DC2500V的隔離功能，速率最高達IMbit/s，提供短路保護和熱保護，對電磁干擾有高的抗干擾性，至少可連接110個節(jié)點。圖6中CAN1、CAN2、CAN3的RXD1、TXDU RXD2、TXD2引腳，分別連接至圖4中Ul的I/O引腳。FPGA芯片通過CTM8251D芯片的RXD1、TXD1、RXD2、TXD2引腳訪問CTM8251D，完成CAN總線數(shù)據(jù)的收發(fā)。7.如圖7所示，組合導(dǎo)航傳感器數(shù)據(jù)采集模塊采用一片雙路232電平轉(zhuǎn)換器MAX3232芯片，實現(xiàn)3. 3V的TTL電平到232電平的轉(zhuǎn)換。每個通道外接一個9針串口接口，實現(xiàn)與RS232數(shù)據(jù)線的連接。MAX3232支持3V到5. 5V的供電，速率最高達250kbit/s，高于RS232總線標(biāo)準(zhǔn)最大波特率，能滿足所有RS232總線應(yīng)用要求。圖7中U8的T1IN、T2IN、R10UT、R20UT引腳，分別連接至圖4中Ul的I/O引腳。FPGA芯片通過MAX3232芯片的T1IN、T2IN、R10UT、R20UT弓丨腳訪問MAX3232，完成串口數(shù)據(jù)的收發(fā)。8.如圖8所示，人機交互模塊由液晶、蜂鳴器和無線射頻收發(fā)器組成。液晶模塊采用一塊帶中文字庫的液晶屏IXD12864，是128X64點陣的漢字圖形型液晶顯示模塊，內(nèi)置國標(biāo)GB2312碼簡體中文字庫(16 X 16點陣)、128個字符(8 X 16點陣)。FPGA的三根控制信號線HCSO HCS2和八根數(shù)據(jù)信號線LCD_DB00 LCD_DB07，經(jīng)兩片74HC245芯片U9、UlO 驅(qū)動后，連接至IXD12864，完成信息顯示。FPGA的一根信號線BELL，經(jīng)三極管放大后，連接至蜂鳴器，控制其發(fā)聲。無線射頻收發(fā)器采用APC220-43模塊，其嵌入了高性能射頻芯片ADF7020-1，傳輸距離可達1200米，工作頻率范圍為418M 455MHz，IKHz步進，提供UART/TTL接口，通信波特率可達57600bps。FPGA的兩根信號線UART3_TX、UART3_RX，連接至射頻模塊接口，完成無線射頻通信。基于FPGA的高性能足式機器人的狀態(tài)感知裝置，硬件接口豐富，能完全感知機器人控制所需的狀態(tài)信息，且電路集成度高，有益于提高系統(tǒng)抗干擾性，降低體積、功耗和成本，同時充分發(fā)揮了 FPGA并行計算的優(yōu)勢，具備高速數(shù)據(jù)采集和處理的能力，另外，可擴展性好，系統(tǒng)的軟硬件升級方便。
權(quán)利要求
1.一種足式機器人狀態(tài)感知系統(tǒng)，其特征在于，包括嵌入式處理器模塊、組合導(dǎo)航傳感器數(shù)據(jù)采集模塊、組合導(dǎo)航傳感器、動力單元傳感器數(shù)據(jù)采集模塊、動力單元傳感器、人機交互模塊和通信模塊； 組合導(dǎo)航傳感器通過組合導(dǎo)航傳感器數(shù)據(jù)采集模塊與嵌入式處理器模塊相連； 動力單元傳感器通過動力單元傳感器數(shù)據(jù)采集模塊與嵌入式處理器模塊相連； 人機交互模塊和通信模塊均與嵌入式處理器模塊相連； 通信模塊還與上位機通信連接； 所述的嵌入式處理器模塊包括基于FPGA的雙端口 RAM和基于FPGA的兩個NIOS II嵌入式處理器核即A核和B核，兩個NIOS II嵌入式處理器核通過雙端口 RAM通信連接。
2.根據(jù)權(quán)利要求I所述的足式機器人狀態(tài)感知系統(tǒng)，其特征在于，所述的嵌入式處理器模塊還包括SDRAM控制器模塊、Flash控制器模塊、CAN控制器模塊、UART控制器模塊、LCD控制器模塊、PIO控制器模塊、SPI控制器模塊、定時器模塊、DMA模塊、總線橋模塊、單端口 RAM模塊、向量中斷控制器模塊，嵌入式處理器模塊內(nèi)的各模塊之間由AVALON總線相連;A核采用的存儲器為SDRAM和Flash，B核采用的存儲器為單端口 RAM，利用向量中斷控制器模塊實現(xiàn)A核和B核的中斷系統(tǒng)。
3.根據(jù)權(quán)利要求1-2任一項所述的足式機器人狀態(tài)感知系統(tǒng)，其特征在于，所述的通信模塊為CAN總線通信模塊； 組合導(dǎo)航傳感器為慣性/衛(wèi)星組合導(dǎo)航傳感器 動力單元傳感器包括四個流量傳感器、兩個壓力傳感器、三個溫度傳感器、一個轉(zhuǎn)速傳感器和一個電壓傳感器； 人機交互模塊包括液晶顯示屏、蜂鳴器和無線射頻收發(fā)器。
4.根據(jù)權(quán)利要求3所述的足式機器人狀態(tài)感知系統(tǒng)，其特征在于，F(xiàn)PGA為Altera公司生產(chǎn)的 EP3C25F256A7N 動力單元傳感器數(shù)據(jù)采集模塊采用ADC芯片MAX188和參考源芯片MAX6350 ;組合導(dǎo)航傳感器數(shù)據(jù)采集模塊采用MAX3232芯片。
全文摘要
本發(fā)明公開了一種足式機器人狀態(tài)感知系統(tǒng)，其特征在于，選擇FPGA作為足式機器人狀態(tài)感知的主芯片，為提高多傳感器數(shù)據(jù)采集和處理的速度，利用IP核構(gòu)成處理器外設(shè)，用硬邏輯電路定制關(guān)鍵算法指令，在FPGA片內(nèi)構(gòu)建雙Nios II處理器系統(tǒng)，分別完成異構(gòu)傳感器數(shù)據(jù)多時間尺度采集和高速處理傳感器數(shù)據(jù)獲得狀態(tài)信息。本發(fā)明的感知裝置包括數(shù)據(jù)采集與處理控制器模塊、動力單元傳感器數(shù)據(jù)采集模塊、組合導(dǎo)航傳感器數(shù)據(jù)采集模塊、CAN總線通信模塊、人機交互模塊和電源模塊。本發(fā)明的足式機器人狀態(tài)感知系統(tǒng)，電路的集成度高、體積和功耗小、成本低，具有可擴展性、升級性和較高的抗干擾性，數(shù)據(jù)處理速度快，便于機器人實時控制。
文檔編號G05B19/418GK102819256SQ201210330409
公開日2012年12月12日 申請日期2012年9月7日 優(yōu)先權(quán)日2012年9月7日
發(fā)明者陳鑫, 吳敏, 曹衛(wèi)華, 劉明亮, 安劍奇 申請人:中南大學(xué)