0
  • 聊天消息
  • 系統(tǒng)消息
  • 評(píng)論與回復(fù)
登錄后你可以
  • 下載海量資料
  • 學(xué)習(xí)在線課程
  • 觀看技術(shù)視頻
  • 寫(xiě)文章/發(fā)帖/加入社區(qū)
會(huì)員中心
創(chuàng)作中心

完善資料讓更多小伙伴認(rèn)識(shí)你,還能領(lǐng)取20積分哦,立即完善>

3天內(nèi)不再提示

利用超聲波傳感器在ARM9與linux平臺(tái)中實(shí)現(xiàn)移動(dòng)機(jī)器人導(dǎo)航的設(shè)計(jì)

電子設(shè)計(jì) ? 作者:電子設(shè)計(jì) ? 2018-09-23 11:13 ? 次閱讀

摘要: 采用新型的超聲波傳感器,設(shè)計(jì)并開(kāi)發(fā)基于ARM9 與嵌入式linux 為平臺(tái)的輪式移動(dòng)機(jī)器人平臺(tái)的下的未知環(huán)境的避障導(dǎo)航系統(tǒng)。本文重點(diǎn)介紹該超聲波傳感器的實(shí)現(xiàn)原理以及在機(jī)器人平臺(tái)中的整個(gè)軟件實(shí)現(xiàn)流程以及控制機(jī)器人行走的實(shí)現(xiàn)方法。

1 引言

在項(xiàng)目開(kāi)發(fā)中采用從英國(guó)進(jìn)口的SRF05 超聲波傳感器,它的回波反饋與測(cè)距方式與通常使用的超聲波傳感器相比較特別, 在ARM中實(shí)現(xiàn)也稍有難度, 但該傳感器精度很高可達(dá)到1cm, 因此用該傳感器去掉了用于近距離測(cè)距的紅外測(cè)距模塊節(jié)約了硬件資源。

該機(jī)器人的最小系統(tǒng)為,觸摸屏模塊,超聲波模塊,攝像頭圖像采集模塊,直流電機(jī)閉環(huán)控制系統(tǒng),在整個(gè)系統(tǒng)中測(cè)距是最總要的一環(huán),它直接影響電機(jī)運(yùn)行距離的精度,在有效范圍內(nèi)的圖像采集控制。整個(gè)系統(tǒng)都是在ARM9 與linux 平臺(tái)中完成,每個(gè)模塊都是用設(shè)備驅(qū)動(dòng)的方式實(shí)現(xiàn)使得模塊的控制更加方便。

2 SRF05 超聲波測(cè)距方法

提供一個(gè)10us 的脈沖觸發(fā)超聲波傳感器,SRF05 會(huì)發(fā)出8 個(gè)周期的頻率為40khz 的超頻脈沖,此時(shí)在echo 也是就回波口上的電平變?yōu)楦撸藭r(shí)定時(shí)器開(kāi)始計(jì)時(shí),等到echo 變?yōu)榈碗娖阶C明有障礙物此時(shí)停止計(jì)時(shí),高脈沖的寬度有測(cè)距的距離成正比,該超聲波的有效測(cè)距范圍為1cm~4m, 因此如果沒(méi)有障礙物或障礙物大于4m,echo 依然會(huì)變?yōu)榈碗娖酱藭r(shí)定時(shí)器的時(shí)間為30ms, 因此在測(cè)距時(shí)定時(shí)器的周期應(yīng)大于30ms 這樣才能有效測(cè)距。

原理如圖1 所示。

利用超聲波傳感器在ARM9與linux平臺(tái)中實(shí)現(xiàn)移動(dòng)機(jī)器人導(dǎo)航的設(shè)計(jì)

3 超聲波測(cè)距軟件實(shí)現(xiàn)

如圖2 為超聲波測(cè)距的流程圖。

利用超聲波傳感器在ARM9與linux平臺(tái)中實(shí)現(xiàn)移動(dòng)機(jī)器人導(dǎo)航的設(shè)計(jì)

