亚洲狠狠干,亚洲国产福利精品一区二区,国产八区,激情文学亚洲色图

物體的計(jì)測方法及物體的計(jì)測裝置的制作方法

文檔序號(hào):6015297閱讀:396來源:國知局
專利名稱:物體的計(jì)測方法及物體的計(jì)測裝置的制作方法
技術(shù)領(lǐng)域
本發(fā)明是關(guān)于使用脈沖激光對(duì)物體的位置、大小、移動(dòng)速度進(jìn)行計(jì)測的物體的計(jì)測方法及物體的計(jì)測裝置的發(fā)明。
背景技術(shù)
現(xiàn)知的技術(shù)是利用激光多普勒方法,對(duì)在運(yùn)送中的長方體形狀的物體的侵入角度和側(cè)邊的實(shí)長進(jìn)行測量的方法、裝置(例如特開平8-285554號(hào)公報(bào))。
更詳細(xì)地說,上述的已知方法和裝置是根據(jù)長方體形狀的物品在通過帶式運(yùn)送機(jī)被運(yùn)送的過程中,通過激光多普勒速度傳感器求得的上述帶式運(yùn)送機(jī)的移動(dòng)速度和,在上述2個(gè)長方體形狀的物品的頂部、與上述帶式運(yùn)送機(jī)的移動(dòng)方向成直角方向并排放置的2個(gè)物體位置檢出傳感器檢出上述被傳送過來的長方體的各個(gè)時(shí)刻的時(shí)間差,來求出上述長方體的側(cè)邊的實(shí)長和對(duì)于上述帶式運(yùn)送機(jī)的移動(dòng)方向的上述長方體的侵入角度。
上述已知的方法和裝置不能計(jì)測長方體的側(cè)邊的實(shí)長和對(duì)上述帶式運(yùn)送機(jī)的移動(dòng)方向的上述長方體的侵入角度以外的值,例如上述長方體的寬、高、上述長方體整體的大小,具有不能計(jì)測長方體以外的形狀的物體的大小、位置、移動(dòng)速度的弱點(diǎn)。
本發(fā)明的目的是提供使用脈沖激光能夠計(jì)測長方體或者長方體以外形狀的物體的整體大小、位置、移動(dòng)速度的物體的計(jì)測方法和物體的計(jì)測裝置。

發(fā)明內(nèi)容
根據(jù)本發(fā)明的第1實(shí)施形態(tài)的物體計(jì)測方法是對(duì)物體的大小、位置、移動(dòng)速度中至少一個(gè)、使用在上述物體的外部設(shè)置的激光發(fā)射器發(fā)射的脈沖激光、來進(jìn)行計(jì)測的物體計(jì)測方法,該物體計(jì)測方法有下述步驟上述脈沖激光對(duì)上述物體進(jìn)行二維掃描,接受上述物體反射的反射光,根據(jù)上述脈沖激光的發(fā)射方向和上述脈沖激光的發(fā)射時(shí)刻和該脈沖激光的反射光的受光時(shí)刻的時(shí)間差來檢出上述物體的反射位置的反射位置檢出步驟;和根據(jù)上述被檢出的多個(gè)反射位置來算出上述物體的大小、位置、移動(dòng)速度中至少一個(gè)的算出步驟。
根據(jù)本發(fā)明的第2實(shí)施形態(tài)的物體計(jì)測裝置是對(duì)物體的大小、位置、移動(dòng)速度中至少一個(gè)進(jìn)行計(jì)測的物體計(jì)測裝置,該物體計(jì)測裝置具有對(duì)上述物體能夠發(fā)射脈沖激光的脈沖激光發(fā)射裝置;用上述脈沖激光對(duì)上述物體進(jìn)行二維掃描的掃描裝置;能夠接受從上述物體被反射的上述脈沖激光的脈沖激光受光裝置;根據(jù)上述脈沖激光的發(fā)射方向和上述脈沖激光的發(fā)射時(shí)刻和這個(gè)脈沖激光的反射光的受光時(shí)刻的時(shí)間差來檢出上述物體的反射位置的反射位置檢出裝置;和根據(jù)上述被檢出的多個(gè)反射位置來計(jì)算出上述物體的大小、位置、移動(dòng)速度中至少一個(gè)的算出裝置。
根據(jù)本發(fā)明的第3實(shí)施形態(tài)的物體計(jì)測方法是底面對(duì)XY平面大體平行地設(shè)置的長方體的大小或者設(shè)置位置、采用在上述長方體的外部設(shè)置的激光發(fā)生器發(fā)射的脈沖激光、來進(jìn)行計(jì)測的計(jì)測方法,該物體計(jì)測方法由下述步驟組成用上述脈沖激光對(duì)上述長方體進(jìn)行二維掃描,接受上述物體反射的反射光,根據(jù)上述脈沖激光的發(fā)射方向和上述脈沖激光的發(fā)射時(shí)刻和該脈沖激光的反射光的受光時(shí)刻的時(shí)間差來檢出上述長方體的反射位置的反射位置檢出步驟;和根據(jù)上述被檢出的多個(gè)反射位置來算出上述長方體的大小、設(shè)置位置的算出步驟。
根據(jù)本發(fā)明的第4實(shí)施形態(tài)的計(jì)算方法是在第3實(shí)施形態(tài)的物體計(jì)測方法中,該方法的算出步驟是根據(jù)上述檢出的多個(gè)反射位置算出上述長方體的棱線的坐標(biāo)值,并用算出的棱線的坐標(biāo)值算出上述長方體的頂面的各個(gè)頂點(diǎn),并計(jì)算出上述長方體的大小或者設(shè)置位置的算出方法。
根據(jù)本發(fā)明的第5實(shí)施形態(tài)的計(jì)測方法是在第4實(shí)施形態(tài)的計(jì)測方法中,該方法的掃描是對(duì)一定方向進(jìn)行一維掃描后,通過變換掃描位置在與上述的一定方向大致平行的方向上進(jìn)行多次同上述的一維掃描相同的掃描來對(duì)上述長方體進(jìn)行二維掃描;上述計(jì)算步驟是對(duì)每個(gè)上述一維掃描,從上述各個(gè)反射位置的X坐標(biāo)值和Y坐標(biāo)值求得XY平面上的適當(dāng)數(shù)的直線方程式,且根據(jù)這個(gè)適當(dāng)數(shù)的直線式的條數(shù)或者傾斜度來判斷從上述激光發(fā)生器對(duì)上述長方體的哪個(gè)面照射了脈沖激光;當(dāng)上述長方體的頂面照射了脈沖激光時(shí),根據(jù)上述各個(gè)掃描的上述頂面的反射位置的X坐標(biāo)值的最大值和與這個(gè)最大值對(duì)應(yīng)的Y坐標(biāo)值、在上述各個(gè)掃描的上述頂面的反射位置的X坐標(biāo)值的最小值和與這個(gè)最小值對(duì)應(yīng)的Y坐標(biāo)值來求得包含上述長方體的頂面的4條棱線的4種直線,并求得上述各條直線的交點(diǎn)的X坐標(biāo)值和Y坐標(biāo)值,而且使用上述頂面的反射位置的Z坐標(biāo)值,計(jì)算上述長方體的上述頂面的各個(gè)頂點(diǎn);在上述長方體的2個(gè)側(cè)面被上述脈沖激光照射的情況下,對(duì)上述各個(gè)掃描,從上述各個(gè)反射位置的X坐標(biāo)值和Y坐標(biāo)值來計(jì)算XY平面上的2個(gè)直線方程式,從這2個(gè)直線方程式的交點(diǎn)中,計(jì)算與Z軸大致平行的、上述長方體的第1棱線的X坐標(biāo)值和Y坐標(biāo)值,且根據(jù)上述各個(gè)掃描的上述側(cè)面的反射位置的X坐標(biāo)值的最大值和與這個(gè)最大值對(duì)應(yīng)的Y坐標(biāo)值來計(jì)算與Z軸大致平行的、上述長方體的第2棱線的X坐標(biāo)值和Y坐標(biāo)值,并根據(jù)上述各個(gè)掃描的上述側(cè)面的反射位置的X坐標(biāo)值的最小值和與這個(gè)最小值對(duì)應(yīng)的Y坐標(biāo)值來計(jì)算與Z軸大致平行的、上述長方體的第3棱線的X坐標(biāo)值和Y坐標(biāo)值,根據(jù)上述第1-3各條棱線的各X坐標(biāo)值和各Y坐標(biāo)值來計(jì)算與Z軸大致平行的、第4棱線的X坐標(biāo)值和Y坐標(biāo)值,從上述各反射位置的Z坐標(biāo)值的最大值,計(jì)算上述長方體的頂面的高度位置,根據(jù)上述第1-4棱線的各X坐標(biāo)值和各Y坐標(biāo)值和上述上面的高度位置來計(jì)算上述長方體的上述頂面的各個(gè)頂點(diǎn);當(dāng)上述長方體的僅僅一個(gè)側(cè)面被上述脈沖激光照射時(shí),判斷為不可能算出長方體的大小或設(shè)置位置是的計(jì)測方法。
根據(jù)本發(fā)明的第6實(shí)施形態(tài)的測量裝置是對(duì)于底面與XY平面大體平行地設(shè)置的長方體的大小或者設(shè)置位置進(jìn)行計(jì)測的計(jì)測裝置,該裝置有可對(duì)上述長方體發(fā)射脈沖激光的脈沖激光發(fā)射裝置;用上述脈沖激光對(duì)上述長方體進(jìn)行二維掃描的掃描裝置;接受從上述長方體反射的上述脈沖激光的脈沖激光受光裝置;根據(jù)上述脈沖激光的發(fā)射方向和、上述脈沖激光的發(fā)射時(shí)刻和這個(gè)脈沖激光的反射光的受光時(shí)刻的時(shí)間差來檢出上述長方體的反射位置的反射位置檢出裝置;根據(jù)上述被檢出的多個(gè)反射位置來算出并輸出上述長方體的大小或者設(shè)置位置的算出裝置。
根據(jù)本發(fā)明的第7實(shí)施形態(tài)的采用區(qū)域感應(yīng)器的物體識(shí)別方法是采用區(qū)域感應(yīng)器的物體識(shí)別方法,該方法的特征是通過區(qū)域感應(yīng)器向覆蓋引導(dǎo)行人的步行區(qū)域和該步行區(qū)域的周圍區(qū)域的檢出范圍內(nèi)一邊發(fā)射脈沖激光一邊掃描,計(jì)測光的反射時(shí)間,通過求出各掃描點(diǎn)的沒有物體存在時(shí)的反射時(shí)間和有物體存在時(shí)的反射時(shí)間的差,來演算物體的形狀、大小、和各掃描的物體的位置變化的向量,從該演算信號(hào)來識(shí)別沿引導(dǎo)方向在步行區(qū)域移動(dòng)的物體和沿橫斷步行區(qū)域的方向移動(dòng)的物體。
根據(jù)本發(fā)明第8實(shí)施形態(tài)的通采用區(qū)域感應(yīng)器的物體識(shí)別方法是在上述第7實(shí)施形態(tài)記載的采用區(qū)域感應(yīng)器的物體識(shí)別方法中,通過向量朝向步行區(qū)域的引導(dǎo)方向、物體的形狀、大小來識(shí)別沿引導(dǎo)方向在步行區(qū)域移動(dòng)的物體的采用區(qū)域感應(yīng)器的物體識(shí)別方法。
根據(jù)本發(fā)明的第9實(shí)施形態(tài)的采用區(qū)域感應(yīng)器的物體識(shí)別方法是在上述第7實(shí)施形態(tài)或第8實(shí)施形態(tài)記載的采用區(qū)域感應(yīng)器的物體識(shí)別方法中,識(shí)別沿引導(dǎo)方向在步行區(qū)域移動(dòng)的物體至少是成年的健康人、小孩、坐輪椅的人、行動(dòng)不自如的人的采用區(qū)域感應(yīng)器的物體識(shí)別方法。
根據(jù)本發(fā)明的第10實(shí)施形態(tài)的采用區(qū)域感應(yīng)器的物體識(shí)別方法是在上述第7實(shí)施形態(tài)記載的采用區(qū)域感應(yīng)器的物體識(shí)別方法中,至少是通過突然出現(xiàn)在檢出范圍的周圍和向量是朝向橫斷步行區(qū)域來識(shí)別在沿橫斷步行區(qū)域方向移動(dòng)的物體的采用區(qū)域感應(yīng)器的物體識(shí)別方法。
根據(jù)本發(fā)明的第11實(shí)施形態(tài)的采用區(qū)域感應(yīng)器的物體識(shí)別方法是在上述第7實(shí)施形態(tài)或第10實(shí)施形態(tài)記載的采用區(qū)域感應(yīng)器的物體識(shí)別方法中,識(shí)別沿橫斷步行區(qū)域移動(dòng)的物體是汽車。
上述第7實(shí)施形態(tài)至第11實(shí)施形態(tài)的采用區(qū)域感應(yīng)器的物體識(shí)別方法的具有以下作用。
因?yàn)槭褂脜^(qū)域掃描器一邊向檢出范圍投射脈沖激光一邊掃描,測量光的反射時(shí)間,檢出在各掃描點(diǎn)的物體不存在時(shí)的反射時(shí)間和物體存在時(shí)的反射時(shí)間的差來檢出物體,所以能不受天氣等環(huán)境狀況的影響、高精度地檢出物體。以此,能更詳細(xì)地識(shí)別沿引導(dǎo)方向在步行區(qū)域移動(dòng)的物體和沿橫斷步行區(qū)域方向移動(dòng)的物體,當(dāng)行人為小孩、坐輪椅的人、和行走不方便的人等交通弱者時(shí),能夠確實(shí)地進(jìn)行識(shí)別,所以用此識(shí)別結(jié)果,交通弱者能夠放心地、安全地走過步行區(qū)域,能夠成為確實(shí)的安全裝置。
根據(jù)本發(fā)明的第12實(shí)施形態(tài)的物體計(jì)測裝置具備掃描所定監(jiān)視區(qū)域的激光雷達(dá);通過這個(gè)激光雷達(dá)檢出的可視化距離信息后制作雷達(dá)圖像的雷達(dá)圖像制作裝置;在前述激光雷達(dá)附近設(shè)置的具備對(duì)激光雷達(dá)的監(jiān)視區(qū)域攝像的監(jiān)視照相機(jī);特別是以具備使由前述監(jiān)視照相機(jī)拍攝的照相圖像的坐標(biāo)和前述雷達(dá)圖像的坐標(biāo)相對(duì)應(yīng)的圖像匹配裝置為特征。
更好的是,前述雷達(dá)圖像制作裝置的構(gòu)成,能夠制作將根據(jù)第13實(shí)施形態(tài)的物體計(jì)測裝置的方式檢出的距離信息經(jīng)濃淡變換或色調(diào)變換后,使3維信息可視化的雷達(dá)圖像。而且,如根據(jù)第14實(shí)施形態(tài)的物體計(jì)測裝置的方式,前述圖像匹配裝置的構(gòu)成是根據(jù)在前述攝像圖像和雷達(dá)圖像之間相互對(duì)應(yīng)的多數(shù)特征點(diǎn)的位置坐標(biāo),使前述攝像圖像的坐標(biāo)系與前述的雷達(dá)圖像坐標(biāo)系相重合。
依照這樣構(gòu)成的物體計(jì)測裝置,因?yàn)閿z像圖像和雷達(dá)圖像可相互對(duì)應(yīng),例如從攝像圖像容易判別監(jiān)視對(duì)象區(qū)域的物體時(shí),同時(shí)從雷達(dá)圖像容易地、精度高地求得該物體的空間坐標(biāo)(從監(jiān)視點(diǎn)的距離和方位)。相反的,因?yàn)楫?dāng)受到天氣等的影響使得攝像圖像不鮮明時(shí),可通過雷達(dá)圖像來補(bǔ)充其不鮮明度,所以能把握住監(jiān)視對(duì)象區(qū)域的確實(shí)狀況。
根據(jù)本發(fā)明的第15實(shí)施形態(tài)的物體計(jì)測裝置,其特征是在上述第12實(shí)施形態(tài)記載的物體計(jì)測裝置中,還具有從前述激光雷達(dá)圖像識(shí)別物體的面和/或移動(dòng)物體的物體識(shí)別裝置;和將確定識(shí)別后的物體的面和/或移動(dòng)物體的輔助信息重疊在上述攝像圖像上表示的輔助信息表示裝置。
依照這樣構(gòu)成的物體計(jì)測裝置,通過把從激光雷達(dá)圖像確定物體的面和/或移動(dòng)物體的輔助信息、例如輪廓線、識(shí)別標(biāo)記在攝像圖像上重疊表示,能夠明確地表示出在監(jiān)視對(duì)象區(qū)域中的不變的固定構(gòu)造物,和把上述監(jiān)視對(duì)象區(qū)域中的應(yīng)注目的物體與其他物體容易識(shí)別地表示出來。其結(jié)果是不受天氣等因素的左右、能夠準(zhǔn)確把握監(jiān)視對(duì)象區(qū)域的各種狀況。
根據(jù)本發(fā)明的第16實(shí)施形態(tài)的物體計(jì)測裝置,其特征是具備一邊接受向所定方向照射的脈沖激光的反射光,一邊使上述脈沖激光的照射方向?qū)λǖ谋O(jiān)視區(qū)域的全區(qū)域進(jìn)行掃描的激光雷達(dá);從通過該激光雷達(dá)檢出出的距離信息(反射光的受光時(shí)間)和該掃描方向的信息中求得分別表示前述脈沖激光的反射點(diǎn)的空間坐標(biāo)的3維雷達(dá)信息的雷達(dá)信息制作裝置;從前述3維雷達(dá)信息檢出在前述所定的監(jiān)視區(qū)域內(nèi)存在的物體的物體檢出裝置;進(jìn)而從前述3維雷達(dá)信息判斷在預(yù)先設(shè)定的觀察點(diǎn)(空間坐標(biāo))有無特定物,對(duì)于前述監(jiān)視區(qū)域控制物體監(jiān)視處理的實(shí)行的監(jiān)視條件判斷裝置;接受該監(jiān)視條件判定裝置的控制并通過前述物體檢出裝置控制物體檢出動(dòng)作,或者控制通過前述物體檢出裝置而得到的檢出結(jié)果的輸出的監(jiān)視裝置。
即,本發(fā)明的物體檢出裝置的特征是著眼于在所定的監(jiān)視區(qū)域內(nèi)的特定物體的動(dòng)作與對(duì)于該監(jiān)視區(qū)域的物體監(jiān)視處理的必要性相關(guān),有效地運(yùn)用激光雷達(dá)所具有的物體的空間坐標(biāo)檢出功能,判斷上述特定物是否處于所定的部位(觀察點(diǎn))(監(jiān)視條件判定裝置),與該判斷結(jié)果相適應(yīng),控制由前述物體檢出裝置的物體檢出動(dòng)作,并且控制由前述物體檢出裝置的檢出結(jié)果的輸出。即,本發(fā)明的物體檢出裝置的特征是利用具備激光雷達(dá)的物體計(jì)測裝置自身擁有的機(jī)能來控制自己的處理動(dòng)作,實(shí)行不需要從外部輸入控制信號(hào)而進(jìn)行必要的監(jiān)視處理動(dòng)作。
本發(fā)明的較好方式如第17實(shí)施形態(tài)記載的物體計(jì)測裝置,前述所定的監(jiān)視區(qū)域是鐵道道口區(qū)域,前述基準(zhǔn)物體由區(qū)劃上述鐵道道口區(qū)域的斷路閘構(gòu)成,前述監(jiān)視條件的判斷裝置判斷前述斷路閘是否處于待機(jī)位置。特別是,本發(fā)明的特征是通過檢出斷路閘不處在待機(jī)位置控制使其實(shí)行監(jiān)視處理動(dòng)作,換言之,只有在斷路閘處于待機(jī)位置時(shí)才停止監(jiān)視處理動(dòng)作,實(shí)行重視安全性的、準(zhǔn)確性高的鐵道道口區(qū)域內(nèi)的監(jiān)視處理。
而且根據(jù)本發(fā)明第18實(shí)施形態(tài)的物體計(jì)測裝置的特征是在上述第16或者上述第17實(shí)施形態(tài)記載的物體計(jì)測裝置上,再加以將上述3維雷達(dá)信息進(jìn)行平面坐標(biāo)變換并制作監(jiān)視圖像的坐標(biāo)變換裝置和,在用該坐標(biāo)變換裝置制作的監(jiān)視圖像上將指定前述物體檢出裝置求得的物體的輔助信息重合表示的圖像表示裝置。
根據(jù)如此構(gòu)成的物體計(jì)測裝置,便能把在所定的監(jiān)視區(qū)域內(nèi)非本意存在的物體和其存在位置以可視的、更容易把握(認(rèn)識(shí))的形式來圖像表示。其結(jié)果,可以例如發(fā)出警報(bào),已及屆時(shí)迅速準(zhǔn)確地采取記錄前述3維雷達(dá)信息等對(duì)策。


