機器人的光電測距裝置制造方法
【專利摘要】一種機器人的光電測距裝置,其特征在于它包括最少一個固定在機器人上的光檢測裝置和最少一個光發(fā)射裝置,以及若干根一端朝向機器人前、后、左、右四個方向中的一個,另一端朝向光檢測裝置或朝向光發(fā)射裝置的光導(dǎo),在上述裝置中至少設(shè)置一個偏置裝置,所述的偏置裝置為光檢測裝置和光發(fā)射裝置及光導(dǎo)中的一類,所謂偏置指朝向前后左右偏過一個小角度的方向,利用偏置測距值與其旁邊正對前后左右方向的測距值進行比較可以得出機器人的偏離方向。
【專利說明】機器人的光電測距裝置
【技術(shù)領(lǐng)域】
[0001]本案為Z1201210435690.4的分案申請,原申請日為2012-11-05,申請名為“機器人的光電測距裝置”,本發(fā)明涉及一種機器人的光電測距裝置,主要用于機器人等機電類物體在移動過程中定位糾偏。
【背景技術(shù)】
[0002]機器人在移動過程中往往因為機構(gòu)本身的缺陷或者地面不平或者輪子間摩擦力不一致等因素引起機器人移動的距離或方向與預(yù)計的不一致,因而引起機器人移動的可靠性差,嚴(yán)重影響了機器人的使用。在室內(nèi)自主移動的機器人或自動導(dǎo)引運輸車(AutomatedGuided Vehicle簡稱AGV)常用的辦法是探測本身離墻壁等邊界的距離以確定機器人自身的方位,在實際使用中常常使用超聲波或激光測距的方式,因超聲波波束角較大等因素,可靠性不高,而激光測距比較可靠,但需在機器人上安裝多個,比如全方位或稱三自由度移動的機器人最好要安裝四套測距裝置以測試機器人到前后左右墻壁(邊界)的距離,因現(xiàn)有的激光測距儀相對于機器人的其它部件成本較高,尤其對于在室內(nèi)移動的家用服務(wù)機器人來說,降低成本尤其顯得重要,在專利號為CN200410014702.1的說明書中描述了一種機器人的測距傳感器,需要配置至少一個反射體,對于光電類傳感器來說,反射體一般需要涂銀,成本稍高,而且裝配時需在機器人上設(shè)置前后左右四個窗口,對于需要結(jié)構(gòu)緊湊的機器人來說,這種方式會受些限制。
[0003]為了知道機器人在行走過程中是向左偏了還是向右偏了,機器人需要左轉(zhuǎn)一下(檢測距離是否變小了)甚至左轉(zhuǎn)(檢測到距離變大了)了再右轉(zhuǎn)一些(檢測距離變小的程度),白白增加了機器人的動作,延緩了機器人運作的時間。
【發(fā)明內(nèi)容】
[0004]本發(fā)明的目的在設(shè)計一種安裝數(shù)量盡可能少的又能探測四個方向距離、安裝方式靈活、且可以不通過轉(zhuǎn)動就能知道是否左偏還是右偏的光電測距裝置。
[0005]本發(fā)明的目的是通過下述設(shè)計達到的:
一種機器人的光電測距裝置,其特征在于它包括最少一個固定在機器人上的光檢測裝置和最少一個光發(fā)射裝置,以及若干根一端朝向機器人前、后、左、右四個方向中的一個,另一端朝向光檢測裝置或朝向光發(fā)射裝置的光導(dǎo),在上述裝置中至少設(shè)置一個偏置裝置,所述的偏置裝置為光檢測裝置和光發(fā)射裝置及光導(dǎo)中的一類,所謂偏置指朝向前后左右偏過一個小角度的方向。檢測裝置會多收到一個回波,測得一個距離d5,這個多裝的偏置發(fā)射裝置與其旁邊的光檢測裝置或光發(fā)射裝置或光導(dǎo)之間有一個小角度夾角B (固定值,已知),正常情況下d5=dl*SecB(正割函數(shù),dl為偏置裝置旁邊的測距方向的測距值),如果偏了,若d5> dl*secB,則機器人是向左偏了,需向右旋轉(zhuǎn)矯正;若d5〈 dl*secB則物體是向右偏了,需向左旋轉(zhuǎn)矯正。
[0006]【專利附圖】
【附圖說明】: 圖1為本發(fā)明的一種典型的測距裝置設(shè)置俯視圖。
[0007]圖2?圖4為發(fā)明的機器人測距糾偏示意圖。
[0008]具體實施方案:
在機器人上固定最少一個光檢測裝置3和最少一個光發(fā)射裝置2,以及若干根一端朝向機器人前、后、左、右四個方向中的一個,另一端朝向光檢測裝置3或朝向激光發(fā)射裝置2的光導(dǎo)I。在上述裝置中至少設(shè)置一個偏置裝置,所述的偏置裝置為光檢測裝置和光發(fā)射裝置及光導(dǎo)中的至少一類,所謂偏置指朝向前后左右偏過一個小角度的方向。偏置裝置可以是一個獨立的光發(fā)射裝置,也可以是一個獨立的光檢測裝置,也可以是偏置設(shè)置的一根光導(dǎo),甚至可以是一個獨立的光發(fā)射裝置加上一根連到光檢測裝置的偏置的光導(dǎo)、一個獨立的光檢測裝置加上一根連到光發(fā)射裝置的偏置的光導(dǎo)、一根連到光發(fā)射裝置的偏置的光導(dǎo)加上一根連到光檢測裝置的偏置的光導(dǎo)、一個獨立的光檢測裝置和一個獨立的光發(fā)射裝置(這種方案成本稍高)。
[0009]光檢測裝置3與每個光發(fā)射裝置2之間有一根采樣光導(dǎo),或者光檢測裝置3朝向與光發(fā)射裝置2,以便光檢測裝置3檢測作為計時的起始點。
[0010]為了簡單知道機器人在行走過程中是向左偏了還是向右偏了,可以在任意一個方向(比如前方)上設(shè)置一個偏置發(fā)射裝置6,如圖1,檢測裝置3也會多收到一個回波,測得一個距離d5,這個多裝的偏置發(fā)射裝置6與其旁邊的發(fā)射裝置2之間有一個夾角B (固定值,已知),正常情況下(如圖2) d5=dl*secB (正割函數(shù)),如果偏了,若d5> dl*secB,則機器人是向左偏了,需向右旋轉(zhuǎn)矯正;若(15〈 dl*SecB則物體是向右偏了(如圖3、圖4),需向左旋轉(zhuǎn)矯正。
[0011 ] 偏置裝置可以設(shè)置在前后左右四個方向中的前方的一個、前后方向各一個共兩個、前后方向設(shè)置一個加上左右方向設(shè)置一個共兩個、前后左(或右)方向各一個共三個、或者前后左右四個方向各一個共四個。如果設(shè)置多個偏置裝置,可以根據(jù)Z1201210435690.4說明書的本意,利用光導(dǎo)或者反射面將多個方向的偏置裝置聚合在一起,只設(shè)置一個偏置光檢測裝置或一個偏置光發(fā)射裝置。
[0012]偏置裝置可以向左偏,也可向右偏,可以設(shè)置在正向(前后左右任一方向)測距裝置的左面,也可設(shè)置在右面,這些設(shè)置方式與例圖的設(shè)置無實質(zhì)性區(qū)別。
[0013]圖1中設(shè)置前后兩個偏置發(fā)射裝置是為了預(yù)防測距上方(前方)遇到墻或障礙物不是平整的情況下,d5嚴(yán)重偏離dl*SecB時,可以嘗試下方(后方)的測距值;或者d5與dl*SecB幾乎相等(dl值比較小時會出現(xiàn)此種情況),也可以嘗試下方(后方)的測距值,甚至比較上方加上下方的測距值。這樣整套裝置除了采樣光導(dǎo)外還包括分別朝向前后左右四個方向的四個光發(fā)射裝置(2)、分別朝向前后偏置方向的兩個偏置光發(fā)射裝置6、一個光檢測裝置3、以及若干根一端朝向機器人前、后、左、右四個方向中一個,另一端朝向光檢測裝置3的光導(dǎo)I。
[0014]一端朝向光檢測裝置3的光導(dǎo)I若干根光導(dǎo)I為十根,其中四根分別朝向分別朝向前后左右四個方向,另六根為朝向六個光發(fā)射裝置的采樣光導(dǎo),這十根光導(dǎo)在光檢測裝置3段聚合在一起。
[0015]—端朝向光檢測裝置3的光導(dǎo)I若干根光導(dǎo)I為十二根,其中六根分別朝向分別朝向前后左右四個方向和前后偏置方向,另六根為朝向六個光發(fā)射裝置的采樣光導(dǎo),這十二根光導(dǎo)在光檢測裝置3段聚合在一起。
[0016]整套裝置可再加上分別朝向左右偏置方向的兩個偏置光發(fā)射裝置出),對應(yīng)的光導(dǎo)(包括采樣光導(dǎo))也相應(yīng)增加。
[0017]光導(dǎo)I為光纖或者廉價的pc材料(工程塑料)制作的光導(dǎo)管(導(dǎo)光管、導(dǎo)光柱)。光導(dǎo)I若可為光纖,為了提高檢測到的發(fā)射光的強度,可在光纖前面設(shè)置一凸透鏡聚焦,對于有一定粗細(xì)的光導(dǎo)管來說在,導(dǎo)光管的前端和末端均可設(shè)置聚焦透鏡,還可將較粗的PC材料的光導(dǎo)的前端和末端加工呈凸面狀,前段甚至可加工成喇叭狀凸面,末端收束呈針狀。在光導(dǎo)和光檢測裝置之間還可設(shè)置濾光片過濾干擾或者濾光材料可以直接添加在光導(dǎo)或凸透鏡中。
[0018]為簡化起見,光發(fā)射、光檢測裝置上的引腳沒有標(biāo)示,傳感器信號的發(fā)射、接收電路、信號處理過程均有成熟的技術(shù),不加以說明。雖然安裝了多個發(fā)射或檢測裝置,但相對應(yīng)的控制電路只需要一套,用多選一電路進行選擇單個逐次發(fā)射或接收。光在光導(dǎo)中傳輸?shù)木嚯x的精確值在整套測距裝置中并不重要,可忽略或事先作為常數(shù)保存。
【權(quán)利要求】
1.一種機器人的光電測距裝置,其特征在于它包括至少一個固定在機器人上的光檢測裝置(3)和至少一個光發(fā)射裝置(2),若干根一端朝向機器人前、后、左、右四個方向中一個,另一端朝向光檢測裝置(3)或朝向光發(fā)射裝置(2)的光導(dǎo)(1),以及至少存在一個偏置裝置,所述的偏置裝置為光檢測裝置(3)和光發(fā)射裝置(2)及光導(dǎo)(I)中的至少一類,所謂偏置指朝向前后左右偏過一個小角度的方向。
2.根據(jù)權(quán)利要求1所述的一種機器人的光電測距裝置,其特征在于所述的光檢測裝置(3)與每個光發(fā)射裝置(2)之間有一根米樣光導(dǎo)。
3.根據(jù)權(quán)利要求1所述的一種機器人的光電測距裝置,其特征在于所述的光檢測裝置(3)朝向與光發(fā)射裝置(2)。
4.根據(jù)權(quán)利要求2所述的一種機器人的光電測距裝置,其特征在于整套裝置除了采樣光導(dǎo)外還包括分別朝向前后左右四個方向的四個光發(fā)射裝置(2)、分別朝向前后偏置方向的兩個偏置光發(fā)射裝置出)、一個光檢測裝置(3)、以及若干根一端朝向機器人前、后、左、右四個方向中一個,另一端朝向光檢測裝置(3)的光導(dǎo)(I)。
5.根據(jù)權(quán)利要求4所述的一種機器人的光電測距裝置,其特征在于所述的一端朝向光檢測裝置(3)的光導(dǎo)(I)若干根光導(dǎo)(I)為十根,其中四根分別朝向分別朝向前后左右四個方向,另六根為朝向六個光發(fā)射裝置的采樣光導(dǎo),這十根光導(dǎo)在光檢測裝置(3)段聚合在一起。
6.根據(jù)權(quán)利要求4所述的一種機器人的光電測距裝置,其特征在于所述的一端朝向光檢測裝置(3 )的光導(dǎo)(I)若干根光導(dǎo)(I)為十二根,其中六根分別朝向分別朝向前后左右四個方向和前后偏置方向,另六根為朝向六個光發(fā)射裝置的采樣光導(dǎo),這十二根光導(dǎo)在光檢測裝置(3)段聚合在一起。
7.根據(jù)權(quán)利要求4所述的一種機器人的光電測距裝置,其特征在于整套裝置再加上分別朝向左右偏置方向的兩個偏置光發(fā)射裝置(6)。
【文檔編號】G01S17/08GK104297757SQ201410576445
【公開日】2015年1月21日 申請日期:2012年11月5日 優(yōu)先權(quán)日:2012年11月5日
【發(fā)明者】張周新 申請人:張周新