3.1 回波檢測(cè)的采集方法

超聲波的回波的檢測(cè)是個(gè)難點(diǎn), 因?yàn)樵贏RM中一個(gè)端口設(shè)置中斷只能設(shè)置一種觸發(fā)方式, 如果設(shè)為上升沿觸發(fā)可以打開(kāi)定時(shí)器定時(shí)但無(wú)法捕獲下降沿,也就無(wú)法關(guān)閉定時(shí)器,從而不能測(cè)距, 因此用軟件的方式實(shí)現(xiàn)。首先設(shè)置兩個(gè)時(shí)間延遲函數(shù)usdelay()和msdelay(),這樣可以在給出高脈沖10us 后等超聲波觸發(fā)再打開(kāi)定時(shí)期計(jì)時(shí),在設(shè)置一個(gè)外部中斷eint1 接到超聲波傳感器的echo 口并設(shè)置為下降沿觸發(fā),等下降沿來(lái)臨關(guān)閉定時(shí)器讀出值既為脈寬的時(shí)間長(zhǎng)度,然后根據(jù)障礙物的距離=(ECHO高電平的時(shí)間)* 聲納速度/2 得出距離??諝庵衯 與溫度關(guān)系:v=331.5√1+T/273 m/s,T 為攝氏溫度。一般情況下超聲波速近似聲速,在室內(nèi)溫度影響下取約343.2m/s.

3.2 超聲波觸發(fā)的實(shí)現(xiàn)

利用數(shù)字示波器精確設(shè)計(jì)一個(gè)軟件計(jì)時(shí)函數(shù)usdelay (),具體實(shí)現(xiàn)如下。

利用超聲波傳感器在ARM9與linux平臺(tái)中實(shí)現(xiàn)移動(dòng)機(jī)器人導(dǎo)航的設(shè)計(jì)

則usdelay(1)既為10us,該函數(shù)用于在給出激發(fā)高脈沖后延續(xù)10us 然后關(guān)脈沖。

還要設(shè)計(jì)一個(gè)msdelay()用于控制整個(gè)測(cè)距周期的時(shí)間值。

msdelay(1000)在主函數(shù)數(shù)中用于延遲1s,這樣定時(shí)器可以完全有足夠的回波檢測(cè)時(shí)間同時(shí)也不會(huì)對(duì)其它三路超聲波信號(hào)造成干擾。

如下所示。

利用超聲波傳感器在ARM9與linux平臺(tái)中實(shí)現(xiàn)移動(dòng)機(jī)器人導(dǎo)航的設(shè)計(jì)

3.3 超聲波回波檢測(cè)的實(shí)現(xiàn)

回波檢測(cè)計(jì)算脈寬的時(shí)間需要用到定時(shí)器和外部中斷,外部中斷接超聲波的echo 并設(shè)置為下降沿觸發(fā)。定時(shí)器的初始化如下。

rTCFG0=0x9595; //預(yù)分頻值為95

rTCFG1=0x00000; //分割值1/2

rTCNTB0=10000; /

根據(jù)T=[TCNTB0*(TCFG0+1)*(1/TCFG1)]/50MHZ 得出定時(shí)器的周期為60ms 在這個(gè)時(shí)間段里足以計(jì)算回波時(shí)間。

外部中斷1 初始化如下

rGPFCON=0xaa; //GPF1 設(shè)置為EINT1

rINTMOD=0x0; //設(shè)置為普通中斷

rGPFUP=0xf; //禁止GPF0 上拉電阻

pISR_EINT1=(unsigned)Eint1Handler; //建立中斷向量

EnableIrq(BIT_EINT1); //使能中斷

rEXTINT0 =0x492; // EINT1 下降沿觸發(fā)

根據(jù)T=[TCNTB0*(TCFG0+1)*(1/TCFG1)]/50MHZ 得出定時(shí)器的周期為60ms 在這個(gè)時(shí)間段里足以計(jì)算回波時(shí)間。

