TW201704915A

TW201704915A - 自動行駛車輛

Info

Publication number: TW201704915A
Application number: TW105111697A
Authority: TW
Inventors: Takahiro Ishii; Takashi Akasaka
Original assignee: Yamaha Motor Co Ltd
Priority date: 2015-07-29
Filing date: 2016-04-14
Publication date: 2017-02-01
Also published as: CN106406302A; KR101839813B1; TW201704916A; TWI704437B; TW201809939A; KR102079524B1; CN106406303A; KR102146311B1; CN106406303B; TWI624743B; KR20170015106A; KR20170141640A; KR20170015107A; TWI668543B

Abstract

本發明提供一種可高精度地辨識當前位置及其前方之行駛路徑之沿預先所規定之行駛路徑自動行駛之自動行駛車輛。該自動行駛車輛係構成為可沿既定行駛路徑自主行駛，且包括：記憶部，其記憶事前已沿既定行駛路徑行駛之自動行駛車輛之行駛軌跡相關之軌跡相關資訊、及既定行駛路徑上之複數個計測點之自既定行駛路徑之起點算起之行駛距離相關之距離相關資訊；行駛距離計測部，其計測自起點至當前地點為止之行駛距離相關之資訊；及行駛區域推定部，其將計測出之行駛距離相關之資訊與距離相關資訊進行對照而掌握當前地點之位置，並且基於軌跡相關資訊藉由運算而推定自當前地點往前之行駛區域。

Description

自動行駛車輛

本發明係關於一種構成為可沿預先所規定之行駛路徑自動行駛之自動行駛車輛。

先前，開發有藉由感測器檢測埋設於行駛路徑之電磁感應線並沿著該感應線自動行駛之自動行駛車輛。此種自動行駛車輛用作例如於高爾夫球場搭載球具袋等物品或玩家而行駛之高爾夫球車(例如，參照下述專利文獻1)。再者，高爾夫球車亦稱為「高爾夫球手拉車」。

又，作為使用電磁感應線之車輛，提出有於果樹園等中使用之無人操作車輛。例如，於下述專利文獻2中揭示有一種於沿著果樹園之樹木之行之間之行駛路徑埋設於地下之感應線上自動行駛的無人操作車輛。該車輛係於其前面具備障礙物感測器。而且，該車輛搭載有如下功能，即，利用該感測器偵測障礙物，且於與該偵測到之障礙物之距離為固定以下之情形時停止。

[先前技術文獻] [專利文獻]

[專利文獻1]日本專利特開2000-181540號公報

[專利文獻2]專利第2944814號公報

且說，於高爾夫球車預定行駛之區域有可能存在玩家或高爾夫球桿等對高爾夫球車而言之障礙物。因此，考慮於專利文獻1揭示之於高爾夫球場行駛之高爾夫球車搭載專利文獻2揭示之於果樹園等中使用之無人操作車輛之障礙物感測器。

然而，高爾夫球車係於配合高爾夫球場之地形所設定之行駛路徑自動行駛。因此，高爾夫球車亦可能會於長有樹木之場所一面以較小之旋轉半徑迴旋一面行駛。例如，有如下情形，即，高爾夫球車於沿著行駛路徑之以較小之旋轉半徑迴旋之部分之近前之直線部分行駛之過程中，向前方之樹木接近。於如上所述之情形時，若使用上述專利文獻2之技術進行障礙物之檢測，則存在於車輛之前方且與車輛接近之位置的樹木被檢測為障礙物。其結果，有儘管為行駛中不存在障礙之狀況下但車輛停止之虞。

因此，不易於專利文獻1揭示之於高爾夫球場行駛之高爾夫球車搭載專利文獻2揭示之於果樹園等中使用之無人操作車輛之障礙物感測器。

