自己位置計(jì)算裝置及自己位置計(jì)算方法
【專(zhuān)利摘要】自己位置計(jì)算裝置具備：向車(chē)輛周?chē)穆访?31)投射圖案光(32a)的投光器(11)、拍攝包含投射有圖案光(32a)的區(qū)域的車(chē)輛周?chē)穆访?31)并取得圖像(38)的攝像機(jī)(12)，根據(jù)由攝像機(jī)(12)取得的圖像(38)中的圖案光(32a)的位置，計(jì)算出車(chē)輛(10)相對(duì)于路面(31)的姿勢(shì)角，基于從圖像(38)檢測(cè)出的路面上的多個(gè)特征點(diǎn)的時(shí)間變化，計(jì)算出車(chē)輛的姿勢(shì)變化量。自己位置計(jì)算裝置通過(guò)車(chē)輛的初始位置及姿勢(shì)角加上姿勢(shì)變化量，計(jì)算出車(chē)輛的當(dāng)前位置及姿勢(shì)角，且在多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)的情況下，投射圖案光(32a)。
【專(zhuān)利說(shuō)明】
自己位置計(jì)算裝置及自己位置計(jì)算方法
技術(shù)領(lǐng)域
[0001 ]本發(fā)明涉及自己位置計(jì)算裝置及自己位置計(jì)算方法。
【背景技術(shù)】
[0002] 已知有如下的技術(shù)，即、取得由搭載于車(chē)輛的攝像機(jī)拍攝的車(chē)輛附近的圖像，并基 于圖像的變化求出車(chē)輛的移動(dòng)量(參照專(zhuān)利文獻(xiàn)1)。專(zhuān)利文獻(xiàn)1中，為了在車(chē)輛的低速且細(xì) 微的移動(dòng)中也高精度地求出移動(dòng)量，從圖像中檢測(cè)特征點(diǎn)，求出圖像上的特征點(diǎn)的位置，并 根據(jù)特征點(diǎn)的移動(dòng)方向及移動(dòng)距離(移動(dòng)量)求出車(chē)輛的移動(dòng)量。
[0003] 現(xiàn)有技術(shù)文獻(xiàn)
[0004] 專(zhuān)利文獻(xiàn)
[0005] 專(zhuān)利文獻(xiàn)1:(日本)特開(kāi)2008 -175717號(hào)公報(bào)
[0006]但是，在特征點(diǎn)的檢測(cè)狀態(tài)差的情況下，難以根據(jù)特征點(diǎn)的位置高精度地求出車(chē) 輛的移動(dòng)量。

【發(fā)明內(nèi)容】