3.4 在外部中斷中計(jì)算機(jī)距離

利用超聲波傳感器在ARM9與linux平臺(tái)中實(shí)現(xiàn)移動(dòng)機(jī)器人導(dǎo)航的設(shè)計(jì)

3.5 循環(huán)控制與輪詢測(cè)距

由于超聲波之間有干擾,采用輪詢的方式依次打開(kāi)超聲波,每次只測(cè)一個(gè),這樣可以有效地避免干擾,為了提高實(shí)時(shí)性可以控制定時(shí)器周期,比如設(shè)置為35ms,這樣四路超聲波輪詢一次大約為140ms,足以滿足實(shí)時(shí)要求。

4 機(jī)器人控制的實(shí)現(xiàn)

圖3 為利用超聲波的反饋信息控制機(jī)器人直流電機(jī)閉環(huán)系統(tǒng)的總體結(jié)構(gòu)圖。

利用超聲波傳感器在ARM9與linux平臺(tái)中實(shí)現(xiàn)移動(dòng)機(jī)器人導(dǎo)航的設(shè)計(jì)

linux 系統(tǒng)中超聲波傳感器為只讀的字符設(shè)備,具體應(yīng)用為在應(yīng)用程序下打開(kāi)超聲波設(shè)備,然后在驅(qū)動(dòng)中測(cè)距,測(cè)得的數(shù)據(jù)傳到應(yīng)用程序,應(yīng)用程序中有超聲波的避障算法,根據(jù)算法判斷障礙物的位置給直流電機(jī)控制信號(hào)進(jìn)行避障導(dǎo)航。

觸摸屏中的圖形界面中含有機(jī)器人的指令設(shè)置, 可以設(shè)置運(yùn)行速度,圖像采集與超聲波模塊的打開(kāi)與關(guān)閉,是否開(kāi)啟機(jī)器人模糊算法運(yùn)行軌跡還是使用普通的PID 調(diào)節(jié), 這使得機(jī)器人有很多種方案可以選擇。