因此，本案發明者對為了搭載障礙物感測器所必需之條件進行了銳意研究。如上所述，如高爾夫球車般之車輛於沿預先所規定之行駛路徑行駛時以較小之旋轉半徑迴旋。因此，車輛若搭載有對預定之行駛路徑上是否存在障礙物進行判別之功能，則可僅於該行駛路徑上存在障礙物之情形時進行停止控制。藉此，可抑制行駛中不存在障礙之狀況下之多餘之自動停止之發動。本案發明者發現，為了實現此而車輛只要掌握車輛之當前位置、及相較當前位置更靠前方之行駛區域即可。又，發現如下情況，即，車輛若掌握車輛之當前位置、及相較當前位置更靠前方之行駛區域，則不僅可將上述資訊用於障礙物檢測，亦可將上述資訊用於車輛之速度控制等車輛之行駛控制。

本發明之目的在於提供一種可高精度地辨識當前位置及其前方之行駛區域的、沿預先所規定之行駛路徑自動行駛之自動行駛車輛。

本發明係一種自動行駛車輛，其特徵在於其構成為可沿既定行駛路徑自動行駛，且具備：記憶部，其記憶事前已沿上述既定行駛路徑行駛之自動行駛車輛之行駛軌跡相關之軌跡相關資訊、及上述既定行駛路徑上之複數個計測點之自上述既定行駛路徑之起點算起之行駛距離相關之距離相關資訊；行駛距離計測部，其計測自上述起點至當前地點為止之行駛距離相關之資訊；及行駛區域推定部，其將藉由上述行駛距離計測部計測出之行駛距離相關之資訊與自上述記憶部讀出之上述距離相關資訊進行對照，而檢測上述當前地點之位置，並且基於自上述記憶部讀出之上述軌跡相關資訊並藉由運算而推定自上述當前地點往前之行駛區域。

設想上述自動行駛車輛沿預先所規定之既定行駛路徑自動行駛。因此，自動行駛車輛事前於該既定行駛路徑上行駛時所獲得之行駛軌跡相關的資訊(軌跡相關資訊)係與該車輛行駛時之行駛軌跡大致完全一致。同樣地，自動行駛車輛事前於該既定行駛路徑上行駛時自起點起到達至該既定行駛路徑上之複數個計測點為止所行駛之距離相關的資訊(距離相關資訊)係與該自動行駛車輛自起點起到達至各計測點為止實際會行駛之距離大致完全一致。

由此，於上述自動行駛車輛，藉由將由行駛距離計測部計測出之實際之行駛距離與自記憶部讀出之距離相關資訊中記載之行駛距離進行對照，而可掌握當前地點之車輛之位置。因此，可基於自記憶部讀出之軌跡相關資訊中記載之行駛軌跡而推定使該自動行駛車輛自當前地點前進之情形時會通過之行駛區域。

此處，作為用於獲取軌跡相關資訊及距離相關資訊之車輛，可為與成為推定行駛區域之對象之自動行駛車輛相同之車輛，只要形狀及大小相同則亦可為其他自動行駛車輛。

行駛距離計測部可包含例如搭載於車輪之旋轉角感測器而構成。可藉由利用旋轉角感測器計測自起點起到達至計測點為止車輪所旋轉之角度，並乘以車輪之直徑而計測行駛距離。再者，亦可視需要將上述積乘以特定之誤差係數。又，亦可將並非與行駛距離相關而與旋轉角相關之資訊記載於距離相關資訊。

作為搭載有用於獲取距離相關資訊之功能之自動行駛車輛，可採用例如以下構成。即，該車輛可設為如下者，其包括：攝像部，其於沿上述既定行駛路徑行駛之過程中，於上述複數個計測點對自上述自動行駛車輛觀察為特定之方向進行拍攝；及軌跡導出部，其基於由上述攝像部拍攝到之複數個攝像資料利用視覺測距之方法導出行駛軌跡；且上述軌跡相關資訊包含基於利用上述軌跡導出部導出之行駛軌跡之資訊而構成。

根據視覺測距之方法，可藉由根據一面移動一面拍攝之連續之複數個圖像資訊偵測各圖像上之特徵點之座標之位移，而導出移動體之軌跡。由此，可藉由具有上述構成之自動行駛車輛事前於既定行駛路徑上行駛，而製作該既定行駛路徑上之行駛軌跡相關之軌跡相關資訊。