圖1是本發(fā)明的實(shí)施形態(tài)的測量裝置的簡略構(gòu)成示圖。
圖2是測量裝置的動(dòng)作的簡略示圖。
圖3是表示對(duì)紙箱施行在圖2的一個(gè)一維掃描情況的示圖。
圖4表示測量裝置測定紙箱的設(shè)置位置、全體的大小時(shí)的動(dòng)作的簡略流程。
圖5是圖3表示的紙箱的各個(gè)反射位置的一部分的擴(kuò)大圖。
圖6是表示紙箱和測量裝置之間的相對(duì)位置關(guān)系和利用脈沖激光進(jìn)行掃描的示圖。
圖7是表示紙箱和測量裝置之間的相對(duì)位置關(guān)系和利用脈沖激光進(jìn)行掃描的示圖。
圖8是表示紙箱和測量裝置之間的相對(duì)位置關(guān)系和利用脈沖激光進(jìn)行掃描的示圖。
圖9是表示紙箱和測量裝置之間的相對(duì)位置關(guān)系和利用脈沖激光進(jìn)行掃描的示圖。
圖10是表示紙箱和測量裝置之間的相對(duì)位置關(guān)系和利用脈沖激光進(jìn)行掃描的示圖。
圖11是表示紙箱和測量裝置之間的相對(duì)位置關(guān)系和利用脈沖激光進(jìn)行掃描的示圖。
圖12是在僅可以對(duì)紙箱的頂面進(jìn)行脈沖激光照射的模式中,用測量裝置對(duì)紙箱的頂面進(jìn)行掃描的情況示圖。
圖13是測量裝置被設(shè)置在只能照射紙箱的頂面和一個(gè)側(cè)面的位置的模式,而且是紙箱的上述一個(gè)側(cè)面與測量裝置的一維掃描方向大致平行的模式,對(duì)紙箱的頂面和一個(gè)的側(cè)面進(jìn)行掃描的情況示圖。
圖14是測量裝置被設(shè)置在只能照射紙箱的頂面和一個(gè)側(cè)面的位置的模式,而且是紙箱的上述一個(gè)側(cè)面和測量裝置的一維掃描方向大致平行的模式,對(duì)紙箱的頂面和一個(gè)側(cè)面進(jìn)行掃描的情況的示圖。
圖15是在測量裝置可能對(duì)紙箱的頂面和2個(gè)側(cè)面進(jìn)行脈沖激光照射的模式中,對(duì)紙箱的2個(gè)的側(cè)面進(jìn)行掃描的情況示圖。
圖16是在測量裝置可能對(duì)紙箱的頂面和2個(gè)側(cè)面進(jìn)行脈沖激光照射的模式中,對(duì)紙箱的2個(gè)側(cè)面進(jìn)行掃描的情況示圖。
圖17是在測量裝置僅可能對(duì)紙箱的2個(gè)側(cè)面進(jìn)行脈沖激光照射的模式中,對(duì)紙箱的2個(gè)側(cè)面進(jìn)行掃描的情況示圖。
圖18是在測量裝置僅可能對(duì)紙箱的2個(gè)側(cè)面進(jìn)行脈沖激光照射的模式中,對(duì)紙箱的2個(gè)側(cè)面進(jìn)行掃描的情況示圖。
圖19是實(shí)施本發(fā)明裝置的形態(tài)之一例的框圖。
圖20是表示適用本發(fā)明的公路交叉點(diǎn)的一例的平面圖。
圖21是表示在本發(fā)明的檢出范圍內(nèi)脈沖激光掃描狀態(tài)的斜視圖。
圖22是表示通過圖21的脈沖激光的反射時(shí)間、在各點(diǎn)、3維地計(jì)測行人狀態(tài)的斜視圖。
圖23是表示在圖22在各點(diǎn)、3維地計(jì)測后的信息中加權(quán),得到能識(shí)別行人和汽車的檢出值的狀態(tài)的斜視圖。
圖24是表示與圖21不同的檢出范圍的狀態(tài)的斜視圖。
圖25是用向量表示在圖24中的物體的狀態(tài)的斜視圖。
圖26是本發(fā)明的一實(shí)施形態(tài)的物體計(jì)測裝置的簡略構(gòu)成圖。
圖27是通過激光雷達(dá)對(duì)監(jiān)視對(duì)象區(qū)域進(jìn)行掃描的狀態(tài)示圖。
圖28是表示激光雷達(dá)圖像的簡略制作處理裝置的框圖。
圖29是對(duì)激光雷達(dá)圖像30A和攝像圖像30B進(jìn)行匹配處理的概念的表示圖。
圖30是圖像匹配處理的具體處理順序的一例示圖。
圖31是表示圖26所示的物體計(jì)測裝置的監(jiān)視圖像的有代表性的表示例的示圖。
圖32是本發(fā)明的一實(shí)施形態(tài)的物體計(jì)測裝置的簡略構(gòu)成圖。
圖33是通過激光雷達(dá)對(duì)監(jiān)視對(duì)象區(qū)域進(jìn)行掃描的狀態(tài)示圖。
圖34是表示激光雷達(dá)圖像的簡略的制作處理裝置的框圖。
圖35是使用圖32所示的物體計(jì)測裝置監(jiān)視鐵道道口樣子的示圖。
圖36是圖32所示的物體計(jì)測裝置的初期設(shè)定處理的簡略的處理順序示圖。
圖37是圖32所示的物體計(jì)測裝置的監(jiān)視處理的實(shí)施控制順序的一例的示圖。
實(shí)施發(fā)明的最好的形態(tài)圖1是本發(fā)明的實(shí)施形態(tài)的計(jì)測裝置3的簡略構(gòu)成示圖。
計(jì)測裝置3具有對(duì)紙箱1能夠發(fā)射脈沖激光LB1的脈沖激光發(fā)射裝置5;用上述脈沖激光LB1對(duì)上述紙箱1進(jìn)行二維掃描的掃描裝置7;接受從上述紙箱1反射的上述脈沖激光LB1的脈沖激光受光裝置9;根據(jù)上述脈沖激光LB1的發(fā)射方向和上述脈沖激光LB1的發(fā)射時(shí)刻與該脈沖激光LB1的反射光的受光時(shí)刻的時(shí)間差來檢出上述紙箱1的反射位置的反射位置檢出裝置11;根據(jù)上述被檢出的多個(gè)反射位置,算出并輸出上述紙箱1的整體大小和設(shè)置位置的算出裝置13。
在這里,脈沖激光發(fā)射裝置5有設(shè)置在控制單元15內(nèi)的、可產(chǎn)生脈沖激光LB1激光器單元17,上述生成的脈沖激光LB1從被設(shè)置在掃描裝置7的基臺(tái)19的脈沖激光發(fā)射部21面向上述掃描裝置7的多面鏡23的反射面發(fā)射出去。
掃描裝置7,用脈沖激光LB1向一定的方向?qū)埾?進(jìn)行一維掃描后,通過變換掃描位置,在與上述一定方向大致平行的方向上多次進(jìn)行與上述一維掃描同樣的掃描,在上述紙箱1的表面中,使脈沖激光LB1對(duì)照射可能的面的大致全域進(jìn)行二維掃描。
在這里,掃描裝置7具備基臺(tái)19,回轉(zhuǎn)自由地支持多面鏡23的多面鏡支撐部件25回轉(zhuǎn)自由地被支持在該基臺(tái)19上。而且,多面鏡23的回轉(zhuǎn)軸和多面鏡支撐部件25的回轉(zhuǎn)軸以相互大致成直角方式設(shè)置。用于讓多面鏡23向箭頭AR11的方向回轉(zhuǎn)的控制電機(jī)27被連動(dòng)地連接在上述多面鏡23上,用于讓多面鏡支撐部件25向箭頭AR12的方向回轉(zhuǎn)的控制電機(jī)29被連動(dòng)地連接在上述多面鏡支撐材料25上。
通過回轉(zhuǎn)在側(cè)面的4個(gè)面形成反射面的多面鏡23,從脈沖激光反射部21發(fā)射出的脈沖激光LB1的發(fā)射方向產(chǎn)生變化,該脈沖激光LB1向一定方向?qū)埾?進(jìn)行一維掃描。而且,通過回轉(zhuǎn)多面鏡支撐部件25,反復(fù)進(jìn)行多次與上述一維掃描大致平行的一維掃描,就能實(shí)現(xiàn)對(duì)紙箱1的二維掃描。
為了檢出這些各控制電機(jī)的回轉(zhuǎn)角度,在控制電機(jī)27或控制電機(jī)29上設(shè)置了編碼器(encoder),通過上述各個(gè)編碼器,能夠檢出上述脈沖激光LB1的發(fā)射方向。
脈沖激光受光裝置9具有探測器33,該探測器33用于檢出脈沖激光發(fā)射裝置5發(fā)射的、被紙箱1的表面反射的、由集光鏡頭31集光的脈沖激光。且被紙箱1的表面反射的上述脈沖激光,被多面鏡23反射,向著集光鏡頭31的方向前進(jìn)。
脈沖激光發(fā)射部21、集光鏡頭31和探測器33,通過沒有圖示的連接部材,被一體地固定在多面鏡支撐材料25上,隨著多面鏡支撐材料25的回轉(zhuǎn)一起回轉(zhuǎn)。
反射位置檢出裝置11具有設(shè)置在控制單元15的記數(shù)器35,該記數(shù)器35計(jì)算從上述激光單元17發(fā)射出的脈沖激光LB1的發(fā)射時(shí)刻與探測器33檢測出的上述脈沖激光LB1的反射光的受光時(shí)刻的時(shí)間差。
然后,設(shè)置在控制單元15控制用個(gè)人電腦37接受上述記數(shù)器35求得的上述時(shí)間差、表示上述脈沖激光LB1的發(fā)射方向的、由編碼器檢測出的控制電機(jī)27的輸出軸的回轉(zhuǎn)角度值、和控制電機(jī)29的輸出軸的回轉(zhuǎn)角度的值,上述脈沖激光的紙箱1的表面的反射位置由控制用個(gè)人電腦37檢出。
控制用個(gè)人電腦37,如上所述,在控制設(shè)置了激光器單元17和記數(shù)器35的控制單元15整體的同時(shí),控制控制電機(jī)27和控制電機(jī)29。
算出裝置13使用上位個(gè)人電腦39,根據(jù)控制用個(gè)人電腦37檢出的多個(gè)反射位置,算出上述紙箱1的棱線的坐標(biāo)值,使用該被算出的棱線的坐標(biāo)值算出上述紙箱1的各頂點(diǎn),算出并輸出上述紙箱1的整體大小和設(shè)置位置。且,上述被算出的上述紙箱1的大小和設(shè)置位置,被輸出并表示在上述上位個(gè)人電腦39的液晶顯示器等的顯示屏(沒有圖示)上或與上述上位個(gè)人電腦39連接的打印機(jī)上。
接下來,對(duì)計(jì)測裝置3的動(dòng)作進(jìn)行說明。
計(jì)測裝置3的各動(dòng)作在如圖1中所示的控制用個(gè)人電腦37、上位個(gè)人電腦39的控制下進(jìn)行。
首先說明計(jì)測裝置3求出為計(jì)測紙箱1所發(fā)射的脈沖激光LB1在上述紙箱1的表面上的反射位置的XYZ坐標(biāo)值的動(dòng)作。
在上述動(dòng)作中,使紙箱1和計(jì)測裝置3之間的相對(duì)位置關(guān)系不變化。例如,紙箱1設(shè)置成對(duì)于地面不移動(dòng)的狀態(tài),計(jì)測裝置3的基臺(tái)19也設(shè)置成對(duì)于地面不移動(dòng)的狀態(tài)。
圖2是計(jì)測裝置3的動(dòng)作的簡略表示圖。
在圖2中,把紙箱1的底面設(shè)置成對(duì)于地面大致平行(例如,上述底面和上述地面接觸)來設(shè)置紙箱1,而且在上述地面的上方部設(shè)置計(jì)測裝置3。
連續(xù)發(fā)射脈沖激光LB1,通過回轉(zhuǎn)如圖1所示的多面鏡23,計(jì)測裝置3在如圖2所示的箭頭AR21方向進(jìn)行直線性的、一維的掃描W21。上述掃描W21,脈沖激光LB1被發(fā)射(N)次,在上述地面上形成各反射位置(點(diǎn))P11-P1N。
繼而,回轉(zhuǎn)圖1所示的多面鏡支撐部件25,連續(xù)發(fā)射脈沖激光LB1,通過回轉(zhuǎn)如圖1所示的多面鏡23,使一維的掃描位置向如圖2所示的AR22方向移動(dòng),計(jì)測裝置3進(jìn)行與掃描W21大致一樣的直線性的、并且一維的掃描W22。進(jìn)而,計(jì)測裝置3進(jìn)行多次與掃描W21大致同樣的掃描W23-W2M。象這樣,通過一維的多次的掃描W21-W2m,計(jì)測裝置3進(jìn)行對(duì)紙箱1的二維掃描。而且,上述各一維掃描W21-W2M的掃描方向是相互平行的。
其次,對(duì)檢出(抽出)紙箱1的反射位置的動(dòng)作進(jìn)行說明。
圖3是在對(duì)紙箱1實(shí)行如圖2的一個(gè)一維的掃描W2n的情況的示圖。圖3中,設(shè)置紙箱1使其底面與XY平面(Z=0的面)Pxy相接,計(jì)測裝置3被設(shè)置在XYZ空間的所定的位置(例如,X=0、Y=0、Z=H;高度)。
圖3(a)是在施行一個(gè)一維掃描W2n的情況的正面圖,圖3(b)是表示在圖3(a)中的III箭頭方向的平面圖。
這里,如圖2說明的那樣,連續(xù)發(fā)射脈沖激光LB1,通過回轉(zhuǎn)圖1所示的多面鏡23,在圖3(b)的箭頭AR31的方向上進(jìn)行一次直線性的一維掃描W2n。該一維掃描W2n中,多個(gè)(n個(gè))脈沖激光Wp1-Wpn被發(fā)射,對(duì)應(yīng)于該各脈沖激光Wp1-Wpn形成多個(gè)反射位置(反射點(diǎn))P1-P2。
這里,例如,使用計(jì)測裝置3和反射位置Pr之間的距離和脈沖激光Wpr的發(fā)射方向,用上述XYZ空間的XYZ坐標(biāo)值來表示反射位置Pr的情況進(jìn)行說明。
一個(gè)脈沖激光Wpr從計(jì)測裝置3被反射的時(shí)刻作為時(shí)刻t1,上述脈沖激光Wpr從紙箱1上的反射位置Pr被反射,如果用上述計(jì)測裝置3接受該激光的時(shí)刻作為時(shí)刻t2,從上述計(jì)測裝置3到上述反射位置Pr的距離L3可用式子(L3=(t2-t1)×c)([c]是光速)算出。
如圖3(a)所示,上述脈沖激光Wpr的發(fā)射方向與z軸的交叉角度作為角度θ,如圖3(b)表示的那樣,上述脈沖激光Wpr的發(fā)射方向和y軸的交叉角度作為角度φ,上述反射位置Pr的z坐標(biāo)值能夠用計(jì)算式[H-L3cosθ]求得,上述反射位置Pr的x坐標(biāo)值能用計(jì)算式[-L3sinθsinφ]求得,上述反射位置Pr的y坐標(biāo)值能用[L3sinθcosφ]求得。
同樣的,上述脈沖激光Wpr以外的各脈沖激光Wp1-Wpr-1、Wpr+2-Wpn的各反射位置P1-Pr-1、Pr+2-Pn的xyz坐標(biāo)值也能夠求得,各反射位置P1-Pn的xyz坐標(biāo)值也能夠被求得。
在這些各反射位置P1-Pn中,z坐標(biāo)值大致為0的各反射位置P1-Pr-1、Pr+9-Pn,表示上述xy平面Pxy上的反射位置,在z坐標(biāo)值不為0的各反射位置Pr-Pr+8表示紙箱1上的反射位置。
因此,各反射位置P1-Pr-1、Pr+9-Pn是上述xy平面Pxy上的反射位置,因?yàn)椴皇羌埾?上的反射位置,因而可無視,根據(jù)各反射位置Pr-Pr+8,算出上述紙箱1的棱線的坐標(biāo)值,用該計(jì)算出的棱線的坐標(biāo)值算出上述紙箱1的上面的各個(gè)頂點(diǎn),并算出紙箱1的設(shè)置位置和整體的大小。
如圖3(b)所示,例如一個(gè)反射位置Pm,對(duì)于上述反射位置Pm先后的反射位置Pm-1、Pm+1,坐標(biāo)值明顯不同的可無視,例如,作為空氣中檢出飄著的垃圾等檢出。也就是,在反射位置Pm,紙箱1不存在。
圖3中,關(guān)于一個(gè)一維掃描W2n進(jìn)行了說明,變換圖3(a)表示的交叉角度θ,實(shí)行別的一維掃描時(shí),和一維掃描W2n一樣,可求出紙箱1的表面上的個(gè)反射位置的xyz坐標(biāo)值。然后,如圖2所示,通過多次的一維掃描W21-W2M,即對(duì)紙箱1施行二維掃描。而且,通過多次的一維掃描W21-W2M形成的一個(gè)二維掃描可表現(xiàn)為一個(gè)幀。
而且,當(dāng)圖3(a)表示的交叉角θ的值變大,計(jì)測裝置3發(fā)射的脈沖激光的不能反射時(shí),就認(rèn)為在脈沖激光的發(fā)射方向上紙箱1不存在。
下面,更詳細(xì)地說明當(dāng)檢出上述紙箱1的表面上的各反射位置的xyz坐標(biāo)值后,從這些各檢出值求出上述紙箱1的設(shè)置位置、整體大小時(shí)的計(jì)測裝置3的動(dòng)作。
圖4是計(jì)測裝置3測量紙箱1的設(shè)置位置和整體大小時(shí)的動(dòng)作的簡略流程圖。
首先,計(jì)測裝置3求得在圖2所示的一個(gè)幀(通過各掃描W21-W2M構(gòu)成的一個(gè)幀)的各一維掃描的紙箱1上的各反射位置,求出連接與該求得的各反射位置的xy平面上的直線方程式(S1)。
在這里對(duì)在一個(gè)一維掃描中求解連接紙箱1上的各反射位置的xy平面上的直線方程式動(dòng)作進(jìn)行更詳細(xì)的說明。
圖5是圖3示的紙箱1上的各反射位置Pr-Pr+8的部分?jǐn)U大圖。圖5所示的各反射位置Pr-Pr+8是在xy平面上表示的各反射位置,各反射位置Pr-Pr+8中的反射位置Pr-Pr+2大致在一直線上并列,構(gòu)成了一個(gè)群41,各反射位置Pr+2-Pr+6大致在一直線上并列,構(gòu)成了一個(gè)群43,各反射位置Pr+6-Pr+8大致在一直線上并列,構(gòu)成了一個(gè)群45。
從構(gòu)成上述群41的各反射位置Pr-Pr+2用例如最小乘法算出直線42。該直線42的式子能用[y=K1x+T1]表示。
同樣的,從構(gòu)成上述群43的各反射位置Pr+2-Pr+6算出直線44,從構(gòu)成上述群45的各反射位置Pr+6-Pr+8算出直線46。該直線44的式子能用[y=K2x+T2]表示,這個(gè)直線46的式子能用[y=K3x+T3]表示。且上述直線44的式子的[K2]的值接近0。
圖5,用一個(gè)一維掃描W2n檢出的紙箱1的各反射位置算出各直線42、44、46,對(duì)每個(gè)圖3所示的掃描W2n以外的各一維掃描W21-W2M(參考圖2)都求出上述xy平面上的各直線方程式。
根據(jù)如圖3表示的計(jì)測裝置3和紙箱1的位置關(guān)系,計(jì)測裝置3能對(duì)紙箱1的頂面和2個(gè)側(cè)面照射脈沖激光。但并不是所有各一維掃描都是在紙箱1的頂面和2個(gè)的側(cè)面照射脈沖激光,各掃描能否在紙箱1的哪個(gè)面上照射脈沖激光由圖3(a)所示的被發(fā)射的脈沖激光的行進(jìn)方向和z軸之間的交角θ等決定。
由在紙箱1的頂面和2個(gè)側(cè)面照射的脈沖激光的一維掃描能夠得到(算出)上述那樣的3根直線,這些直線的傾斜互不相同。由僅對(duì)紙箱1的2個(gè)的側(cè)面照射的脈沖激光的一維掃描能夠得到2根直線,這些直線的傾斜互不相同。而且,由僅在紙箱1的頂面照射的脈沖激光的一維掃描能夠得到1根直線。
然后,對(duì)紙箱1和計(jì)測裝置3的相對(duì)位置關(guān)系與通過計(jì)測裝置3的掃描對(duì)在紙箱1上的各反射位置算出的xy平面上的直線的根數(shù)和與上述各直線的傾斜度的關(guān)系進(jìn)行更詳細(xì)的說明。
圖6-圖11是表示紙箱1和計(jì)測裝置3之間的相對(duì)位置關(guān)系和脈沖激光掃描的圖,圖6是表示僅在紙箱1的頂面能夠照射脈沖激光的位置上計(jì)測裝置3的設(shè)置狀態(tài)圖。
圖6(a)是表示計(jì)測裝置3和紙箱1的位置關(guān)系的正面圖,圖6(b)-(d)是圖6(a)中的VI方向的視圖。
圖6(a)中,通過計(jì)測裝置3進(jìn)行一維的各掃描W6a-W6k,對(duì)于紙箱1進(jìn)行二維的掃描。
圖6(b)表示的一維掃描W6a,因?yàn)橛妹}沖激光照射的只是xy平面,所以不能檢出紙箱1上的反射位置。同樣的,一維掃描W6k也不能檢出紙箱1上的反射位置。
圖6(c)中,因?yàn)榧埾?被一維掃描W6d照射到,所以能夠檢出紙箱1上的反射位置。這里,如圖6(c)表示的線段R6d是將上述檢出的各個(gè)反射位置(紙箱1的表面的各反射位置)識(shí)別為圖5所示的大致在一條直線上并列的群,并用直線連接各反射位置而得到的線段。因此,在線段R6d上存在多個(gè)反射位置。含有上述線段R6d的xy平面上的直線方程可以表示為[y=K6dX+T6d]。而且,上述[K6d]的值近于0。即,包含上述線段R6d的直線與x軸大致平行的直線。
而且,圖6(d)也和圖6(c)一樣,能夠用一維掃描W6g得到線段R6g,而且,包含上述線段R6g的xy平面上的直線方程式能夠表示為[y=K6gX+T6g],上述[K6g]的值也近于0。即,包含上述線段R6g的直線也是與x軸大致平行的直線。
進(jìn)而,與圖6(c)和圖6(d)表示的情況大致相同,從各掃描W6b、W6c、W6e、W6f、W6h、W6i、W6j的各反射位置能夠?qū)ι鲜龈鲯呙枨蟮酶髦本€方程式。但是,與上述各掃描W6b、W6c、W6e、W6f、W6h、W6i、W6j對(duì)應(yīng)的各直線也是與x軸大致平行的直線。
即,用上述的各掃描W6b-W6j的各反射位置求得的xy平面上的直線的數(shù)目無論在上述各個(gè)掃描W6b-W6j中的哪個(gè)掃描都是一條,該直線的傾斜也只有一種。
而且,在上述各掃描W6b-W6j的反射位置的z坐標(biāo)值,因?yàn)槭怯妹}沖激光照射紙箱1后得到的值,所以是大致一定的??傊?,上述各反射位置是在與xy平面平行的一個(gè)平面(Z=一定的平面)上。
圖7是計(jì)測裝置3設(shè)置在可對(duì)紙箱1的頂面和僅一個(gè)側(cè)面照射脈沖激光的位置上的狀態(tài),而且是紙箱1的上述一個(gè)側(cè)面和一維掃描(例如掃描W7a)的方向大致保持平行的狀態(tài)的表示圖。
圖7(a)是表示計(jì)測裝置3和紙箱1的位置關(guān)系的正面圖,圖7(b)-(d)是在圖7(a)中的VII方向的視圖。
圖7(a)中,通過計(jì)測裝置3進(jìn)行一維的各掃描W7a-W7h,對(duì)于紙箱1進(jìn)行二維掃描。
圖7(b)表示的一維的掃描W7a,因?yàn)楸幻}沖激光照射的僅僅是xy平面,與圖6(a)所示同樣,因而也不能檢出紙箱1上的反射位置。
關(guān)于圖7(c),因?yàn)榧埾?被一維掃描W7c照射,所以能夠檢出紙箱1上的反射位置。這里,圖7(c)表示的線段R7c是和圖6(c)表示的線段R6d大致相同的線段。而且,包含上述線段R7c的xy平面上的直線方程式能用[y=K7cX+T7c]表示。上述[K7c]的接近y于0。即,上述直線是與x軸大致平行的直線。
圖7(d)也和圖7(c)一樣,能夠用一維掃描W7g得到線段R7g。而且,包含上述線段R7g的xy的平面上的直線方程式能用[y=K7gX+T7g]表示,上述[K7g]的值也接近于0。即,上述直線也是與x軸大致平行的直線。
還有,與圖7(c)和圖7(d)表示的情況大致相同,從各掃描W7b、W7d、W7e、W7f、W7h的各反射位置能夠求得各掃描的各直線方程式。但是,與上述各掃描W7b、W7d、W7e、W7f、W7h對(duì)應(yīng)的各直線也是與x軸大致平行的直線。
即,用上述的各掃描W7b-W7h求得的xy平面上的各直線的數(shù)目無論在上述各個(gè)掃描W7b-W7h中的哪個(gè)掃描都是一條,該直線的傾斜也只有一種。
而且,從圖7(a)可以理解,隨著從掃描W7b朝向著掃描W7e,用脈沖激光照射從紙箱1的側(cè)面的下部朝向上部,所以隨著從掃描W7b朝向掃描W7e,在上述各掃描W7b-W7e的各掃描位置的z坐標(biāo)值逐漸變大。
另一方面,在上述各掃描W7f、W7g、W7h的各反射位置的z坐標(biāo)值,因?yàn)槭怯妹}沖激光照射紙箱1的頂面而得到的值,因此大致一定。
即,在上述各掃描W7b-W7h的各反射位置的z坐標(biāo)值的一部分位于與xy平面平行的一個(gè)的平面(z=一定的面)上。
圖8是計(jì)測裝置3設(shè)置在僅可對(duì)紙箱1的一個(gè)的側(cè)面照射脈沖激光的位置上的狀態(tài)表示圖。
且,圖8(a)是表示計(jì)測裝置3和紙箱1的位置關(guān)系的正面圖,圖8(b)-(d)是表示在圖8(a)中的VII方向的視圖。
圖8(a)通過計(jì)測裝置3進(jìn)行一維的各掃描W8a-W8h,對(duì)于紙箱1進(jìn)行二維掃描。
關(guān)于圖8(b)表示的一維掃描W8a,與圖6(a)表示的相同,因?yàn)橛妹}沖激光照射的僅僅是xy平面,因而不能檢出紙箱1上的反射位置。
關(guān)于圖8(c),因?yàn)榧埾?被一維掃描W8b照射,所以能夠檢出紙箱1上的反射位置。這里,圖8(c)表示的線段R8b是和圖6(c)表示的線段R6d大致相同的線段。且,包含上述線段R8b的xy平面上的直線方程式能用[y=K8bX+T8b]表示。
圖8(d)也和圖8(c)一樣,能夠用一維掃描W8c得到線段R8c。且,包含上述線段R8c的xy平面上的直線方程式能用[y=K8cX+T8c]表示。而且,掃描W8b和掃描W8c中,因?yàn)槭菍?duì)紙箱1的同一側(cè)面照射的,在上述直線方程式[y=K8bX+T8b]、[y=K8cX+T8c]中,[K8b]和[K8c]的值大致相等,[T8b]和[T8c]的值大致相等,也就是說,包含線段R8b的xy平面上的直線方程式和包含線段R8c的xy平面上的直線方程式是大致相同的直線。
進(jìn)而,與圖7(c)和圖7(d)表示的大致相同,從各掃描W8d、W8e、W8f、W8g的各反射位置能夠求得上述各掃描的直線方程式。這樣求得的直線方程式,因?yàn)槭菍?duì)紙箱1的同一側(cè)面照射得到的,所以是和上面的[y=K8bX+T8b]、[y=K8cX+T8c]大致相同的直線方程式。
因此,包含各掃描W8b-W8g的各反射位置的xy平面上的各直線互相是大致相同的直線。即,包含各掃描W8b-W8g的各反射位置的xy平面上的各直線的數(shù)目為1,且這個(gè)直線的傾斜也只有1種。
圖9是計(jì)測裝置3設(shè)置可對(duì)紙箱1的上面和兩個(gè)側(cè)面照射脈沖激光的位置的狀態(tài)的表示圖。
圖9(a)是表示計(jì)測裝置3和紙箱1的位置關(guān)系的正面圖,圖9(b)-(e)是在圖9(a)中的IX方向的視圖。
圖9(a)中,通過計(jì)測裝置3進(jìn)行一維的各掃描W9a-W9i來對(duì)紙箱1進(jìn)行二維掃描。
關(guān)于圖9(b)表示的一維掃描W9a,與圖6(a)表示的相同,因?yàn)楸幻}沖激光照射的僅僅是xy平面,因而不能檢出紙箱1上的反射位置。
圖9(c)中,因?yàn)榧埾?被一維掃描W9e照射,所以能夠檢出紙箱1上的反射位置。這里,如圖9(c)表示的線段R9e是和圖6(c)表示的線段R6d大致相同的線段,而且,因?yàn)樯鲜鼍€段R9e是用掃描W9e照射紙箱1的兩個(gè)側(cè)面,所以由2個(gè)線段R1、R2形成。
包含上述2個(gè)線段R1、R2中的一個(gè)線段R1的xy平面上的直線方程式能用[y=K9eX+T9e]表示,包含第2個(gè)線段R2的xy平面上的直線方程式能用[y=L9eX+U9e]表示。
而且,圖9(d)也和圖9(c)同樣,能夠得到線段R9g。而且,因?yàn)樯鲜鼍€段R9g是用掃描W9e照射紙箱1的頂面和2個(gè)側(cè)面,所以由3個(gè)線段R3、R4、R5形成。
包含上述3個(gè)線段R3、R4、R5中的第一個(gè)線段R3的xy平面上的直線方程式能用[y=K9gX+T9g]表示,包含第2個(gè)線段R4的xy平面上的直線方程式能用[y=M9gX+V9g]表示,包含第3個(gè)線段R5的xy平面上的直線方程式能用[y=L9gX+U9g]表示。
圖9(e)也和圖9(c)同樣的,能夠得到線段R9h。且上述線段R9h因?yàn)橛脪呙鑇9e照射紙箱1的頂面和一個(gè)側(cè)面,所以由2個(gè)線段R6、R7形成。
包含上述2個(gè)的線段中的第1個(gè)線段R6的xy平面上的直線方程式能用[y=K9hX+T9h]表示,包含第2個(gè)線段R7的xy平面上的直線方程式能用[y=M9hX+V9h]表示。
上述線段R1的直線方程式[y=K9eX+T9e]和線段R3的直線方程式[y=K9gX+T9g]和線段R6的直線方程式[y=K9hX+T9h],因?yàn)槭怯酶鲯呙鑇9e、W9g、W9h照射紙箱1的一個(gè)側(cè)面而得到的,所以相互為大致一樣的直線方程式。
同樣,上述線段R2的直線方程式[y=L9eX+U9e]和線段R5的直線方程式[y=L9gX+U9g],因?yàn)槭怯酶鲯呙鑇9e、W9g照射紙箱1的一個(gè)側(cè)面而得到的,所以相互為大致一樣的直線方程式。
同樣,上述線段R4的直線方程式[y=M9gX+V9g]和線段R7的直線方程式[y=M9hX+V9h],因?yàn)槭怯酶鲯呙鑇9g、W9h照射紙箱1的頂面而得到的,所以[M9g]和[M9h]的值大致為0,而[V9g]和[V9h]的值則互不一樣。
通過掃描W9e的各反射位置能夠求得相互傾斜不同的2條直線,通過掃描W9g的各反射位置能夠求得相互傾斜不同的3條直線,通過掃描W9h的各反射位置能夠求得相互傾斜不同的2條直線。
通過各掃描W9b、W9c、W9d、W9f、W9i的各反射位置,在如圖9(c)、圖9(d)、圖9(e)表示的情況下,能夠求得大致相同的直線方程式。
對(duì)通過各掃描W9b、W9c、W9d、W9f、W9i的各反射位置求得的直線方程式進(jìn)行具體的說明,通過各掃描W9b-W9d的各反射位置,和掃描W9e一樣,能夠求得相互傾斜不同的2條直線,通過各掃描W9f的各反射位置,和掃描W9g一樣,能夠求得相互傾斜不同的3條直線,通過各掃描W9i的各反射位置,能夠求得1條直線。
即,通過各掃描W9b-W9e能夠求得2條直線,通過各掃描W9f、W9g能夠求得3條直線,通過掃描W9h能夠求得2根直線,通過掃描W9i能夠求得1根直線。換而言之,通過各掃描W9b-W9i從紙箱1的各反射位置得到的直線的最多為3條。而且,通過各掃描W9b-W9i從紙箱1的各反射位置得到的直線的傾斜最多為3種。
圖10是計(jì)測裝置3設(shè)置在僅僅可對(duì)紙箱1的兩個(gè)側(cè)面照射脈沖激光的位置上的狀態(tài)的表示圖。
圖10(a)是表示計(jì)測裝置3和紙箱1的位置關(guān)系的正面圖,圖10(b)-(d)是在圖10(a)中的X方向的視圖。
圖10(a)通過計(jì)測裝置3進(jìn)行一維的各掃描W10a-W10k對(duì)于紙箱1進(jìn)行二維掃描。
至于如圖10(b)表示的一維掃描W10a,與圖6(a)所示相同,因?yàn)楸幻}沖激光照射的僅僅是xy平面,因而不能檢出紙箱1上的反射位置。
圖10(c)中,因?yàn)榧埾?被一維掃描W10c照射,所以能夠檢出紙箱1上的反射位置。這里,如圖10(c)所示的線段R10c是和圖6(c)所示的線段R6d大致相同的線段,且上述線段R10c因?yàn)槭怯脪呙鑇10c照射紙箱1的兩個(gè)的側(cè)面而得到的線段,所以由2個(gè)線段R8、R9形成。
包含上述2個(gè)線段R8、R9中的第一個(gè)線段R8的xy平面上的直線方程式能用[y=K10cX+T10c]表示,包含第2個(gè)線段R9的xy平面上的直線方程式能用[y=L10cX+U10c]表示。
圖10(d)和圖10(c)同樣,能夠得到線段R10d。且上述線段R10d因?yàn)橛脪呙鑇10d照射紙箱1的2個(gè)側(cè)面,所以由2個(gè)線段R10、R11形成。
包含上述2個(gè)線段中的第一個(gè)線段R10的xy平面上的直線方程式能用[y=K10dX+T10d]表示,包含第2個(gè)線段R11的xy平面上的直線方程式能用[y=L10dX+U10d]表示。
上述線段R8的直線方程式[y=K10cX+T10c]和線段R10的直線方程式[y=K10dX+T10d],因?yàn)槭怯酶鲯呙鑇10c、W10d照射紙箱1的一個(gè)側(cè)面而得到的,所以為大致一樣的直線方程式。
同樣的,上述線段R9的直線方程式[y=L10cX+U10c]和線段R11的直線方程式[y=L10dX+U10d],因?yàn)槭怯酶鲯呙鑇10c、W10d照射紙箱1的另一個(gè)側(cè)面而得到的,所以為大致一樣的直線方程式。
進(jìn)而,通過掃描W10c的各反射位置能夠求得相互傾斜不同的2條直線,通過掃描W10d的各反射位置能夠求得相互傾斜不同的2條直線。
通過各掃描W10b、W10e-W10k的各反射位置,與如圖10(c)和圖10(d)表示的情況大致相同,能夠求得直線方程式。
對(duì)通過各掃描W10b、W10e-W10k的各反射位置求得的直線方程式進(jìn)行具體的說明,從各掃描W10b、W10e-W10k的各反射位置,與掃描W10c和掃描W10d一樣,能夠求得相互傾斜不同的2條直線。
即,通過各掃描W10b-W10k能夠求得2條直線,換而言之,通過各掃描W10b-W10k從紙箱1的各反射位置得到的直線最多為2條。且對(duì)通各掃描W10b-W10k從紙箱1的各反射位置得到的直線的傾斜種類最多為2種。
圖11是計(jì)測裝置3設(shè)置在僅僅可對(duì)紙箱1的頂面和一個(gè)側(cè)面照射脈沖激光的位置的狀態(tài)表示圖。
圖11(a)是表示計(jì)測裝置3和紙箱1的位置關(guān)系的正面圖,圖11(b)-(d)是在圖11(a)的XI方向的視圖。
圖11(a)通過計(jì)測裝置3進(jìn)行一維的各掃描W11a-W11i對(duì)于紙箱1進(jìn)行二維掃描。
圖11(b)中,因?yàn)榧埾?被一維掃描W11d照射,所以能夠檢出紙箱1上的反射位置。這里,圖11(b)所示的線段R11d是和圖6(c)所示的線段R6d同樣地得到的線段,包含上述線段R11d的xy平面上的直線方程式能用[y=K11dX+T11d]表示。
圖11(c)和圖11(b)同樣,能夠得到線段R11g。上述線段R11g因?yàn)橛脪呙鑇11g照射紙箱1的一個(gè)側(cè)面和頂面進(jìn)行照射,所以由2個(gè)線段R12、R13形成。
包含上述2個(gè)線段中的第一個(gè)線段R12的xy平面上的直線方程式能用[y=M11gX+V11g]表示,包含第2個(gè)線段R13的xy平面上的直線方程式能用[y=K11gX+T11g]表示。
圖11(d)和圖11(b)同樣,能夠得到線段R11i。且包含上述線段R11i的xy平面上的直線方程式能用[y=M11iX+V11i]表示。
上述線段R11d的直線方程式[y=K11dX+T11d]和線段R13的直線方程式[y=K11gX+T11g],因?yàn)槭怯酶鲯呙鑇11d、W11g照射紙箱1的同一個(gè)側(cè)面而得到的,所以為大致相同的直線方程式。
上述線段R12的直線方程式[y=M11gX+V11g]和線段R11i的直線方程式[y=M11iX+V11i],因?yàn)槭怯酶鲯呙鑇11g、W11i照射紙箱1的頂面而得到的,所以[M11g]和[M11i]的值大致為0,而[V11g]和[V11i]的值則不一樣。
通過掃描W11d的各反射位置能夠求得1條直線,通過掃描W11g的各反射位置能夠求得相互傾斜不同的2條直線,通過掃描W11i的各反射位置能夠求得1條直線。
通過各掃描W11b、W11c、W11e、W11f、W11h、W11j,與如圖11(c)和圖11(d)表示的情況相同,能夠求得直線方程式。
對(duì)通過各掃描W11b、W11c、W11e、W11f、W11h、W11j的各反射位置求得的直線進(jìn)行具體的說明,通過各掃描W11b、W11c、W11e、W11f,和掃描W11d一樣,能夠求得1條直線,通過掃描W11h,和掃描W11g一樣,能夠求得相互傾斜不同的2條直線,通過掃描W11i、和掃描W11i一樣,能夠求得1條直線。
即,通過各掃描W11b-W11f能夠各求得1條直線,通過各掃描W11h、W11g能夠各求得2條直線,通過各掃描W11i、W11j能夠求得1條直線。換而言之,通過各掃描W11b-W11i從紙箱1的各反射位置得到的直線最多為2條。且通過各掃描W11b-W11i從紙箱1的各反射位置得到的直線的傾斜種類最多為2種。
遵循圖6-圖11的順序,在步驟S1求得在各掃描的直線的條數(shù)的最大值,從這個(gè)最大值判斷計(jì)測裝置3和紙箱1的相對(duì)位置關(guān)系。
即如圖4所示,在各掃描的反射位置求得的直線條數(shù)的最大值為1的情況下(S3),計(jì)測裝置3判斷所有在各掃描的各反射位置是否形成與xy平面平行的一個(gè)平面(所有各反射位置的Z坐標(biāo)值是否大致一樣)(S5)。
然后,在所有各掃描的各反射位置形成與xy平面平行的一個(gè)平面的情況下,測量判斷為如圖6表示的那樣,裝置3和紙箱1之間的相對(duì)位置關(guān)系是計(jì)測裝置3僅僅可對(duì)紙箱1的頂面照射脈沖激光的模式(以下稱為[A模式]。),并與上述A模式對(duì)應(yīng),對(duì)紙箱1進(jìn)行識(shí)別(S7)。對(duì)與上述A模式對(duì)應(yīng)的、對(duì)紙箱1的識(shí)別將在下面進(jìn)行詳細(xì)說明。
步驟S5,所有在各掃描的各反射位置沒有形成與xy平面平行的一個(gè)平面時(shí),判斷在各掃面的各反射位置的一部分是否形成與xy平面平行的一個(gè)平面(S9)。
在各掃描的反射位置的一部分形成與xy平面平行的一個(gè)平面時(shí),判斷為計(jì)測裝置3和紙箱1之間的相對(duì)位置關(guān)系,如圖7表示的那樣,是計(jì)測裝置3僅僅可對(duì)紙箱1的頂面和一個(gè)側(cè)面照射脈沖激光的模式,而且,紙箱1的上述一個(gè)側(cè)面和一維掃描的方向大致平面的模式(以下稱為[B模式]),并與上述B模式對(duì)應(yīng),對(duì)紙箱1進(jìn)行識(shí)別(S11)。對(duì)上述B模式對(duì)應(yīng)的對(duì)紙箱1的識(shí)別將在下面進(jìn)行詳細(xì)說明。
步驟S9,在各掃描的各反射位置的全部或者一部分沒有形成與xy平面平行的一個(gè)平面時(shí),判斷為計(jì)測裝置3和紙箱1之間的相對(duì)位置關(guān)系,如圖8表示的那樣,是計(jì)測裝置3僅僅可對(duì)紙箱1的一個(gè)側(cè)面照射脈沖激光的模式(以下稱為[C模式]。),并與上述C模式對(duì)應(yīng),對(duì)紙箱1進(jìn)行識(shí)別(S13)。對(duì)與上述C模式對(duì)應(yīng)的、對(duì)紙箱1的識(shí)別將在下面進(jìn)行詳細(xì)說明。
步驟S3,在用各掃描的反射位置求得的直線數(shù)的最大值不為1的情況下,判斷用各掃描的各反射位置求得的直線的最多是否為2(S15)。
在用各掃描的反射位置求得的直線數(shù)的最大值不為2的情況下,計(jì)測裝置3和紙箱1之間的相對(duì)位置關(guān)系,如圖9表示的那樣,是計(jì)測裝置3可對(duì)紙箱1的頂面和2個(gè)側(cè)面照射脈沖激光的模式(以下稱為[D模式]。),并對(duì)應(yīng)上述D模式,對(duì)紙箱1進(jìn)行識(shí)別(S17)。對(duì)與上述D模式對(duì)應(yīng)的、對(duì)紙箱1的識(shí)別將在下面進(jìn)行詳細(xì)說明。
步驟S15,在用各掃描的反射位置求得的直線數(shù)的最大值為2的情況下,判斷在各掃描的反射位置的一部分是否形成與xy平面平行的一個(gè)平面(S19)。
在各掃描的各反射位置的全部或者一部分沒有形成與xy平面平行的一個(gè)平面時(shí),判斷為計(jì)測裝置3和紙箱1之間的相對(duì)位置關(guān)系,如圖10表示的那樣,是計(jì)測裝置3僅僅可對(duì)紙箱1的2個(gè)側(cè)面照射脈沖激光的模式(以下稱為[E模式]。),并與上述E模式對(duì)應(yīng),對(duì)紙箱1進(jìn)行識(shí)別(S21)。對(duì)與上述E模式對(duì)應(yīng)的、對(duì)紙箱1的識(shí)別將在下面進(jìn)行詳細(xì)說明。
步驟S19,在各掃描的各反射位置的一部分形成與xy平面平行的一個(gè)平面時(shí),判斷為計(jì)測裝置3和紙箱1之間的相對(duì)位置關(guān)系,如圖11表示的那樣,是計(jì)測裝置3僅僅可對(duì)紙箱1的頂面和一個(gè)側(cè)面照射脈沖激光的模式(以下稱為[F模式]。),并對(duì)紙箱進(jìn)行與上述F模式相應(yīng)的識(shí)別(S23)。對(duì)與上述F模式相應(yīng)的、對(duì)紙箱1的識(shí)別將在下面進(jìn)行詳細(xì)說明。
在步驟S3和步驟S15,與由各掃描的各反射位置求得的直線數(shù)的最大值相應(yīng)判斷其次進(jìn)行哪個(gè)步驟的動(dòng)作,可以不用上述直線的最大值,而用對(duì)應(yīng)各掃描的各反射位置求得的直線的傾斜種類的最大值,判斷其次進(jìn)行哪個(gè)步驟的動(dòng)作。
例如可以,在步驟S1,求得一幀的各掃描的xy平面的各直線方程式的結(jié)果,在步驟S3,在各掃描的的直線方程式的傾斜的種類數(shù)的最大值為[1]的情況下,向步驟S5推進(jìn),不為[1]的情況下,向步驟S15推進(jìn)。
下面,對(duì)在圖4所示的步驟S7的A模式的紙箱1的識(shí)別進(jìn)行說明。
圖12是在用計(jì)測裝置3僅能對(duì)紙箱1的頂面照射脈沖激光的模式(A模式)中,掃描紙箱1的頂面的情況的表示圖。
即,圖12(a)中,計(jì)測裝置3,通過在紙箱1的頂面順序地進(jìn)行各一維掃描51-56,來對(duì)紙箱1的頂面進(jìn)行二維掃描。
在表示上述掃描51的直線上,如圖2所述,形成適當(dāng)個(gè)數(shù)的紙箱1上的反射位置(沒有圖示)。然后,這些各反射位置中的x坐標(biāo)值最小的反射位置(點(diǎn))51a的x坐標(biāo)值為[x1],與其對(duì)應(yīng)的y坐標(biāo)值(反射位置51a的y坐標(biāo)值)為[y1]。而且,上述各反射位置中的x坐標(biāo)值最大的反射位置(點(diǎn))51b的x坐標(biāo)值為[x21],與其對(duì)應(yīng)的y坐標(biāo)值(反射位置51b的y坐標(biāo)值)為[y21]。
同樣,在各掃描52-66也形成x坐標(biāo)值最小的反射位置52a-66a和x坐標(biāo)值最大的反射位置52b-66b。上述各反射位置52a-66a的各x坐標(biāo)值為[x2-x16],與這些x坐標(biāo)值對(duì)應(yīng)的y坐標(biāo)值為[y2-y16],上述各反射位置52b-66b的x坐標(biāo)值為[x21-x36],與這些x坐標(biāo)值對(duì)應(yīng)的y坐標(biāo)值為[y21-y36]。這樣得到的x坐標(biāo)值和y坐標(biāo)值如圖12(b)所示。
然后,A模式,如圖12(a)所示,因?yàn)楦鞣瓷湮恢?1a-54a位于紙箱1的頂面的第一條棱線的附近,所以各反射位置51a-54a大致都位于同一直線上。這里,從這些各反射位置51a-54a應(yīng)用最小二乘法,求出表示通過各反射位置51a-54a的附近的xy平面上的直線50A的直線方程式。同樣,求出表示對(duì)應(yīng)各反射位置55a-66a的直線50B的直線方程式,求出表示對(duì)應(yīng)各反射位置63b-66b的直線50C的直線方程式,求出表示對(duì)應(yīng)各反射位置51b-62b的直線50D的直線方程式。且用上述直線方程式表示的各直線50A-50D是含有在紙箱1的頂面存在的4條棱線的直線(各棱線被延長后)。換而言之,通過表示各直線50A-50D的各直線方程式可表示紙箱1的頂面的各棱線的坐標(biāo)值。
進(jìn)而,求出直線50A的直線方程式和直線50B的直線方程式的交點(diǎn)50E的x坐標(biāo)值和y坐標(biāo)值。同樣,求出各交點(diǎn)50F、50G、50H的各x坐標(biāo)值和y坐標(biāo)值。
從各掃描51-66的各反射位置的Z坐標(biāo)值(例如上述各反射位置的各Z坐標(biāo)值的平均值)求出各交點(diǎn)50E、50F、50G、50H的各Z坐標(biāo)值。
在這里,如果采用如上述那樣求得的上述各交點(diǎn)50E、50F、50G、50H的xyz坐標(biāo)值作為位于紙箱1的頂面的各頂點(diǎn)的xyz坐標(biāo)值,就能夠認(rèn)知紙箱1的設(shè)置位置和整體的大小(紙箱1的長、寬、高)。
而且,上述紙箱1的設(shè)置位置和整體的大小能適當(dāng)?shù)妮敵霾⒈硎驹诶鐖D1表示的上位個(gè)人電腦PC39的液晶顯示器上(圖中未表示)。
下面對(duì)圖4表示的步驟S11的B模式的紙箱1的識(shí)別進(jìn)行說明。
圖13和圖14表示在計(jì)測裝置3僅可對(duì)紙箱1的頂面和一個(gè)側(cè)面照射脈沖激光的模式、并且是紙箱1的上述一個(gè)側(cè)面與計(jì)測裝置3的一維掃描的方向大致平行的模式(B模式)中,對(duì)紙箱1的頂面和一個(gè)側(cè)面進(jìn)行掃描的情況。
圖13中,計(jì)測裝置3對(duì)紙箱1的頂面和一個(gè)側(cè)面進(jìn)行二維掃描。即,通過按照從紙箱1的一個(gè)側(cè)面的下部向上、并且向紙箱1的頂面的順序進(jìn)行一維各掃描71-79,對(duì)紙箱1的一個(gè)側(cè)面和頂面進(jìn)行二維掃描。
在表示上述掃描71的直線上,同上述掃描51大致相同,形成適當(dāng)數(shù)個(gè)紙箱1的反射位置(無圖示)。然后,這些各反射位置中,x坐標(biāo)值最小的反射位置(點(diǎn))71a的x坐標(biāo)值為[x41],與其對(duì)應(yīng)的y坐標(biāo)值(反射位置71a的y坐標(biāo)值)為[y41],z坐標(biāo)值(反射位置71a的z坐標(biāo)值)為[z41]。且,各反射位置中的x坐標(biāo)值最大的反射位置(點(diǎn))71b的x坐標(biāo)值為[x51],與其對(duì)應(yīng)的y坐標(biāo)值(反射位置71b的y坐標(biāo)值)為[y51],z坐標(biāo)值(反射位置71b的z坐標(biāo)值)為[z51]。
同樣,在各掃描72-79,形成x坐標(biāo)值最小的反射位置72a-79a和x坐標(biāo)值最大的反射位置71b-79b。且上述各反射位置72a-79a的各x坐標(biāo)值為[x42-x49],對(duì)應(yīng)這些x坐標(biāo)值的各y坐標(biāo)值為[y42-y49],各z坐標(biāo)值為[z42-z49]。且上述各反射位置71b-79b的x坐標(biāo)值為[x52-x59],對(duì)應(yīng)這些x坐標(biāo)值的各y坐標(biāo)值為[y52-y59],各z坐標(biāo)值為[z52-z59]。這樣得到的各x坐標(biāo)值和各y坐標(biāo)值和各z坐標(biāo)值示于圖14。
B模式,如圖13所示,有形狀的紙箱1的一個(gè)側(cè)面(通過各掃描71-74照射脈沖激光的側(cè)面)與xz平面大致平行,因?yàn)楦鞣瓷湮恢?1a-79a、71b-79b位于紙箱1的棱線的附近,所以在圖14所示的各坐標(biāo)值中,[x41-x49]的值大致互相相等為一定值,[x51-x59]的值大致互相相等為一定值,[y41-y44]的值大致互相相等為一定值,[y51-y54]的值大致互相相等為一定值,[z45-z49]的值大致互相相等為一定值,[z55-z59]的值大致互相相等為一定值。
這里,在僅僅對(duì)紙箱1的頂面照射的各掃描75-79中,如上所述,因?yàn)閇x45-x49]的值大致互相相等為一定值,[z45-z49]的值大致互相相等為一定值,各反射位置75a-79a大致都位于同一直線上。用最小二乘法從這些各反射位置75a-79a求出通過各反射位置75a-79a附近的直線70A的直線方程式。
同樣,在僅僅對(duì)紙箱1的上面照射的各掃描75-79中,因?yàn)楦鞣瓷湮恢?5b-79b大致都位于同一直線上,用最小二乘法從這些各反射位置75b-79b求出通過各反射位置75b-79b附近的直線70B的直線方程式。
用上述直線方程式表示的各直線70A、70B是含有在紙箱1的頂面存在的2條棱線的直線(各棱線被延長后)。換而言之,通過表示各直線70A、70B的各直線方程式可表示紙箱1的頂面的各棱線的坐標(biāo)值。
繼而,各掃描75-79的反射位置中,y坐標(biāo)值最小的反射位置(例如反射位置75a和75b)的y坐標(biāo)值代入到上述直線70A的直線方程式和上述直線70B直線方程式中,求出紙箱1的頂面的第一個(gè)頂點(diǎn)70C(參照?qǐng)D13)的x坐標(biāo)值和y坐標(biāo)值和z坐標(biāo)值,紙箱1的頂面的第2個(gè)頂點(diǎn)70D(參照?qǐng)D13)的x坐標(biāo)值和y坐標(biāo)值和z坐標(biāo)值。
各掃描75-79的反射位置中,y坐標(biāo)值最大的反射位置(例如反射位置79a和79b)的y坐標(biāo)值代入到上述直線70A的直線方程式和上述直線70B直線方程式中,求出紙箱1的頂面的第3個(gè)的頂點(diǎn)70E(參照?qǐng)D13)的x坐標(biāo)值和y坐標(biāo)值和z坐標(biāo)值,紙箱1的頂面的第4個(gè)的頂點(diǎn)70F(參照?qǐng)D13)的x坐標(biāo)值和y坐標(biāo)值和z坐標(biāo)值。
在這里,如果采用如上述那樣求得的上述各交點(diǎn)70C、70D、70E、70F的xyz坐標(biāo)值作為位于紙箱1的頂面的各頂點(diǎn)的xyz坐標(biāo)值,就能夠識(shí)別紙箱1的設(shè)置位置和整體的大小(紙箱1的長、寬、高)。
與A模式相同,上述紙箱1的設(shè)置位置和整體的大小能適當(dāng)?shù)妮敵霾⒈硎驹趫D1表示的上位個(gè)人電腦PC39的液晶顯示器上(未圖示)。
在B模式中,僅僅用紙箱1的頂面的反射位置(掃描75-79的反射位置)能求得紙箱1的設(shè)置位置和整體的大小,而且,為了正確的求得紙箱1的設(shè)置位置和整體的大小,可以加上紙箱1的側(cè)面的反射位置(掃描71-74的反射位置),求得紙箱1的設(shè)置位置和整體的大小。
即,例如替代反射位置75a和75b的y坐標(biāo)值,而采用在各掃描71-74的反射位置的x坐標(biāo)值和y坐標(biāo)值的平均值(例如圖14表示的y41-y44的平均值和y51-y54的平均值)作為頂點(diǎn)70C和70D的y坐標(biāo)值,例如即使掃描75的掃描位置比紙箱1的棱線的實(shí)際位置大大向y方向偏離,也能夠正確地把握紙箱1的頂點(diǎn)70C和70D的位置(特別是y坐標(biāo)值)。
下面對(duì)圖4所示的步驟S13的C模式的紙箱1的識(shí)別進(jìn)行說明。
C模式是計(jì)測裝置3僅可對(duì)紙箱1的側(cè)面照射脈沖激光的模式。
按照C模式,用計(jì)測裝置3能夠測量上述紙箱1的上述一個(gè)側(cè)面的位置和大小,但不能測量與上述這個(gè)側(cè)面的成直角的上述紙箱1的進(jìn)深方向的大小。
所以,上述C模式,判斷為用計(jì)測裝置3不可能測量上述紙箱1的整體大小和設(shè)置位置,這個(gè)判斷結(jié)果被適當(dāng)?shù)妮敵霾⒈硎驹趫D1所示的上位個(gè)人電腦PC39的液晶顯示器上(無圖示)。
雖然算出上述紙箱1的設(shè)置位置和整體大小是不可能的,但是根據(jù)上述一個(gè)側(cè)面上的各反射位置,能用計(jì)測裝置3測量上述紙箱1的上述一個(gè)側(cè)面(計(jì)測裝置3能夠照射脈沖激光的側(cè)面)的位置和大小,所以能夠求得上述一個(gè)側(cè)面的大小和位置,并適當(dāng)?shù)剌敵霾⒈硎驹趫D1所示的上位個(gè)人電腦PC39的液晶顯示器上(無圖示)。
下面對(duì)圖4所示的步驟S17的D模式的紙箱1的識(shí)別進(jìn)行說明。
D模式,因?yàn)橛?jì)測裝置3能夠?qū)埾?的頂面照射脈沖激光,所以與上述A模式相同,僅僅用紙箱1的頂面的反射位置就能夠求得上述紙箱1的設(shè)置位置和整體大小,而且為了以更高的精良度求得上述紙箱1的設(shè)置位置和整體大小,可以再加上上述紙箱1的2個(gè)的側(cè)面的各反射位置來求得上述紙箱1的設(shè)置位置和整體大小。
這里,對(duì)根據(jù)紙箱1的2個(gè)側(cè)面的各反射位置求得上述紙箱1的設(shè)置位置和整體大小的情況進(jìn)行說明。
圖15,圖16是表示在計(jì)測裝置3能夠?qū)埾?的頂面和2個(gè)側(cè)面照射脈沖激光的模式(D模式)中掃描紙箱1的頂面和2個(gè)側(cè)面的情況的表示圖。
圖15(a),計(jì)測裝置3對(duì)紙箱1的2個(gè)側(cè)面進(jìn)行二維掃描。即,通過從紙箱1的2個(gè)側(cè)面下部按順序向上部進(jìn)行一維各掃描81-89,來對(duì)紙箱1的2個(gè)側(cè)面進(jìn)行二維掃描。
在表示各掃描81-89的直線上,與A模式相同,形成適當(dāng)個(gè)數(shù)的紙箱1的反射位置(無圖示)。通過這些各反射位置的各x坐標(biāo)值和與這些相對(duì)應(yīng)的y坐標(biāo)值,在xy平面上形成線段。
圖15(b)是在上述xy平面上的線段中,以從上述掃描85的反射位置得到的、包含xy平面上的線段的直線851和直線85m為例的表示圖。
從其他的各掃描81-84、86-89的各反射位置得到的、包含xy平面上的各線段的直線也能夠與直線851和直線85m大致相同地表示。因?yàn)槠渌母鲯呙?1-84、86-89的各反射位置是紙箱1的同一側(cè)面上的反射位置,所以從其他的各掃描81-84、86-89的各反射位置得到的包含的xy平面上的各線段的直線是與包含上述線段851和包含上述線段85m的直線大致相同的直線。
然后,計(jì)測裝置3求出,在能夠照射脈沖激光的紙箱1的2個(gè)側(cè)面中的一個(gè)側(cè)面1A上的各反射位置的、在各掃描81-89的各反射位置上形成的、包含xy平面上的線段的xy平面的各直線的平均直線80A(參照?qǐng)D15(b))。
這里,上述平均直線80A,能用例如從各掃描81-89的各反射位置(紙箱1的側(cè)面1A上的反射位置)得到的包含xy平面上的各線段的各直線性的各傾斜度的平均值和、從各掃描81-89的各反射位置(紙箱1的側(cè)面1A上的各反射位置)得到的包含的xy平面上的各線段的各切片的平均值來求出。
同樣,計(jì)測裝置3求出xy平面的各直線的平均直線80B(參照?qǐng)D15(b)),該xy平面的各直線的平均直線80B包含能夠被脈沖激光照射的紙箱1的2個(gè)側(cè)面中的一個(gè)側(cè)面1B上的、在各掃描81-89的各反射位置上形成的xy平面上的線段。
然后求出上述平均直線80A和上述平均直線80B的交點(diǎn)80C(參照?qǐng)D15(b))。將該交點(diǎn)80C的x坐標(biāo)值和y坐標(biāo)值作為與z軸大致平行的、上述紙箱1的4條棱線中的第一條棱線的x坐標(biāo)值和y坐標(biāo)值。
然后,通過在上述各掃描81-89的上述側(cè)面1A的各反射位置的x坐標(biāo)值的最小值和與這個(gè)最小值對(duì)應(yīng)的y坐標(biāo)值,求出與z軸大致平行的、上述紙箱1的4條棱線中的第2條棱線的x坐標(biāo)值和y坐標(biāo)值。
具體的說,例如,在紙箱1的2個(gè)側(cè)面中的一個(gè)側(cè)面1A上的、各掃描81-89的、x坐標(biāo)值最小的各反射位置81a-89a中,求出x坐標(biāo)值大致為一定的各反射位置85a-89a的x坐標(biāo)值(x65-x69;參照?qǐng)D15(a)、圖16)的平均值,把這個(gè)求得的x坐標(biāo)值的平均值代入表示平均直線80A的直線方程式,求得y坐標(biāo)值。然后把這樣求得的x坐標(biāo)值和y坐標(biāo)值作為上述紙箱1的上述第2條棱線的x坐標(biāo)值和y坐標(biāo)值。用這些各xy坐標(biāo)值表示的點(diǎn)在圖15(b)中作為點(diǎn)80D表示。
然后,通過在上述各掃描81-89的上述側(cè)面1B上的反射位置的x坐標(biāo)的最大值和與這個(gè)最大值對(duì)應(yīng)的y坐標(biāo)值,求出與z軸大致平行的、上述紙箱1的4條棱線的第3條棱線的x坐標(biāo)值和y坐標(biāo)值。
具體的說,例如,在紙箱1的2個(gè)的側(cè)面中的一個(gè)側(cè)面1B上的、各掃描81-89的、x坐標(biāo)值最大的各反射位置81b-89b中,求出x坐標(biāo)值大致為一定的各反射位置82b-89b的x坐標(biāo)值(x72-x79;參照?qǐng)D15(a)、圖16)的平均值,把這個(gè)求得的x坐標(biāo)值的平均值代入表示平均直線80B的直線方程式,求得y坐標(biāo)值。然后把這樣求得的x坐標(biāo)值和y坐標(biāo)值作為上述紙箱1的上述第3條棱線的x坐標(biāo)值和y坐標(biāo)值。用這些各xy坐標(biāo)值表示的點(diǎn)在圖15(b)中作為點(diǎn)80E表示。
繼而,通過上述的第1-第3條各棱線的各x坐標(biāo)值和各y坐標(biāo)值,求出與z軸大致平行的、上述紙箱1的4條棱線中的第4條棱線的x坐標(biāo)值和y坐標(biāo)值。
具體的說,例如求得連接上述點(diǎn)80D和上述點(diǎn)80E的線段的中心點(diǎn)的x坐標(biāo)值和y坐標(biāo)值,以該求出的中心點(diǎn)為對(duì)稱點(diǎn),求出與上述交點(diǎn)80C點(diǎn)對(duì)稱的點(diǎn)80F,然后把這個(gè)點(diǎn)80F的x坐標(biāo)值和y坐標(biāo)值作為上述紙箱1的上述第4條棱線的x坐標(biāo)值和y坐標(biāo)值。
然后,從上述各掃描81-89的各反射位置的z坐標(biāo)值的最大值求得紙箱1頂面的高度位置。
具體的說,例如在上述各掃描81-89的反射位置中,求出z坐標(biāo)值為最大的反射位置的89c 89d(參照?qǐng)D案5(a))的z坐標(biāo)值的平均值,然后把這個(gè)z坐標(biāo)值作為上述紙箱1的高。
然后,通過上述4條棱線的各x坐標(biāo)值和各y坐標(biāo)值和上述紙箱1的頂面的高度位置,算出上述紙箱1的頂面的4個(gè)頂點(diǎn)的x坐標(biāo)值、y坐標(biāo)值和z坐標(biāo)值。
這樣、如果采用從紙箱1的兩個(gè)側(cè)面的各反射位置求出的頂點(diǎn)(紙箱1的頂面的4個(gè)頂點(diǎn))的坐標(biāo)值和、與A模式同樣地、從紙箱1的頂面的反射位置所求出的頂點(diǎn)(紙箱1的上面的4個(gè)頂點(diǎn))的坐標(biāo)值的平均值,作為位于紙箱1的頂面的各頂點(diǎn)的xyz坐標(biāo)值的話,就可以識(shí)別紙箱1的設(shè)置位置和整體大小(紙箱1的長寬高)。
此外,將上述紙箱1的設(shè)置位置和整體大小,與A模式的情況相同,適當(dāng)輸出并被顯示在圖1上所示的上位個(gè)人電腦PC39的LCD(沒有圖示)上。
而且、在圖3(a)中,當(dāng)計(jì)測裝置3和紙箱1相互之間y軸方向間隔較大距離的情況下,由于圖3(a)所表示的交叉角度θ變化量很小,基于紙箱1的頂面的各反射位置來計(jì)算的、紙箱1的頂面的各頂點(diǎn)的xyz坐標(biāo)值容易產(chǎn)生較大的誤差,所以,例如也可以從兩個(gè)側(cè)面的各反射位置求出的各頂點(diǎn)的數(shù)據(jù)上加權(quán),來求出紙箱1的頂面的各頂點(diǎn)的xyz坐標(biāo)值的平均值。
下面對(duì)圖4所示的步驟S21的E模式的紙箱識(shí)別進(jìn)行說明。即、說明在計(jì)測裝置3僅可對(duì)紙箱1的2個(gè)側(cè)面照射脈沖激光的情況下,根據(jù)在上述兩個(gè)側(cè)面的脈沖激光的各反射位置求解上述紙箱1的設(shè)置位置和整體大小。
圖17、圖18是表示僅紙箱1的2個(gè)側(cè)面可被脈沖激光照射的模式(E模式)中,計(jì)測裝置3對(duì)紙箱1的兩個(gè)側(cè)面進(jìn)行掃描的情況的圖。
即、在圖17(a)中,計(jì)測裝置3在紙箱1的兩個(gè)側(cè)面上進(jìn)行二維掃描。也就是說,通過在紙箱1的兩個(gè)側(cè)面上,進(jìn)行從下部到上部順序的一維各掃描91-99,在紙箱1的兩個(gè)側(cè)面上進(jìn)行二維掃描。
在各掃描91-88所示的各直線上,與A模式的情況相同,形成了適當(dāng)個(gè)數(shù)的紙箱1的反射位置。進(jìn)而,通過這些各反射位置的各x坐標(biāo)值和與其相對(duì)應(yīng)的y坐標(biāo)值,形成了xy平面上的線段。
圖17(b)是表示在上述xy平面上的線段中,以包含有從上述掃描92的反射位置得到xy平面上的線段的直線921和直線92m作為例子的圖。
此外、包含有從其他各掃描91、93-99的各反射位置得到的xy平面上的各線段的直線,也能夠與上述線段921和直線92m同樣地表示。而且、因?yàn)槠渌膾呙?1、93-99的各反射位置是紙箱1的相同側(cè)面上的反射位置,所以包含有從其他的掃描91、93-99的反射位置上得到的xy平面上的各線段的直線,是與包含上述線段921的直線或包含上述線段92m的直線基本相同的直線。
接下來,計(jì)測裝置3求出xy平面上的各直線的平均直線90A(參照?qǐng)D17(b)),該xy平面上的各直線的平均直線90A包含脈沖激光能夠照射到的紙箱1的兩個(gè)側(cè)面中的一個(gè)側(cè)面1A上的、在各掃描91-99的各反射位置上形成的xy平面上的線段。
這里,上述平均直線90A可以用、例如、從包含各掃描91-99的各反射位置(紙箱1的側(cè)面1A上的各反射位置)所得到的XY平面上的各線段的各直線的各斜率的平均值和、包含從各掃描91-99的各反射位置(紙箱1的側(cè)面1A上的各反射位置)得到的XY平面上的各線段的直線的各切片的平均值來求出。
同樣地,計(jì)測裝置3求出XY平面上的各直線的平均直線90B(參照?qǐng)D15(B)),該各直線的平均直線90B包含脈沖激光可以照射的紙箱1的兩個(gè)側(cè)面中的一個(gè)側(cè)面1B上的、各掃描91-99的各反射位置上所形成的XY平面上的線段。
接下來,求出上述平均直線90A和上述平均直線90B的交點(diǎn)90C(參照?qǐng)D17(b))。將該交點(diǎn)的x軸坐標(biāo)值和y軸坐標(biāo)值作為與z軸基本平行的、上述紙箱1的4條稜線中的第一條稜線的x坐標(biāo)值和y坐標(biāo)值。
然后,根據(jù)在上述各掃描91-99的上述1A的反射位置的x坐標(biāo)值的最小值和與該最小值對(duì)應(yīng)的y坐標(biāo)值,求出與z軸基本平行的、上述紙箱1的4條稜線中的第二條稜線的x坐標(biāo)值和y坐標(biāo)值。
具體的,例如,在紙箱1的兩個(gè)側(cè)面中的一個(gè)側(cè)面1A上各掃描91-99的各反射位置上中的、x坐標(biāo)值最小的各反射位置91a-99a中,求出x坐標(biāo)值基本為一定值的各反射位置92a-97a的x坐標(biāo)值(X82-X87;參照?qǐng)D17(a)、圖18)的平均值,所求出的x坐標(biāo)值的平均值代入表示平均直線90A的直線方程,求出y軸坐標(biāo)值。然后,將這樣求出的x坐標(biāo)值和y軸坐標(biāo)值作為上述紙箱1的上述第二條稜線的x坐標(biāo)值和y坐標(biāo)值。此外,用這些各坐標(biāo)值所表示點(diǎn)在圖17(b)中作為點(diǎn)90D圖示出來。
接下來,根據(jù)在上述各掃描91-99的上述側(cè)面1B的反射位置上的x坐標(biāo)值的最大值和與這個(gè)最大值對(duì)應(yīng)的y軸坐標(biāo)值,求出與z軸基本平行的、上述紙箱1的4條棱線的第三條稜線的x坐標(biāo)值和y坐標(biāo)值。
具體的,例如,在紙箱1的兩個(gè)側(cè)面中的一個(gè)側(cè)面1B上的各掃描91-99的、x坐標(biāo)值為最大的各反射位置91b-99b中,求出x坐標(biāo)值基本為一定值的各反射位置92b-98b的x坐標(biāo)值(X92-X98;參照?qǐng)D17(a)、圖18)的平均值,所求出的x坐標(biāo)值的平均值代入表示平均直線90B的直線方程,求出y軸坐標(biāo)值。然后,將這樣求出的x坐標(biāo)值和y坐標(biāo)值作為上述紙箱1的上述第三條稜線的x坐標(biāo)值和y坐標(biāo)值。此外,用這些各坐標(biāo)值所表示點(diǎn)在圖17(b)中作為點(diǎn)90E圖表出來。
接下來,根據(jù)上述第1-第3條的各稜線的各x坐標(biāo)值和各y坐標(biāo)值,求出與z軸基本平行的、上述紙箱1的4條棱線中的第4條稜線的x坐標(biāo)值和y坐標(biāo)值。
具體來說,例如求出連接上述點(diǎn)90D和上述點(diǎn)90E的線段的中心點(diǎn)的x坐標(biāo)值和y坐標(biāo)值,以該求出的中心點(diǎn)為對(duì)稱點(diǎn),求出與上述交點(diǎn)90C為點(diǎn)對(duì)稱的點(diǎn)90F,將這個(gè)點(diǎn)90F的x坐標(biāo)值和y坐標(biāo)值作為上述紙箱1的4條棱線中的第4條稜線的x坐標(biāo)值和y坐標(biāo)值。
接下來,從各掃描91-99的各反射位置的z坐標(biāo)值的最大值求出紙箱的上面的高的位置。
具體來說,例如,在各掃描91-99的各反射位置中,求出z坐標(biāo)值為最大的反射位置89c,89d(參照?qǐng)D15(a))的z坐標(biāo)值的平均值,這個(gè)求出的z坐標(biāo)值作為紙箱1的高。
然后,根據(jù)上述4條各稜線的各x坐標(biāo)值和各y坐標(biāo)值和上述紙箱1的頂面的高的位置,算出上述紙箱1的頂面的4個(gè)頂點(diǎn)的x坐標(biāo)值、y坐標(biāo)值、z坐標(biāo)值。
這樣,如果采上述求得的位于紙箱1的各頂點(diǎn)的xyz坐標(biāo)值,可以實(shí)現(xiàn)對(duì)紙箱1的設(shè)置位置和整體大小的認(rèn)識(shí)。
此外,與A模式的情況相同,上述紙箱1的設(shè)置位置和整體大小被恰當(dāng)?shù)剌敵龊捅硎驹趫D1所表示的上位個(gè)人電腦PC39的LCD(沒有圖示)上。
下面對(duì)圖4表示的步驟S23的F模式的紙箱1的識(shí)別進(jìn)行說明。
在F模式中,因?yàn)橛?jì)測裝置3能夠在紙箱1的頂面照射脈沖激光,與上述A模式表示的情相同,只利用紙箱1頂面的反射位置也能求出紙箱1的設(shè)置位置和大小,但是為了更高精度地求出上述紙箱1的設(shè)置位置和大小,可以加上紙箱1的一個(gè)側(cè)面的各反射位置,與D模式情況基本相同,求出上述紙箱1的設(shè)置位置和大小。
如果通過計(jì)測裝置3,用脈沖激光向紙箱1照射,用發(fā)射的脈沖激光對(duì)上述紙箱1(在上述紙箱1的各面中,測計(jì)裝置3用脈沖激光可能照到的全體)進(jìn)行二維的掃描,接受上述紙箱1反射的上述脈沖激光,通過上述脈沖激光的發(fā)射方向和、上述脈沖激光的發(fā)射時(shí)刻和接受這個(gè)脈沖激光的反射光的時(shí)刻的時(shí)間差,檢測出上述紙箱1的反射位置,根據(jù)檢測出來的多各反射位置,計(jì)算出上述紙箱1的大小和設(shè)置位置,所以可以實(shí)現(xiàn)對(duì)于計(jì)測裝置3相對(duì)靜止的紙箱1的設(shè)置位置和整體大小的測量。
而且,因?yàn)槭菦]有移動(dòng)紙箱1就實(shí)現(xiàn)了對(duì)紙箱1的計(jì)測,所以當(dāng)紙箱1很重不易被移動(dòng)時(shí),也很容易計(jì)測紙箱1的大小。
通過計(jì)測裝置3,例如從紙箱1的下部開始一維掃描,通過按順序在紙箱1的上方按一定間隔、錯(cuò)開平行地進(jìn)行與該一維掃描一樣的掃描來進(jìn)行二維掃描,根據(jù)上述各掃描的反射位置的極值(例如,x坐標(biāo)值的最小值和這個(gè)值所對(duì)應(yīng)的y坐標(biāo)值),求出紙箱1的頂點(diǎn),算出紙箱1的設(shè)置位置和大小,所以掃描的操作和上述棱線的算出方法很單純,可以迅速算出紙箱1的設(shè)置位置和整體大小。
因?yàn)橥ㄟ^計(jì)測裝置3可以判斷出計(jì)測裝置3與紙箱1的相對(duì)位置,當(dāng)計(jì)測裝置3用脈沖激光能夠照射到紙箱1的面僅為一個(gè)面時(shí),就可以容易地判斷不能測出紙箱1的大小和位置。而且,按照計(jì)測裝置3和紙箱1的相對(duì)位置的關(guān)系,確實(shí)能夠計(jì)算測量出紙箱1的設(shè)置位置和整體大小。
而且,計(jì)測裝置3,用x坐標(biāo)值、y坐標(biāo)值、z坐標(biāo)值表示紙箱1上的各反射位置,進(jìn)行紙箱1的設(shè)置位置和大小的測量,也可以用極坐標(biāo)的形式表示上述各反射位置,測量紙箱1的設(shè)置位置和整體大小。
而且也可以,在計(jì)測裝置3,著眼于各掃描的各反射位置的x坐標(biāo)值、y坐標(biāo)值、z坐標(biāo)值,例如,在上述D模式中,將各反射位置中z坐標(biāo)值基本一定的點(diǎn)作為紙箱1的頂面的反射位置的集合,求出包絡(luò)這些各反射位置集合的四角形(上述各反射位置的全部基本上均等地存在的四角形中),將這個(gè)四角形作為形成紙箱1的頂面的要素來測量紙箱1的設(shè)置位置和全體的大小。
此外還可以通過計(jì)測裝置3計(jì)測除長方形的紙箱1以外的集裝箱等、表面可對(duì)脈沖激光反射的長方體的設(shè)置位置和大小。
還可以用物體計(jì)測裝置(計(jì)測裝置)計(jì)測紙箱或集裝箱等長方體以外的形狀的物體。
即也可以,用在上述物體外部設(shè)置的激光發(fā)生器發(fā)射脈沖激光測量上述物體的大小、位置、移動(dòng)速度(速度向量)中至少一個(gè)的情況下,用上述脈沖激光對(duì)上述物體進(jìn)行二維掃描,接受上述物體的反射光,通過上述脈沖激光的發(fā)射方向和、上述脈沖激光的發(fā)射時(shí)刻和接受這個(gè)脈沖激光的反射光的時(shí)刻的時(shí)間差,檢測出上述物體的反射位置,根據(jù)檢測出來的多個(gè)反射位置、計(jì)算上述物體的大小、位置、移動(dòng)速度中的至少一個(gè)。
此外,上述移動(dòng)速度的計(jì)算是、例如、根據(jù)上述各二維掃描的上述物體的位置變化算出的。即,用上述計(jì)算裝置13等,在上述一個(gè)二維掃描計(jì)測下的上述物體的位置與在上述該一個(gè)二維掃描之后的下一個(gè)二維掃描時(shí)計(jì)測下的上述物體的位置進(jìn)行比較,算出上述物體的移動(dòng)速度。
通過這樣的方法,具有計(jì)算出長方體及長方體以外形狀的物體的整體大小、位置、移動(dòng)速度的效果。
而且,上述物體是機(jī)動(dòng)車等車輛、行人的時(shí)候,如果用上述物體計(jì)測裝置計(jì)測通過交叉點(diǎn)等物體,上述物體計(jì)測裝置即可適用于交通監(jiān)視系統(tǒng)。
此外,本發(fā)明是有關(guān)的物體識(shí)別方法的發(fā)明,該方法不受天氣等環(huán)境的影響,通過測定在引導(dǎo)行人的步行區(qū)域及周邊區(qū)域中物體的形狀、大小、向量,識(shí)別在引導(dǎo)方向上步行區(qū)域中移動(dòng)的物體和、在橫斷步行區(qū)域的方向上中移動(dòng)的物體,采用適當(dāng)手段、利用區(qū)域傳感器來實(shí)現(xiàn)行人及交通弱者安全地通過步行區(qū)域?yàn)槟康摹?br> 以前,在行車道上設(shè)置了行人用的行人人行橫道,在行人人行橫道上設(shè)置了一般的過馬路的行人使用的信號(hào)機(jī)(以下稱之為橫斷信號(hào))和車輛用的信號(hào)機(jī)(以下稱之為車道信號(hào)),通過兩個(gè)信號(hào)機(jī)的交替變換,行人便可以安全地過馬路。
在復(fù)數(shù)行車道交叉的交叉點(diǎn)上,設(shè)置了為步行者通過每個(gè)行車道的行人人行橫道。例如,行車道十字形狀交叉的交叉路口,通常設(shè)置4個(gè)行人人行橫道。在這樣的交叉路口上,車道信號(hào)變綠時(shí)機(jī)動(dòng)車通行,與行車道相平行的行人人行橫道的橫斷信號(hào)變綠,行人能夠按照橫斷信號(hào)綠的引導(dǎo)方向過馬路。
但是,在車道信號(hào)變綠的車道上機(jī)動(dòng)車除直行外還可左轉(zhuǎn),因此,左轉(zhuǎn)的汽車可以通過步行者正在橫斷的人行橫道。
因此,行人有時(shí)被催促盡快通過馬路,特別是兒童或老人、坐輪椅的殘疾人、腿腳不便的人等速度慢的交通弱者,因?yàn)閼延信戮砣霗C(jī)動(dòng)車事故的害怕心理,變得焦急,從而發(fā)生摔倒等危險(xiǎn)事故。
且,在過去,用設(shè)置聲音信號(hào)機(jī)的方法作為謀求人行橫道安全的方法,通過用聲音引導(dǎo)行人,實(shí)施對(duì)兒童或老人、坐輪椅的殘疾人、腿腳不便的人的幫助。還有作為這種引導(dǎo)方法,為了能讓視覺障礙的行人知道可以橫斷的方向,通常采用鳴叫交換的方式、或采用異種鳴叫交換等信號(hào)機(jī)。這種方法特別對(duì)視覺障礙者和兒童等是有效方法。但是,采用這樣聲音引導(dǎo)方法的時(shí)候,行人存在對(duì)左轉(zhuǎn)的機(jī)動(dòng)車輛的恐怖,所以并沒有改變催促行人盡早過馬路的事實(shí),問題沒有根本解決。
另一方面,近年,在行人人行橫道上設(shè)置了為能夠檢測出過馬路行人的超聲波式的行人感知器、紅外線感知器、或者CCD照相機(jī)等,大概能夠檢測出過馬路行人的人數(shù)、過馬路時(shí)移動(dòng)的速度等,參考這樣做得到的檢出信號(hào),調(diào)整橫斷信號(hào)改變的時(shí)間以謀求行人安全地過馬路,或者提出了通過更有效的信號(hào)改變來緩和交通堵塞等各種方案。
但是、根據(jù)上述以前的超聲波式的行人感知器、紅外線感知器、CCD照相機(jī)等方法,用二維平面掃描行人人行橫道,僅能大略檢測出是否有人過馬路或者人數(shù)、移動(dòng)速度等,不能正確地識(shí)別出行人是兒童、老人、坐輪椅的殘疾人、腿腳不便的人等。而且,特別是用紅外線感知器和CCD照相機(jī)作為檢測方法,在夜間或雨、雪等環(huán)境狀況下,會(huì)發(fā)生檢出精度大幅降低導(dǎo)致不能檢出等問題。
作為謀求行人人行橫道的安全的方法,如果能夠正確地檢測出是否有通過行人人行橫道的行人存在,特別是正確動(dòng)檢出兒童或老人、坐輪椅的殘疾人、腿腳不便的行人等正在通過人行橫道的情況,將次情報(bào)告知即將左轉(zhuǎn)的機(jī)動(dòng)車的駕駛員,使其準(zhǔn)確地停車;或者通過調(diào)整信號(hào),使交通弱者能夠安全的橫過馬路,但是上利用超聲波式行人感知器、紅外線感知器、CCD照相機(jī)等以前的方法,即使能夠捕捉到行人人行橫道或在其周圍的行人大概的數(shù)量也不能正確地檢出交通弱者,因此,行人、特別是交通弱者很難安全的橫過馬路。而且,紅外線感知器或CCD照相機(jī)等,會(huì)因在夜間或雨、雪等環(huán)境狀況下檢測精度大幅下降,不能利用其實(shí)現(xiàn)實(shí)質(zhì)的橫過馬路的安全。
本發(fā)明是解決了從前裝置存在的問題。本發(fā)明的目的是提供利用區(qū)域傳感器來識(shí)別物體的方法,該方法不受天氣等環(huán)境的影響,通過測定在引導(dǎo)行人的步行區(qū)域及周邊區(qū)域中物體的形狀、大小、向量來識(shí)別在引導(dǎo)方向上步行區(qū)域中移動(dòng)的物體和、在橫斷步行區(qū)域的方向上移動(dòng)的物體,采用適當(dāng)?shù)氖侄蝸韺?shí)現(xiàn)使行人及交通弱者安全地通過步行區(qū)域?yàn)槟康摹?br> 以下,用附圖來說明本發(fā)明的最好的是實(shí)形態(tài)。
圖20是展示實(shí)施本發(fā)明的形態(tài)的一個(gè)例子的圖,在圖20中,展示了2車線的車道202A和車道202B交叉后形成的十字路口,在該十字路口處,在引導(dǎo)方向20P設(shè)置了4個(gè)為了讓行人橫過上述車道202A和202B的人行橫道201(步行區(qū)域)。
在十字路口的4個(gè)角落里設(shè)置柱子203,在該柱子上,在行走車輛上部前方位置安置三種燈(紅綠黃)的車道信號(hào)器204,又在柱子203上,在行人人行橫道201的前后上部位置的對(duì)向位置安置橫斷信號(hào)器205。圖中206是車道的白線,207時(shí)停車線。
在圖20表示20A方向的車輛停止,20B方向的車輛行走的狀態(tài)。所以,行人正在橫過引導(dǎo)方向20P與行走20B方向相平行的方向的人行橫道201,在引導(dǎo)方向20P與停止方向20A相平行的人行橫道201,行人正在兩端部的信號(hào)等待區(qū)域208等待信號(hào)。
在上述各柱子203上設(shè)置能夠?qū)Ω采w人行橫道201和其周邊區(qū)域209的檢出范圍210發(fā)射和檢出脈沖激光211(例如應(yīng)用激光感應(yīng)器的區(qū)域感應(yīng)器)的區(qū)域感應(yīng)器212。上述檢出范圍210包含人行橫道201,而且包括該人行橫道201的反交叉點(diǎn)一側(cè)和人行橫道201兩端的信號(hào)等待區(qū)域208,例如以3-5米左右任意設(shè)定的超出寬度20L來覆蓋,而且為了能夠檢測出左轉(zhuǎn)的、朝向人行橫道201的汽車,還有按所需要的范圍覆蓋人行橫道210的交叉點(diǎn)側(cè)車道的周邊區(qū)域209。
區(qū)域感應(yīng)器212是向?qū)ο笪锿渡涿}沖激光211,并且檢測到反射回來的反射激光的裝置。因而區(qū)域感應(yīng)器最好設(shè)置在能看到上述檢測范圍210的位置。所以除了使用上述信號(hào)裝置的柱子203以外,還可以設(shè)置為了區(qū)域感應(yīng)器212的專用柱子等。
區(qū)域感應(yīng)器212的構(gòu)成如圖19所示。即、區(qū)域感應(yīng)器212由掃描裝置216和擺動(dòng)裝置219構(gòu)成,掃描裝置216用馬達(dá)213以掃描軸214為中心、使多邊鏡215在x方向上掃描,擺動(dòng)裝置219通過馬達(dá)217以擺動(dòng)軸218為中心令該掃描裝置216在y方向上擺動(dòng)。
從區(qū)域感應(yīng)器212上裝備的激光光源220發(fā)射的脈沖激光211,經(jīng)擁有鏡子221等的激光投射裝置222輸出到上述多邊鏡215,輸出到多邊鏡215上的脈沖激光211,根據(jù)掃描裝置216和擺動(dòng)裝置219的動(dòng)作,對(duì)覆蓋包括人行橫道201和信號(hào)等待區(qū)域208和包含車道的周邊區(qū)域209的檢出范圍210進(jìn)行掃描。且投射到檢出范圍210上并被反射回的反射激光223回到上述多邊鏡215,而且,反射激光223通過鏡頭224被輸入到受光元件225中,通過受光元件225的計(jì)測信號(hào)226(電氣信號(hào))被輸入到演算裝置227中。
在演算裝置227中,輸入從受光元件225來的計(jì)測信號(hào)226,對(duì)檢出范圍210掃描并從各掃描點(diǎn)上反射回來的反射激光223的反射時(shí)間進(jìn)行計(jì)算測量。
在檢出范圍210上不存在行人等物體的時(shí)候,像圖21所表示的那樣,在x方向上進(jìn)行一次掃描時(shí),從各掃描點(diǎn)反射回來的反射激光223的反射時(shí)間基本上是定值,接著,通過擺動(dòng)裝置219使掃描裝置216進(jìn)行微小角度的擺動(dòng)后,也進(jìn)行同樣的掃描,從各掃描點(diǎn)反射回來的反射激光223的反射時(shí)間基本上是定值。通過這樣做的掃描和擺動(dòng),對(duì)檢出范圍210進(jìn)行掃描,檢出來的各掃描點(diǎn)的計(jì)測值,用圖來表示的話,即是圖22中較平坦的面。
相反,像圖21那樣,在檢出范圍210中存在行人或坐輪椅的殘疾人、自行車等或機(jī)動(dòng)車等物體20S時(shí),從向物體20S照射的脈沖激光211的各掃描點(diǎn)來的反射時(shí)間將變短,據(jù)此,物體20S的形狀大小和位置像圖22那樣,以三維x、y、z形式以點(diǎn)228來表示的檢出值。而且,通過反復(fù)地掃描,通過時(shí)間的推移,物體20S的形狀和大小和位置發(fā)生變化,根據(jù)這些情況,可以詳細(xì)地檢出物體20S的各種情報(bào)。
區(qū)域感應(yīng)器212可以在1秒鐘發(fā)射數(shù)十萬回脈沖激光,而且可以檢測2m-100m的距離,例如在30m出處檢出,以26mm以下的高分辨率檢出,而且,這個(gè)時(shí)候的距離精度在10mm以下。在圖22中展示的點(diǎn)228的間隔被放大了,但是實(shí)際上這個(gè)間隔非常的小,因此,就能夠得到關(guān)于各個(gè)物體20S的詳細(xì)的情報(bào)。
通過演算裝置227,根據(jù)圖22中點(diǎn)228的三維數(shù)據(jù),可以得到如圖23所示的物體20S的加權(quán)檢出值229,可以得到表示由該檢出值229所表示的物體20S的形狀和大小的演算信號(hào)值230a。
將這個(gè)演算信號(hào)值230a輸入識(shí)別裝置232,通過與事先求出的、輸入到識(shí)別裝置232中的判定情報(bào)331相比較,進(jìn)行物體20S的識(shí)別。即、識(shí)別裝置232根據(jù)形狀、大小等判定情報(bào)331,來識(shí)別演算信號(hào)230所表示的物體20S是健康的成年人、小孩、坐輪椅的殘疾人、腿腳不便的人、推嬰兒車的人或騎自行車的人等。而且,在檢出范圍210中的物體20S是左轉(zhuǎn)侵入的時(shí)候,從該位置和形狀和大小,可以檢測出物體20S是機(jī)動(dòng)車。且,可以檢測出在上述檢出范圍210中的行人的人數(shù),甚至可以檢測出掉落物品等障礙物。
上述演算裝置227按照下述方法檢出在范圍210中移動(dòng)的物體20S的矢量。
圖24表示,由于周邊區(qū)域209的緣故而使較寬廣地檢出十字路口的檢出范圍210中,車道上的物體20S(機(jī)動(dòng)車)左轉(zhuǎn)、向橫斷人行橫道201的方向移動(dòng),正在這時(shí),物體20S(坐輪椅的殘疾人)在引導(dǎo)方向20P上在人行橫道201上移動(dòng)時(shí)的狀態(tài)。
這時(shí),從圖22的點(diǎn)228的檢出值是在經(jīng)過所定時(shí)間后位置變化了的檢出值,如圖25所示,可以用矢量233表示物體20S移動(dòng)的方向和移動(dòng)量。從該矢量233所得到的演算信號(hào)230b輸入到識(shí)別裝置232中,根據(jù)這個(gè)矢量233實(shí)行對(duì)物體20S的識(shí)別。
前面所述的演算信號(hào)230b的矢量233是在向著人行橫道201的引導(dǎo)方向20P的時(shí)候,可以識(shí)別出物體20S是行人,而且從表示移動(dòng)量的矢量233長度之小(速度低)也能識(shí)別出是行人。而且,當(dāng)矢量233向著人行橫道201的橫斷方向時(shí),可以識(shí)別出物體20S是機(jī)動(dòng)車,而且從矢量233的長度之大(速度快)也能識(shí)別出是機(jī)動(dòng)車。這時(shí),向車道左轉(zhuǎn)的物體20S的檢出值是突然出現(xiàn)在離開檢出范圍210的人行橫道201的位置上的,從這點(diǎn)上也能識(shí)別出物體20S是機(jī)動(dòng)車。
按照上述做法,在識(shí)別裝置232中,從演算信號(hào)233a表示的形狀和大小可以識(shí)別出物體20S是步行者,同時(shí)能夠識(shí)別出行人是健康的成年人、小孩、坐輪椅的殘疾人、腿腳不便的人、推嬰兒車的人或騎自行車的人等。而且,從前述的演算信號(hào)230b的矢量233是向著人行橫道201的引導(dǎo)方向20P可以識(shí)別出是行人,而且,從矢量233的長度小也可以識(shí)別出是行人。所以,至少根據(jù)矢量233向著人行橫道201的引導(dǎo)方向20P、物體20S的形狀和大小,可以確實(shí)地識(shí)別出行人。
前述演算信號(hào)230b的矢量233的方向是如圖25所示的橫斷人行橫道201的方向的物體20S的情況時(shí),能夠識(shí)別至少不是行人,而是機(jī)動(dòng)車。因?yàn)橄蜍嚨雷筠D(zhuǎn)的物體20S的檢出值是在離開檢出范圍210的人行橫道201的位置上突然出現(xiàn)的,所以從矢量233是在檢出范圍210內(nèi)突然出現(xiàn)的情況,也能夠識(shí)別出物體20S是機(jī)動(dòng)車。而且,從矢量233的長度大也可以識(shí)別出是機(jī)動(dòng)車。而且,通過前述演算信號(hào)230a表示的物體20S的形狀和大小也可以識(shí)別出機(jī)動(dòng)車。所以,至少是從在檢出范圍210的周邊區(qū)域209突然出現(xiàn)矢量233和矢量233是向著橫斷人行橫道的方向,能夠確實(shí)地機(jī)動(dòng)車。而且這時(shí),機(jī)動(dòng)車是摩托車的情況時(shí),根據(jù)其形狀和大小可以識(shí)別出是摩托車。
通過上述識(shí)別裝置232,檢測出過馬路的行人是兒童、坐輪椅的殘疾人、腿腳不便的人等的步行速度慢的交通弱者的情況時(shí),用識(shí)別裝置232的識(shí)別信號(hào)234,可以實(shí)現(xiàn)采用適當(dāng)?shù)拇胧┦菇煌ㄈ跽吣軌蚍判牡匕踩赝ㄟ^人行橫道201。
即,在圖19中,將識(shí)別裝置232的識(shí)別信號(hào)234輸入到無線裝置235上,交通弱者橫過人行橫道201時(shí),通過無線裝置235,向左轉(zhuǎn)橫斷人行橫道201方向上移動(dòng)的機(jī)動(dòng)車的駕駛員傳達(dá)“交通弱者正在過馬路”的信息。據(jù)此喚起機(jī)動(dòng)車駕駛員保證行人安全的注意以識(shí)。
且,將上述識(shí)別裝置232的識(shí)別信號(hào)234輸入到信號(hào)切換器237中,能夠進(jìn)行信號(hào)切換的修正等。通常,車道信號(hào)204和橫斷信號(hào)205,在各十字路口,與時(shí)間、星期幾、季節(jié)對(duì)應(yīng)的車輛交通量和過馬路的行人數(shù)的變動(dòng)對(duì)應(yīng)的、選定的設(shè)定周期236輸入到信號(hào)切換器237,根據(jù)這個(gè)設(shè)定周期236實(shí)行對(duì)信號(hào)的切換控制。而且,信號(hào)切換器237有時(shí)與生音裝置或光電顯示板等傳達(dá)裝置238連接,傳達(dá)裝置232通過聲音或文字,進(jìn)行向過馬路的行人通知橫過的注意事項(xiàng)。
從前述識(shí)別裝置232得到的識(shí)別信號(hào)234輸入到信號(hào)切換器237時(shí),信號(hào)切換器237,為了能使正在過馬路的交通弱者安全地通過行人行橫道201,可以調(diào)整延長橫斷信號(hào)205的綠燈時(shí)間,或延長綠燈的點(diǎn)減時(shí)間。且,通過傳達(dá)裝置238以聲音、文字等向行人進(jìn)行“橫斷時(shí)間已被延長。不要著急,慢慢地通過”等引導(dǎo)。
以下說明上述形態(tài)的作用。
如圖19、圖20所示,采用區(qū)域感應(yīng)器212的區(qū)域感應(yīng)器,根據(jù)掃描裝置216和擺動(dòng)裝置219的動(dòng)作,向包含有可以檢測出人行橫道201和信號(hào)等待區(qū)域208及左轉(zhuǎn)橫斷人行橫道201的方向上的移動(dòng)物體(機(jī)動(dòng)車)20S的周邊區(qū)域209的檢出范圍,用脈沖激光進(jìn)行掃描檢測。
通過區(qū)域感應(yīng)器212向檢出范圍210發(fā)射后反射的激光223,返回到區(qū)域感應(yīng)器212的多邊鏡215,經(jīng)鏡頭224輸入到受光元件225中,受光元件225的計(jì)測信號(hào)226輸入到演算裝置227中。
在演算裝置227,通過輸入的從受光元件225來的計(jì)測信號(hào)226,計(jì)算測量對(duì)掃描檢出范圍210進(jìn)行掃描并從各反射點(diǎn)上反射回的反射激光233的反射時(shí)間。
據(jù)此,在演算裝置227上得到了如圖22所示的、以點(diǎn)228表示的各掃描點(diǎn)的三維數(shù)據(jù),而且,從這個(gè)點(diǎn)228的數(shù)據(jù)中,可以得到如圖23所示的、表達(dá)形狀和大小的檢出值229,演算信號(hào)輸入到識(shí)別裝置232中。而且同時(shí),利用演算裝置227求出了如圖25所示的物體20S的矢量233,該演算信號(hào)230b被輸入到識(shí)別裝置232中。
識(shí)別裝置232可以,根據(jù)判定情報(bào)231,從前述演算信號(hào)230a的形狀大小,來識(shí)別物體20S是行人或是機(jī)動(dòng)車,而且,可以識(shí)別出行人是健康的成年人、小孩、坐輪椅的殘疾人、腿腳不便的人、推嬰兒車的人或騎自行車的人等。進(jìn)而,從演算信號(hào)230b的矢量233是向著人行橫道201的引導(dǎo)方向20P,可以識(shí)別物體20S物體是步行者,而且,從表示移動(dòng)量的矢量233的長度小(速度慢)也能夠識(shí)別出是步行者。
因此,至少從矢量233是向著人行橫道201的引導(dǎo)方向20P以及物體20S的形狀和大小,能夠確實(shí)識(shí)別出物體20S是行人,而且在行人是交通弱時(shí),也能夠確實(shí)地識(shí)別出。
當(dāng)物體20s是,如圖25所示,演算信號(hào)230b的矢量233的方向是橫斷人行橫道201的方向的時(shí)候,至少能夠識(shí)別出不是行人,而是機(jī)動(dòng)車。又因?yàn)橄蜍嚨雷筠D(zhuǎn)的物體20S是突然出現(xiàn)在離開檢出范圍210的人行橫道201的位置上的,所以從矢量233是突然出現(xiàn)在檢出范圍210可以識(shí)別出是機(jī)動(dòng)車。而且,從矢量233的長度大(速度快)也可以識(shí)別出是機(jī)動(dòng)車。從根據(jù)前述的演算信號(hào)230a表示的物體20S的形狀和大小也能夠識(shí)別出是機(jī)動(dòng)車。
所以至少是,通過矢量233是在檢出范圍210的周邊區(qū)域209突然出現(xiàn)的和、矢量233向著橫斷人行橫道201的方向,能夠確實(shí)地識(shí)別出物體20s是機(jī)動(dòng)車。
如上所述,用區(qū)域感應(yīng)器212一邊向檢出范圍210發(fā)射脈沖激光一邊掃描測量計(jì)算掃描光的反射時(shí)間,求出各掃描點(diǎn)的、物體不存在時(shí)的反射時(shí)間和物體存在時(shí)的反射時(shí)間的差,就能夠通過演算裝置227實(shí)行對(duì)物體20S的檢測,所以能夠?qū)崿F(xiàn)不受天氣等環(huán)境狀況的影響,高精度的檢出物體20S。根據(jù)從演算裝置227來的演算信號(hào)230a、230b,通過識(shí)別裝置232,可以詳細(xì)地識(shí)別出在人行橫道201上沿引導(dǎo)方向20P移動(dòng)的物體20S和橫斷人行橫道201的方向上移動(dòng)的物體20S,在行人是交通弱者,例如小孩、坐輪椅的殘疾人、腿腳不便的人等情況時(shí),也可以確實(shí)地識(shí)別出,所以,用這個(gè)識(shí)別裝置232的識(shí)別信號(hào)234,可以實(shí)現(xiàn)采用適當(dāng)?shù)拇胧?,使交通弱者能夠放心地安全地通過人行橫道201。
而且,本發(fā)明不是僅限于上述的實(shí)施形態(tài),也適用于人行橫道以外的通過行車道的步行區(qū)域,區(qū)域感應(yīng)器上可以采用各種各樣的感應(yīng)器,只要不脫離本發(fā)明的思想,可以進(jìn)行各種各樣的變更。
根據(jù)本發(fā)明,使用區(qū)域感應(yīng)器,一邊向檢出范圍發(fā)射脈沖激光,一邊掃描測量計(jì)算光的反射時(shí)間,求出各掃描點(diǎn)的物體不存在時(shí)的反射時(shí)間和物體存在時(shí)的反射時(shí)間的差,就可實(shí)行對(duì)物體的檢測,能夠?qū)崿F(xiàn)不受天氣等環(huán)境狀況的影響,高精度的檢出物體,詳細(xì)地識(shí)別出在步行區(qū)域沿引導(dǎo)方向移動(dòng)的物體和橫斷步行區(qū)域的物體,也可以確實(shí)地識(shí)別出行人是交通弱者,例如小孩、坐輪椅的殘疾人、腿腳不乏便的人等情況,所以,可以實(shí)現(xiàn)采用適當(dāng)?shù)拇胧?,是交通弱者能夠放心地安全地通過步行區(qū)域。
進(jìn)而,本發(fā)明是關(guān)于適用于把握在既定的監(jiān)視區(qū)域內(nèi)的移動(dòng)物體或監(jiān)視區(qū)域的狀況變化的物體計(jì)測裝置的發(fā)明。
以前,監(jiān)視在既定的監(jiān)視區(qū)域的侵入物或掌握其狀況時(shí),一般采用監(jiān)視照相機(jī)。但是,用監(jiān)視照相機(jī)得到的圖像,一般容易受天氣(氣象)的影響,而且,在夜間監(jiān)視困難。
最近,提倡用激光雷達(dá)監(jiān)視既定監(jiān)視區(qū)域的入侵物等(例如在特開平11-227608號(hào)公報(bào)上所展示的專利文獻(xiàn)2、在特開平11-352245號(hào)公報(bào)上所展示的專利文獻(xiàn)3)。如果探用這種激光雷達(dá)的監(jiān)視系統(tǒng),可以不受天氣(氣象)等影響進(jìn)行物體的檢出。
但是,在用上述激光雷達(dá)的監(jiān)視系統(tǒng),雖然能夠得到高精度地檢出侵入監(jiān)視區(qū)域的移動(dòng)物體等的空間坐標(biāo)(從監(jiān)視點(diǎn)開始的距離和方位),但是一般很難掌握物體到底是什么。在這點(diǎn)上,如果用前述的監(jiān)視照相機(jī)的圖像時(shí),攝像圖像中的物體通過人的視覺感性上就能判斷,從該圖像情報(bào)可以很容易判斷各種各樣的物體是什么。但是從照相機(jī)的圖像上,除了利用立體照相機(jī)之外,不能得到與檢出對(duì)象物的距離情報(bào)。
本發(fā)明解決這樣的問題,本發(fā)明的目的是提供一種物體計(jì)測裝置,該物體計(jì)測裝置能夠同時(shí)容易地得到在既定的監(jiān)視區(qū)域內(nèi)的移動(dòng)物體等的情報(bào)和其空間位置情報(bào)。
以下,參照