機(jī)器人的每一次行為都是根據(jù)超聲波傳感器測(cè)得的值和當(dāng)前機(jī)器人運(yùn)行的即時(shí)速度來(lái)來(lái)給出將要運(yùn)行的時(shí)間, 在遇到障礙物時(shí)(0

5 結(jié)論

本文采用新型的超聲波傳感器,在ARM9 與嵌入式linux 為平臺(tái)的移動(dòng)機(jī)器人上實(shí)現(xiàn)了超聲波的測(cè)距, 并利用超聲波傳感器控制運(yùn)動(dòng)系統(tǒng)和圖像采集系統(tǒng)。該機(jī)器人目前已經(jīng)成功應(yīng)用與本項(xiàng)目的開(kāi)發(fā)并取得良好的效果。

本文創(chuàng)新點(diǎn):采用一種精度高的新型超聲波傳感器,用軟件方法克服了它在ARM9 中不利于檢測(cè)回波的問(wèn)題,成功應(yīng)用于移動(dòng)機(jī)器人的運(yùn)行軌跡控制, 使得機(jī)器人無(wú)論在行走和圖像采集的即時(shí)性上都得到了很大的高。

聲明:本文內(nèi)容及配圖由入駐作者撰寫(xiě)或者入駐合作網(wǎng)站授權(quán)轉(zhuǎn)載。文章觀點(diǎn)僅代表作者本人,不代表電子發(fā)燒友網(wǎng)立場(chǎng)。文章及其配圖僅供工程師學(xué)習(xí)之用,如有內(nèi)容侵權(quán)或者其他違規(guī)問(wèn)題,請(qǐng)聯(lián)系本站處理。 舉報(bào)投訴
  • 傳感器
    +關(guān)注

    關(guān)注

    2552

    文章

    51326

    瀏覽量

    755427
  • 機(jī)器人
    +關(guān)注

    關(guān)注

    211

    文章

    28579

    瀏覽量

    207804
  • Linux
    +關(guān)注

    關(guān)注

    87

    文章

    11331

    瀏覽量

    210016
  • 超聲波
    +關(guān)注

    關(guān)注

    63

    文章

    3037

    瀏覽量

    138537
收藏 人收藏

    評(píng)論

    相關(guān)推薦

    基于超聲波傳感器的自主移動(dòng)機(jī)器人的探測(cè)系統(tǒng)

    實(shí)現(xiàn)的。視覺(jué)、紅外、激光、超聲波傳感器都在移動(dòng)機(jī)器人中得到實(shí)際應(yīng)用。超聲波傳感器以其性價(jià)比高、
    發(fā)表于 01-19 13:45

    Labview My RIO 移動(dòng)機(jī)器人

    移動(dòng)機(jī)器人機(jī)械結(jié)構(gòu)和電氣部分安裝完成?;镜碾姍C(jī),傳感器等信號(hào)調(diào)試已經(jīng)完成。 由于是第一次使用Labview開(kāi)發(fā)移動(dòng)機(jī)器人,目前水平還不夠,遇到了問(wèn)題,如何利用編碼
    發(fā)表于 08-21 12:20

    超聲波傳感器機(jī)器人中的應(yīng)用

    、垂直的反射名義下進(jìn)行的。但對(duì)于移動(dòng)機(jī)器人很難保證其自身運(yùn)動(dòng)姿態(tài)的穩(wěn)定性,采用超聲波傳感器固定在移動(dòng)機(jī)器人車身的探測(cè)方式,當(dāng)移動(dòng)機(jī)器人偏離平
    發(fā)表于 08-09 15:19

    基于超聲波傳感器的自主移動(dòng)機(jī)器人探測(cè)系統(tǒng)

    的信息而實(shí)現(xiàn)的。視覺(jué)、紅外、激光、超聲波傳感器都在移動(dòng)機(jī)器人中得到實(shí)際應(yīng)用。超聲波傳感器以其性
    發(fā)表于 11-02 16:04

    超聲波傳感器機(jī)器人避障中有什么作用

    高、硬件實(shí)現(xiàn)簡(jiǎn)單等優(yōu)點(diǎn),移動(dòng)機(jī)器人感知系統(tǒng)中得到了廣泛的應(yīng)用。但是超聲波傳感器也存在一定的局限性,主要是因?yàn)椴ㄊ谴?、方向性差、測(cè)距的不穩(wěn)
    發(fā)表于 02-27 23:29

    基于ARM9的DF-1機(jī)器人傳感器系統(tǒng)設(shè)計(jì)

    感知外部環(huán)境信息和自身狀態(tài),獲得反饋信息,實(shí)現(xiàn)系統(tǒng)的閉環(huán)控制。目前仿人機(jī)器人中應(yīng)用的傳感器種類繁多,例如視覺(jué)傳感器、電子羅盤(pán)、加速度計(jì)和
    發(fā)表于 06-21 07:04

    家庭移動(dòng)機(jī)器人避障常用傳感器及相關(guān)技術(shù)

    移動(dòng)機(jī)器人機(jī)器人的重要研究領(lǐng)域,人們很早就開(kāi)始移動(dòng)機(jī)器人的研究。世界上第一臺(tái)真正意義上的移動(dòng)機(jī)器人是斯坦福研究院(SRI)的人工智能中心于1966年到1972年研制的,名叫Shake
    發(fā)表于 05-14 08:15

    如何實(shí)現(xiàn)移動(dòng)機(jī)器人的設(shè)計(jì)?

     移動(dòng)機(jī)器人利用導(dǎo)航技術(shù),獲得機(jī)器人的目前所處的位置,結(jié)合傳感器技術(shù)對(duì)周圍外界環(huán)境(障礙物等)作實(shí)時(shí)探測(cè),并根據(jù)環(huán)境提供的信息規(guī)劃一條可行路
    發(fā)表于 11-23 15:08

    移動(dòng)機(jī)器人超聲波測(cè)距功能設(shè)計(jì)

    ,在有效范圍內(nèi)的圖像采集控制。整個(gè)系統(tǒng)都是ARM9linux 平臺(tái)中完成,每個(gè)模塊都是用設(shè)備驅(qū)動(dòng)的方式實(shí)現(xiàn)使得模塊的控制更加方便。2
    發(fā)表于 10-08 09:41

    怎么實(shí)現(xiàn)三路超聲波避障移動(dòng)機(jī)器人平臺(tái)的設(shè)計(jì)?

    怎么實(shí)現(xiàn)三路超聲波避障移動(dòng)機(jī)器人平臺(tái)的設(shè)計(jì)?
    發(fā)表于 11-10 07:00

    【科普】干貨!帶你從0了解移動(dòng)機(jī)器人(三) ——自主導(dǎo)航系統(tǒng)及上位機(jī)軟件設(shè)計(jì)與實(shí)現(xiàn)

    傳感器數(shù)據(jù)獲取環(huán)境信息,規(guī)劃路徑并選擇最優(yōu)路徑到達(dá)目的地的算法。運(yùn)動(dòng)控制算法是指移動(dòng)機(jī)器人在到達(dá)目的地后,根據(jù)傳感器數(shù)據(jù)調(diào)整方向和速度的算法。這些算法需要在移動(dòng)機(jī)器人的控制
    發(fā)表于 06-28 09:36

    超聲波移動(dòng)機(jī)器人導(dǎo)航設(shè)計(jì)方法

      摘要: 采用新型的超聲波傳感器,設(shè)計(jì)并開(kāi)發(fā)基于ARM9 與嵌入式linux平臺(tái)的輪式移動(dòng)機(jī)器人平
    發(fā)表于 05-11 15:06 ?2783次閱讀
    <b class='flag-5'>超聲波</b><b class='flag-5'>移動(dòng)機(jī)器人</b><b class='flag-5'>導(dǎo)航</b>設(shè)計(jì)方法

    ARM-Linux平臺(tái)移動(dòng)機(jī)器人傳感器檢測(cè)數(shù)據(jù)讀取

    使用嵌入式技術(shù)設(shè)計(jì)移動(dòng)機(jī)器人控制時(shí),要求Linux操作系統(tǒng)下管理硬件資源。故以移動(dòng)機(jī)器人上配置的典型接近
    發(fā)表于 01-08 14:33 ?0次下載
    <b class='flag-5'>ARM-Linux</b><b class='flag-5'>平臺(tái)</b>上<b class='flag-5'>移動(dòng)機(jī)器人</b>的<b class='flag-5'>傳感器</b>檢測(cè)數(shù)據(jù)讀取

    采用超聲波移動(dòng)機(jī)器人導(dǎo)航設(shè)計(jì)方法[圖]

    摘要: 采用新型的超聲波傳感器,設(shè)計(jì)并開(kāi)發(fā)基于ARM9 與嵌入式linux平臺(tái)的輪式移動(dòng)機(jī)器人平臺(tái)
    發(fā)表于 01-17 22:39 ?429次閱讀

    基于DSP和CAN總線實(shí)現(xiàn)移動(dòng)機(jī)器人超聲測(cè)距系統(tǒng)的軟硬件設(shè)計(jì)

    移動(dòng)機(jī)器人實(shí)現(xiàn)在未知和不確定環(huán)境下運(yùn)行,必須具備自動(dòng)導(dǎo)航和避障功能。移動(dòng)機(jī)器人導(dǎo)航系統(tǒng)中,
    的頭像 發(fā)表于 10-18 07:49 ?5978次閱讀
    基于DSP和CAN總線<b class='flag-5'>實(shí)現(xiàn)</b><b class='flag-5'>移動(dòng)機(jī)器人</b><b class='flag-5'>超聲</b>測(cè)距系統(tǒng)的軟硬件設(shè)計(jì)