上述自動行駛車輛亦可包括根據上述攝像資料製作視差圖像之視差圖像製作部，上述行駛區域推定部包含特定出與所導出之行駛軌跡對應之上述視差圖像上之區域的功能，且上述軌跡相關資訊包含上述複數個計測點各自之上述視差圖像上之、與上述行駛軌跡對應之區域相關的資訊而構成。

根據上述構成，表示於複數個計測點各自之視差圖像上與事前行駛之自動行駛車輛之行駛軌跡對應之區域為哪一區域的資訊記載為軌跡相關資訊。藉此，能以較少之資訊量記載自動行駛車輛於既定行駛路徑上行駛時會通過之區域相關之資訊。

更具體而言，上述軌跡相關資訊亦可包含將於上述複數個計測點各自之上述視差圖像上與上述行駛軌跡對應之區域之座標之範圍按視差值建立對應關係所得的資訊而構成。

又，上述自動行駛車輛可包括：障礙物檢測部，其對存在於上述自動行駛車輛之前方之障礙物進行檢測；及判定部，其判定所檢測到之上述障礙物是否存在於由上述行駛區域推定部推定出之上述行駛區域內。

根據上述構成，自動行駛車輛可藉由行駛區域推定部推定自當前地點往前之行駛區域，因此，可藉由判定部判定障礙物是否存在於行駛區域上。藉此，可藉由包括例如僅於由判定部判定障礙物存在於行駛區域上之情形時對自動行駛車輛進行停止控制的控制部，而抑制行駛中不存在障礙之狀況下之多餘之自動停止之發動。

上述自動行駛車輛可設為能夠於埋入於上述既定行駛路徑之電磁感應線上自動行駛之構成。

上述複數個計測點可包含埋入於上述既定行駛路徑且搭載於上述自動行駛車輛之感測器可讀取的定點構件之設置位置。

上述自動行駛車輛可用作例如高爾夫球車。

根據本發明之沿預先所規定之行駛路徑自動行駛之自動行駛車輛，可高精度地辨識當前位置及其前方之行駛區域。

1‧‧‧自動行駛車輛

3‧‧‧攝像部

3a‧‧‧左圖像感測器

3b‧‧‧右圖像感測器

4‧‧‧方向盤

5‧‧‧右前輪

6‧‧‧左前輪

7‧‧‧讀取部

7a‧‧‧定點感測器

7b‧‧‧感應線感測器

9‧‧‧旋轉角感測器

11‧‧‧自動運行控制部

13‧‧‧行駛距離計測部

15‧‧‧行駛區域推定部

17‧‧‧記憶部

19‧‧‧軌跡導出部

21‧‧‧行駛路徑

23‧‧‧定點構件

24‧‧‧電磁感應線

31‧‧‧視差圖像製作部

33‧‧‧障礙物檢測部

35‧‧‧判定部

50‧‧‧視差圖像

50a‧‧‧視差圖像

51‧‧‧視差圖像上之障礙物

52‧‧‧視差圖像上之障礙物

53‧‧‧視差圖像上之障礙物

54‧‧‧視差圖像上之障礙物

C0‧‧‧起點

C1‧‧‧地點

C2‧‧‧地點

C3‧‧‧地點

d1~d7‧‧‧視差值

X1~X10‧‧‧X座標區域

圖1係自前面觀察自動行駛車輛時之模式圖。

圖2係功能性地表示自動行駛車輛之第一實施形態之構成的方塊圖。

圖3係表示自動行駛車輛行駛之行駛路徑之一例之模式圖。

圖4(a)~(d)係用以對軌跡相關資訊進行說明之圖式。

圖5係功能性地表示自動行駛車輛之第二實施形態之構成的方塊圖。

圖6係表示視差圖像之一例之圖式。

圖7係功能性地表示自動行駛車輛之第三實施形態之構成的方塊圖。

圖8係表示於行駛路徑上存在障礙物之情形時之視差圖像之一例的圖式。

[第一實施形態]

參照圖式對本發明之自動行駛車輛之第一實施形態之構成進行說明。再者，於以下之圖式中，實際之尺寸比與圖式上之尺寸比未必一致。