[0007] 本發(fā)明是鑒于上述課題而創(chuàng)立的，其目的在于，提供一種自己位置計(jì)算裝置及自 己位置計(jì)算方法，無(wú)論特征點(diǎn)的檢測(cè)狀態(tài)如何，均能夠高精度且穩(wěn)定地推定車(chē)輛的當(dāng)前位 置。
[0008] 本發(fā)明的一方式的自己位置(本車(chē)輛位置local location)計(jì)算裝置具備：投光 器，其向車(chē)輛周?chē)穆访嫱渡鋱D案光;攝像部，其拍攝包含投射圖案光的區(qū)域在內(nèi)的車(chē)輛周 圍的路面并取得圖像。自己位置計(jì)算裝置根據(jù)由攝像部取得的圖像中的圖案光的位置，計(jì) 算出車(chē)輛相對(duì)于路面的姿勢(shì)角，并基于根據(jù)圖像檢測(cè)出的路面上的多個(gè)特征點(diǎn)的時(shí)間變 化，計(jì)算出車(chē)輛的姿勢(shì)變化量。而且，通過(guò)在車(chē)輛的初始位置及姿勢(shì)角加上姿勢(shì)變化量，計(jì) 算出車(chē)輛的當(dāng)前位置及姿勢(shì)角。自己位置計(jì)算裝置在多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基 準(zhǔn)而差的狀態(tài)的情況下，投射圖案光。
【附圖說(shuō)明】
[0009] 圖1是表示實(shí)施方式的自己位置計(jì)算裝置的整體構(gòu)成的塊圖；
[0010] 圖2是表示投光器11及攝像機(jī)12向車(chē)輛10的搭載例的外觀圖；
[0011] 圖3(a)是表示根據(jù)投光器11和攝像機(jī)12之間的基線長(zhǎng)度Lb、各光點(diǎn)的圖像上的坐 標(biāo)(UpVj)，計(jì)算出照射各光點(diǎn)的路面31上的位置的情形的圖，圖3(b)是表示根據(jù)從與照射 圖案光32a的區(qū)域不同的另一區(qū)域33檢測(cè)出的特征點(diǎn)的時(shí)間變化，求出攝像機(jī)12的移動(dòng)方 向34的情形的不意圖；
[0012 ]圖4 (a)及圖4 (b)是表示對(duì)由攝像機(jī)12取得的圖像實(shí)施了二值化處理的圖案光32a 的圖像的圖，圖4(a)表不圖案光32a整體，圖4(b)表不擴(kuò)大一個(gè)光點(diǎn)Sp，圖4(c)是表不由圖 案光抽取部21抽取的各光點(diǎn)S p的重心的位置凡的圖；
[0013] 圖5是用于說(shuō)明計(jì)算距離及姿勢(shì)角的變化量及攝像機(jī)12的移動(dòng)量（AL)的方法的 示意圖；
[0014] 圖6(a)表示在時(shí)刻t取得的第一幀（圖像)38的一例，圖6(b)表示在從時(shí)刻t經(jīng)過(guò)時(shí) 間At的時(shí)刻(t+At)取得的第二幀38' ；
[0015]圖7是表示使用了圖1的自己位置計(jì)算裝置的自己位置計(jì)算方法的一例的流程圖；
[0016] 圖8是表示圖7的步驟S05的詳細(xì)順序的流程圖；
[0017] 圖9是表示按照?qǐng)D8的流程執(zhí)行的信息處理的一例的圖，圖9(a)表示姿勢(shì)角計(jì)算部 22是否根據(jù)圖案光32a計(jì)算出距離及姿勢(shì)角，圖9(b)表示圖案光投射實(shí)施標(biāo)志的狀態(tài)，圖9 (c)表示取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量；
[0018] 圖10是表示圖7的步驟S09的詳細(xì)順序的流程圖；
[0019] 圖11(a)及圖11(b)是表示車(chē)輛10的側(cè)滾角及車(chē)寬方向移動(dòng)量的推定誤差的例的 圖；
[0020] 圖12是表示第二實(shí)施方式的步驟S05的詳細(xì)順序的流程圖；
[0021] 圖13是表示按照?qǐng)D12的流程執(zhí)行的信息處理的一例的圖，圖13(a)表示姿勢(shì)角計(jì) 算部22是否根據(jù)圖案光32a計(jì)算出距離及姿勢(shì)角，圖13(b)表示圖案光投射實(shí)施標(biāo)志的狀 態(tài)，圖13 (c)表示取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量；
[0022]圖14是表示第三實(shí)施方式的步驟S05的詳細(xì)順序的流程圖；
[0023]圖15是表示按照?qǐng)D14的流程執(zhí)行的信息處理的一例的圖，圖15(a)表示姿勢(shì)角計(jì) 算部22是否根據(jù)圖案光32a計(jì)算出距離及姿勢(shì)角，圖15(b)表示圖案光投射實(shí)施標(biāo)志的狀 態(tài)，圖15 (c)表示取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量；
[0024]圖16是表示第四實(shí)施方式的步驟S05的詳細(xì)順序的流程圖；
[0025]圖17是表示按照?qǐng)D16的流程執(zhí)行的信息處理的一例的圖，圖17(a)表示姿勢(shì)角計(jì) 算部22是否根據(jù)圖案光32a計(jì)算出距離及姿勢(shì)角，圖17(b)表示圖案光投射實(shí)施標(biāo)志的狀 態(tài)，圖17 (c)表示取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量。
【具體實(shí)施方式】
[0026]參照【附圖說(shuō)明】實(shí)施方式。附圖的記載中，對(duì)相同部分標(biāo)注相同的符號(hào)并省略說(shuō)明。 [0027](第一實(shí)施方式）
[0028](硬件構(gòu)成）
[0029]首先，參照?qǐng)D1說(shuō)明第一實(shí)施方式的自己位置計(jì)算裝置的硬件構(gòu)成。自己位置計(jì)算 裝置具備:投光器11、攝像機(jī)12、發(fā)動(dòng)機(jī)控制單元(ECU)13。投光器11搭載于車(chē)輛上，向車(chē)輛 周?chē)穆访嫱渡鋱D案光。攝像機(jī)12是搭載于車(chē)輛上而拍攝包含投射圖案光的區(qū)域在內(nèi)的車(chē) 輛周?chē)穆访娌⑷〉脠D像的攝像部的一例。ECU13是控制投光器11且執(zhí)行根據(jù)由攝像機(jī)12 取得的圖像推定車(chē)輛的移動(dòng)量的一連串的信息處理循環(huán)的控制部的一例。
[0030] 攝像機(jī)12是使用了固體攝像元件、例如CCD及CMOS的數(shù)字?jǐn)z像機(jī)，取得可以進(jìn)行圖 像處理的數(shù)字圖像。攝像機(jī)12的拍攝對(duì)象是車(chē)輛周?chē)穆访?，?chē)輛周?chē)穆访姘?chē)輛的 前部、后部、側(cè)部、車(chē)輛底部的路面。例如，如圖2所示，攝像機(jī)12可以搭載于車(chē)輛10的前部， 具體而言，可以搭載于前保險(xiǎn)杠上。
[0031] 調(diào)整設(shè)置攝像機(jī)12的高度及方向且自動(dòng)調(diào)整攝像機(jī)12所具備的透鏡的焦點(diǎn)及光 圈，以可拍攝車(chē)輛10的前方路面31上的特征點(diǎn)（紋理)及由投光器11投射的圖案光32b。攝像 機(jī)12每隔規(guī)定的時(shí)間間隔進(jìn)行重復(fù)拍攝，取得一連串的圖像(幀)組。由攝像機(jī)12取得的圖 像數(shù)據(jù)向E⑶13傳送，并存儲(chǔ)于E⑶13所具備的存儲(chǔ)器。
[0032]如圖2所示，投光器11向攝像機(jī)12的拍攝范圍內(nèi)的路面31，投射具有包含正方形或 長(zhǎng)方形的光柵圖像的規(guī)定形狀的圖案光32b。攝像機(jī)12拍攝由路面31照射的圖案光。投光器 11具備例如激光指示器及衍射光柵。將從激光指示器射出的激光利用衍射光柵進(jìn)行衍射， 由此，如圖2~圖4所示，投光器11生成光柵圖像或由行列狀地排列的多個(gè)光點(diǎn)心構(gòu)成的圖 案光(32b、32a)。圖3及圖4所示的例子中，生成由5X7的光點(diǎn)S p構(gòu)成的圖案光32a。
[0033] 返回圖1，ECU13由具備CPU、存儲(chǔ)器及輸入輸出部的微型控制器構(gòu)成，通過(guò)執(zhí)行預(yù) 先安裝的計(jì)算機(jī)程序，構(gòu)成自己位置計(jì)算裝置具備的多個(gè)信息處理部。ECU13對(duì)每個(gè)圖像 (幀）重復(fù)執(zhí)行根據(jù)由攝像機(jī)12取得的圖像計(jì)算出車(chē)輛的當(dāng)前位置的一連串的信息處理循 環(huán)。E⑶13也可以兼用作車(chē)輛10的其它控制所使用的E⑶。
[0034]多個(gè)信息處理部包含：圖案光抽取部21、姿勢(shì)角計(jì)算部22、姿勢(shì)變化量計(jì)算部24、 自己位置計(jì)算部26、圖案光控制部27、檢測(cè)狀態(tài)判斷部30、計(jì)算狀態(tài)判斷部35。姿勢(shì)變化量 計(jì)算部24包含特征點(diǎn)檢測(cè)部23。
[0035] 圖案光抽取部21從存儲(chǔ)器讀取由攝像機(jī)12取得的圖像，根據(jù)圖像抽取圖案光的位 置。如圖3(a)所示，例如，投光器11向路面31投射由行列狀地排列的多個(gè)光點(diǎn)構(gòu)成的圖案光 32a，并利用攝像機(jī)12檢測(cè)被路面31反射的圖案光32a。圖案光抽取部21通過(guò)對(duì)由攝像機(jī)12 取得的圖像實(shí)施二值化處理，如圖4(a)及圖4(b)所示，僅抽取光點(diǎn)S p的圖像。如圖4(c)所 示，圖案光抽取部21通過(guò)計(jì)算出各光點(diǎn)Sp的重心的位置He，即光點(diǎn)心的圖像上的坐標(biāo)(Uj、 V j)，而抽取圖案光32a的位置。坐標(biāo)在以攝像機(jī)12的攝像元件的像素為單位且5X7的光點(diǎn) Sp的情況下，"j"為1以上且35以下的自然數(shù)。光點(diǎn)&的圖像上的坐標(biāo)㈨、％)作為表示圖案 光32a的位置的數(shù)據(jù)存儲(chǔ)于存儲(chǔ)器。
[0036] 姿勢(shì)角計(jì)算部22從存儲(chǔ)器讀取表示圖案光32a的位置的數(shù)據(jù)，根據(jù)由攝像機(jī)12取 得的圖像中的圖案光32a的位置，計(jì)算出車(chē)輛10相對(duì)于路面31的距離及姿勢(shì)角。例如，如圖3 (a)所示，根據(jù)投光器11和攝像機(jī)12之間的基線長(zhǎng)度Lb、各光點(diǎn)的圖像上的坐標(biāo)〇]>%)，使 用三角測(cè)量原理，將照射各光點(diǎn)的路面31上的位置作為相對(duì)于攝像機(jī)12的相對(duì)位置而計(jì)算 出。而且，姿勢(shì)角計(jì)算部22根據(jù)各光點(diǎn)相對(duì)于攝像機(jī)12的相對(duì)位置，計(jì)算出投射圖案光32a 的路面31的平面方程式即攝像機(jī)12相對(duì)于路面31的距離及姿勢(shì)角(法向矢量）。此外，攝像 機(jī)12相對(duì)于車(chē)輛10的搭載位置及拍攝方向已知，因此，實(shí)施方式中，作為車(chē)輛10相對(duì)于路面 31的距離及姿勢(shì)角的一例，計(jì)算出攝像機(jī)12相對(duì)于路面31的距離及姿勢(shì)角。以后，將攝像機(jī) 12相對(duì)于路面31的距離及姿勢(shì)角簡(jiǎn)稱(chēng)為"距離及姿勢(shì)角"。由姿勢(shì)角計(jì)算部22計(jì)算出的距離 及姿勢(shì)角存儲(chǔ)于存儲(chǔ)器。
[0037] 具體而言，攝像機(jī)12及投光器11分別固定于車(chē)輛10上，因此，圖案光32a的照射方 向、攝像機(jī)12和投光器11的距離(基線長(zhǎng)度Lb)已知。因此，姿勢(shì)角計(jì)算部22可以使用三角測(cè) 量的原理，將從各光點(diǎn)的圖像上的坐標(biāo)(UpV j)照射各光點(diǎn)的路面31上的位置作為相對(duì)于攝 像機(jī)12的相對(duì)位置(Xj，Yj，Z j)而求出。
[0038]此外，各光點(diǎn)相對(duì)于攝像機(jī)12的相對(duì)位置(?，乃，Zj)大多情況下不存在于同一平 面上。這是由于，根據(jù)在路面31上露出的瀝青的凹凸不同，各光點(diǎn)的相對(duì)位置進(jìn)行改變。因 此，也可以使用最小二乘法，求出與各光點(diǎn)的距離誤差的平方和成為最小那樣的平面方程 式。
[0039]特征點(diǎn)檢測(cè)部23從存儲(chǔ)器讀取由攝像機(jī)12取得的圖像，并根據(jù)從存儲(chǔ)器讀取的圖 像，檢測(cè)路面31上的特征點(diǎn)。特征點(diǎn)檢測(cè)部23為了檢測(cè)路面31上的特征點(diǎn)，可以使用例如 uD.G.Lowe, uDistinctive Image Features from Scale-Invariant Keypoints /' Int · J. Comput .Vis.，vo 1.60,否.2, pp .91-110,否 ν· 200"，或，"金澤靖，金谷健 一，匕。 二一夕匕'、：％^(7)化^)(7)畫(huà)像(7)特徴點(diǎn)抽出（用于計(jì)算機(jī)圖像的圖像的特征點(diǎn)抽取)"信學(xué) 志，vol · 87，否· 12，pp · 1043-1048，Dec · 2004" 所記載的方法。
[0040]具體而言，特征點(diǎn)檢測(cè)部23使用例如哈里斯(Harris)運(yùn)算符或SUSAN操作符，以物 體的頂點(diǎn)那樣輝度值比周?chē)蠓兓狞c(diǎn)為特征點(diǎn)進(jìn)行檢測(cè)?；蛘?，特征點(diǎn)檢測(cè)部23也可 以使用SIFT(Scale_Invariant Feature Transform)特征量，以根據(jù)在其周?chē)x度值以一 定規(guī)則性變化的點(diǎn)為特征點(diǎn)進(jìn)行檢測(cè)。而且，特征點(diǎn)檢測(cè)部23對(duì)由1個(gè)圖像檢測(cè)的特征點(diǎn)的 總數(shù)N進(jìn)行計(jì)數(shù)，并對(duì)各特征點(diǎn)標(biāo)注識(shí)別編號(hào)（i(l<i<N))。各特征點(diǎn)的圖像上的位置(仏、 V 1)存儲(chǔ)于ECU13內(nèi)的存儲(chǔ)器。圖6(a)及圖6(b)表示根據(jù)由攝像機(jī)12取得的圖像檢測(cè)出的特 征點(diǎn)Te的例子。各特征點(diǎn)的圖像上的位置(U 1J1)存儲(chǔ)于存儲(chǔ)器中。
[0041]此外，實(shí)施方式中，路面31上的特征點(diǎn)主要假定大小為Icm以上且2cm以下的瀝青 混合物的粒子。為了檢測(cè)該特征點(diǎn)，攝像機(jī)12的分辨率為VGA(約30萬(wàn)像素）。另外，攝像機(jī)12 相對(duì)于路面31的距離大致為70cm。另外，攝像機(jī)12的拍攝方向從水平面向路面31傾斜約 45deg。另外，將由攝像機(jī)12取得的圖像向ECU13傳送時(shí)的輝度數(shù)值為0~255(0:最暗，255: 最殼)的范圍內(nèi)。
[0042]姿勢(shì)變化量計(jì)算部24從存儲(chǔ)器讀取按照一定的信息處理循環(huán)拍攝的幀中、上一次 幀所包含的多個(gè)特征點(diǎn)的圖像上的位置(UhV1),且從存儲(chǔ)器讀取此次幀所包含的多個(gè)特征 點(diǎn)的圖像上的位置(UhV 1)13而且，基于多個(gè)特征點(diǎn)的圖像上的位置變化，求出車(chē)輛的姿勢(shì)變 化量。在此，"車(chē)輛的姿勢(shì)變化量"包含相對(duì)于路面31的"距離及姿勢(shì)角"的變化量及在路面 上的"車(chē)輛(攝像機(jī)12)的移動(dòng)量"雙方。以下，說(shuō)明距離及姿勢(shì)角的變化量及車(chē)輛的移動(dòng)量 的計(jì)算方法。
[0043] 圖6(a)表示在時(shí)刻t取得的第一幀（圖像)38的一例。如圖5或圖6(a)所示，考慮在 第一幀38分別計(jì)算出例如3個(gè)特征點(diǎn)T el、Te2、Te3的相對(duì)位置(XiUi)的情況。在該情況下， 可以將由特征點(diǎn)T el、Te2、Te3特定的平面G看作路面。因此，姿勢(shì)變化量計(jì)算部24可以根據(jù)相 對(duì)位置(X 1J1)，求出攝像機(jī)12相對(duì)于路面(平面G)的距離及姿勢(shì)角(法向矢量）。另外，姿 勢(shì)變化量計(jì)算部24可以根據(jù)已知的攝像機(jī)型號(hào)，求出各特征點(diǎn)T el、Te2、Te3之間的距離（h、 12、1 3)及連結(jié)各個(gè)特征點(diǎn)Te3l Je32Je33的直線構(gòu)成的角度。圖5的攝像機(jī)12表示第一幀時(shí)的攝 像機(jī)的位置。
[0044] 此外，作為表示相對(duì)于攝像機(jī)12的相對(duì)位置的三維坐標(biāo)(Xi、Yi、Zi )，將攝像機(jī)12的 拍攝方向設(shè)定成Z軸，將拍攝方向設(shè)為法線且在包含攝像機(jī)12的平面內(nèi)設(shè)定相互正交的X軸 及Y軸。另一方面，作為圖像38上的坐標(biāo)，將水平方向及垂直方向分別設(shè)定成V軸及U軸。
[0045] 圖6 (b)表示在從時(shí)刻t經(jīng)由時(shí)間△ t的時(shí)刻（t+ △ t)取得的第二幀。圖5的攝像機(jī) 12'表示拍攝第二幀38'時(shí)的攝像機(jī)的位置。如圖5或圖6(b)所示，在第二幀38'，攝像機(jī)12' 拍攝特征點(diǎn)T e3l Je32Je33,特征點(diǎn)檢測(cè)部23檢測(cè)出特征點(diǎn)Te3l Je32Je33t3在該情況下，姿勢(shì)變化量 計(jì)算部24根據(jù)時(shí)刻t時(shí)的各特征點(diǎn)Tel、Te2、Te3的相對(duì)位置(Xi、Yi、Zi )、各特征點(diǎn)的第二幀38 ' 上的位和攝像機(jī)12的攝像機(jī)型號(hào)，不僅可以計(jì)算出時(shí)間At時(shí)的攝像機(jī)12(車(chē) 輛)的移動(dòng)量（AL)，而且還可以計(jì)算出距離及姿勢(shì)角的變化量。例如，通過(guò)解開(kāi)以下的由式 (1)~(4)構(gòu)成的聯(lián)合方程式，姿勢(shì)變化量計(jì)算部24可以計(jì)算出攝像機(jī)12的移動(dòng)量（AL)及 距離及姿勢(shì)角的變化量。此外，式（1)是攝像機(jī)12作為沒(méi)有失真或沒(méi)有光軸偏離的理想性的 針孔攝像機(jī)而模擬化的式子，Ai為常數(shù)，f為焦點(diǎn)距離。攝像機(jī)型號(hào)的參數(shù)只要預(yù)先進(jìn)行校 準(zhǔn)即可。
[0046]
[0047]
[0048]
[0049]
[0050] 圖3(b)示意性地表示攝像機(jī)12的拍攝范圍中，根據(jù)與照射圖案光32a的區(qū)域不同 的其它區(qū)域33檢測(cè)出的特征點(diǎn)的時(shí)間變化，求出攝像機(jī)12的移動(dòng)方向34的情形。另外，圖6 (a)及圖6 (b)中，將表示各特征點(diǎn)Te的位置的變化方向及變化量的矢量Dte與圖像重疊表示。 姿勢(shì)變化量計(jì)算部24不僅可以計(jì)算出時(shí)間△ t時(shí)的攝像機(jī)12的移動(dòng)量（△ L)，而且還可以同 時(shí)計(jì)算出距離及姿勢(shì)角的變化量。因此，姿勢(shì)變化量計(jì)算部24考慮距離及姿勢(shì)角的變化量， 可以高精度地計(jì)算出6個(gè)自由度的移動(dòng)量（△ L)。即，即使距離或姿勢(shì)角根據(jù)車(chē)輛10的轉(zhuǎn)向 或加減速產(chǎn)生的側(cè)滾運(yùn)動(dòng)或俯仰運(yùn)動(dòng)不同而變化，也可以抑制移動(dòng)量（△ U的推定誤差。 [0051 ]此外，姿勢(shì)變化量計(jì)算部24也可以不使用計(jì)算出相對(duì)位置的全部特征點(diǎn)，而基于 特征點(diǎn)彼此的位置關(guān)系選定最佳的特征點(diǎn)。作為選定方法，例如可以使用對(duì)極幾何(對(duì)極線 I.Hartley:uA linear method for reconstruction from lines and points," Proc.5th International Conference on Computer Vision,Cambridge,Massachusetts, pp.882-887(1995))〇
[0052]就在前后幀間使特征點(diǎn)對(duì)應(yīng)而言，只要將例如檢測(cè)出的特征點(diǎn)周邊的小區(qū)域的圖 像記錄于存儲(chǔ)器，并根據(jù)輝度或色信息的類(lèi)似度進(jìn)行判斷即可。具體而言，ECU13將以檢測(cè) 出的特征點(diǎn)為中心的5 X 5(水平X垂直)像素的圖像記錄于存儲(chǔ)器中。姿勢(shì)變化量計(jì)算部24 如果將例如輝度信息收納于20像素以上且誤差1 %以下，則判斷為在前后幀間取得對(duì)應(yīng)關(guān) 系的特征點(diǎn)。
[0053]這樣，從在后面的時(shí)刻取得的圖像38'也檢測(cè)到計(jì)算出相對(duì)位置(X1 JnZ1)的特征 點(diǎn)Tel、Te2、Te3時(shí)，姿勢(shì)變化量計(jì)算部24可以基于路面上的多個(gè)特征點(diǎn)的時(shí)間變化，計(jì)算出 "車(chē)輛的姿勢(shì)變化量"。
[0054]自己位置計(jì)算部26根據(jù)由姿勢(shì)變化量計(jì)算部24計(jì)算出的"距離及姿勢(shì)角的變化 量"計(jì)算出距離及姿勢(shì)角。另外，根據(jù)由姿勢(shì)變化量計(jì)算部24計(jì)算出的"車(chē)輛的移動(dòng)量"計(jì)算 出車(chē)輛的當(dāng)前位置。
[0055]具體而言，在將由姿勢(shì)角計(jì)算部22(參照?qǐng)D1)計(jì)算出的距離及姿勢(shì)角設(shè)定為起點(diǎn) 的情況下，對(duì)該起點(diǎn)(距離及姿勢(shì)角)逐次加上(進(jìn)行積分運(yùn)算）由姿勢(shì)變化量計(jì)算部24計(jì)算 出的各個(gè)幀的距離及姿勢(shì)角的變化量，由此，將距離及姿勢(shì)角更新成最新的數(shù)值。另外，將 由姿勢(shì)角計(jì)算部22計(jì)算出距離及姿勢(shì)角時(shí)的車(chē)輛位置設(shè)定為起點(diǎn)（車(chē)輛的初始位置），且從 該初始位置逐次加上(進(jìn)行積分運(yùn)算)車(chē)輛的移動(dòng)量，由此，計(jì)算出車(chē)輛的當(dāng)前位置。例如， 通過(guò)設(shè)定與地圖上的位置核對(duì)的起點(diǎn)（車(chē)輛的初始位置），可以逐次計(jì)算出地圖上的車(chē)輛的 當(dāng)前位置。
[0056]這樣，如果可以繼續(xù)檢測(cè)在前后幀間取得對(duì)應(yīng)關(guān)系的3點(diǎn)以上的特征點(diǎn)，則通過(guò)繼 續(xù)加上距離及姿勢(shì)角的變化量的處理(積分運(yùn)算），不使用圖案光32a，也可以將距離或姿勢(shì) 角繼續(xù)更新成最新的數(shù)值。其中，在最初的信息處理循環(huán)中，也可以使用通過(guò)使用圖案光 32a計(jì)算出的距離及姿勢(shì)角或規(guī)定的初始距離及初始姿勢(shì)角。即，成為積分運(yùn)算的起點(diǎn)的距 離及姿勢(shì)角也可以使用圖案光32a計(jì)算出，或也可以使用規(guī)定的初始值。規(guī)定的初始距離及 初始姿勢(shì)角優(yōu)選為至少考慮了車(chē)輛10的乘坐人員及搭載物的距離及姿勢(shì)角。例如，在車(chē)輛 10的點(diǎn)火開(kāi)關(guān)為接通狀態(tài)，且移動(dòng)位置從停車(chē)場(chǎng)移動(dòng)至另一位置時(shí)，只要投射圖案光32a， 且將根據(jù)圖案光32a計(jì)算出的距離及姿勢(shì)角用作規(guī)定的初始距離及初始姿勢(shì)角即可。由此， 可以求出不產(chǎn)生車(chē)輛10的轉(zhuǎn)向或加減速引起的滾動(dòng)運(yùn)動(dòng)或俯仰運(yùn)動(dòng)時(shí)的距離及姿勢(shì)角。 [0057] 此外，實(shí)施方式中，通過(guò)計(jì)算出距離及姿勢(shì)角的變化量，且逐次加上距離及姿勢(shì)角 的變化量，將距離及姿勢(shì)角更新成最新的數(shù)值。但是，也可以?xún)H將攝像機(jī)12相對(duì)于路面31的 姿勢(shì)角設(shè)為其變化量而計(jì)算出并作為更新的對(duì)象。在該情況下，攝像機(jī)12相對(duì)于路面31的 距離只要假定為一定即可。由此，也可以考慮姿勢(shì)角的變化量，抑制移動(dòng)量（AL)的推定誤 差，同時(shí)減輕E⑶13的運(yùn)算負(fù)荷，且提高運(yùn)算速度。
[0058]檢測(cè)狀態(tài)判斷部30判斷特征點(diǎn)檢測(cè)部23進(jìn)行的特征點(diǎn)Te的檢測(cè)狀態(tài)是否不滿足 第一基準(zhǔn)而是差的狀態(tài)。例如，如隧道內(nèi)的混凝土路面那樣，在路面上瀝青混合物的顆粒等 的狀況或凹凸較少的情況下，從圖像可檢測(cè)的特征點(diǎn)變少。在該情況下，在前后幀間取得對(duì) 應(yīng)關(guān)系的特征點(diǎn)的繼續(xù)檢測(cè)變得困難，距離及姿勢(shì)角的更新精度降低。
[0059] 因此，檢測(cè)狀態(tài)判斷部30在例如計(jì)算出相對(duì)于攝像機(jī)12的相對(duì)位置的特征點(diǎn)中、 從在后面的信息處理循環(huán)中取得的圖像也可檢測(cè)出的特征點(diǎn)的數(shù)量不是規(guī)定的閾值（例 如，4個(gè)）以上的情況下，判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)，而是差的狀態(tài)。即， 在不能檢測(cè)前后幀間取得對(duì)應(yīng)的4個(gè)以上的特征點(diǎn)的情況下，檢測(cè)狀態(tài)判斷部30判斷為特 征點(diǎn)T e的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)，而是差的狀態(tài)。此外，如圖6所示，為了求出距離及姿勢(shì) 角的變化量，需要在前后幀間取得對(duì)應(yīng)的至少3個(gè)特征點(diǎn)。這是由于，特定平面G需要3個(gè)特 征點(diǎn)。提高推定精度需要更多的特征點(diǎn)，因此，規(guī)定的閾值優(yōu)選為4或5以上。
[0060] 圖案光控制部27基于檢測(cè)狀態(tài)判斷部30的判斷結(jié)果，控制投光器11進(jìn)行的圖案光 32a的投射。在檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)滿足第一基準(zhǔn)而不是差的 狀態(tài)的情況下，圖案光控制部27將圖案光32a熄滅。另一方面，在檢測(cè)狀態(tài)判斷部30判斷為 多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)而是差的狀態(tài)的情況下，圖案光控制部27投射圖案 光32a。具體地，圖案光控制部27基于檢測(cè)狀態(tài)判斷部30的判斷結(jié)果，切換圖案光投射實(shí)施 標(biāo)志的0N/0FF，并對(duì)投光器1發(fā)送圖案光投射實(shí)施標(biāo)志。投光器1基于圖案光投射實(shí)施標(biāo)志， 在下面的信息處理循環(huán)中，將圖案光32a進(jìn)行投射或熄滅。
[0061] 另外，檢測(cè)狀態(tài)判斷部30判斷特征點(diǎn)檢測(cè)部23進(jìn)行的特征點(diǎn)Te3的檢測(cè)狀態(tài)是否不 滿足比第一基準(zhǔn)更低的第二基準(zhǔn)而是差的狀態(tài)。例如，在不能檢測(cè)前后幀間取得對(duì)應(yīng)的3個(gè) 以上的特征點(diǎn)的情況下，檢測(cè)狀態(tài)判斷部30判斷為特征點(diǎn)Te的檢測(cè)狀態(tài)不滿足第二基準(zhǔn)而 是差的狀態(tài)。
[0062]在檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)滿足第二基準(zhǔn)且不是差的狀 態(tài)的情況下，姿勢(shì)角計(jì)算部22不能根據(jù)圖案光32a的位置計(jì)算出距離及姿勢(shì)角。另一方面， 在檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第二基準(zhǔn)而是差的狀態(tài)的情況 下，不能根據(jù)特征點(diǎn)T e3特定平面G，因此，姿勢(shì)角計(jì)算部22根據(jù)圖案光32a的位置計(jì)算出距離 及姿勢(shì)角。
[0063]自己位置計(jì)算部26在檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)滿足第二 基準(zhǔn)的情況下，維持積分運(yùn)算的起點(diǎn)。另一方面，在檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征點(diǎn)的 檢測(cè)狀態(tài)不滿足第二基準(zhǔn)而是差的狀態(tài)的情況下，自己位置計(jì)算部26在相同的信息處理循 環(huán)中，將姿勢(shì)角計(jì)算部22(參照?qǐng)D1)計(jì)算出的距離及姿勢(shì)角及此時(shí)的車(chē)輛位置設(shè)定成新的 起點(diǎn)(車(chē)輛的姿勢(shì)角及初始位置），并從該起點(diǎn)起開(kāi)始車(chē)輛的姿勢(shì)變化量的加算。
[0064]此外，第一實(shí)施方式中，檢測(cè)狀態(tài)判斷部30基于在前后幀間取得對(duì)應(yīng)關(guān)系的特征 點(diǎn)的數(shù)量，判斷多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)，但也可以基于從1個(gè)圖像檢測(cè)出的特征點(diǎn)的總數(shù)N， 判斷多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)。即，在從1個(gè)圖像檢測(cè)出的特征點(diǎn)的總數(shù)N為規(guī)定的閾值(例如 9)以下的情況下，也可以判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)差。只要考慮檢測(cè)出的特征點(diǎn)中有 未取得對(duì)應(yīng)的特征點(diǎn)，且將規(guī)定的閾值(4)的3倍的數(shù)(12)設(shè)定成閾值即可。
[0065]計(jì)算狀態(tài)判斷部35判斷姿勢(shì)角計(jì)算部22計(jì)算距離及姿勢(shì)角的計(jì)算狀態(tài)是否不滿 足第三基準(zhǔn)而是差的狀態(tài)。例如，在圖案光照射至路面31上的臺(tái)階的情況下，路面31上的臺(tái) 階比瀝青的凹凸大，因此，距離及姿勢(shì)角的計(jì)算精度極低。在多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足 第二基準(zhǔn)而是差的狀態(tài)，且距離及姿勢(shì)角的計(jì)算狀態(tài)不滿足第三基準(zhǔn)而是差的狀態(tài)的情況 下，就沒(méi)有高精度地檢測(cè)距離及姿勢(shì)角及其變化量的手段。
[0066] 于是，計(jì)算狀態(tài)判斷部35在例如由姿勢(shì)角計(jì)算部22計(jì)算出的距離及姿勢(shì)角的標(biāo)準(zhǔn) 偏差比規(guī)定的閾值大的情況下，判斷為由姿勢(shì)角計(jì)算部22計(jì)算距離及姿勢(shì)角的計(jì)算狀態(tài)不 滿足第三基準(zhǔn)而是差的狀態(tài)。另外，在35個(gè)的光點(diǎn)中不能檢測(cè)出的光點(diǎn)的數(shù)量低于3點(diǎn)的情 況下，原則上不能求出路面31的平面方程式，因此，判斷為由姿勢(shì)角計(jì)算部22計(jì)算距離及姿 勢(shì)角的計(jì)算狀態(tài)不滿足第三基準(zhǔn)而是差的狀態(tài)。在使用最小二乘法求出平面方程式時(shí)，與 各光點(diǎn)的距離誤差的最大值的絕對(duì)值成為某個(gè)閾值(例如0.05m)以上的情況下，也可以判 斷為由姿勢(shì)角計(jì)算部22計(jì)算距離及姿勢(shì)角的計(jì)算狀態(tài)不滿足第三基準(zhǔn)而是差的狀態(tài)。
[0067] 在檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第二基準(zhǔn)而是差的狀 態(tài)，且計(jì)算狀態(tài)判斷部35判斷為由姿勢(shì)角計(jì)算部22計(jì)算距離及姿勢(shì)角的計(jì)算狀態(tài)不滿足第 三基準(zhǔn)而是差的狀態(tài)的情況下，自己位置計(jì)算部26使用之前的信息處理循環(huán)中的距離及姿 勢(shì)角及車(chē)輛的當(dāng)前位置作為積分運(yùn)算的起點(diǎn)。由此，可抑制車(chē)輛的移動(dòng)量的計(jì)算誤差。 [0068](信息處理循環(huán)）
[0069]接著，作為根據(jù)由攝像機(jī)12取得的圖像38推定車(chē)輛10的移動(dòng)量的自己位置計(jì)算方 法的一例，參照?qǐng)D7說(shuō)明由ECU13重復(fù)執(zhí)行的信息處理循環(huán)。圖7的流程圖所示的信息處理循 環(huán)在車(chē)輛10的點(diǎn)火開(kāi)關(guān)成為接通狀態(tài)且自己位置計(jì)算裝置啟動(dòng)的同時(shí)開(kāi)始，并重復(fù)執(zhí)行到 自己位置計(jì)算裝置停止。
[0070]圖7的步驟SOl中，投光器11將圖案光32a投射或熄滅。具體而言，投光器11在上一 次的信息處理循環(huán)的步驟S05,基于從圖案光控制部27發(fā)送的圖案光投射實(shí)施標(biāo)志的ON/ OFF，切換圖案光32a的投光/熄滅。參照?qǐng)D8對(duì)圖案光投射實(shí)施標(biāo)志進(jìn)行后述。
[0071]進(jìn)入步驟S03，ECU13控制攝像機(jī)12,拍攝包含投射圖案光32a的區(qū)域的車(chē)輛周?chē)?路面31，而取得圖像38 ACU13將由攝像機(jī)12取得的圖像數(shù)據(jù)存儲(chǔ)于存儲(chǔ)器中。
[0072]此外，E⑶13可自動(dòng)控制攝像機(jī)12的光圈。也可以根據(jù)之前的信息處理循環(huán)中取得 的圖像38的平均輝度，對(duì)攝像機(jī)12的光圈進(jìn)行反饋控制，以成為輝度值的最大值和最小值 的中間值。另外，投射圖案光32a的區(qū)域的輝度值較高，因此，也可以從除抽取了圖案光32a 的部分以外的區(qū)域，求出平均輝度值。
[0073]進(jìn)入步驟S05,檢測(cè)狀態(tài)判斷部30判斷多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)。圖案光控制部27基 于檢測(cè)狀態(tài)判斷部30的判斷結(jié)果切換圖案光投射實(shí)施標(biāo)志，并發(fā)送至投光器11。而且，姿勢(shì) 角計(jì)算部22基于檢測(cè)狀態(tài)判斷部30的判斷結(jié)果計(jì)算出或不計(jì)算出距離及姿勢(shì)角。步驟S05 的詳情參照?qǐng)D8及圖9進(jìn)行后述。
[0074]進(jìn)入步驟S07，ECU13根據(jù)圖像38檢測(cè)特征點(diǎn)，且抽取前后的信息處理循環(huán)之間取 得對(duì)應(yīng)的特征點(diǎn)，并根據(jù)特征點(diǎn)的圖像上的位置OJ1J1)計(jì)算出距離及姿勢(shì)角的變化量及車(chē) 輛的移動(dòng)量。
[0075]具體而言，首先，特征點(diǎn)檢測(cè)部23從存儲(chǔ)器讀取由攝像機(jī)12取得的圖像38,且從圖 像38檢測(cè)路面31上的特征點(diǎn)，并將各特征點(diǎn)的圖像上的位置(Ui、V1)存儲(chǔ)于存儲(chǔ)器。姿勢(shì)變 化量計(jì)算部24從存儲(chǔ)器讀取各特征點(diǎn)的圖像上的位置(Ui、V 1),并根據(jù)距離及姿勢(shì)角和特征 點(diǎn)的圖像上的位置OJ1J1)計(jì)算出特征點(diǎn)相對(duì)于攝像機(jī)12的相對(duì)位置(HZ 1)。此外，姿勢(shì) 變化量計(jì)算部24使用之前的信息處理循環(huán)的步驟S09中設(shè)定的起點(diǎn)（距離及姿勢(shì)角）。姿勢(shì) 變化量計(jì)算部24將特征點(diǎn)相對(duì)于攝像機(jī)12的相對(duì)位置(X i、Yi、Zi)存儲(chǔ)于存儲(chǔ)器中。
[0076]而且，姿勢(shì)變化量計(jì)算部24從存儲(chǔ)器讀取特征點(diǎn)的圖像上的位置(U1J1)和之前的 信息處理循環(huán)的步驟S07中計(jì)算出的特征點(diǎn)的相對(duì)位置(Xi、Yi、Zi)。姿勢(shì)變化量計(jì)算部24使 用前后的信息處理循環(huán)之間取得對(duì)應(yīng)的特征點(diǎn)的相對(duì)位置(X 1 JnZ1)及圖像上的位置(仏、 V1),計(jì)算出距離及姿勢(shì)角的變化量。另外，根據(jù)上一次的信息處理循環(huán)中的特征點(diǎn)的相對(duì) 位置(X 1U1)和此次的信息處理循環(huán)中的特征點(diǎn)的相對(duì)位置(HZ1),計(jì)算出車(chē)輛的移 動(dòng)量。步驟S07中計(jì)算出的"距離及姿勢(shì)角的變化量"及"車(chē)輛的移動(dòng)量"在步驟Sll的處理中 使用。
[0077]進(jìn)入步驟S09，ECU13根據(jù)多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)及圖案光的距離及姿勢(shì)角的計(jì)算 狀態(tài)，設(shè)定積分運(yùn)算的起點(diǎn)。詳情參照?qǐng)D10進(jìn)行后述。
[0078] 進(jìn)入步驟Sll，自己位置計(jì)算部26根據(jù)步驟S09的處理中設(shè)定的積分運(yùn)算的起點(diǎn)、 及步驟S07的處理中計(jì)算出的"距離及姿勢(shì)角的變化量"及"車(chē)輛的移動(dòng)量"，計(jì)算出距離及 姿勢(shì)角、及車(chē)輛的當(dāng)前位置。
[0079]這樣，本實(shí)施方式的自己位置計(jì)算裝置通過(guò)重復(fù)執(zhí)行上述的一連串的信息處理循 環(huán)并累計(jì)車(chē)輛10的移動(dòng)量，可以計(jì)算出車(chē)輛10的當(dāng)前位置。
[0080]參照?qǐng)D8的流程，說(shuō)明圖7的步驟S05的詳細(xì)順序。首先，在步驟S501中，檢測(cè)狀態(tài)判 斷部30判斷是否檢測(cè)有4個(gè)以上的前后幀間取得對(duì)應(yīng)的特征點(diǎn)。在檢測(cè)有4個(gè)以上特征點(diǎn)的 情況下（S501中，是），根據(jù)特征點(diǎn)的時(shí)間變化可計(jì)算出距離及姿勢(shì)角的變化量。于是，進(jìn)入 步驟S505,圖案光控制部27將圖案光投射實(shí)施標(biāo)志設(shè)定成OFF狀態(tài)，且發(fā)送至投光器11。然 后，不根據(jù)圖案光32a的位置計(jì)算出距離及姿勢(shì)角，并進(jìn)入圖7的步驟S07。
[0081]另一方面，在未檢測(cè)4個(gè)以上特征點(diǎn)的情況下（S501中，否），判斷為多個(gè)特征點(diǎn)的 檢測(cè)狀態(tài)不滿足第一基準(zhǔn)而是差的狀態(tài)，因此，進(jìn)入步驟S503。而且，圖案光控制部27將圖 案光投射實(shí)施標(biāo)志設(shè)定成ON狀態(tài)，并發(fā)送至投光器11。然后，進(jìn)入步驟S507。
[0082]步驟S507中，檢測(cè)狀態(tài)判斷部30判斷是否檢測(cè)有3個(gè)以上的前后幀間取得對(duì)應(yīng)的 特征點(diǎn)。在檢測(cè)有3個(gè)以上特征點(diǎn)的情況下（S507中，是），根據(jù)特征點(diǎn)的時(shí)間變化可計(jì)算出 距離及姿勢(shì)角的變化量。因此，不根據(jù)圖案光32a的位置計(jì)算出距離及姿勢(shì)角，進(jìn)入圖7的步 驟 S07。
[0083]另一方面，在未檢測(cè)有3個(gè)以上特征點(diǎn)的情況下（S507中，否），不能根據(jù)特征點(diǎn)的 時(shí)間變化計(jì)算出距離及姿勢(shì)角的變化量。因此，進(jìn)入步驟S509,姿勢(shì)角計(jì)算部22根據(jù)圖案光 32a的位置計(jì)算出距離及姿勢(shì)角。然后，進(jìn)入圖7的步驟S07。
[0084]步驟S509中，首先，圖案光抽取部21從存儲(chǔ)器讀取由攝像機(jī)12取得的圖像38,如圖 4(c)所示，從圖像38抽取圖案光32a的位置。圖案光抽取部21將作為表示圖案光32a的位置 的數(shù)據(jù)計(jì)算出的光點(diǎn)&的圖像上的坐標(biāo)(山、％)存儲(chǔ)于存儲(chǔ)器中。
[0085]姿勢(shì)角計(jì)算部22從存儲(chǔ)器讀取表示圖案光32a的位置的數(shù)據(jù)，根據(jù)圖案光32a的位 置計(jì)算出距離及姿勢(shì)角，并存儲(chǔ)于存儲(chǔ)器中。
[0086]參照?qǐng)D9說(shuō)明按照?qǐng)D8的流程執(zhí)行的信息處理的一例。圖9(a)表示姿勢(shì)角計(jì)算部22 是否根據(jù)圖案光32a計(jì)算出距離及姿勢(shì)角，圖9(b)表示圖案光投射實(shí)施標(biāo)志的狀態(tài)，圖9(c) 表示取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量。圖9 (a)~（c)的橫軸表示時(shí)間的經(jīng)過(guò)，t0、11、t2、......表示 信息處理循環(huán)（以后，均簡(jiǎn)稱(chēng)為"循環(huán)"）。
[0087]循環(huán)t0~t3中，取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量為4個(gè)以上，因此，圖案光投射實(shí)施標(biāo)志 為OFF狀態(tài)，"三維測(cè)量實(shí)施標(biāo)志"也為OFF狀態(tài)。如果"三維測(cè)量實(shí)施標(biāo)志"為OFF狀態(tài)，則姿 勢(shì)角計(jì)算部22不根據(jù)圖案光32a計(jì)算出距離及姿勢(shì)角。循環(huán)t4~t6中，取得對(duì)應(yīng)的特征點(diǎn)的 數(shù)量成為3個(gè)時(shí)，圖8的步驟S501判斷為否，步驟S503中圖案光投射實(shí)施標(biāo)志成為ON狀態(tài)，但 在步驟S507中判斷為是，因此，三維測(cè)量實(shí)施標(biāo)志仍為OFF狀態(tài)。循環(huán)t7~tlO中取得對(duì)應(yīng)的 特征點(diǎn)的數(shù)量成為4個(gè)以上時(shí)，圖案光投射實(shí)施標(biāo)志成為OFF狀態(tài)。循環(huán)112~114中，取得對(duì) 應(yīng)的特征點(diǎn)的數(shù)量成為低于3個(gè)，因此，步驟S501及S507中均判斷為否，因此，圖案光投射實(shí) 施標(biāo)志及三維測(cè)量實(shí)施標(biāo)志成為ON狀態(tài)，實(shí)施利用姿勢(shì)角計(jì)算部22進(jìn)行距離及姿勢(shì)角的計(jì) 算。
[0088] 參照?qǐng)D10的流程說(shuō)明圖7的步驟S09的詳細(xì)順序。步驟S900中，E⑶13判斷此次的信 息處理循環(huán)是否為初次。而且，在為初次的情況下，即在沒(méi)有上一次的信息處理循環(huán)的數(shù)據(jù) 的情況下，將處理進(jìn)入步驟S905，在不是初次的情況下，將處理進(jìn)入步驟S901。
[0089]步驟S901中，檢測(cè)狀態(tài)判斷部30判斷由特征點(diǎn)檢測(cè)部23檢測(cè)的特征點(diǎn)Te的檢測(cè)狀 態(tài)是否不滿足第二基準(zhǔn)而是差的狀態(tài)。即，如與圖8的步驟S507相同，判斷取得對(duì)應(yīng)的特征 點(diǎn)Te的數(shù)是否為3個(gè)以上。在判斷為不是3個(gè)以上的情況下（步驟S901中為是），進(jìn)入步驟 S903,在判斷為3個(gè)以上的情況下(步驟S901中為否），進(jìn)入步驟S909。
[0090] 步驟S909中，E⑶13維持當(dāng)前設(shè)定的積分運(yùn)算的起點(diǎn)。
[0091] 步驟S903中，計(jì)算狀態(tài)判斷部35判斷由姿勢(shì)角計(jì)算部22計(jì)算距離及姿勢(shì)角的計(jì)算 狀態(tài)是否不滿足第三基準(zhǔn)而是差的狀態(tài)。例如在相同的信息處理循環(huán)的步驟S509中判斷距 離及姿勢(shì)角的計(jì)算是否成功。在判斷為成功的情況下(步驟S903中為是），進(jìn)入步驟S905,在 判斷為不成功的情況下(步驟S903中為否），進(jìn)入步驟S907。
[0092] 步驟S905中，E⑶13將步驟S509中由姿勢(shì)角計(jì)算部22計(jì)算出的距離及姿勢(shì)角、及此 時(shí)的車(chē)輛的當(dāng)前位置設(shè)定為積分運(yùn)算的起點(diǎn)。以該距離及姿勢(shì)角為起點(diǎn)開(kāi)始新的積分運(yùn) 算。另外，以車(chē)輛的當(dāng)前位置為起點(diǎn)開(kāi)始新的積分運(yùn)算。
[0093]步驟S907中，E⑶13將上一次的信息處理循環(huán)中采用的距離及姿勢(shì)角、及上一次的 信息處理循環(huán)中的車(chē)輛的當(dāng)前位置設(shè)定為積分運(yùn)算的起點(diǎn)。以該距離及姿勢(shì)角為起點(diǎn)開(kāi)始 新的積分運(yùn)算。另外，以車(chē)輛的當(dāng)前位置為起點(diǎn)開(kāi)始新的積分運(yùn)算。然后，使處理進(jìn)入圖8的 步驟Sll。
[0094]如以上說(shuō)明，根據(jù)第一實(shí)施方式，可得到以下的作用效果。
[0095]當(dāng)多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)差時(shí)，由姿勢(shì)變化量計(jì)算部24計(jì)算出的距離及姿勢(shì)角的 計(jì)算精度降低，因此，車(chē)輛10的移動(dòng)量的推定誤差變大。圖11(a)及圖11(b)是表示車(chē)輛10的 側(cè)滾角(姿勢(shì)角的一例)及移動(dòng)量(車(chē)寬方向）的推定誤差的例子的圖，表示車(chē)輛10在無(wú)傾斜 的平坦的路面上以一定的速度直行時(shí)的、側(cè)滾角的推定值及移動(dòng)量的計(jì)算值的時(shí)間變化。 圖中的 uP1 "及"p2"表示不管多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)如何，均維持移動(dòng)量計(jì)算的起點(diǎn)及距離 及姿勢(shì)角的積分運(yùn)算的起點(diǎn)的比較例。"Qi"及"Q 2"表示真實(shí)值。車(chē)輛10進(jìn)行直行，因此，側(cè)滾 角及車(chē)寬方向的移動(dòng)量的真實(shí)值(Qi、Q2)為保持為0的狀態(tài)。但是，在時(shí)刻tl~t2之間，由于 在多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)差的混凝土路面行駛，因此，路面的平面方程式中產(chǎn)生誤差，側(cè)滾 角中出現(xiàn)推定誤差。側(cè)滾角的誤差會(huì)作為車(chē)寬方向的移動(dòng)量的誤差反映。比較例中，根據(jù)多 個(gè)特征點(diǎn)的檢測(cè)狀態(tài)，不能將移動(dòng)量計(jì)算的起點(diǎn)及側(cè)滾角的積分運(yùn)算的起點(diǎn)重置至根據(jù)圖 案光32a計(jì)算出的距離及姿勢(shì)角、及此時(shí)的車(chē)輛的當(dāng)前位置。因此，車(chē)輛10的移動(dòng)量的誤差 會(huì)擴(kuò)大。
[0096]根據(jù)第一實(shí)施方式，在檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第 一基準(zhǔn)而是差的狀態(tài)的情況下(步驟S501中為否），圖案光控制部27投射圖案光32a。由此， 可以根據(jù)圖案光32a的位置計(jì)算出距離及姿勢(shì)角。因此，以根據(jù)圖案光32a計(jì)算出的誤差較 小的距離及姿勢(shì)角為起點(diǎn)，可重新開(kāi)始積分運(yùn)算。因此，可以高精度且穩(wěn)定地推定車(chē)輛10的 當(dāng)前位置。
[0097]另外，多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)變差的路面包含例如成為特征點(diǎn)的對(duì)象的狀況或凹 凸較少的路面。狀況或凹凸較少的路面的平坦性較高，因此，根據(jù)圖案光32a計(jì)算出的距離 及姿勢(shì)角所包含的噪聲成分較少。另一方面，在多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)良好的路面31，由于 瀝青的凹凸，圖案光32a的反射位置不穩(wěn)定，因此，根據(jù)圖案光32a計(jì)算出的距離及姿勢(shì)角包 含較多的噪聲成分。根據(jù)第一實(shí)施方式，可以根據(jù)多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)，適當(dāng)?shù)胤譃槭褂?了特征點(diǎn)的距離及姿勢(shì)角的更新和使用了圖案光32a的距離及姿勢(shì)角的計(jì)算，并高精度且 穩(wěn)定地求出距離及姿勢(shì)角。
[0098]另外，由于路面31的照度的急劇變化，有時(shí)圖像38的對(duì)比度降低，且多個(gè)特征點(diǎn)的 檢測(cè)狀態(tài)變差。根據(jù)第一實(shí)施方式，通過(guò)直接判斷多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)，不需要額外設(shè)置 照度計(jì)等傳感器，可減少成本，且有助于裝置的輕量化。
[0099]根據(jù)第一實(shí)施方式，在檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)滿足第一 基準(zhǔn)而不是差的狀態(tài)的情況下(步驟S501中為是），圖案光控制部27停止圖案光32a的投射。 僅在多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)而是差的狀態(tài)的情況下可以投射圖案光32a， 因此，可以?xún)H在需要的情況下投射圖案光32a，并抑制投光所需要的耗電量。
[0100] 圖7的步驟S05中的圖案光32a的投光及熄滅（步驟S503、S505)的判斷在下面的信 息處理步驟的步驟SOl中反映。因此，為了使用圖案光32a計(jì)算出距離及姿勢(shì)角，需要預(yù)先在 之前的循環(huán)中將圖案光投射實(shí)施標(biāo)志切換成ON狀態(tài)。于是，第一實(shí)施方式中，如果是多個(gè)特 征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)而是差的狀態(tài)，則將圖案光投射實(shí)施標(biāo)志切換成ON狀態(tài) (S05)。在其下面的循環(huán)中，投射圖案光32a(S01)。而且，在相同的循環(huán)中，在多個(gè)特征點(diǎn)的 檢測(cè)狀態(tài)不滿足第二基準(zhǔn)而是差的狀態(tài)的情況下(S507中為否），姿勢(shì)角計(jì)算部22可以根據(jù) 圖案光32a的位置計(jì)算出距離及姿勢(shì)角。這樣，通過(guò)使用兩個(gè)基準(zhǔn)(第一基準(zhǔn)，第二基準(zhǔn))判 斷多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)，可以適當(dāng)?shù)乜刂茍D案光32a的投光時(shí)間及距離及姿勢(shì)角的計(jì)算 時(shí)間。
[0101] (第二實(shí)施方式）
[0102] 第二實(shí)施方式中，說(shuō)明根據(jù)從開(kāi)始圖案光32a的投射起的經(jīng)過(guò)時(shí)間控制使用了圖 案光32a的距離及姿勢(shì)角的計(jì)算時(shí)間的例子。第二實(shí)施方式的自己位置計(jì)算裝置的硬件構(gòu) 成如圖1所示，因此，省略說(shuō)明。另外，由ECU13重復(fù)執(zhí)行的信息處理循環(huán)除了步驟S05之外， 也如圖7所示那樣，因此，省略說(shuō)明。后述的第三及第四實(shí)施方式也同樣。
[0103] 參照?qǐng)D12說(shuō)明第二實(shí)施方式的步驟S05的詳細(xì)順序。圖12所示的流程中，代替圖8 的步驟S507,而實(shí)施步驟S511。其它步驟與圖8相同，而省略說(shuō)明。ECU13測(cè)量從開(kāi)始圖案光 32a的投射起的經(jīng)過(guò)時(shí)間。
[0104]具體而言，E⑶13在步驟S503中測(cè)量從將圖案光投射實(shí)施標(biāo)志從OFF狀態(tài)切換至ON 狀態(tài)起的經(jīng)過(guò)時(shí)間。步驟S511中，ECU13判斷從切換圖案光投射實(shí)施標(biāo)志起是否經(jīng)過(guò)第一規(guī) 定時(shí)間。如果未經(jīng)過(guò)第一規(guī)定時(shí)間（S511中為否），則不根據(jù)圖案光32a的位置計(jì)算出距離及 姿勢(shì)角，而進(jìn)入步驟S07。另一方面，如果經(jīng)過(guò)第一規(guī)定時(shí)間（S511中為是），則進(jìn)入步驟 S509,根據(jù)圖案光32a的位置計(jì)算出距離及姿勢(shì)角，然后，進(jìn)入步驟S07。
[0105] 此外，第一規(guī)定時(shí)間例如圖13所示，可以設(shè)定兩次的信息處理循環(huán)(Dl)。即，將圖 案光投射實(shí)施標(biāo)志從OFF狀態(tài)切換至ON狀態(tài)的信息處理循環(huán)（til)及下一次的信息處理循 環(huán)(tl2)中，不計(jì)算出距離及姿勢(shì)角(在S511中為否），或者在下一次(第二次)的信息處理循 環(huán)(tl3)中，首次計(jì)算出距離及姿勢(shì)角(S511中為是，S509)。
[0106] 如之前敘述，為了使用圖案光32a計(jì)算出距離及姿勢(shì)角，需要預(yù)先在之前的循環(huán)中 將圖案光投射實(shí)施標(biāo)志切換成ON狀態(tài)。第二實(shí)施方式中，圖案光控制部27從開(kāi)始圖案光32a 的投射起經(jīng)過(guò)第一規(guī)定時(shí)間(Dl)之后，姿勢(shì)角計(jì)算部22開(kāi)始根據(jù)圖案光32a的位置計(jì)算出 距離及姿勢(shì)角。由此，可以適當(dāng)?shù)乜刂茍D案光32a的投光時(shí)間及距離及姿勢(shì)角的計(jì)算時(shí)間。
[0107] (第三實(shí)施方式）
[0108] 第三實(shí)施方式中，說(shuō)明如下例子，即，在開(kāi)始圖案光32a的投射后，即使判斷為多個(gè) 特征點(diǎn)的檢測(cè)狀態(tài)滿足第一基準(zhǔn)且不是差的狀態(tài)，也將圖案光32a的投射從該判斷起繼續(xù) 到經(jīng)過(guò)第二規(guī)定時(shí)間為止。
[0109] 在檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)是不比第一基準(zhǔn)差的情況下， 圖案光控制部27在從檢測(cè)狀態(tài)判斷部30判斷起經(jīng)過(guò)第二規(guī)定時(shí)間之后，停止圖案光32a的 投射。
[0110] 參照?qǐng)D14說(shuō)明第三實(shí)施方式的步驟S05的詳細(xì)順序。相對(duì)于圖8,圖14所示的流程 還具備步驟S513及步驟S515。其它步驟與圖8相同而省略說(shuō)明。
[0111] ECU13測(cè)量從判斷為取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量為4個(gè)以上起的經(jīng)過(guò)時(shí)間。在判斷為 取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量為4個(gè)以上的情況下（S501中為是），進(jìn)入步驟S513，ECUl 3判斷為 取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量為4個(gè)以上后，判斷是否經(jīng)過(guò)第二規(guī)定時(shí)間。如果經(jīng)過(guò)第二規(guī)定時(shí) 間（S513中為是），則進(jìn)入步驟S505,圖案光控制部27將圖案光投射實(shí)施標(biāo)志從ON狀態(tài)向OFF 狀態(tài)切換。另一方面，如果未經(jīng)過(guò)第二規(guī)定時(shí)間（S513中為否），則進(jìn)入步驟S515,圖案光控 制部27將圖案光投射實(shí)施標(biāo)志維持成ON狀態(tài)。
[0112] 此外，第二規(guī)定時(shí)間例如圖15所示，可以設(shè)定兩次的信息處理循環(huán)(D2)。即，取得 對(duì)應(yīng)的特征點(diǎn)的數(shù)量成為4個(gè)以上的信息處理循環(huán)(t6、tl4)及下一次的信息處理循環(huán)(t7、 tl5)中將圖案光投射實(shí)施標(biāo)志維持成ON狀態(tài)(S513中為否，S515)，且在下一次(第二次）的 信息處理循環(huán)（t8、tl6)中，首次將圖案光投射實(shí)施標(biāo)志切換成OFF狀態(tài)（S513中為是， S505)〇
[0113] 由此，如果暫時(shí)開(kāi)始圖案光32a的投射，則之后即使改善多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)， 圖案光32a也不立即熄滅。即，圖案光32a的投光狀態(tài)中可以具有滯后(滯后效應(yīng)），因此，可 以抑制圖案光32a的閃爍，且減輕閃爍引起的煩惱。
[0114](第四實(shí)施方式）
[0115] 第四實(shí)施方式中，與第三實(shí)施方式對(duì)稱(chēng)地說(shuō)明圖案光32a的熄滅狀態(tài)中具有滯后 的例子。在使圖案光32a熄滅后，即使多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)而變差，從該 判斷起圖案光控制部27也將圖案光32a的熄滅繼續(xù)到經(jīng)過(guò)第三規(guī)定時(shí)間。在檢測(cè)狀態(tài)判斷 部30判斷為多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)而是差的狀態(tài)的情況下，圖案光控制部 27在從檢測(cè)狀態(tài)判斷部30判斷起經(jīng)過(guò)第三規(guī)定時(shí)間之后，開(kāi)始圖案光32a的投光(投射）。
[0116] 參照?qǐng)D16說(shuō)明與第四實(shí)施方式相關(guān)的步驟S05的詳細(xì)順序。相對(duì)于圖8,圖16所示 的流程還具備步驟S517。另外，步驟S501中，判斷取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量是否為5個(gè)以上。 即，在取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量不是5個(gè)以上的情況下，檢測(cè)狀態(tài)判斷部30判斷為多個(gè)特征 點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)而是差的狀態(tài)。其它步驟與圖8相同并省略說(shuō)明。
[0117] ECU13測(cè)量從判斷為取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量不是5個(gè)以上起的經(jīng)過(guò)時(shí)間。在判斷 為取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量不是5個(gè)以上的情況下（S501中為否），進(jìn)入步驟S517，ECU13判 斷為取得對(duì)應(yīng)的特征點(diǎn)的數(shù)量不是5個(gè)以上后，判斷是否經(jīng)過(guò)第三規(guī)定時(shí)間。如果經(jīng)過(guò)第三 規(guī)定時(shí)間（S517中為是），則進(jìn)入步驟S503,圖案光控制部27將圖案光投射實(shí)施標(biāo)志切換成 ON狀態(tài)。另一方面，如果未經(jīng)過(guò)第三規(guī)定時(shí)間（S517中為否），則進(jìn)入步驟S505,圖案光控制 部27將圖案光投射實(shí)施標(biāo)志維持成OFF狀態(tài)。
[0118]此外，第三規(guī)定時(shí)間可以如例如圖17所示設(shè)定兩次的信息處理循環(huán)(D3)。即，取得 對(duì)應(yīng)的特征點(diǎn)的數(shù)量低于5個(gè)的信息處理循環(huán)(t2、t9)及下一次的信息處理循環(huán)（t3、tl0) 中，將圖案光投射實(shí)施標(biāo)志維持成OFF狀態(tài)(S517中為否，S505)，且在下一次(第二次）的信 息處理循環(huán)(t4、tll)中，首次將圖案光投射實(shí)施標(biāo)志切換成ON狀態(tài)(S517中為是，S503)。
[0119]由此，如果暫時(shí)停止圖案光32a的投射，則之后，即使多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)惡化， 也立即不開(kāi)始圖案光32a的投射。即，圖案光32a的熄滅狀態(tài)中可以具有滯后(滯后效應(yīng)），因 此，可以抑制圖案光32a的閃爍，并減少閃爍產(chǎn)生的煩惱。
[0120] 如上所述，記載了本發(fā)明的第一~第四實(shí)施方式，但不應(yīng)理解為形成該公開(kāi)的一 部分的論述及附圖限定于本發(fā)明。根據(jù)本公開(kāi)內(nèi)容，對(duì)于本領(lǐng)域技術(shù)人員來(lái)說(shuō)，可知有各種 代替實(shí)施方式、實(shí)施例及運(yùn)用技術(shù)。
[0121] 圖2表示將攝像機(jī)12和投光器11安裝于車(chē)輛10的前面的例子，但也可以朝向車(chē)輛 10的側(cè)方、后方、正下方設(shè)置。另外，本實(shí)施方式中，作為車(chē)輛10的一例，圖2中表示了四輪的 乘用車(chē)，但可以適用于摩托車(chē)、貨車(chē)、或例如搬運(yùn)工程機(jī)械的特殊車(chē)輛等、可拍攝道路的路 面或壁面上的特征點(diǎn)的全部移動(dòng)體(車(chē)輛）。
[0122] 符號(hào)說(shuō)明
[0123] 10 車(chē)輛
[0124] 11投光器
[0125] 12攝像機(jī)(攝像部）
[0126] 21圖案光抽取部
[0127] 22姿勢(shì)角計(jì)算部
[0128] 23特征點(diǎn)檢測(cè)部
[0129] 24姿勢(shì)變化量計(jì)算部
[0130] 26自己位置計(jì)算部
[0131] 27圖案光控制部
[0132] 30檢測(cè)狀態(tài)判斷部
[0133] 31 路面
[0134] 32a、32b 圖案光
[0135] 35計(jì)算狀態(tài)判斷部
[0136] Te特征點(diǎn)
【主權(quán)項(xiàng)】
1. 一種自己位置計(jì)算裝置，其特征在于，具備： 投光器，其向車(chē)輛周?chē)穆访嫱渡鋱D案光； 攝像部，其搭載于所述車(chē)輛，拍攝包含投射圖案光的區(qū)域在內(nèi)的車(chē)輛周?chē)穆访娌⑷?得圖像； 姿勢(shì)角計(jì)算部，其根據(jù)由所述攝像部取得的圖像中的所述圖案光的位置，計(jì)算出車(chē)輛 相對(duì)于所述路面的姿勢(shì)角； 姿勢(shì)變化量計(jì)算部，其基于根據(jù)由所述攝像部取得的圖像檢測(cè)出的所述路面上的多個(gè) 特征點(diǎn)的時(shí)間變化，計(jì)算出所述車(chē)輛的姿勢(shì)變化量； 自己位置計(jì)算部，其通過(guò)在所述車(chē)輛的初始位置及姿勢(shì)角加上所述姿勢(shì)變化量，計(jì)算 出所述車(chē)輛的當(dāng)前位置及姿勢(shì)角； 檢測(cè)狀態(tài)判斷部，其判斷所述姿勢(shì)變化量計(jì)算部中的所述多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)； 圖案光控制部，其控制所述投光器進(jìn)行的圖案光的投射， 在所述檢測(cè)狀態(tài)判斷部判斷為所述多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)的情況下， 所述圖案光控制部投射圖案光。2. 如權(quán)利要求1所述的自己位置計(jì)算裝置，其特征在于， 在所述檢測(cè)狀態(tài)判斷部判斷為所述多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)滿足第一基準(zhǔn)的情況下，所 述圖案光控制部停止圖案光的投射。3. 如權(quán)利要求1或2所述的自己位置計(jì)算裝置，其特征在于， 在所述檢測(cè)狀態(tài)判斷部判斷為所述多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足比所述第一基準(zhǔn)低 的第二基準(zhǔn)的情況下，所述姿勢(shì)角計(jì)算部根據(jù)所述圖案光的位置計(jì)算出車(chē)輛相對(duì)于所述路 面的姿勢(shì)角。4. 如權(quán)利要求1或2所述的自己位置計(jì)算裝置，其特征在于， 從所述圖案光控制部開(kāi)始圖案光的投射起，經(jīng)過(guò)第一規(guī)定時(shí)間之后，所述姿勢(shì)角計(jì)算 部根據(jù)所述圖案光的位置開(kāi)始計(jì)算出車(chē)輛相對(duì)于所述路面的姿勢(shì)角。5. 如權(quán)利要求1~4中任一項(xiàng)所述的自己位置計(jì)算裝置，其特征在于， 在所述檢測(cè)狀態(tài)判斷部判斷為所述多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)的情況下， 所述圖案光控制部在從所述檢測(cè)狀態(tài)判斷部進(jìn)行判斷起經(jīng)過(guò)第二規(guī)定時(shí)間之后，停止圖案 光的投射。6. 如權(quán)利要求1~4中任一項(xiàng)所述的自己位置計(jì)算裝置，其特征在于， 在所述檢測(cè)狀態(tài)判斷部判斷為所述多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)的情況下， 所述圖案光控制部在從所述檢測(cè)狀態(tài)判斷部進(jìn)行判斷起經(jīng)過(guò)第三規(guī)定時(shí)間之后，開(kāi)始圖案 光的投射。7. -種自己位置計(jì)算方法， 向車(chē)輛周?chē)穆访嫱渡鋱D案光， 拍攝包含投射所述圖案光的區(qū)域在內(nèi)的車(chē)輛周?chē)穆访妫⑷〉脠D像， 根據(jù)所述圖像中的所述圖案光的位置，計(jì)算出車(chē)輛相對(duì)于所述路面的姿勢(shì)角， 基于根據(jù)所述圖像檢測(cè)出的所述路面上的多個(gè)特征點(diǎn)的時(shí)間變化，計(jì)算出所述車(chē)輛的 姿勢(shì)變化量， 通過(guò)在所述車(chē)輛的初始位置及姿勢(shì)角加上所述姿勢(shì)變化量，計(jì)算出所述車(chē)輛的當(dāng)前位 置及姿勢(shì)角， 其特征在于， 在判斷為所述多個(gè)特征點(diǎn)的檢測(cè)狀態(tài)不滿足第一基準(zhǔn)的情況下，投射所述圖案光。
【文檔編號(hào)】G08G1/16GK106062849SQ201480076204
【公開(kāi)日】2016年10月26日
【申請(qǐng)日】2014年2月24日
【發(fā)明人】山口郎, 山口一郎, 西內(nèi)秀和
【申請(qǐng)人】日產(chǎn)自動(dòng)車(chē)株式會(huì)社