關(guān)于與本發(fā)明的一個(gè)實(shí)施形態(tài)的物體計(jì)測裝置。
圖26是表示該實(shí)施形態(tài)的物體計(jì)測裝置的大略構(gòu)成的圖。310是對(duì)既定的監(jiān)視對(duì)象區(qū)域進(jìn)行掃描的激光雷達(dá),320是在310的旁邊設(shè)置的、對(duì)既定的監(jiān)視對(duì)象區(qū)域進(jìn)行攝像的監(jiān)視照相機(jī)(例如電視照相機(jī))。這些激光雷達(dá)310和監(jiān)視照相機(jī)320是整體收容在一個(gè)筐體330內(nèi),構(gòu)成傳感器單元,設(shè)置在建筑物的外墻或電線桿等的特定高度的監(jiān)視點(diǎn)上,能夠俯瞰該監(jiān)視對(duì)象區(qū)域的地表面。即,激光雷達(dá)310和監(jiān)視照相機(jī)320設(shè)計(jì)為,實(shí)際上是從可看作同一個(gè)的監(jiān)視點(diǎn)出發(fā),從不同的視野監(jiān)視同一個(gè)監(jiān)視對(duì)象區(qū)域。
即,因?yàn)榧す饫走_(dá)310具有、例如、以一定速度旋轉(zhuǎn)驅(qū)動(dòng)多面體鏡子311的主掃描馬達(dá)312和副掃描馬達(dá)313,該副掃描馬達(dá)313設(shè)計(jì)成與該主掃描馬達(dá)312的轉(zhuǎn)動(dòng)軸成直角,通過讓上述多面體鏡子311的轉(zhuǎn)動(dòng)軸在所定的角度范圍內(nèi)傾斜運(yùn)動(dòng),使多面體鏡子311的回轉(zhuǎn)面以既定的速度搖動(dòng)。從激光光源314發(fā)射出的激光脈沖光通過半鏡315照射在上述多面鏡311上,上述激光脈沖光,在與該多面鏡311的回轉(zhuǎn)和傾斜相應(yīng),照射既定的監(jiān)視區(qū)域,而且,受光器317從前述多面鏡311經(jīng)集光鏡頭316接受和檢知來從激光脈沖光的監(jiān)視區(qū)域來的反射光。
該激光雷達(dá)310的構(gòu)成如下。通過多面鏡311的回轉(zhuǎn)和搖動(dòng),一邊在主掃描方向(x方向)上高速的對(duì)激光脈沖光的照射方向掃描,一邊在副掃描方向(y方向)上對(duì)其掃描面進(jìn)行掃描,據(jù)此,如圖27所示,對(duì)既定的監(jiān)視對(duì)象區(qū)域的全域進(jìn)行掃描。接著,與上述激光脈沖光照射同步,接受在監(jiān)視對(duì)象區(qū)域內(nèi)存在的各種各樣的物體的反射光,從該受光經(jīng)過時(shí)間(從脈沖激光照射的時(shí)刻開始到反射光的受光時(shí)刻為止的經(jīng)過時(shí)間),求出到物體(反射點(diǎn))的距離情報(bào)。
將用這樣的激光雷達(dá)310檢出的距離情報(bào)做成可視化雷達(dá)圖像的雷達(dá)圖像做成裝置340,例如,可以通過由個(gè)人電腦構(gòu)成的監(jiān)視裝置(物體計(jì)測裝置)本體350所具備的一種機(jī)能來實(shí)現(xiàn)。具體的,該雷達(dá)圖像做成裝置340具備反射光檢出部342、距離情報(bào)變換部343和濃淡變換部344,該反射光檢出部342,例如如圖28所示,接受從驅(qū)動(dòng)前述激光光源314的脈沖激光掃描回路341來的同步信號(hào)并計(jì)算測量前述激光脈沖的、物體的反射光的受光時(shí)刻,距離情報(bào)變換部343將計(jì)測時(shí)間變換為距離情報(bào),該濃淡變換部344將該距離情報(bào)變換為濃淡情報(bào)。當(dāng)然,前述計(jì)測時(shí)間也可以直接變換成為濃淡情報(bào)。而且,在這個(gè)實(shí)施形態(tài)中,將距離情報(bào)轉(zhuǎn)換成、例如、距離遠(yuǎn)時(shí)濃度變濃的濃淡情報(bào),然而也可以采取與距離相應(yīng)的顏色階段地變化的色調(diào)變換。
激光雷達(dá)圖像按下述方法做成。對(duì)按上述做法求出的濃淡情報(bào)(距離情報(bào)),按從前述脈沖激光掃描回路341求出的主掃描角度及副掃描角度的情報(bào),順序在所定的圖像存儲(chǔ)器345上測繪、生成圖像。即,在通過表示激光脈沖的掃描方向的主掃描角度及副掃描角度特定的坐標(biāo)(圖像存儲(chǔ)器345的地址)上,寫入該時(shí)刻所求出的濃淡情報(bào)(距離情報(bào)),以此在圖像存儲(chǔ)器345上做成在監(jiān)視對(duì)象區(qū)域內(nèi)的三維地確定激光脈沖的反射點(diǎn)的激光雷達(dá)圖像。
本發(fā)明的物體計(jì)測裝置的特征是具備有圖像匹配裝置360,該圖像匹配裝置360與如上所述求出的監(jiān)視對(duì)象區(qū)域的激光雷達(dá)圖像30A的坐標(biāo)和、前述用監(jiān)視照相機(jī)320所拍攝的上述監(jiān)視區(qū)域的攝像圖像30B的坐標(biāo)相互對(duì)應(yīng)。該圖像匹配裝置360也是作為前述監(jiān)視裝置本體350所具備的機(jī)能的一部分來實(shí)現(xiàn)的。進(jìn)而,該圖像匹配裝置360是將裝備了激光雷達(dá)310和監(jiān)視照相機(jī)為一體的感應(yīng)器單元330設(shè)置在前述電線桿等以便可看到既定的監(jiān)視區(qū)域時(shí),作為初期設(shè)定處理來啟動(dòng)的。
具體的,圖像匹配裝置360設(shè)置在前述監(jiān)視裝置本體350上,監(jiān)視器(顯示器)370上分別表示激光雷達(dá)圖像30A及攝像圖像30B,當(dāng)這些各圖像30A、30B中的、前述監(jiān)視對(duì)象區(qū)域中相互對(duì)應(yīng)的、具有代表性的特征點(diǎn)分別被指定多個(gè)點(diǎn)時(shí),按照這些指定的特征點(diǎn)的位置坐標(biāo),實(shí)行使上述激光雷達(dá)圖像30A的坐標(biāo)系和攝像圖像30B的坐標(biāo)系相互對(duì)應(yīng)的處理。
即,如圖29所示的處理概念,將表示在激光雷達(dá)圖像30A上的明確可識(shí)別的復(fù)數(shù)的物體位置的坐標(biāo)指定為代表的特征點(diǎn)a1、a2、a3……,指定,將表示在攝像圖像B上的上述各物體位置的、與上述各特征點(diǎn)a1、a2、a3……分別對(duì)應(yīng)的坐標(biāo)指定為特征點(diǎn)b1、b2、b3……。關(guān)于這些特征點(diǎn)a1、a2、a3……(b1、b2、b3……),例如根據(jù)操作的經(jīng)驗(yàn)或圖像的認(rèn)知感覺,選擇性地指定明確認(rèn)知的在各圖像30A、30B上為同一的物體或著目點(diǎn),作為與監(jiān)視點(diǎn)近距離的物體及與監(jiān)視點(diǎn)遠(yuǎn)距離的物體。接下來,使這些指定的特征點(diǎn)a1、a2、a3……(b1、b2、b3……)相互重合,變換一方圖像(激光雷達(dá)圖像30A或攝像圖像30B)的坐標(biāo)系,通過這些如能實(shí)現(xiàn)激光雷達(dá)圖像30A和攝像圖像30B相互重合則為好。
具體的如圖30所示的處理順序,首先,在激光雷達(dá)圖像30A上指定垂直的對(duì)象物體的坐標(biāo),具體來說,分別指定4個(gè)在激光雷達(dá)圖像30A的水平方向點(diǎn)位置和垂直方向點(diǎn)位置(步驟S301)。接下來,在攝像圖像30B上,分別指定4個(gè)表示與激光雷達(dá)圖像30A同一的對(duì)象物的同一部位的坐標(biāo)(水平方向點(diǎn)位置和垂直方向點(diǎn)位置)。從這些指定的復(fù)數(shù)的坐標(biāo)來分別求出各圖像30A、30B的增益(空間傾斜比)(步驟303)。
接下來,令在激光雷達(dá)圖像30A的對(duì)象物的特定部位的坐標(biāo)與在攝像圖像30B的同一物體的相同部位的坐標(biāo)一致,輸入由上述坐標(biāo)間差異的水平方向的點(diǎn)差和垂直方向的點(diǎn)差表示的位移(步驟S304),根據(jù)前述的增益和位移,例如,令[激光圖像坐標(biāo)]=[攝像圖像坐標(biāo)]/[增益]-[位移],使激光雷達(dá)圖像30A的坐標(biāo)系與攝像圖像30B的坐標(biāo)系相重合。
這樣,如使激光雷達(dá)圖像30A的坐標(biāo)系和攝像圖像30B的坐標(biāo)系匹配,在這之后的監(jiān)視動(dòng)作時(shí),一般來說,在容易把握攝像對(duì)象區(qū)域的狀況的攝像圖像30B的各個(gè)部位上,能夠分別賦予由上述激光雷達(dá)圖像30A所顯示的記錄情報(bào)。在攝像圖像30B中,即使只看一眼很難識(shí)別的、例如,其一部分互相重合并相似色調(diào)的復(fù)數(shù)的物體、或者受到氣象條件影響難以識(shí)別復(fù)數(shù)物體的隔斷的情況下,按照從上述雷達(dá)激光圖像30A求出的距離情報(bào),能夠分別地、明確地識(shí)別每個(gè)物體。所以激光雷達(dá)圖像30A和攝像圖像30B相互彌補(bǔ)分別存在的不足,而且激光雷達(dá)圖像30A及攝像圖像30B的優(yōu)點(diǎn)被分別地靈活使用,能夠容易地、且準(zhǔn)確地掌握在既定的監(jiān)視對(duì)象領(lǐng)域的移動(dòng)物體等的狀況。
本發(fā)明的物體計(jì)測裝置,增加了上述的圖像匹配處理裝置360,還具備了從上述激光雷達(dá)圖像30A認(rèn)識(shí)前述監(jiān)視對(duì)象區(qū)域的固定物體的面或移動(dòng)物體的物體識(shí)別裝置380。具體的,該物體識(shí)別裝置380由平面識(shí)別處理部381和移動(dòng)物體檢出處理部382構(gòu)成,該平面識(shí)別處理部381,如圖30所示,從監(jiān)視對(duì)象區(qū)域的固定物體的匯總的情報(bào)來識(shí)別構(gòu)成該固定物體的面,該移動(dòng)物體檢出處理部382在前述監(jiān)視對(duì)象區(qū)域中從每一次掃描檢出的坐標(biāo)變化的情報(bào)來識(shí)別移動(dòng)物體。
即、平面識(shí)別處理部381,例如、通過在激光雷達(dá)圖像30A上,連續(xù)的、相連的空間坐標(biāo)的并列方向的調(diào)查,具備有識(shí)別在前述監(jiān)視對(duì)象區(qū)域中不變的道路或建筑物等固定構(gòu)造物的面的機(jī)能。用這個(gè)平面識(shí)別處理部381識(shí)別的結(jié)果,例如作為確定該面的輪廓線或多角形線(polygon)的輔助情報(bào),在激光雷達(dá)圖像30A或攝像圖像30B上重合表示出來。移動(dòng)物體檢出處理部382從上述的每一次激光雷達(dá)掃描時(shí)檢出坐標(biāo)的依次變化的物體情報(bào),來識(shí)別出該物體是人或車等移動(dòng)物,具備有例如、將包圍移動(dòng)物體的四角形的位置標(biāo)識(shí)(marker)等作為輔助情報(bào),在上述激光雷達(dá)圖像30A或攝像圖像30B上重疊表示的機(jī)能。關(guān)于這樣的輔助情報(bào),可以在操作人員的指示下有選擇地表示,也可以只表示應(yīng)當(dāng)注意的移動(dòng)物體。
根據(jù)具備了這樣的物體識(shí)別裝置380和前述的圖像匹配裝置360構(gòu)成的物體計(jì)測裝置,將經(jīng)圖像匹配處理后的監(jiān)視圖像在監(jiān)視器370上表示,并對(duì)既定的監(jiān)視對(duì)象區(qū)域的狀況進(jìn)行監(jiān)視的時(shí)候,例如與圖31(a)-(d)上所示的代表性的表示例一樣,可以提供與監(jiān)視對(duì)象區(qū)域的環(huán)境(狀況)相對(duì)應(yīng)的、確切地表示出掌握該狀況的必要的情報(bào)并進(jìn)行監(jiān)視。
即,監(jiān)視圖像是如前所述的、使攝像圖像30B的坐標(biāo)與激光雷達(dá)圖像30A的坐標(biāo)相對(duì)應(yīng)的圖像,例如,如圖31(a)所示,用鼠標(biāo)等坐標(biāo)輸入裝置,使指示標(biāo)(pointer)30P移動(dòng),僅僅指定監(jiān)視圖像上的觀察點(diǎn),可以表示該指定部位的空間位置坐標(biāo)、具體來說就是從(到)監(jiān)視點(diǎn)的距離。而且移動(dòng)物體檢出的時(shí)候,例如,如圖31(b)所示,通過在監(jiān)視圖像上重疊表示所示包為已經(jīng)認(rèn)識(shí)出的移動(dòng)物體的位置標(biāo)識(shí)(輔助情報(bào))30M,能夠明確地識(shí)別表示出應(yīng)當(dāng)注意的移動(dòng)物體。
想要識(shí)別某個(gè)物體的大小或形狀的情況時(shí),如例圖31(c)所示,如果指定了表示關(guān)注物體的角部的復(fù)數(shù)的點(diǎn),通過前述的平面識(shí)別處理,能夠分別掌握該物體的主要面的大小和形狀,從這個(gè)認(rèn)識(shí)結(jié)果出發(fā),就能很容易推定出物體的立體的大小、很容易地求出其存在位置。
將分別確定根據(jù)前面所述的平面識(shí)別處理得到的物體的平面的多角形線圖(polygon)(輔助情報(bào)),如圖31(d)所示,在監(jiān)視圖像上重疊顯示出來的話,假定即使存在受時(shí)間帶或天氣條件的影響,不能鮮明地得到攝像圖像30B的時(shí)候,也可以從上述多角形線圖)(輔助情報(bào))來掌握監(jiān)視對(duì)象區(qū)域的大概情況。其結(jié)果就是能夠?qū)崿F(xiàn)不受監(jiān)視時(shí)間帶或天氣條件的等的影響,容易地、而且準(zhǔn)確地掌握監(jiān)視區(qū)域的狀況。
本發(fā)明不是被上述實(shí)施形態(tài)所限定的發(fā)明。在這只展示了一個(gè)關(guān)于掌握在屋外既定的監(jiān)視對(duì)象區(qū)域狀況的例子,然而,使用如例圖31(a)所示的監(jiān)視圖像,可以實(shí)現(xiàn)具備各部測距機(jī)能的照相機(jī),適用于船舶的監(jiān)視照相機(jī)或機(jī)器人的電子眼以及距離計(jì)測等。而且使用圖31(b)所示的監(jiān)視圖像,可以構(gòu)筑在屋外等的大范圍的監(jiān)視系統(tǒng),以移動(dòng)物體的檢知作為的觸發(fā)裝置發(fā)出警報(bào),采取記錄當(dāng)時(shí)監(jiān)視圖像等的對(duì)策。而且可以用在十字路口處交通量的掌握系統(tǒng)或過馬路行人的掌握系統(tǒng),以及移動(dòng)物體的追尾系統(tǒng)上等。
而且,通過使用如圖31所示的圖像,能夠應(yīng)用于決定集裝箱吊車(container crane)的位置或帶式運(yùn)輸機(jī)上移動(dòng)的各種貨物大小判斷處理等情況。而且,使用圖31(d)所示的圖像,能夠?qū)崿F(xiàn)進(jìn)行各種物體的凹凸判斷或地形測量。其他,本發(fā)明能夠在不離開主題的范圍內(nèi)實(shí)施種種變化,能夠應(yīng)用于各種物體識(shí)別領(lǐng)域。
通過以上說明,本發(fā)明使從激光雷達(dá)求出雷達(dá)圖像的坐標(biāo)與通過設(shè)置在前述激光雷達(dá)的旁邊的監(jiān)視照相機(jī)拍攝的攝像圖像的坐標(biāo)相對(duì)應(yīng),對(duì)既定的監(jiān)視區(qū)域進(jìn)行監(jiān)視處理,不受天氣條件或監(jiān)視時(shí)間帶的影響,能夠經(jīng)常地、安定地、容易地監(jiān)視上述監(jiān)視對(duì)象區(qū)域的狀況。而且得到觀察點(diǎn)的距離情報(bào),可以確實(shí)地監(jiān)視那時(shí)的狀況。
而且,在監(jiān)視圖像上重疊表示作為輔助情報(bào)的、從激光雷達(dá)圖像來識(shí)別出的與物體的面有關(guān)的情報(bào)和移動(dòng)物體的情報(bào),所以可以更加準(zhǔn)確地掌握那時(shí)狀況,在實(shí)際應(yīng)用上能夠起到很大的效果。
而且,本發(fā)明的物體計(jì)測裝置(監(jiān)視裝置),適用于監(jiān)視,不論斷路閘是否已降下,在鐵道領(lǐng)域內(nèi)存在的移動(dòng)物體或落下物體等。
以前,在監(jiān)視既定的監(jiān)視區(qū)域內(nèi)的移動(dòng)物體時(shí),一般采用監(jiān)視照相機(jī)。但是,用監(jiān)視照相機(jī)得到的圖像,一般容易受天氣(氣象)的影響,而且在夜間監(jiān)視困難。最近提倡用激光雷達(dá)監(jiān)視在既定監(jiān)視區(qū)域的入侵物等(例如在特開平11-227608號(hào)公報(bào)上所展示的專利文獻(xiàn)2、在特開平11-352245號(hào)公報(bào)上所展示的專利文獻(xiàn)3)。如果探用這種激光雷達(dá)的監(jiān)視系統(tǒng),可以進(jìn)行不受天氣(氣象)等影響的物體檢出。
但是,采用激光雷達(dá)監(jiān)視在十字路口的人或車輛的時(shí)候,最好采用與信號(hào)機(jī)的指示狀態(tài)相對(duì)應(yīng),判斷出人或車輛的移動(dòng)方向的方法。而且同樣地,用激光雷達(dá)監(jiān)視在鐵道內(nèi)的異常情況時(shí),最好能夠與斷路閘是否已降下相對(duì)應(yīng),判斷出在鐵道內(nèi)是否存在人或車輛或掉落物體。
但是,實(shí)行與信號(hào)機(jī)的指示狀態(tài)或斷路閘的動(dòng)作狀態(tài)相對(duì)應(yīng)的監(jiān)視時(shí),需要例如檢出信號(hào)機(jī)或斷路閘的動(dòng)作信號(hào)或動(dòng)作控制信號(hào),控制通過激光雷達(dá)的監(jiān)視處理動(dòng)作(例如物體識(shí)別處理)。具體的來說,必須將使信號(hào)機(jī)或斷路閘動(dòng)作的動(dòng)作控制信號(hào)經(jīng)既定的信號(hào)線輸入到物體計(jì)測裝置上,使信號(hào)機(jī)與斷路閘的動(dòng)作聯(lián)動(dòng),實(shí)施用激光雷達(dá)的監(jiān)視處理。因此,這個(gè)系統(tǒng)的構(gòu)成是規(guī)模很大的。
本發(fā)明考慮了這樣的情況,本發(fā)明的目的是提供一種簡易的物體計(jì)測裝置,該物體計(jì)測裝置發(fā)明有效地靈活使用激光雷達(dá)具有的機(jī)能,例如不輸入斷路閘的動(dòng)作控制信號(hào),在斷路閘降下的狀態(tài)下,確實(shí)地檢出鐵道內(nèi)的人或車輛、甚至掉落物品。
以下,參照附圖,就本發(fā)明的一個(gè)實(shí)施形態(tài)的物體測計(jì)裝置,說明監(jiān)視向鐵道內(nèi)的異常侵入的例子。
圖32展示了該實(shí)施形態(tài)的物體計(jì)測裝置的大略構(gòu)成,410是掃描既定的監(jiān)視對(duì)象區(qū)域的激光雷達(dá)。該激光雷達(dá)410被收入在既定的筐體內(nèi)成為一體,構(gòu)成感應(yīng)單元,設(shè)置在建筑物的墻壁或電線桿等的既定高度的監(jiān)視點(diǎn)上,設(shè)計(jì)為能夠俯視監(jiān)視對(duì)象區(qū)域的鐵道道口。且,用當(dāng)一臺(tái)激光雷達(dá)410不能俯視上述鐵道道口領(lǐng)域(監(jiān)視對(duì)象區(qū)域)的全部時(shí),在不同的設(shè)置位置設(shè)置多臺(tái)激光雷達(dá)410上。
激光雷達(dá)410具備主掃描馬達(dá)412和副掃描馬達(dá)413,該主掃描馬達(dá)412驅(qū)動(dòng),例如,多面體鏡子以一定速度回轉(zhuǎn),該副掃描馬達(dá)413設(shè)計(jì)成與該主掃描馬達(dá)412的回轉(zhuǎn)軸成正角,通過使上述多面鏡子411的回轉(zhuǎn)軸在既定的角度范圍內(nèi)傾動(dòng)來使該多面鏡411的回轉(zhuǎn)面在既定的速度下?lián)u動(dòng)。接下來,用從激光光源414發(fā)射的脈沖激光,經(jīng)半鏡415照射在上述多面體鏡411上,用上述脈沖激光與該多面體411的回轉(zhuǎn)和傾斜相應(yīng)照射既定的監(jiān)視區(qū)域,從脈沖激光的監(jiān)視區(qū)域來的反射光,從上述多面體鏡子411經(jīng)集光鏡頭416,由受光器417受光和檢知。
即、該激光雷達(dá)410,通過多面體鏡子411的回轉(zhuǎn)和搖動(dòng),一邊使脈沖激光在主掃描方向(x方向)上進(jìn)行高速偏向掃描,一邊使掃描面向副掃描方向(y方向)進(jìn)行偏向掃描,以此來進(jìn)行如圖33所示的對(duì)既定的掃描監(jiān)視對(duì)象區(qū)域的全域的掃描。接了來,與上述脈沖激光的照射同步,接受在監(jiān)視對(duì)象區(qū)域內(nèi)存在的各種各樣的物體反射的反射光,求出從該受光時(shí)刻(從脈沖激光的照射時(shí)刻到接受反射光的時(shí)間經(jīng)過。)到物體(反射點(diǎn))的距離情報(bào)。激光雷達(dá)410的掃描范圍設(shè)置成,例如,主掃描方向(水平)60度,副掃描方向(垂直)30度。且,激光雷達(dá)410的構(gòu)成使,例如,掃描方向每變化0.1度時(shí),用脈沖激光照射,接受反射光,這樣就能夠依次檢出從合計(jì)(600×300)方位來的反射光的情報(bào)。
另一方面,例如由個(gè)人電腦構(gòu)成的監(jiān)視裝置(物體計(jì)測裝置)本體420具備有從使用上述的激光雷達(dá)410檢出的反射情報(bào)求出表示該反射點(diǎn)的空間坐標(biāo)的三維雷達(dá)情報(bào)的雷達(dá)情報(bào)做成裝置421。具體的來說,這個(gè)雷達(dá)情報(bào)做成裝置421有反射光檢出部412b、距離情報(bào)變換部421c和濃淡變換部421d,該有反射光檢出部412b,如圖34所示,接受從驅(qū)動(dòng)上述雷達(dá)光源414的脈沖激光掃描回路421a來的同步信號(hào),測量上述脈沖激光的、從物體的反射光的受光時(shí)刻,該距離情報(bào)變換部421c將該計(jì)測時(shí)間變換成距離情報(bào),該濃淡變換部421d將距離情報(bào)變換成濃淡情報(bào)。
當(dāng)然,前述計(jì)測時(shí)間可以直接變換成為濃淡情報(bào)。而且,在這個(gè)實(shí)施形態(tài)中,展示了將距離情報(bào)轉(zhuǎn)換成、例如距離遠(yuǎn)時(shí)濃度變濃的濃淡情報(bào)的例子,也可以采取與距離相應(yīng)的顏色實(shí)施階段地變化的色調(diào)變換。且,不需要3維雷達(dá)情報(bào)轉(zhuǎn)化為激光雷達(dá)圖像的可視化操作時(shí),不進(jìn)行上述的濃淡變換,將由前述反射光檢出部421b求出的計(jì)測時(shí)間作為脈沖激光的反射點(diǎn)的情報(bào)利用。
接下來,作為3維雷達(dá)情報(bào)的激光雷達(dá)圖像按照下述方法被作成使用按照上面所述的那樣求出的濃淡情報(bào)(距離情報(bào)),按照從前述的激光雷達(dá)掃描回路421a求出的主掃描角度及副掃描角度的情報(bào),在既定的圖像存儲(chǔ)器421e上順次地生成圖像。即,在由表示激光脈沖的掃描方向的主掃描角度及副掃描角度確定的坐標(biāo)(圖像存儲(chǔ)器421e的地址)上寫入那時(shí)求出的濃淡坐標(biāo)(距離情報(bào)),在圖像存儲(chǔ)器421e上做成在監(jiān)視對(duì)象區(qū)域內(nèi)3維地確定激光脈沖的反射點(diǎn)的激光雷達(dá)圖像。
上述監(jiān)視裝置主體420有、監(jiān)視條件判斷裝置423和區(qū)域判定裝置424,該物體檢出裝置422在上述雷達(dá)情報(bào)做成裝置421上加上從3維雷達(dá)情報(bào)(激光雷達(dá)圖像)檢出在前述的監(jiān)視對(duì)象區(qū)域內(nèi)存在的物體,該監(jiān)視條件判斷裝置423從前述3維雷達(dá)情報(bào)判斷在預(yù)先設(shè)定的觀察點(diǎn)上(空間坐標(biāo))有無特定物體,控制對(duì)前述監(jiān)視對(duì)象區(qū)域的物體監(jiān)視處理的實(shí)行,該區(qū)域判定裝置424限制由前述物體檢出裝置422的物體檢出的對(duì)象區(qū)域。監(jiān)視裝置主體420還可以在這些基本處理機(jī)能上加上后述的平面坐標(biāo)變換裝置425、動(dòng)作檢出裝置426、以及輔助情報(bào)表示裝置427。
對(duì)這些各種機(jī)能進(jìn)行說明。前述的物體檢出裝置422具備以下的機(jī)能基本上是將從前述的3維雷達(dá)情報(bào)來的、空間坐標(biāo)是連續(xù)的既定數(shù)以上的反射點(diǎn)的集合作為某個(gè)有大小的物體來識(shí)別,其重心作為物體的位置來檢出。接下來,前述的動(dòng)態(tài)檢出裝置426是從這樣檢出的物體的重心位置的時(shí)間變化來判定物體是固定物,還是移動(dòng)物體。特別是識(shí)別出物體是移動(dòng)物體時(shí),將上述重心位置的變化方識(shí)別為移動(dòng)方向,且,將重心位置的變化量識(shí)別為移動(dòng)速度。
領(lǐng)域判定裝置424擔(dān)負(fù)的作用是判斷如上所述的檢出的物體的存在位置是否存在于預(yù)先設(shè)定的監(jiān)視對(duì)象領(lǐng)域內(nèi)。具體的來說,激光雷達(dá)410的掃描范圍,如前面所述,向著用脈沖激光照射、檢出該反射光的水平掃描及垂直掃描所確定的區(qū)域,設(shè)定為包含有上述監(jiān)視區(qū)域的全部。所以,前述的檢出的物體中,也包括在上述監(jiān)視對(duì)象區(qū)域以外的位置上存在的物體。這里,在領(lǐng)域判斷裝置424中,在通過激光雷達(dá)410掃描的空間領(lǐng)域內(nèi),僅判定應(yīng)該進(jìn)行物體檢出的領(lǐng)域。通過這樣領(lǐng)域判定處理,例如,從物體檢出對(duì)象中,除去成為物體檢出的基準(zhǔn)面的地表面自身,或從除去與火車道道口距離1m以上的位置上的物體檢出等。僅僅限于以上述鐵道領(lǐng)域或在其近旁存在的人或車輛、落下物等作為物體認(rèn)識(shí)對(duì)象。
前述的監(jiān)視條件判斷裝置423有物體計(jì)測裝置具備的特征的處理機(jī)能,它判斷在預(yù)定的觀察點(diǎn)(空間坐標(biāo)位置)上是否存在預(yù)先指定的特定物,承擔(dān)控制根據(jù)前述物體檢出的監(jiān)視處理的實(shí)行的作用。具體的來說,該監(jiān)視條件判斷裝置判斷例如作為特定物體的斷路閘是否處在待機(jī)位置上,僅在斷路閘不處于待機(jī)位置上時(shí),根據(jù)前面所述物體檢出,實(shí)行在鐵道內(nèi)異常物是否存在的監(jiān)視處理。
即,在這個(gè)實(shí)施形態(tài)中,監(jiān)視向鐵道道口內(nèi)的人或車輛的異常侵入或掉下物體的有無為目的,實(shí)質(zhì)上,僅在斷路閘機(jī)降下阻止向鐵道道口內(nèi)的入侵時(shí),進(jìn)行這樣的監(jiān)視處理是充分的。所以基本上,只要在鐵道道口的進(jìn)出路上檢出遮斷機(jī)降下的狀態(tài),控制監(jiān)視處理的實(shí)行就可以了。但是斷路閘的降下位置是鐵道道口領(lǐng)域的一部分,在斷路閘沒有降下的狀態(tài)下,人或車輛橫過上述位置。
所以,該裝置通過判斷斷路閘是否在那個(gè)待機(jī)位置,換句話說,判定斷路閘是否在揚(yáng)上位置,就可以不到通過鐵道道口的人或車輛的影響,檢出該斷路閘的動(dòng)作狀態(tài)。接下來,斷路閘不在待機(jī)位置上時(shí),判斷出斷路閘正在下降,或已經(jīng)是放下的狀態(tài),由此,在由斷路閘切斷鐵道道口的狀態(tài)之前的時(shí)刻,迅速指示監(jiān)視處理的實(shí)行。且,這個(gè)監(jiān)視處理實(shí)行的實(shí)行控制可以是控制前述的物體檢出處理自身的實(shí)行,也可以是控制是否將物體檢出求出的物體情報(bào)作為監(jiān)視結(jié)果輸出。
這樣的監(jiān)視控制下求出的鐵道道口內(nèi)的異常物的檢出結(jié)果,例如用平面坐標(biāo)變換裝置425,對(duì)前述的3維雷達(dá)情報(bào)進(jìn)行平面坐標(biāo)變換,將顯示從天上向下看鐵道道口內(nèi)的狀況的平面監(jiān)視圖像在顯示器430上顯示。即,在用多個(gè)激光雷達(dá)410,將監(jiān)視區(qū)域分為多個(gè)區(qū)域,分別監(jiān)視時(shí),該多個(gè)激光雷達(dá)410對(duì)上述監(jiān)視區(qū)域的視點(diǎn)和視野方向不同。在將這些各激光雷達(dá)圖像分別表示時(shí),必須考慮在各激光雷達(dá)圖像中的視點(diǎn)位置,判斷表示圖像內(nèi)容。
在前述平面坐標(biāo)變換裝置425,將各激光雷達(dá)圖象進(jìn)行平面坐標(biāo)變換,以地表面作為基準(zhǔn),合成各激光雷達(dá)圖像的坐標(biāo),制作監(jiān)視對(duì)象區(qū)域的平面視化了的一張監(jiān)視圖像,將其在顯示器430上顯示。其時(shí),輔助情報(bào)表示裝置427將前述包圍識(shí)別的物體框狀識(shí)別記號(hào)(輔助情報(bào))在上述平面監(jiān)視圖像上重疊表示,這樣做可以對(duì)物體強(qiáng)化表示,提高識(shí)別性。
這樣求得的監(jiān)視圖像適宜記錄在例如圖像記錄裝置431。特別是當(dāng)由前述物體檢出檢出人或車輛等異常侵入鐵道道口時(shí),與上述激光雷達(dá)圖像一起記錄在圖像記錄裝置431,可以利用為確定侵入切斷的鐵道道口人或車輛。
圖35表示使用上述物體計(jì)測裝置監(jiān)視的鐵道道口的樣子,440為鐵道線路,441為通過鐵道線路的鐵道道口,442為鐵道道口441的進(jìn)出口兩側(cè)分別設(shè)置的斷路閘。443為通過鐵道道口441的行人,444為自行車,445為機(jī)動(dòng)車輛。該例子中,鐵道道口441沿對(duì)角線分為2個(gè)區(qū)域,用2臺(tái)激光雷達(dá)410a和410b分別斜視方向的視野對(duì)該2個(gè)區(qū)域進(jìn)行監(jiān)視,由此而對(duì)鐵道道口441的全區(qū)域進(jìn)行監(jiān)視。40A為激光雷達(dá)410a的掃描領(lǐng)域,40B為激光雷達(dá)410b的掃描領(lǐng)域。
圖36表示該物體計(jì)測裝置的初期設(shè)定處理的簡要處理程序,圖37表示監(jiān)視處理的實(shí)行控制程序。對(duì)這些處理程序進(jìn)行簡單的說明。初期設(shè)定處理在設(shè)置激光雷達(dá)410時(shí),根據(jù)用該激光雷達(dá)410得到的情報(bào),首先做成監(jiān)視對(duì)象的激光雷達(dá)圖像(步驟401)。該激光雷達(dá)圖像由通過距離情報(bào)濃淡化處理得到的疑似3維的可視化圖形構(gòu)成。該激光雷達(dá)圖像顯示在顯示器430上(步驟402),在顯示圖像上(激光雷達(dá)圖象)指頂定斷路閘的待機(jī)位置(步驟403)。從上述激光雷達(dá)求出上述指定的位置的空間坐標(biāo),將該空間坐標(biāo)作為監(jiān)視斷路閘的動(dòng)作狀態(tài)的特定位置而登記下來。
照以上做法完成初期設(shè)定處理后,以后按圖37所示的處理順序?qū)﹁F道道口的監(jiān)視處理的實(shí)行。該監(jiān)視處理是首先取得激光雷達(dá)圖像(步驟411),檢出在該激光雷達(dá)圖像的特定位置(觀察點(diǎn))是否存在物體(斷路閘)(步驟412)。而后,在上述特定位置物體(斷路閘)存在時(shí),判斷為斷路閘沒有降下(處于待機(jī)位置),在上述特定位置物體(斷路閘)不存在時(shí),判斷為斷路閘已經(jīng)降下(步驟413)。因?yàn)樵跀嗦烽l沒有降下時(shí)是處于許可通過鐵道道口的狀態(tài),所以不實(shí)行監(jiān)視處理,再次在下一個(gè)掃描時(shí)刻取得下一個(gè)激光雷達(dá)圖像(步驟411)。
另一方面,如果檢出斷路閘是處于降下的狀態(tài),就檢出鐵道道口區(qū)域內(nèi)的物體(步驟414)。該物體檢出邊指定上述的檢出對(duì)象區(qū)域邊進(jìn)行。如有物體被檢出,則判斷檢出物體的大小,根據(jù)需要判斷應(yīng)進(jìn)行的動(dòng)作(步驟415)。識(shí)別根據(jù)判斷處理檢出的是人,是車輛,還是落下物。與該識(shí)別結(jié)果相應(yīng)、應(yīng)將該物體明確表示時(shí),如前所述將激光雷達(dá)圖象(3維雷達(dá)情報(bào))進(jìn)行平面坐標(biāo)變換,在顯示器430顯示的監(jiān)視圖像上將識(shí)別記號(hào)(輔助情報(bào))重疊表示(步驟416)。根據(jù)需要,對(duì)上述檢出的物體(人或車輛)發(fā)出警告,將該時(shí)的監(jiān)視圖像等記錄在圖像記錄裝置331上(步驟417)。
使用上述構(gòu)成的物體計(jì)測裝置,利用激光雷達(dá)檢出的情報(bào)的一部分,容易地控制是否實(shí)行根據(jù)采用該激光雷達(dá)的物體檢出的所定的監(jiān)視區(qū)域的監(jiān)視處理。特別是在該實(shí)施形態(tài)中,通過檢出斷路閘是否處于待機(jī)位置,在斷路閘上揚(yáng)待機(jī)時(shí)能夠不受通過道口的物體的影響,確實(shí)檢出斷路閘的動(dòng)作狀態(tài)。所以,當(dāng)斷路閘降下、禁止通過道口的狀態(tài)時(shí),確實(shí)地檢出侵入該道口的,或殘留在該道口的人或車輛,迅速采取防止事故的對(duì)策,具有實(shí)用上的極大效果。而且,本裝置可以使控制斷路閘的交通監(jiān)視系統(tǒng)獨(dú)立地動(dòng)作,具有可使外部接口簡單、降低設(shè)備成本的優(yōu)點(diǎn)。
本發(fā)明不受上述實(shí)施形態(tài)的限制。這里雖只就鐵道道口的物體異常侵入一例進(jìn)行了說明,但是同樣可使用于例如塔式停車場,監(jiān)視在停車臺(tái)上是否有人的監(jiān)視系統(tǒng)。這時(shí),判斷設(shè)置在通往停車臺(tái)的進(jìn)出路的門是否打開,當(dāng)門關(guān)閉時(shí),可以實(shí)行延續(xù)一段時(shí)間的監(jiān)視處理。這種場合,為了防止由于置于停車臺(tái)的車輛產(chǎn)生的死角而使人的存在不能檢出的情況,可以用不同的激光雷達(dá)從車輛的斜前方和斜后方對(duì)車輛周圍進(jìn)行監(jiān)視。
激光雷達(dá)410的水平·垂直方向的掃描角度、對(duì)監(jiān)視區(qū)域的俯瞰角度等可根據(jù)監(jiān)視樣式來決定。關(guān)于對(duì)激光雷達(dá)信號(hào)的信號(hào)處理機(jī)能也可以進(jìn)行各種變化。在不脫離本發(fā)明的主旨的范圍內(nèi),可以進(jìn)行各種變化來實(shí)施本發(fā)明。
如以上所述,本發(fā)明有效地活用激光雷達(dá)所擁有的物體檢出機(jī)能,可以控制監(jiān)視處理的實(shí)行,而且可以實(shí)現(xiàn)動(dòng)作信賴度高的簡易的物體計(jì)測裝置。特別是,可以實(shí)行僅在鐵道道口被切斷時(shí)檢出侵入該鐵道道口的物體這種鐵道道口監(jiān)視處理,具有很大的使用效果。
日本專利申請(qǐng)第2002-287953(2002年9月30日申請(qǐng))、日本專利申請(qǐng)第2002-352226(2002年12月4日申請(qǐng))、日本專利申請(qǐng)第2002-380109(2002年12月27日申請(qǐng))以及日本專利申請(qǐng)第2002-380110(2002年12月27日申請(qǐng))的全部內(nèi)容,用參照的方式,寫入了本發(fā)明說明書。
最后,如上所述,本發(fā)明不受實(shí)施形態(tài)的限制,通過適當(dāng)?shù)淖兏罂梢杂衅渌膶?shí)施形態(tài)。
權(quán)利要求
1.使用在物體的外部設(shè)置的激光發(fā)生器發(fā)射的脈沖激光對(duì)物體的大小、位置、移動(dòng)速度中至少一個(gè)進(jìn)行計(jì)測的物體計(jì)測方法,其特征是該物體計(jì)測方法有下述步驟上述脈沖激光對(duì)上述物體進(jìn)行二維掃描,接受被上述物體反射的反射光,根據(jù)上述脈沖激光的發(fā)射方向和上述脈沖激光的發(fā)射時(shí)刻和該脈沖激光的反射光的受光時(shí)刻的時(shí)間差來檢出上述物體的反射位置的反射位置檢出步驟和;根據(jù)上述被檢出的多個(gè)反射位置來計(jì)算上述物體的大小、位置、移動(dòng)速度中至少一個(gè)的計(jì)算步驟。
2.對(duì)物體的大小、位置、移動(dòng)速度中至少一個(gè)進(jìn)行計(jì)測的物體計(jì)測裝置,其特征是該物體計(jì)測裝置具有能夠?qū)ι鲜鑫矬w發(fā)射脈沖激光的脈沖激光發(fā)射裝置;用上述脈沖激光對(duì)上述物體進(jìn)行二維掃描的掃描裝置;接受被上述物體反射的上述脈沖激光的脈沖激光接受裝置;根據(jù)上述脈沖激光的發(fā)射方向和上述脈沖激光的發(fā)射時(shí)刻和該脈沖激光的反射光的受光時(shí)刻的時(shí)間差來檢出上述物體的反射位置的反射位置檢出裝置;和根據(jù)上述被檢出的多個(gè)反射位置來計(jì)算出上述物體的大小、位置、移動(dòng)速度中至少一個(gè)的計(jì)算裝置。
3.對(duì)底面與XY平面大體平行地設(shè)置的長方體的大小或者設(shè)置位置、采用在上述長方體的外部設(shè)置的激光發(fā)生器發(fā)射的脈沖激光、來進(jìn)行計(jì)測的計(jì)測方法,其特征是該物體計(jì)測方法有下述步驟用上述脈沖激光對(duì)上述長方體進(jìn)行二維掃描,接受上述長方體反射的反射光,根據(jù)上述脈沖激光的發(fā)射方向和上述脈沖激光的發(fā)射時(shí)刻和這個(gè)脈沖激光的反射光的受光時(shí)刻的時(shí)間差來檢出上述長方體的反射位置的反射位置檢出步驟和;根據(jù)上述被檢出的多個(gè)反射位置來計(jì)算上述長方體的大小、設(shè)置位置的計(jì)算步驟。
4.權(quán)利要求3所記載的計(jì)測方法,其特征是該方法的計(jì)算步驟是根據(jù)上述測量出的多個(gè)反射位置算出上述長方體的棱線的坐標(biāo)值,并用算出的棱線的坐標(biāo)值計(jì)算上述長方體的頂面的各個(gè)頂點(diǎn),并計(jì)算出上述長方體的大小或者設(shè)置位置。
5.權(quán)利要求4所記載的計(jì)測方法,其特征是該方法的掃描是對(duì)一定方向進(jìn)行一維掃描后,通過變換掃描位置在與上述的一定方向大致平行的方向上進(jìn)行多次同上述的一維掃描相同的掃描來對(duì)上述長方體進(jìn)行二維掃描;上述計(jì)算步驟是對(duì)每個(gè)上述一維掃描從上述各個(gè)反射位置的X坐標(biāo)值和Y坐標(biāo)值求出XY平面上的適當(dāng)數(shù)目的直線方程式,且根據(jù)這個(gè)適當(dāng)數(shù)目的直線式的條數(shù)或者傾斜度來判斷從上述激光發(fā)生器對(duì)上述長方體的哪個(gè)面上照射了脈沖激光;當(dāng)上述長方體的頂面照射了脈沖激光時(shí),根據(jù)上述各個(gè)掃描的上述頂面的反射位置的X坐標(biāo)值的最大值和與這個(gè)最大值對(duì)應(yīng)的Y坐標(biāo)值、和在上述各個(gè)掃描的上述頂面的反射位置的X坐標(biāo)值的最小值和與這個(gè)最小值對(duì)應(yīng)的Y坐標(biāo)值來求得包含上述長方體的頂面的4條棱線的4種直線,并求得上述各條直線的交點(diǎn)的X坐標(biāo)值和Y坐標(biāo)值,而且使用上述頂面的反射位置的Z坐標(biāo)值,來計(jì)算上述長方體的上述頂面的各個(gè)頂點(diǎn);在上述長方體的2個(gè)側(cè)面被上述脈沖激光照射的情況下,對(duì)上述各個(gè)掃描,從上述各個(gè)反射位置的X坐標(biāo)值和Y坐標(biāo)值來計(jì)算XY平面上的2個(gè)直線方程式,從這2個(gè)直線方程式的交點(diǎn)中,計(jì)算與Z軸大致平行的、上述長方體的第1棱線的X坐標(biāo)值和Y坐標(biāo)值,且根據(jù)上述各個(gè)掃描的上述側(cè)面的反射位置的X坐標(biāo)值的最大值和與這個(gè)最大值對(duì)應(yīng)的Y坐標(biāo)值來計(jì)算與Z軸大致平行的、上述長方體的第2棱線的X坐標(biāo)值和Y坐標(biāo)值,并根據(jù)上述各個(gè)掃描的上述側(cè)面的反射位置的X坐標(biāo)值的最小值和與這個(gè)最小值對(duì)應(yīng)的Y坐標(biāo)值來計(jì)算與Z軸大致平行的、上述長方體的第3棱線的X坐標(biāo)值和Y坐標(biāo)值,根據(jù)上述第1-3各條棱線的各X坐標(biāo)值和各Y坐標(biāo)值來計(jì)算與Z軸大致平行的、第4棱線的X坐標(biāo)值和Y坐標(biāo)值,從上述各反射位置的Z坐標(biāo)值的最大值,計(jì)算上述長方體的頂面的高度位置,根據(jù)上述第1-4棱線的各X坐標(biāo)值和各Y坐標(biāo)值和上述頂面的高度位置來計(jì)算上述長方體的上述頂面的各個(gè)頂點(diǎn);當(dāng)上述長方體的僅僅一個(gè)側(cè)面被上述脈沖激光照射時(shí),判斷為不可能算出長方體的大小或設(shè)置位置。
6.對(duì)于底面與XY平面大體平行地設(shè)置的長方體的大小或者設(shè)置位置進(jìn)行計(jì)測的計(jì)測裝置,其特征是該裝置有可對(duì)上述長方體發(fā)射脈沖激光的脈沖激光發(fā)射裝置;用上述脈沖激光對(duì)上述長方體進(jìn)行二維掃描的掃描裝置;接受從上述長方體反射的上述脈沖激光的脈沖激光受光裝置;根據(jù)上述脈沖激光的發(fā)射方向和、上述脈沖激光的發(fā)射時(shí)刻和這個(gè)脈沖激光的反射光的受光時(shí)刻的時(shí)間差、來檢出上述長方體的反射位置的反射位置檢出裝置;根據(jù)上述被檢出的多個(gè)反射位置來算出并輸出上述長方體的大小或者設(shè)置位置的算出裝置。
7.一種采用區(qū)域感應(yīng)器的物體識(shí)別方法,其特征是該方法通過區(qū)域感應(yīng)器向覆蓋引導(dǎo)行人的步行區(qū)域和該步行區(qū)域的周圍區(qū)域的檢出范圍內(nèi)一邊發(fā)射脈沖激光一邊掃描,計(jì)測光的反射時(shí)間,通過求出各掃描點(diǎn)的沒有物體存在時(shí)的反射時(shí)間和有物體存在時(shí)的反射時(shí)間的差,來演算物體的形狀、大小、和各掃描的物體的位置變化的向量,從該演算信號(hào)來識(shí)別沿引導(dǎo)方向在步行區(qū)域移動(dòng)的物體和沿橫斷步行區(qū)域方向移動(dòng)的物體。
8.權(quán)利要求7所記載的采用區(qū)域感應(yīng)器的物體識(shí)別方法,其特征是通過向量是朝向步行區(qū)域的引導(dǎo)方向、物體的形狀、大小來識(shí)別沿引導(dǎo)方向在步行區(qū)域移動(dòng)的物體。
9.權(quán)利要求7或8的任何一項(xiàng)所記載的采用區(qū)域感應(yīng)器的物體識(shí)別方法,其特征是識(shí)別沿引導(dǎo)方向在步行區(qū)域移動(dòng)的物體至少是成年的健康人、小孩、坐輪椅的人、移動(dòng)不自如的人。
10.權(quán)利要求7所記載的采用區(qū)域感應(yīng)器的物體識(shí)別方法,其特征是至少通過突然出現(xiàn)在檢出范圍的周圍區(qū)域和向量是朝向橫斷步行區(qū)域來識(shí)別沿橫斷步行區(qū)域的方向移動(dòng)的物體。
11.權(quán)利要求7或10的任何一項(xiàng)所記載的采用區(qū)域感應(yīng)器的物體識(shí)別方法,其特征是識(shí)別沿橫斷步行區(qū)域移動(dòng)的物體是汽車。
12.一種物體計(jì)測裝置,其特征是具備對(duì)所定監(jiān)視區(qū)域進(jìn)行掃描的激光雷達(dá);將通過這個(gè)激光雷達(dá)檢出的距離情報(bào)制作可視化的雷達(dá)圖像的雷達(dá)圖像像制作裝置;在前述激光雷達(dá)附近設(shè)置的、對(duì)激光雷達(dá)的監(jiān)視區(qū)域攝像的監(jiān)視照相機(jī);使由前述監(jiān)視照相機(jī)拍攝的攝像圖像的坐標(biāo)和前述雷達(dá)圖像的坐標(biāo)對(duì)應(yīng)起來的圖像匹配裝置。
13.權(quán)利要求12所記載的物體計(jì)測裝置,其特征是上述雷達(dá)圖像制作裝置是將檢出的距離信息經(jīng)濃淡變換或色調(diào)變換后,將3維情報(bào)做成可視化的雷達(dá)圖像。
14.權(quán)利要求12所記載的物體計(jì)測裝置,其特征是前述圖像匹配裝置根據(jù)在前述照相圖像和雷達(dá)圖像之間相互對(duì)應(yīng)起來的多數(shù)特征點(diǎn)的位置坐標(biāo),使前述照相像圖像的坐標(biāo)系與前述雷達(dá)圖像的坐標(biāo)系相重合。
15.權(quán)利要求12所記載的物體計(jì)測裝置,其特征是還具有從前述激光雷達(dá)圖像來識(shí)別物體的面和/或移動(dòng)物體的物體識(shí)別裝置,和將確定識(shí)別后的物體的面和/或移動(dòng)物體的輔助信息重疊在上述照像圖像上表示的輔助情報(bào)表示裝置。
16.一種物體計(jì)測裝置,其特征是具備對(duì)所定的監(jiān)視區(qū)域進(jìn)行掃描的激光雷達(dá);從通過該激光雷達(dá)檢出的距離情報(bào)和該掃描方向的情報(bào)中求出3維雷達(dá)情報(bào)的雷達(dá)情報(bào)制作裝置;從前述3維雷達(dá)情報(bào)中檢出在前述所定的監(jiān)視區(qū)域內(nèi)存在的物體的物體檢出裝置;從前述3維雷達(dá)情報(bào)判斷在預(yù)先設(shè)定的觀察點(diǎn)(空間坐標(biāo))有無特定物,控制監(jiān)視處理的實(shí)行的監(jiān)視條件判斷裝置;接受該監(jiān)視條件判定裝置的控制,并控制通過前述物體檢出裝置的物體檢出動(dòng)作,或者控制通過前述物體檢出裝置的檢出結(jié)果的輸出的監(jiān)視控制裝置。
17.權(quán)利要求16所記載的物體計(jì)測裝置,其特征是前述所定的監(jiān)視區(qū)域是鐵道道口區(qū)域,前述特定物由切斷上述鐵道道口區(qū)域的斷路閘構(gòu)成,前述監(jiān)視條件判斷裝置判斷前述斷路閘是否處于待機(jī)位置。
18.權(quán)利要求16或17的任何一項(xiàng)所記載的物體計(jì)測裝置,其特征是還具備有將上述3維雷達(dá)情報(bào)進(jìn)行平面坐標(biāo)變換并制作監(jiān)視圖像的坐標(biāo)變換裝置和;在用該坐標(biāo)變換裝置制作的監(jiān)視圖像上將確定用前述物體檢出裝置求得的物體的輔助情報(bào)重疊表示的圖像表示裝置。
全文摘要
對(duì)物體的大小、位置、移動(dòng)速度中至少一個(gè)進(jìn)行計(jì)測的物體計(jì)測方法,該方法是用脈沖激光發(fā)射裝置對(duì)物體發(fā)射脈沖激光,該脈沖激光對(duì)物體進(jìn)行二維掃描,接受被物體反射的反射光,根據(jù)脈沖激光的發(fā)射方向和脈沖激光的發(fā)射時(shí)刻和該脈沖激光的反射光的受光時(shí)刻的時(shí)間差來檢出物體的反射位置的反射位置,根據(jù)被檢出的多個(gè)反射位置來計(jì)算物體的大小、位置、移動(dòng)速度中的至少一個(gè)。
文檔編號(hào)G01S17/46GK1628237SQ0380327
公開日2005年6月15日 申請(qǐng)日期2003年9月29日 優(yōu)先權(quán)日2002年9月30日
發(fā)明者永田宏一郎, 久光豐, 關(guān)本清英, 小林健, 竹內(nèi)暢人, 出川定男, 上原實(shí) 申請(qǐng)人:石川島播磨重工業(yè)株式會(huì)社
網(wǎng)友詢問留言 已有0條留言
  • 還沒有人留言評(píng)論。精彩留言會(huì)獲得點(diǎn)贊!
1