於本實施形態中，作為自動行駛車輛而例示高爾夫球車進行說明。但是，作為自動行駛車輛，並不限定於高爾夫球車，亦包含於工廠或果樹園中行駛之無人搬送車。又，本發明中之自動行駛車輛並不限定於四輪車，亦可為三輪車，亦可為單軌型。於下述之第二實施形態之後之內容中亦情況相同。

(車輛之構成)

圖1係自前面觀察本實施形態中之自動行駛車輛時之模式圖。圖1所示之自動行駛車輛1係於高爾夫球場內自動行駛之高爾夫球車。再者，圖2係功能性地表示該自動行駛車輛1之構成之方塊圖。

圖1所示之自動行駛車輛1係於前面中央部具備攝像部3。攝像部3包括例如立體攝影機，且包含左圖像感測器3a與右圖像感測器3b。該等圖像感測器(3a、3b)包括CCD(Charge-Coupled Device，電荷耦合元件)或CMOS(Complementary MOS(Metal Oxide Semiconductor)，互補金氧半導體)等一般之可見光感測器。再者，於本說明書內，「前後」或「左右」等記載係以自動行駛車輛1前進之方向為基準之表現。

自動行駛車輛1包括方向盤4、及藉由該方向盤4之旋轉而進行操舵之右前輪5及左前輪6。又，自動行駛車輛1係於車體之下部具備讀取部7。讀取部7包含定點感測器7a與感應線感測器7b(參照圖2)。

於自動行駛車輛1之右前輪5設置有檢測右前輪5之旋轉角之旋轉角感測器9。旋轉角感測器9係檢測車輪之旋轉角者，且包括例如旋轉編碼器。再者，該旋轉角感測器9亦可代替右前輪5或者除該右前輪5以外亦設置於左前輪6或後輪。

圖2係表示自動行駛車輛1之構成之功能方塊圖。自動行駛車輛1包括自動運行控制部11、行駛距離計測部13、行駛區域推定部15、記憶部17、軌跡導出部19。行駛距離計測部13、行駛區域推定部15、軌跡導出部19包括例如CPU(Central Processing Unit，中央處理單元)等運算裝置。又，記憶部17包括例如記憶體或硬碟等。

自動運行控制部11係對自動行駛車輛1進行用於沿著設置於既定之行駛路徑上之電磁感應線之自動運行的控制。圖3係預定供自動行駛車輛1行駛之行駛路徑之一例。如圖3所示，於行駛路徑21上埋入有電磁感應線24。感應線感測器7b係接收自電磁感應線24發出之電磁波，並對自動運行控制部11輸出檢測信號。自動運行控制部11係基於該檢測信號對未圖示之操舵機構進行控制。藉此，自動運行車輛1於行駛路徑21上自動運行。

又，如圖3所示，於行駛路徑21上於包含起點C0之預先所規定之複數個位置埋設有定點構件23。定點構件23係藉由例如複數個磁鐵之組合而構成。定點感測器7a為可讀取來自該定點構件23之磁場資訊之構成，且包括例如磁力感測器。該等定點構件23發送例如指示行駛、停止、減速等之指示信號。當自動運行車輛1通過定點構件23上時，定點感測器7a係接收來自該通過之定點構件23之指示信號，並對自動運行控制部11輸出該指示信號。自動運行控制部11係根據該指示信號而控制自動行駛車輛1。藉此，自動行駛車輛1係基於由定點構件23指定之資訊而自動地進行行駛、停止、減速等控制。

又，定點感測器7a係於自動行駛車輛1通過定點構件23之時間點，將該內容之資訊輸出至行駛距離計測部13。行駛距離計測部13係以自定點感測器7a通過定點構件23之時間點為基準，基於自旋轉角感測器9輸出之車輪之旋轉角相關之資訊，計測通過定點構件23後行駛之距離。行駛距離計測部13可預先記憶右前輪5之直徑相關之資訊。藉此，可基於自特定之時間點起之右前輪5之旋轉角(轉數)及右前輪5之直徑，並藉由運算而計算自上述特定之時間點起之自動行駛車輛1之行駛距離。

