"/>
  • 
    <ul id="o6k0g"></ul>
    <ul id="o6k0g"></ul>

    機(jī)器人搜索任務(wù)路徑規(guī)劃方法技術(shù)

    技術(shù)編號(hào):39397464 閱讀:23 留言:0更新日期:2023-11-19 15:51
    本公開(kāi)提供的機(jī)器人搜索任務(wù)路徑規(guī)劃方法,包括:

    【技術(shù)實(shí)現(xiàn)步驟摘要】
    機(jī)器人搜索任務(wù)路徑規(guī)劃方法、裝置、電子設(shè)備和存儲(chǔ)介質(zhì)


    [0001]本公開(kāi)屬于機(jī)器人路徑規(guī)劃領(lǐng)域,具體涉及基于置信準(zhǔn)則決策的機(jī)器人搜索任務(wù)路徑規(guī)劃方法

    裝置

    電子設(shè)備和存儲(chǔ)介質(zhì)


    技術(shù)介紹

    [0002]移動(dòng)機(jī)器人在室內(nèi)環(huán)境幫助人類完成物體搜索已成為機(jī)器人的核心任務(wù)之一,例如,密閉救災(zāi)環(huán)境下搜尋幸存者,辦公室環(huán)境下傳遞文件,家庭環(huán)境下端茶倒水

    目前基于搜素任務(wù)的路徑規(guī)劃方法通常是根據(jù)機(jī)器人與環(huán)境中每個(gè)房間距離遠(yuǎn)近或者按照固定搜索策略
    (
    順時(shí)針或者逆時(shí)針遍歷各個(gè)房間
    )
    執(zhí)行的,由于物體位置未知,機(jī)器人任務(wù)執(zhí)行時(shí)間長(zhǎng)

    規(guī)劃效率低

    因此有必要開(kāi)發(fā)一種有效的利用環(huán)境先驗(yàn)知識(shí)獲取物體在不同房間的概率以及高效決策的路徑規(guī)劃方法,實(shí)現(xiàn)機(jī)器人快速

    精準(zhǔn)的物體搜索任務(wù)


    技術(shù)實(shí)現(xiàn)思路

    [0003]本公開(kāi)旨在至少在一定程度上解決相關(guān)技術(shù)中的技術(shù)問(wèn)題之一

    [0004]為此,本公開(kāi)第一方面實(shí)施例提供的機(jī)器人搜索任務(wù)路徑規(guī)劃方法,可有效利用環(huán)境先驗(yàn)知識(shí)處理室內(nèi)環(huán)境物體搜索的路徑規(guī)劃方法,實(shí)現(xiàn)快速

    高效的物體搜索任務(wù),本公開(kāi)第一方面實(shí)施例提供的機(jī)器人搜索任務(wù)路徑規(guī)劃方法,包括:
    [0005]S1、
    通過(guò)語(yǔ)義信息獲取目標(biāo)物體在當(dāng)前環(huán)境中各個(gè)房間的概率,根據(jù)所述概率得到機(jī)器人搜索任務(wù)的當(dāng)前置信狀態(tài);
    [0006]S2、
    基于路徑長(zhǎng)度

    當(dāng)前置信狀態(tài)和運(yùn)動(dòng)機(jī)動(dòng)性設(shè)計(jì)搜索任務(wù)的代價(jià)函數(shù),將代價(jià)最小時(shí)對(duì)應(yīng)的房間作為當(dāng)前搜索任務(wù)的目標(biāo)位置;
    [0007]S3、
    機(jī)器人運(yùn)動(dòng)到所述目標(biāo)位置并進(jìn)行目標(biāo)物體檢測(cè),若機(jī)器人檢測(cè)到目標(biāo)物體,則當(dāng)前搜索任務(wù)結(jié)束;若機(jī)器人未檢測(cè)到目標(biāo)物體,則進(jìn)入步驟
    S4

    [0008]S4、
    對(duì)目標(biāo)物體在當(dāng)前環(huán)境中各個(gè)房間的概率進(jìn)行更新:將目標(biāo)物體在當(dāng)前房間的概率減小至第一值,將目標(biāo)物體在其他房間的概率均增加第二值,且增加總和等于所述目標(biāo)物體在當(dāng)前房間的概率的變化量;更新當(dāng)前置信狀態(tài),返回步驟
    S2。
    [0009]在一些實(shí)施例中,步驟
    S1
    中,設(shè)目標(biāo)物體在當(dāng)前環(huán)境中第
    i
    個(gè)房間
    R
    i
    的概率為
    p
    i
    ,按照下式獲取得到:
    [0010][0011][0012]p(R
    i
    )

    1/n
    [0013]式中,
    p(R
    i
    |obj)
    為根據(jù)貝葉斯定理計(jì)算的目標(biāo)物體
    obj
    存在于第
    i
    個(gè)房間
    R
    i
    的概率,
    i
    取1時(shí)對(duì)應(yīng)機(jī)器人當(dāng)前所在房間的編號(hào);
    p(obj|R
    i
    )
    為第
    i
    個(gè)房間
    R
    i
    存在目標(biāo)物體
    obj

    基于語(yǔ)義信息的概率,
    NR
    i
    表示第
    i
    個(gè)房間的單詞在語(yǔ)料庫(kù)中出現(xiàn)的總次數(shù),所述語(yǔ)料庫(kù)中存儲(chǔ)有若干語(yǔ)句,且各語(yǔ)句中均含有與搜索任務(wù)對(duì)應(yīng)的目標(biāo)物體的單詞,
    NF
    為用于表示目標(biāo)物體搜索失敗次數(shù)的超參數(shù),
    n
    為搜索任務(wù)環(huán)境下的房間總數(shù);
    p(R
    i
    )
    為第
    i
    個(gè)房間
    R
    i
    被搜索的概率,設(shè)搜索任務(wù)執(zhí)行前每個(gè)房間被搜索過(guò)相同的次數(shù)

    [0014]在一些實(shí)施例中,步驟
    S1
    中,設(shè)所述當(dāng)前置信狀態(tài)為
    B
    ,表達(dá)式為:
    [0015]B

    [b1,

    ,b
    i
    ,

    ,b
    n
    ],b
    i

    p
    i
    [0016]式中,
    b
    i
    為當(dāng)前置信狀態(tài)
    B
    中的第
    i
    個(gè)元素,
    p
    i
    為目標(biāo)物體在當(dāng)前環(huán)境中第
    i
    個(gè)房間
    R
    i
    的概率,
    i
    取1時(shí)對(duì)應(yīng)機(jī)器人當(dāng)前所在房間的編號(hào)

    [0017]在一些實(shí)施例中,步驟
    S2
    中,所述代價(jià)函數(shù)的表達(dá)式如下:
    [0018]Γ
    i

    ω1·
    L
    i
    /p(R
    i
    |obj)+
    ω2·
    θ
    i
    [0019]式中,
    Γ
    i
    為第
    i
    個(gè)房間
    R
    i
    的代價(jià);
    L
    i
    為機(jī)器人的當(dāng)前位置到第
    i
    個(gè)房間的路徑長(zhǎng)度;
    θ
    i
    為機(jī)器人由當(dāng)前位置運(yùn)動(dòng)到第
    i
    個(gè)房間的運(yùn)動(dòng)機(jī)動(dòng)性;
    ω1為衡量考慮室內(nèi)環(huán)境先驗(yàn)知識(shí)的路徑長(zhǎng)度的第一權(quán)重系數(shù),
    ω2為衡量運(yùn)動(dòng)機(jī)動(dòng)性的第二權(quán)重系數(shù),且滿足
    ω1+
    ω2=1;
    [0020]所述機(jī)器人由當(dāng)前位置運(yùn)動(dòng)到第
    i
    個(gè)房間的運(yùn)動(dòng)機(jī)動(dòng)性
    θ
    i
    按照以下步驟得到:
    [0021]以機(jī)器人的當(dāng)前位置作為圓心,構(gòu)建一圓形區(qū)域,該圓形區(qū)域應(yīng)覆蓋所述當(dāng)前環(huán)境所在范圍,將所述圓形區(qū)域等分為
    m
    個(gè)扇形區(qū)域,
    m
    為大于或者等于2的正整數(shù),設(shè)第
    i
    個(gè)房間
    R
    i
    與機(jī)器人當(dāng)前位置間的連線和機(jī)器人當(dāng)前朝向的夾角為
    β
    i
    ,設(shè)機(jī)器人運(yùn)動(dòng)機(jī)動(dòng)性的等級(jí)有
    k
    個(gè),并將運(yùn)動(dòng)機(jī)動(dòng)性的值在0~1范圍內(nèi)進(jìn)行歸一化處理,最終按照下式得到機(jī)器人由當(dāng)前位置運(yùn)動(dòng)到第
    i
    個(gè)房間的運(yùn)動(dòng)機(jī)動(dòng)性
    θ
    i

    [0022][0023][0024]式中,
    α
    為所述扇形區(qū)域的圓心角,
    α
    =2π
    /m。
    [0025]在一些實(shí)施例中,步驟
    S3
    中,機(jī)器人按照利用動(dòng)態(tài)窗口方法生成的運(yùn)動(dòng)控制量運(yùn)動(dòng)到所述目標(biāo)位置

    [0026]在一些實(shí)施例中,所述運(yùn)動(dòng)控制量包括機(jī)器人的線速度和角速度

    [0027]在一些實(shí)施例中,步驟
    S4
    中,按照下式對(duì)目標(biāo)物體在當(dāng)前環(huán)境中各個(gè)房間的概率進(jìn)行更新:
    [0028]p'1=
    ε
    [0029]p'
    j

    p
    ...

    【技術(shù)保護(hù)點(diǎn)】

    【技術(shù)特征摘要】
    1.
    一種機(jī)器人搜索任務(wù)路徑規(guī)劃方法,其特征在于,包括:
    S1、
    通過(guò)語(yǔ)義信息獲取目標(biāo)物體在當(dāng)前環(huán)境中各個(gè)房間的概率,根據(jù)所述概率得到機(jī)器人搜索任務(wù)的當(dāng)前置信狀態(tài);
    S2、
    基于路徑長(zhǎng)度

    當(dāng)前置信狀態(tài)和運(yùn)動(dòng)機(jī)動(dòng)性設(shè)計(jì)搜索任務(wù)的代價(jià)函數(shù),將代價(jià)最小時(shí)對(duì)應(yīng)的房間作為當(dāng)前搜索任務(wù)的目標(biāo)位置;
    S3、
    機(jī)器人運(yùn)動(dòng)到所述目標(biāo)位置并進(jìn)行目標(biāo)物體檢測(cè),若機(jī)器人檢測(cè)到目標(biāo)物體,則當(dāng)前搜索任務(wù)結(jié)束;若機(jī)器人未檢測(cè)到目標(biāo)物體,則進(jìn)入步驟
    S4

    S4、
    對(duì)目標(biāo)物體在當(dāng)前環(huán)境中各個(gè)房間的概率進(jìn)行更新:將目標(biāo)物體在當(dāng)前房間的概率減小至第一值,將目標(biāo)物體在其他房間的概率均增加第二值,且增加總和等于所述目標(biāo)物體在當(dāng)前房間的概率的變化量;更新當(dāng)前置信狀態(tài),返回步驟
    S2。2.
    根據(jù)權(quán)利要求1所述的機(jī)器人搜索任務(wù)路徑規(guī)劃方法,其特征在于,步驟
    S1
    中,設(shè)目標(biāo)物體在當(dāng)前環(huán)境中第
    i
    個(gè)房間
    R
    i
    的概率為
    p
    i
    ,按照下式獲取得到:,按照下式獲取得到:
    p(R
    i
    )

    1/n
    式中,
    p(R
    i
    |obj)
    為根據(jù)貝葉斯定理計(jì)算的目標(biāo)物體
    obj
    存在于第
    i
    個(gè)房間
    R
    i
    的概率,
    i
    取1時(shí)對(duì)應(yīng)機(jī)器人當(dāng)前所在房間的編號(hào);
    p(obj|R
    i
    )
    為第
    i
    個(gè)房間
    R
    i
    存在目標(biāo)物體
    obj
    的基于語(yǔ)義信息的概率,
    NR
    i
    表示第
    i
    個(gè)房間的單詞在語(yǔ)料庫(kù)中出現(xiàn)的總次數(shù),所述語(yǔ)料庫(kù)中存儲(chǔ)有若干語(yǔ)句,且各語(yǔ)句中均含有與搜索任務(wù)對(duì)應(yīng)的目標(biāo)物體的單詞,
    NF
    為用于表示目標(biāo)物體搜索失敗次數(shù)的超參數(shù),
    n
    為搜索任務(wù)環(huán)境下的房間總數(shù);
    p(R
    i
    )
    為第
    i
    個(gè)房間
    R
    i
    被搜索的概率,設(shè)搜索任務(wù)執(zhí)行前每個(gè)房間被搜索過(guò)相同的次數(shù)
    。3.
    根據(jù)權(quán)利要求1所述的機(jī)器人搜索任務(wù)路徑規(guī)劃方法,其特征在于,步驟
    S1
    中,設(shè)所述當(dāng)前置信狀態(tài)為
    B
    ,表達(dá)式為:
    B

    [b1,


    b
    i



    b
    n
    ]

    b
    i

    p
    i
    式中,
    b
    i
    為當(dāng)前置信狀態(tài)
    B
    中的第
    i
    個(gè)元素,
    p
    i
    為目標(biāo)物體在當(dāng)前環(huán)境中第
    i
    個(gè)房間
    R
    i
    的概率,
    i
    取1時(shí)對(duì)應(yīng)機(jī)器人當(dāng)前所在房間的編號(hào)
    。4.
    根據(jù)權(quán)利要求2所述的機(jī)器人搜索任務(wù)路徑規(guī)劃方法,其特征在于,步驟
    S2
    中,所述代價(jià)函數(shù)的表達(dá)式如下:
    Γ
    i

    ω1·
    L
    i
    /p(R
    i
    |obj)+
    ω2·
    θ
    i
    式中,
    Γ
    i
    為第
    i
    個(gè)房間
    R
    i
    的代價(jià);
    L
    i
    為機(jī)器人的當(dāng)前位置到第
    i
    個(gè)房間的路徑長(zhǎng)度;
    θ
    i
    為機(jī)器人由當(dāng)前位置運(yùn)動(dòng)到第
    i
    個(gè)房間的運(yùn)動(dòng)機(jī)動(dòng)性;
    ω1為衡量考慮室內(nèi)環(huán)境先驗(yàn)知識(shí)的路徑長(zhǎng)度的第一權(quán)重系數(shù),
    ω2為衡量運(yùn)動(dòng)機(jī)動(dòng)性的第二權(quán)...

    【專利技術(shù)屬性】
    技術(shù)研發(fā)人員:孫富春閔海波
    申請(qǐng)(專利權(quán))人:北京愛(ài)賓果科技有限公司
    類型:發(fā)明
    國(guó)別省市:

    網(wǎng)友詢問(wèn)留言 已有0條評(píng)論
    • 還沒(méi)有人留言評(píng)論。發(fā)表了對(duì)其他瀏覽者有用的留言會(huì)獲得科技券。

    1
    主站蜘蛛池模板: 无码AV大香线蕉| 少妇久久久久久人妻无码| 午夜成人无码福利免费视频| 免费无遮挡无码视频在线观看| 一级毛片中出无码| 中文字幕无码AV波多野吉衣| 精品久久久无码中文字幕天天| 97久久精品亚洲中文字幕无码| 精品人妻少妇嫩草AV无码专区| 久久综合精品国产二区无码| 无码专区一va亚洲v专区在线 | 日韩少妇无码喷潮系列一二三| 国产v亚洲v天堂无码网站| 国产精品无码专区AV在线播放| 国产50部艳色禁片无码| 精品久久久久久无码国产| 国产成人无码精品久久久露脸 | 麻豆精品无码国产在线果冻| 亚洲V无码一区二区三区四区观看 亚洲爆乳精品无码一区二区三区 亚洲爆乳无码一区二区三区 | 一本一道av中文字幕无码| 国语成本人片免费av无码| 亚洲日韩AV无码一区二区三区人| 亚洲中久无码永久在线观看同| 日韩经典精品无码一区| 无码免费午夜福利片在线| 精品国产aⅴ无码一区二区| 无码视频在线观看| 色综合久久无码中文字幕| 国产成A人亚洲精V品无码| 国产精品无码AV一区二区三区| 人妻丰满熟妇aⅴ无码| 中文无码熟妇人妻AV在线| 日韩A无码AV一区二区三区| 日韩经典精品无码一区| 无码人妻精品一区二| 久久无码精品一区二区三区| 国产成人亚洲综合无码| 亚洲精品无码永久在线观看你懂的| 中文字幕精品无码一区二区 | 无套中出丰满人妻无码| 无码一区二区三区老色鬼|