一種車道線精確位置采集裝置以及采集方法
【技術(shù)領(lǐng)域】
[0001] 本發(fā)明涉及信號傳感和位置采集領(lǐng)域，具體來講，是一種車道線精確位置采集裝 置以及采集方法。
【背景技術(shù)】
[0002] 隨著電子及信息技術(shù)對交通應(yīng)用的不斷滲透，人們對道路交通車輛行駛位置精度 的要求越來越高，目前道路基礎(chǔ)數(shù)據(jù)的采集方法及技術(shù)難以適應(yīng)新的需求，主要體現(xiàn)在采 集精度、效率和成本之間的矛盾。
[0003]目前已知的相關(guān)技術(shù)，車道線的識別基本都是通過攝像頭獲取前方的道路信息， 通過算法對車道線進(jìn)行識別，這種方式導(dǎo)致了整個系統(tǒng)結(jié)構(gòu)復(fù)雜，成本高昂，并且只能識 另Il，不能定位。
[0004] 專利1 "車道線識別方法及裝置"、申請?zhí)?01310269099. 0,該專利通過分析攝像 頭影像來識別車道線的，該方法結(jié)構(gòu)復(fù)雜，成本高，并且只能對車道線進(jìn)行識別，不能對車 道線進(jìn)行定位。
[0005] 專利2 "基于單目視覺和慣性導(dǎo)航單元的實(shí)時車道線檢系統(tǒng)"、申請?zhí)?201410129551. 8,該專利只有慣性導(dǎo)航，只能定位車輛位置，無法精確定位車道線位置。

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