因此，藉由以通過起點C0之時間點為基準，行駛距離計測部13可計測自起點C0起至當前地點為止之行駛距離。

於記憶部17記憶有下述之軌跡相關資訊及距離相關資訊。該等資訊係自動行駛車輛1事前於行駛路徑21上行駛時產生並記憶於記憶部17者。行駛區域推定部15具有如下功能，即，基於事前記憶於記憶部17之上述資訊、及由行駛距離計測部13計測出之自起點C0起至當前地點為止之行駛距離，藉由運算而檢測自動行駛車輛1之當前地點之位置。進而，行駛區域推定部15具有推定自該當前地點往前之行駛區域之功能。關於記憶於記憶部17之各種資訊、及行駛區域推定部15中之具體之運算內容，將於下文進行敍述。

(記憶於記憶部17之各種資訊)

如上所述，於記憶部17預先記憶有軌跡相關資訊及距離相關資訊。軌跡相關資訊係藉由自動行駛車輛1事前於行駛路徑21上行駛而利用軌跡導出部19製作的資訊。

於製作軌跡相關資訊時，首先，自動行駛車輛1一面於行駛路徑21上行駛一面使攝像部3以特定之圖框率連續地對自動行駛車輛1之前方進行拍攝。以此方式藉由攝像部3拍攝到之複數個地點(C0、C1、C2、...)與「複數個計測點」對應。

其次，軌跡導出部19係基於該等連續圖像，特定自動行駛車輛1之位置與車體之方向。圖4係模式性地表示藉由攝像部3拍攝到之連續之4張照片、以及拍攝到各照片之時間點之攝像部3之位置及方向者。再者，以下，設為圖4(a)之位置為圖3中之起點C0而進行說明。

軌跡導出部19係基於藉由攝像部3以特定之圖框率拍攝到之攝像資料而推算自動行駛車輛1之位置與車體之方向。作為該推算方法，可使用例如視覺測距(visual odometry)之方法。作為具體之一例，藉由軌跡導出部19擷取攝像資料上之複數個特徵點並且檢測各特徵點之於連續之2張攝像資料上之位移而進行。藉此，計算2張攝像資料間之自動行駛車輛1之位置之變化量與方向之變化量。

繼而，以起點C0為原點，將計算出之變化量自起點C0起依次累加，藉此，如圖4所示，獲得自動行駛車輛1之由位置與方向之共計6種成分構成之行駛軌跡(xi，yi，zi，θi，i，ψi)。軌跡導出部19係以此方式遍及整個行駛路徑21製作自動行駛車輛1之行駛軌跡，並將其記憶於記憶部17。該資訊與「軌跡相關資訊」對應。

又，軌跡導出部19係將藉由攝像部3拍攝到自動行駛車輛1之前方之時間點之自動行駛車輛1之6軸之座標資訊、與自起點C0起至各地點為止之自動行駛車輛1之行駛距離相關之資訊建立關聯而記憶於記憶部17。將該座標與行駛距離建立關聯所得之資訊與「距離相關資訊」對應。再者，該距離相關資訊可為自起點C0算起之自動行駛車輛1之行駛距離本身之資訊，亦可為自起點C0算起之自動行駛車輛1之右車輪5之旋轉角相關之資訊，亦可為將該等值乘以誤差等特定之係數而獲得之資訊。

(行駛區域推定部15之處理內容)

於自動行駛車輛1之記憶部17，如上所述，預先記憶有藉由自動運行車輛1於行駛路徑21上行駛而獲得之軌跡相關資訊及距離相關資訊。行駛區域推定部15係於自動行駛車輛1於行駛路徑21上行駛之過程中自行駛距離計測部13被提供自起點C0起至當前地點為止之行駛距離相關之資訊。行駛區域推定部15係將該行駛距離相關之資訊與自記憶部17讀出之距離相關資訊進行對照而檢測自動運行車輛1之當前地點之座標。進而，行駛區域推定部15係自記憶部17讀出軌跡相關資訊，推定自剛才檢測出之當前地點往前之自動行駛車輛1之行駛區域。

