基于概率論的機(jī)器人高斯運(yùn)動(dòng)避障軌跡規(guī)劃方法
【圖文】:
定軌跡,而是在沿軌跡行走的每一時(shí)刻都存在偏離軌跡的概率。當(dāng)假定系統(tǒng)觀測(cè)誤差和控制過程誤差都服從高斯分布時(shí),偏離預(yù)定軌跡的偏移量也服從高斯分布。這種誤差服從高斯分布的機(jī)器人非確定性運(yùn)動(dòng),在本文中簡(jiǎn)稱為高斯運(yùn)動(dòng)。由于觀測(cè)誤差和系統(tǒng)過程誤差都限定在一個(gè)范圍內(nèi),因此機(jī)器人的運(yùn)動(dòng)偏差范圍也會(huì)在一個(gè)可估計(jì)的區(qū)間內(nèi)。從概率的角度考慮,當(dāng)機(jī)器人重復(fù)地走一條預(yù)定義軌跡,由于噪聲的隨機(jī)性機(jī)器人每次的實(shí)際軌跡并不相同,但所有的軌跡會(huì)近似地以預(yù)定義軌跡為期望,在一定方差范圍的區(qū)間內(nèi)服從高斯分布,如圖1所示。因此,盡管機(jī)器人在軌跡預(yù)定義階段進(jìn)行了避障規(guī)劃,但并不能保證實(shí)際運(yùn)動(dòng)能夠完全避開障礙,這種與障礙碰撞的概率需要進(jìn)行量化計(jì)算,作為機(jī)器人高斯運(yùn)動(dòng)的安全性分析基矗目前機(jī)器人系統(tǒng)的軌跡規(guī)劃方法研究大多是基于系統(tǒng)的確定性假設(shè),不乏有很多非常優(yōu)秀的成果[2-4]。在機(jī)器人非確定性的研究方面BRY等[5-6]將系統(tǒng)非確定性加入隨機(jī)擴(kuò)展樹的節(jié)點(diǎn)生成過程,每生成一個(gè)新的節(jié)點(diǎn),用蒙特卡洛法檢驗(yàn)新生節(jié)點(diǎn)的方差概率,進(jìn)行軌跡規(guī)劃。TOIT等[7-8]在機(jī)器人控制系統(tǒng)中,將LQR控制與卡爾曼濾波相結(jié)合,采用滾動(dòng)時(shí)域的方法降低機(jī)器人系統(tǒng)運(yùn)動(dòng)偏差。SUN等[9-10]應(yīng)用多核、多線程編程技術(shù)將TOIT的LQG非確定性采樣優(yōu)化方法,,應(yīng)用于實(shí)時(shí)計(jì)算,并對(duì)醫(yī)療探針、移動(dòng)機(jī)器人的實(shí)時(shí)軌跡規(guī)劃進(jìn)行了仿真。本文采用概率論的方法,在機(jī)器人模型線性化的基礎(chǔ)上,應(yīng)用LQR線性控制與觀測(cè)傳感器卡爾曼濾波相結(jié)合,對(duì)機(jī)器人沿預(yù)定軌跡運(yùn)動(dòng)的誤差概率進(jìn)行先驗(yàn)估計(jì)。將預(yù)定義軌跡上的點(diǎn)作為概率期望、其可能誤差用協(xié)方差表示。對(duì)每條軌跡的協(xié)方差進(jìn)行避開障礙的概率評(píng)估,得到軌跡的避障概率。在此基礎(chǔ)上通過樣?
ku的權(quán)重系數(shù)矩陣,對(duì)于控制周期k0,,l1,l個(gè)控制周期內(nèi)Lk的迭代解分別為lS(13)111T1T111()kk+kk+kk+k+LBSBBSA(14)11111TT1kk+kk+k+kk+kSASA+ASBL(15)在軌跡規(guī)劃中,以式(6)~(15)機(jī)器人高斯運(yùn)動(dòng)控制形式計(jì)算每個(gè)周期軌跡位置誤差的先驗(yàn)概率協(xié)方差Pk。3碰撞概率計(jì)算3.1高斯運(yùn)動(dòng)概率橢圓表示通過第2節(jié)的軌跡建模與估計(jì)過程迭代得到每個(gè)控制周期機(jī)器人軌跡點(diǎn)的正態(tài)分布方差?梢杂酶怕蕶E圓表示方差的分布情況。假設(shè)軌跡點(diǎn)pi處的協(xié)方差矩陣為Ti。如圖2所示,圖2中分布著服從期望為pi方差為Ti的正態(tài)分布的隨機(jī)點(diǎn),每個(gè)隨機(jī)點(diǎn)都表示一個(gè)機(jī)器人可能出現(xiàn)的位置。圖2概率橢圓生成過程為了能夠?qū)⑦@些可能出現(xiàn)的概率點(diǎn)進(jìn)行幾何表示,對(duì)協(xié)方差矩陣進(jìn)行特征分解,從而得到特征值Di和特征矢量Vi[,]E()liiVDigT(16)E()iigT為特征值分解函數(shù)。由標(biāo)準(zhǔn)正態(tài)分布概率表[12]可知,隨機(jī)變量在區(qū)間[ 3,3]的概率為99.95%,我們將其近似看作100%。因此,圓心在c0處半徑為3個(gè)單位長(zhǎng)度的圓,可以近似地表示期
【相似文獻(xiàn)】
相關(guān)期刊論文 前10條
1 ;2001恩格爾伯格機(jī)器人獎(jiǎng)?lì)C布[J];機(jī)器人技術(shù)與應(yīng)用;2001年05期
2 ;神奇的機(jī)器人世界[J];機(jī)電新產(chǎn)品導(dǎo)報(bào);2001年Z5期
3 宋樹藩;采用機(jī)器人的有效自動(dòng)化[J];世界制造技術(shù)與裝備市場(chǎng);2001年06期
4 ;創(chuàng)造出色的機(jī)器人[J];個(gè)人電腦;2003年04期
5 ;危險(xiǎn)作業(yè)機(jī)器人——人類的好幫手——訪國(guó)家863機(jī)器人技術(shù)主題專家組專家戴先中教授[J];機(jī)器人技術(shù)與應(yīng)用;2003年03期
6 小才;;機(jī)器人時(shí)代[J];電腦愛好者;2006年13期
7 宋海宏;;機(jī)器人技術(shù)展望[J];山西煤炭管理干部學(xué)院學(xué)報(bào);2006年04期
8 董煬斌;蔣靜坪;何衍;;一種基于雙令牌的多機(jī)器人協(xié)作策略研究[J];計(jì)算機(jī)工程;2007年12期
9 王國(guó)奎;劉彥波;;草方格鋪設(shè)機(jī)器人綜合、高效控制系統(tǒng)的設(shè)計(jì)[J];科技咨詢導(dǎo)報(bào);2007年20期
10 陳秀珍;潘拓;;21世紀(jì)初機(jī)器人技術(shù)的走向[J];中國(guó)設(shè)備工程;2007年11期
相關(guān)會(huì)議論文 前10條
1 楊朝虹;張海珠;;機(jī)器人技術(shù)的應(yīng)用與發(fā)展[A];先進(jìn)制造技術(shù)論壇暨第五屆制造業(yè)自動(dòng)化與信息化技術(shù)交流會(huì)論文集[C];2006年
2 王明輝;王楠;李斌;;面向?yàn)?zāi)難救援的機(jī)器人控制站系統(tǒng)設(shè)計(jì)[A];中國(guó)儀器儀表學(xué)會(huì)第十二屆青年學(xué)術(shù)會(huì)議論文集[C];2010年
3 郭戈;王燕;王偉;;一種多機(jī)器人協(xié)作方法[A];第二十屆中國(guó)控制會(huì)議論文集(下)[C];2001年
4 崔世鋼;邴志剛;彭商賢;王玉東;;基于遠(yuǎn)程腦概念的服務(wù)機(jī)器人開發(fā)平臺(tái)的設(shè)計(jì)與研究[A];先進(jìn)制造技術(shù)論壇暨第二屆制造業(yè)自動(dòng)化與信息化技術(shù)交流會(huì)論文集[C];2003年
5 楊瑩;丁X;許侃;;國(guó)際機(jī)器人科學(xué)知識(shí)前沿演化的可視化分析[A];科學(xué)學(xué)理論與科學(xué)計(jì)量學(xué)探索——全國(guó)科學(xué)技術(shù)學(xué)暨科學(xué)學(xué)理論與學(xué)科建設(shè)2008年聯(lián)合年會(huì)論文集[C];2008年
6 唐矯燕;趙群飛;黃杰;楊汝清;;基于兩足步行椅機(jī)器人的人在環(huán)中的助殘機(jī)器人控制系統(tǒng)[A];第二十六屆中國(guó)控制會(huì)議論文集[C];2007年
7 薛頌東;曾建潮;杜靜;;具運(yùn)動(dòng)學(xué)特性約束的群機(jī)器人目標(biāo)搜索[A];2009中國(guó)控制與決策會(huì)議論文集(2)[C];2009年
8 張國(guó)偉;李斌;龔海里;王聰;鄭懷兵;;廢墟洞穴搜救機(jī)器人控制軟件設(shè)計(jì)與實(shí)現(xiàn)[A];中國(guó)儀器儀表學(xué)會(huì)第十二屆青年學(xué)術(shù)會(huì)議論文集[C];2010年
9 崔世鋼;方景林;劉嘉q;彭商賢;邴志剛;;服務(wù)機(jī)器人開發(fā)中測(cè)控問題的研究[A];中國(guó)儀器儀表學(xué)會(huì)第五屆青年學(xué)術(shù)會(huì)議論文集[C];2003年
10 吳國(guó)盛;李云霞;李驪;;一種基于極坐標(biāo)系下的機(jī)器人動(dòng)態(tài)避碰算法[A];2006中國(guó)控制與決策學(xué)術(shù)年會(huì)論文集[C];2006年
相關(guān)重要報(bào)紙文章 前10條
1 冬冬;看看自動(dòng)化機(jī)器人在包裝業(yè)中能起多大作用[N];中國(guó)包裝報(bào);2005年
2 莽九晨 周之然;有感“機(jī)器人道德法”[N];人民日?qǐng)?bào);2007年
3 記者 陳琳;機(jī)器人總動(dòng)員[N];第一財(cái)經(jīng)日?qǐng)?bào);2010年
4 記者 孫亞斐;千余支隊(duì)伍攜機(jī)器人亮相金城[N];蘭州日?qǐng)?bào);2011年
5 崔鑫;機(jī)器人也能和您一起下廚[N];北京科技報(bào);2012年
6 特約記者 楊保國(guó);中國(guó)科大“藍(lán)鷹”稱雄機(jī)器人世界杯[N];大眾科技報(bào);2007年
7 本報(bào)記者 陳淑娟;機(jī)器人走近生活[N];計(jì)算機(jī)世界;2006年
8 虎虎;科學(xué)好玩(三)[N];四川科技報(bào);2007年
9 孫潛彤;新松公司:在機(jī)器人研發(fā)領(lǐng)域顯身手[N];經(jīng)濟(jì)日?qǐng)?bào);2008年
10 財(cái)宣邋Q孟推
本文編號(hào):2554638
本文鏈接:http://sikaile.net/kejilunwen/zidonghuakongzhilunwen/2554638.html