概覽

由美國國家儀器公司工程師搭建的演示平臺NIRo是一種小型的無人地面車輛，它的組件都是從當(dāng)?shù)厣痰曛匈徺I的商用現(xiàn)貨?？刂葡到y(tǒng)在集成了FPGA和實(shí)時(shí)處理器的NI Single-Board RIO嵌入式平臺上實(shí)現(xiàn)。

部件概述

NIRo實(shí)現(xiàn)高效導(dǎo)航和避障需要幾個(gè)關(guān)鍵硬件組件：

嵌入式控制器 – 用于傳感器數(shù)據(jù)采集、決策和電機(jī)控制。

紅外線傳感器 – 用于探測機(jī)器人平臺兩側(cè)和后方一定距離內(nèi)的目標(biāo)。

超聲波傳感器 – 用于探測機(jī)器人前方的目標(biāo)，因?yàn)榍胺礁采w了較大的區(qū)域。

H橋 – 用于控制電池至電機(jī)的電流方向，使電機(jī)前進(jìn)或后退。

圖1顯示了每個(gè)硬件組件在NIRo上的位置。表1提供了詳細(xì)的部件列表。

圖 1. NIRo硬件框圖

表1.部件列表

系統(tǒng)概述

NIRo的軟件構(gòu)架同時(shí)采用了底層和高層控制。避障和傳感器數(shù)據(jù)解析等高級任務(wù)在嵌入式實(shí)時(shí)控制器上執(zhí)行。避障算法使用IR和超聲波傳感器的測量數(shù)據(jù)來決定該如何根據(jù)周圍的環(huán)境進(jìn)行導(dǎo)航。

NIRo還包括電機(jī)的底層控制，該控制在FPGA上實(shí)現(xiàn)。根據(jù)避障算法獲得的結(jié)果，F(xiàn)PGA通過數(shù)字I/O線路輸出脈沖寬度調(diào)制(PWM)信號來控制電機(jī)。實(shí)時(shí)處理器與FPGA之間的數(shù)據(jù)傳輸通過LabVIEW內(nèi)置的FPGA接口功能來完成。

NIRo軟件構(gòu)架中的主要軟件組件包括：

·避障算法
·電機(jī)控制(PWM)

NIRo的軟件構(gòu)架可見圖2。IR傳感器與NI Single-Board RIO設(shè)備上內(nèi)建的模擬通道連接，超聲波傳感器與內(nèi)建的數(shù)字線路連接。電機(jī)與H橋連接，H橋再通過數(shù)字I/O連接到NI Single-Board RIO設(shè)備上。

圖 2. 在NI Single-Board RIO平臺上實(shí)現(xiàn)NIRo的軟件構(gòu)架

避障

在避障過程中NIRo監(jiān)視從IR和超聲波傳感器獲得的值。如果從傳感器獲得的值顯示有物體接近，NIRo將按照自身與障礙物距離成比例的速率轉(zhuǎn)彎。也就是說，障礙物與NIRo的距離越近，轉(zhuǎn)彎的速度越快。

圖3的控制框圖說明了以上問題。障礙物與NIRo之間設(shè)置了一個(gè)預(yù)期最小距離。機(jī)器人與障礙物之間的距離小于該距離時(shí)會(huì)及時(shí)轉(zhuǎn)彎。機(jī)器人會(huì)考慮預(yù)期最小距離與物體真實(shí)距離的差值與傳感器測量到的真實(shí)距離的比例。

圖 3. 用于避障的控制框圖

避障算法的實(shí)現(xiàn)代碼可見圖4。值得注意的是，與圖3類似，障礙物與NIRo之間的真實(shí)距離用來與最小預(yù)期距離進(jìn)行比較。還要注意圖4中case結(jié)構(gòu)與圖3中的避障框圖類似。 PID.vi的輸出用于向電機(jī)發(fā)出指令，使NIRo避開附近的障礙物。

圖4. 用于避障的LabVIEW代碼

電機(jī)控制(PWM)

避障算法的輸出控制每個(gè)電機(jī)PWM信號的占空比。舉例來說，如果NIRo未在行進(jìn)路徑上探測到任何障礙物，它將向FPGA發(fā)送數(shù)據(jù)告訴電機(jī)向前行進(jìn)。這可通過向所有電機(jī)發(fā)送相同的占空比來實(shí)現(xiàn)。如果NIRo需要轉(zhuǎn)向，每個(gè)電機(jī)收到的PWM信號占空比將不同。

實(shí)時(shí)控制器將占空比指令發(fā)送給FPGA。在FPGA上，占空比指令被轉(zhuǎn)換成可被H橋使用的數(shù)字指令。每個(gè)H橋得到4個(gè)數(shù)字信號，4個(gè)數(shù)字信號結(jié)合確定了電池至電機(jī)的電流方向。根據(jù)發(fā)送到H橋的數(shù)字信號指揮電機(jī)前進(jìn)、后退或不動(dòng)。

總結(jié)

盡管NIRo是小型的地面機(jī)器人，它用到的許多傳感器、算法和技術(shù)與大型的更復(fù)雜的機(jī)器人相同。通過LabVIEW Real-Time、LabVIEW FPGA及NI Single-Board RIO，開發(fā)人員能夠輕松集成硬件和軟件，快速設(shè)計(jì)、開發(fā)和發(fā)布算法。高層決策算法及底層電機(jī)控制都可以在同一個(gè)平臺上實(shí)現(xiàn)。通過集成可購買到的商用現(xiàn)貨以及使用高級圖形化編程語言，您可以極大地降低自主機(jī)器人開發(fā)的復(fù)雜性。