藉此，自動行駛車輛1可於在行駛路徑21上自動行駛之過程中辨識之後預定於哪一條路徑上行駛。由此，藉由例如將由行駛距離推定部15推定出之行駛區域相關之資訊輸出至自動運行控制部11，可將該資訊用於自動行駛車輛1之速度控制或行駛控制，因此，有助於提高自動運行之安全性。於圖2中，以帶箭頭之虛線表示自行駛區域推定部15對自動運行控制部11輸出資訊之內容。但是，於本實施形態中，關於自動運行控制部11基於由行駛距離推定部15推定出之行駛區域相關之資訊進行自動運行控制的情況係任意，亦可不必具備該功能。

又，於自動行駛車輛1具備障礙物檢測功能之情形時，藉由將由行駛距離推定部15推定出之行駛區域相關之資訊用於該障礙物檢測，可進行與行駛路徑21之特性對應之精度較高之障礙物檢測。該內容將於下文於第三實施形態中進行敍述。

(第一實施形態之另一構成)

亦可於記憶部17記憶有自起點C0起至各定點構件23為止之沿著行駛路徑21之距離相關之資訊。行駛距離計測部13係當定點感測器7a偵測自動行駛車輛1已通過定點構件23之情況時，將該時間點之自起點C0算起之行駛距離輸出至行駛區域推定部15。行駛區域推定部15係自記憶部17讀出自起點C0起至各定點構件23為止之行駛距離相關之資訊，並與自行駛距離計測部13輸出之行駛距離相關之資訊進行對照，而特定行駛距離之值最近之定點構件23。然後，行駛區域推定部15係將特定出之定點構件23之位置上之軌跡相關資訊自記憶部17讀出，而推定自特定出之定點構件23往前之自動行駛車輛1之行駛區域。

進而，行駛區域推定部15係將作為自起點C0起至通過特定出之定點構件23為止自動行駛車輛1所行駛之距離而由行駛距離計測部13計測出的距離置換為自記憶部17讀出之距離。於圖2中，以帶箭頭之虛線表示自行駛區域推定部15對行駛距離計測部13輸出資訊之內容。藉此，行駛距離計測部13可將自起點C0起至通過該定點構件23為止之計測誤差消除。即，根據該構成，每當通過定點構件23時均可將行駛距離計測部13之計測誤差消除，因此，可提高基於行駛距離計測部13之行駛距離之計測精度。

但是，於本實施形態中，關於每當通過定點構件23時對由行駛距離計測部13計測出之行駛距離之值進行調整的情況係任意，亦可不必具備該功能。

[第二實施形態]

參照圖式對自動行駛車輛之第二實施形態之構成進行說明。再者，於以下之各實施形態中，對與第一實施形態共通之構成要素標註相同之符號，並且適當省略說明。

圖5係功能性地表示本實施形態中之自動行駛車輛1之構成的方塊圖。本實施形態之自動行駛車輛1係於如下方面不同，即，除具備第一實施形態之構成以外，而且具備視差圖像製作部31。

於本實施形態中，攝像部3所具備之圖像感測器(3a、3b)係於水平方向保持固定距離而設置。即，左圖像感測器3a及右圖像感測器3b分別以平行立體之位置關係配置。左圖像感測器3a、右圖像感測器3b係以分別拍攝到之圖像之各列之位置一致之方式配置，即，以核線一致之方式配置。

再者，以下，將左圖像感測器3a與右圖像感測器3b連結之方向、即左右方向設為X軸，將相對於行駛路徑21之面正交之方向、即上下方向設為Y軸。又，將自動行駛車輛1之前後方向設為Z軸。

如上文於第一實施形態中進行敍述般，於製作軌跡相關資訊時，事前，自動行駛車輛1一面於行駛路徑21上行駛一面使攝像部3以特定之圖框率連續地對自動行駛車輛1之前方進行拍攝。此時所拍攝到之各圖像、更詳細而言利用左圖像感測器3a與右圖像感測器3b之各者拍攝到之各圖像暫時保管於未圖示之緩衝器。該保管之圖像亦可設為對透鏡失真、焦距之偏差等適當進行修正者。