[0006] 為了解決上述問題，本發(fā)明將車道線識別與導(dǎo)航技術(shù)結(jié)合，導(dǎo)航部分為 GPS(Global Positioning System)導(dǎo)航和慣性導(dǎo)航相結(jié)合，通過算法能夠精確的實(shí)時定位 車道線的經(jīng)煒度、高度信息。為此，本發(fā)明提出了一種利用慣性導(dǎo)航傳感單元、差分導(dǎo)航、車 道線感應(yīng)裝置，并融合車輛本身車速、輪速、轉(zhuǎn)向等數(shù)據(jù)實(shí)現(xiàn)對車道線的高精度、低成本、高 效率的采集裝置及采集方法。采用的技術(shù)方案如下：
[0007] -種車道線精確位置采集裝置，包括傳感器單元、導(dǎo)航單元、無線電收發(fā)基站、控 制單元；
[0008] 所述傳感器單元包括車道線識別傳感器、車速傳感器以及方向盤轉(zhuǎn)角傳感器；所 述車道線識別傳感器、所述車速傳感器以及所述方向盤轉(zhuǎn)角傳感器均與所述控制單元相連 接；
[0009] 所述導(dǎo)航單元包括慣性導(dǎo)航傳感器、導(dǎo)航天線以及導(dǎo)航接收機(jī)；所述慣性導(dǎo)航傳 感器、所述導(dǎo)航天線以及所述導(dǎo)航接收機(jī)均與所述控制單元相連接；
[0010] 所述無線電收發(fā)基站將車輛位置差分信息發(fā)射給所述導(dǎo)航天線，所述導(dǎo)航天線將 接收的差分信息送給所述導(dǎo)航接收機(jī)，所述導(dǎo)航接收機(jī)以串行通信方式將差分信息發(fā)送給 控制單元處理；
[0011] 所述控制單元包括中央處理器和外圍電路；所述控制單元用于對所述導(dǎo)航接收 機(jī)、所述慣性導(dǎo)航傳感器、所述車道線識別傳感器、所述車速傳感器、所述方向盤轉(zhuǎn)角傳感 器發(fā)送過來的信息進(jìn)行記錄和綜合處理，計(jì)算出車道線的經(jīng)煒度值及海拔高度值。
[0012] 作為優(yōu)選，所述車道線識別傳感器的個數(shù)為5個，5個車道線識別傳感器均固定在 安裝板上、并且排成一條直線，5個車道線識別傳感器中每相鄰兩者之間設(shè)有隔板、并且相 鄰兩者之間的距離t均相等；所述安裝板的一端通過剛性支架水平安裝在車身中部，所述 安裝板上5個車道線識別傳感器與所述慣性導(dǎo)航傳感器之間的連線與車身縱軸線垂直，所 述安裝板突出于車身一側(cè)。
[0013] 作為優(yōu)選，所述車道線識別傳感器為RGB三原色顏色識別傳感器。
[0014] 作為優(yōu)選，所述安裝板為矩形，5個車道線識別傳感器排成的直線與所述矩形長邊 平行，5個車道線識別傳感器中相鄰兩者之間的距離t = (B+BD/2,其中，B為車道標(biāo)線線 寬，Bl為雙標(biāo)線的兩條線之間的橫向間距。
[0015] 作為優(yōu)選，所述安裝板四周設(shè)有遮光部件，所述遮光部件分為兩層，所述遮光部件 的內(nèi)層為柔性遮光部件、所述遮光部件的外層設(shè)為掃路刷。
[0016] 基于上述裝置，本發(fā)明還提出了一種車道線精確位置采集方法，包括如下步驟：
[0017] 步驟1，設(shè)置中間車道線識別傳感器III與路面車道標(biāo)線的位置關(guān)系；
[0018] 步驟2,設(shè)置車道線識別傳感器識別車道線的判斷標(biāo)準(zhǔn)；
[0019] 步驟3,根據(jù)慣性導(dǎo)航傳感器的經(jīng)度、煒度和航向角，計(jì)算車道線識別傳感器的經(jīng) 度、煒度和航向角；
[0020] 步驟4,根據(jù)方向盤轉(zhuǎn)角傳感器提供的方向盤轉(zhuǎn)角δ f，計(jì)算穩(wěn)態(tài)橫擺角速度
:其中，u為車輛行駛速度；L為汽車軸距，單位為m ;K為穩(wěn)定性因數(shù)，單位為 s2/m2; δ = Κ' δ f，其中Κ'為車輪轉(zhuǎn)角與方向盤轉(zhuǎn)角的比例系數(shù)；
[0021] 步驟5,在一個定位周期T內(nèi)取若干個時間點(diǎn)，實(shí)時測量車輛行駛速度u，結(jié)合步驟 4中的關(guān)系式計(jì)算所述若干個時間點(diǎn)對應(yīng)的慣性導(dǎo)航傳感器所處位置的經(jīng)度、煒度和航向 角，再根據(jù)步驟3計(jì)算若干個時間點(diǎn)對應(yīng)的車道線識別傳感器的經(jīng)度、煒度和航向角；
[0022] 步驟6,判斷車道線為單車道線還是雙車道線，根據(jù)步驟3至步驟5計(jì)算出單車道 線或雙車道線軌跡；
[0023] 步驟7,判斷車道線為虛線還是實(shí)線，根據(jù)步驟3至步驟5計(jì)算虛線或?qū)嵕€軌跡；
[0024] 步驟8,重復(fù)步驟3至步驟7,實(shí)時精確計(jì)算各種車道線的位置。
[0025] 進(jìn)一步，所述步驟7中所述虛線的軌跡計(jì)算包括計(jì)算實(shí)線長度和空格長度，具體 為：從車道線突然消失的時間點(diǎn)起到車道線再次出現(xiàn)所經(jīng)過的時間為t x，這段時間車輛行 駛的距離為
，則Sx即為空格長度，從車道線出現(xiàn)到再次消失所經(jīng)歷的時間為t。， 這段時間車輛行駛的距離為
，則s。即為實(shí)線長度。
[0026] 進(jìn)一步，所述步驟1中所述的位置關(guān)系具體為：
[0027] 若為單標(biāo)線車道，中間的車道線識別傳感器III剛好處于車道線中間；若為雙標(biāo)線 車道，中間的車道線識別傳感器III剛好處于車輛前進(jìn)方向兩條標(biāo)線之間的正中間位置。
[0028] 進(jìn)一步，所述步驟2中的判斷標(biāo)準(zhǔn)為：當(dāng)三原色值R〈 = 126, G〈 = 126, B〈 = 126 同時成立時，判定為普通路面；其余情況均判定為車道標(biāo)線。
[0029] 和現(xiàn)有技術(shù)相比，本發(fā)明的有益效果：
[0030] 本發(fā)明利用在車輛中部與慣性導(dǎo)航傳感器對齊的顏色傳感器，能夠快速準(zhǔn)確的識 別出車道線，并以此為依據(jù)，結(jié)合車速、車輛方向盤轉(zhuǎn)向角、導(dǎo)航信息，能夠快速準(zhǔn)確的算出 車道線的經(jīng)煒度及海拔高度，具有很高的實(shí)用性和商業(yè)價值。而且本發(fā)明系統(tǒng)結(jié)構(gòu)簡單，成 本較低，對車道線的識別、采集效率和精度都較高。
【附圖說明】
[0031] 圖1為系統(tǒng)結(jié)構(gòu)框圖；
[0032] 圖2為遮光部件示意圖；
[0033] 圖3為車道線識別傳感器與剛性支架結(jié)構(gòu)示意圖；
[0034] 圖4為車道標(biāo)線類型示意圖；
[0035] 圖5為車道線識別傳感器與車身相對位置示意圖；
[0036] 圖6為車輛與單車道標(biāo)線的位置關(guān)系示意圖；
[0037] 圖7為車輛與雙車道標(biāo)線的位置關(guān)系示意圖；
[0038] 圖8為導(dǎo)航傳感器一個定位周期里兩個定位點(diǎn)及其中間分隔點(diǎn)。
[0039] 圖中標(biāo)記，1-遮光部件，2-安裝板，3-剛性支架，4-車道線識別傳感器I，5-車道 線識別傳感器II，6-車道線識別傳感器III，7-車道線識別傳感器IV，8-車道線識別傳感器 V，9-隔板，10-單車道虛標(biāo)線，11-單車道實(shí)標(biāo)線，12-雙車道虛標(biāo)線，13-雙車道實(shí)標(biāo)線， 14-慣性導(dǎo)航傳感器，15-車身。
【具體實(shí)施方式】
[0040] 下面結(jié)合附圖