視差圖像製作部31係基於該保管之圖像資料製作視差圖像。對製作視差圖像之方法之一例進行說明。將自左圖像感測器3a獲取之圖像資料設為基準圖像，將自右圖像感測器3b獲取之圖像資料設為參照圖像。而且，將基準圖像之一像素設為注目像素，對與注目像素對應之參照圖像上之像素(以下，稱為「對應像素」)進行搜尋。

於該搜尋時，可利用立體匹配等方法。作為立體匹配，有區域基礎匹配或特徵基礎匹配等。例如，於區域基礎匹配之情形時，設定以注目像素為中心之區域(以下，稱為「基準區域」)。將基準區域與參照圖像進行比較，特定出與基準區域最類似之參照圖像上之區域。繼而，將位於特定出之參照圖像上之區域之中心之像素決定為對應像素。

當搜尋對應像素時，計算基準圖像上之注目像素與參照圖像上之對應像素之橫向(X軸方向)之偏移量。該偏移量相當於注目像素中之視差。

對一個像素求出視差後，繼續對基準圖像上之其他像素亦同樣地重新設定為注目像素，重複相同之處理。藉此，亦對其他像素求出視差。可藉由將所求得之視差與各像素建立對應關係而製作視差圖像。所製作之視差圖像記憶於記憶部17。將視差圖像之一例示於圖6。

圖6表示行駛路徑21上之某地點Ci之視差圖像50。圖6所示之視差圖像50係由表示7種視差值(d1~d7)之各區域構成。各視差值d1~d7之關係係d1>d2>d3>d4>d5>d6>d7。

如上文於第一實施形態中進行敍述般，軌跡導出部19係製作遍及整個行駛路徑21之自動行駛車輛1之行駛軌跡，並將其記憶於記憶部17。於本實施形態之自動行駛車輛1，行駛區域推定部15係自記憶部17讀出所製作之行駛軌跡相關之資訊與視差圖像，並求出視差圖像上之行駛路徑21之區域。具體而言，將視差圖像上之行駛路徑之X座標與視差值建立關聯。例如，於圖6所示之視差圖像50之情形時，特定出行駛路徑21為視差值d1時之X座標區域X1~X10、視差值d2時之X座標區域X2~X9、視差值d3時之X座標區域X3~X8、視差值d4時之X座標區域X4~X7、及視差值d5時之X座標區域X5~X6。

行駛區域推定部15係對記憶於記憶部17之各地點之視差圖像以相同之方式特定出視差圖像上之行駛路徑21之區域。而且，特定出行駛路徑21上之各地點之視差圖像上之行駛路徑21之區域的資訊追加至軌跡相關資訊而記憶於記憶部17。

根據本實施形態之構成，可將自動行駛車輛1沿行駛路徑21行駛時通過之軌跡之資訊以附加於視差圖像上之狀態記憶於記憶部17。因此，根據本實施形態之自動行駛車輛1，除上文於第一實施形態中敍述之功能以外，例如可附加如下功能，即，於行駛中將利用視差圖像製作部31所製作之視差圖像與記憶於記憶部17之軌跡相關資訊進行對照，藉此，快速偵測自動行駛車輛1已偏離行駛路徑21。

[第三實施形態]

參照圖式對自動行駛車輛之第三實施形態之構成進行說明。圖7係功能性地表示本實施形態中之自動行駛車輛1之構成的方塊圖。本實施形態之自動行駛車輛1係於如下方面不同，即，除具備第二實施形態之構成以外，而且具備障礙物檢測部33及判定部35。

於自動行駛車輛1於行駛路徑21上行駛之過程中，攝像部3對應於特定之時序對前方進行拍攝，視差圖像製作部31基於該攝像資料製作視差圖像並輸出至障礙物檢測部33。障礙物檢測部33判斷送來之視差圖像上是否存在障礙物，並且於存在障礙物之情形時擷取該障礙物之視差圖像上之區域。作為一例，障礙物檢測部33係將視差圖像中之如下區域檢測為障礙物，該區域之X方向上之不同之視差值接近，且相同視差值之區域具有預先所規定之值以上之Y方向之像素數，換言之，視差值相同且具有預先所規定之高度。例如，於圖6所示之視差圖像50之情形時，障礙物檢測部33將區域51、52及53檢測為障礙物。

判定部35判定檢測出之障礙物是否存在於行駛路徑21上。作為一例，判定部35係自記憶部17讀出軌跡相關資訊，檢測當前地點之視差圖像上之行駛路徑21之X座標之區域。繼而，判定部35係只要自障礙物檢測部33輸出之障礙物之區域之下端之X座標值之範圍包含於行駛路徑21之各視差之X座標之範圍內，則判定障礙物存在於行駛路徑21上。例如，於圖6所示之視差圖像50之情形時，判定部35判定於行駛路徑21上不存在障礙物。

另一方面，對自視差圖像製作部31輸出至障礙物檢測部33之視差圖像為如圖8所示之圖像的情形進行討論。該圖8所示之視差圖像50a係基於在與圖6所示之視差圖像50相同之地點拍攝到之資料所製作者，設想於製成視差圖像50a之時間點於自動行駛車輛1之前方映入有人物之情形。

障礙物檢測部33係利用與上述相同之方法，根據視差圖像50a之資訊將區域51、52、53、及54檢測為障礙物。判定部35係偵測為區域54之下端之X座標值之範圍為X4以上且X8以下之範圍內、且表示視差值d3的行駛路徑21上之區域。其結果，判定部35判定於當前時間點於行駛路徑21上存在障礙物。

判定部35若判定障礙物存在於行駛路徑21上，則對自動運行控制部11輸出該內容之資訊。自動運行控制部11隨之進行自動行駛車輛1之減速或停止控制。

根據本實施形態之自動行駛車輛1，預先於記憶部17記憶有視差圖像上之行駛路徑21之區域相關之資訊，因此，於檢測到障礙物之情形時，可判定該障礙物是否存在於行駛路徑21上。藉此，可設為如下構成，即，即便於檢測到障礙物之情形時，當該障礙物不存在於行駛路徑21上時，自動運行控制部11亦不進行減速或停止之控制。其結果，根據本實施形態之自動行駛車輛1，可抑制行駛中不存在障礙之狀況下之多餘之自動停止之發動。

再者，判定部35亦可於藉由障礙物檢測部33檢測到存在障礙物後，判定包圍該障礙物之區域之矩形區域是否與行駛路徑21之區域重疊，之後僅對具有與行駛路徑21之區域重疊之矩形區域之障礙物進行上述判定。藉由該2階段判定，可更高速地判定障礙物是否存在於行駛路徑上。再者，判定部35係於矩形之下端之Y座標值(高度)大於預先所規定之高度之情形時，判定為架設於行駛路徑21之上空之橋或樹枝等樹木之一部分而並非障礙物，藉此，亦可使障礙物判定之精度提高。

[另一實施形態]

以下，對另一實施形態進行說明。

〈1〉於上述各實施形態中，事前由記憶部17記憶之距離相關資訊及軌跡相關資訊係設為藉由具備該記憶部17之自動行駛車輛1本身於行駛路徑21上行駛而產生者進行了說明。但是，記憶於記憶部17之上述各資訊亦可為藉由與具備該記憶部17之自動行駛車輛1不同的、形狀大致相同且大小大致相同之自動行駛車輛1事前於行駛路徑21上行駛而產生者。於該情形時，於第一實施形態之自動行駛車輛1，不必需要攝像部3及軌跡導出部19。同樣地，第二實施形態之自動行駛車輛1中，不必需要攝像部3、軌跡導出部19、及視差圖像製作部31。

〈2〉本案發明及本說明書之自動行駛車輛(automatically driven vehicle)係可自動行駛之車輛。自動行駛車輛係可不由操作員操舵而自動行駛之車輛。自動行駛車輛係可不由操作員進行加速及減速而自動行駛之車輛。又，自動行駛車輛包含搭載至少一個感測器且可根據該感測器之信號自主行駛之自主行駛車輛(autonomously driven vehicle)。