專利名稱：導航儀的道路主輔路的匹配方法
技術(shù)領(lǐng)域：
本發(fā)明涉及導航儀的工作方法的技術(shù)領(lǐng)域，具體是ー種導航儀根據(jù)道路車線對道路主輔路的匹配方法。
背景技術(shù)：
現(xiàn)有的城市干道往往存在主、輔路，比如北京的ニ環(huán)三環(huán)和四環(huán)，環(huán)路封閉的只允許機動車這樣的，是主路；主路一般包括聞架道路、聞速公路等。輔路就是封閉區(qū)外的，緊挨主路，與其他岔路相連接。在利用GPS導航儀進行道路匹配和導航的過程中，一方面由于GPS信號往往存在一些誤差或干擾，導致現(xiàn)有的導航儀往往無法區(qū)分相鄰且平行的主輔路，導致不能準確匹配作為其載體的車輛(俗稱當前車輛)所在的道路，進而影響了導航的準確性和實時性 (即現(xiàn)有的導航儀無法實時準確判斷當前車輛是否在主路上、無法判斷當前車輛是否已離開主路并進入作為待轉(zhuǎn)向的輔路上)?，F(xiàn)有的配置有導航儀的車輛，往往在該車輛的后端設(shè)有與所述導航儀相連的攝像頭，以通過導航儀的顯示屏顯示拍攝得的影像，其主要用于確保倒車安全或?qū)崿F(xiàn)自動倒車等功能。如何將所述攝像頭和導航儀組合，以解決導航路徑上的主、輔路的匹配問題，是本領(lǐng)域未曾涉及的。
發(fā)明內(nèi)容
本發(fā)明要解決的技術(shù)問題是提供一種實時性和準確性較高的導航儀的道路主輔路的匹配方法。為解決上述技術(shù)問題，本發(fā)明提供的導航儀的道路主輔路的匹配方法包括若當前車輛在一主路上，且在當前車輛前方的2Km內(nèi)存在一通向該主路右側(cè)的輔路的出口，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述主路上的行車道圖像，以判斷當前車輛是否在所述主路的最右側(cè)的行車道內(nèi)；若當前車輛在所述主路的最右側(cè)的行車道內(nèi)，則在即將到達所述出口時，實時判斷所述圖像中的行車道線是否發(fā)生順時針偏轉(zhuǎn)，若所述行車道線發(fā)生順時針偏轉(zhuǎn)，則CPU判斷當前車輛進入所述輔路；導航儀將當前行駛路徑匹配至所述輔路上；若所述行車道線未發(fā)生順時針偏轉(zhuǎn)，則判斷當前車輛仍在所述主路上。作為優(yōu)選的方案，若所述行車道線發(fā)生順時針偏轉(zhuǎn)的角度大于5°，則判斷當前車輛進入所述輔路；以進ー步準確判斷當前車輛是否變道并進入所述輔路。具體實施時，所述CPU獲得所述主路上的行車道圖像后，先提取出該圖像中的鄰近車輛右側(cè)的右行車道線，然后在圖像中分析該右行車道線的右側(cè)后方是否存在另一條行車道線；若不存在另一條行車道線，則判斷當前車輛在所述主路的最右側(cè)的行車道內(nèi)；反之，則判斷當前車輛不在所述主路的最右側(cè)的行車道內(nèi)。另ー種導航儀的道路主輔路的匹配方法，其包括若當前車輛在一主路上，且在當前車輛前方的2Km內(nèi)存在一通向該主路右側(cè)的輔路的出口，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述主路上的行車道圖像，以判斷當前車輛是否在所述主路的最右側(cè)的行車道內(nèi)；若當前車輛在所述主路的最右側(cè)的行車道內(nèi)，則在即將到達所述出ロ時，所述CPU實時通過ー傳感器檢測當前車輛的轉(zhuǎn)向燈撥桿是否向右發(fā)生撥動；若測得所述轉(zhuǎn)向燈撥桿發(fā)生向右撥動，則CPU判斷當前車輛進入所述輔路；導航儀將當前行駛路徑匹配至所述輔路上；若所述轉(zhuǎn)向燈撥桿未發(fā)生向右撥動，則判斷當前車輛仍在所述主路上。第三種導航儀的道路主輔路的匹配方法，其特征在于包括若當前車輛在ー輔路上，且存在一主路與該輔路相鄰，同時在當前車輛前方的I. 5Km內(nèi)存在一通向該輔路左側(cè)的主路的入ロ，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述輔路上的行 車道圖像，以判斷當前車輛是否在所述輔路的最左側(cè)的行車道內(nèi)；若當前車輛在所述輔路的最左側(cè)的行車道內(nèi)，則在即將到達所述入口時，實時判斷所述圖像中的行車道線是否發(fā)生逆時針偏轉(zhuǎn)，若所述行車道線發(fā)生逆時針偏轉(zhuǎn)，則CPU判斷當前車輛進入所述主路；導航儀就當前行駛路徑匹配至所述主路上；若所述行車道線未發(fā)生逆時針偏轉(zhuǎn)，則判斷當前車輛仍在所述輔路上。進ー步，所述CPU獲得所述輔路上的行車道圖像后，先提取出該圖像中的鄰近車輛左側(cè)的左行車道線，然后在圖像中分析該左行車道線的左側(cè)后方是否存在另一條行車道線；若不存在另一條行車道線，則判斷當前車輛在所述輔路的最左側(cè)的行車道內(nèi)；反之，則判斷當前車輛不在所述輔路的最左側(cè)的行車道內(nèi)。第四種導航儀的道路主輔路的匹配方法，其包括若當前車輛在ー輔路上，且存在一主路與該輔路相鄰，同時在當前車輛前方的I. 5Km內(nèi)存在一通向該輔路左側(cè)的主路的入ロ，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述輔路上的行車道圖像，以判斷當前車輛是否在所述輔路的最左側(cè)的行車道內(nèi)；若當前車輛在所述輔路的最左側(cè)的行車道內(nèi)，則在即將到達所述入口時，所述CPU實時通過ー傳感器檢測當前車輛的轉(zhuǎn)向燈撥桿是否向左發(fā)生撥動；若測得所述轉(zhuǎn)向燈撥桿發(fā)生向左撥動，則CPU判斷當前車輛進入所述主路；導航儀將當前行駛路徑匹配至所述主路上；若所述轉(zhuǎn)向燈撥桿未發(fā)生向左撥動，則判斷當前車輛仍在所述輔路上。本發(fā)明具有的技術(shù)效果本發(fā)明的導航儀的道路匹配方法，主要通過設(shè)于車輛后端的攝像頭判斷當前車輛所在的行車道，然后通過行車道線在所拍攝的圖像或視頻中的角度變化，來判斷車輛是否在主路的出入口處發(fā)生相應(yīng)的轉(zhuǎn)向，進而判斷當前車輛是否進入或離開主路。作為另ー種方案，采用檢測轉(zhuǎn)向燈撥桿的動作，來判斷車輛是否在主路的出入ロ處發(fā)生相應(yīng)的轉(zhuǎn)向，進而判斷當前車輛是否進入或離開主路。這些方法具有步驟簡單、可靠性較高的特點。
為了使本發(fā)明的內(nèi)容更容易被清楚的理解，下面根據(jù)的具體實施例并結(jié)合附圖，對本發(fā)明作進ー步詳細的說明，其中
圖I是本發(fā)明的導航儀的結(jié)構(gòu)框圖。
具體實施方式
下面結(jié)合附圖及實施例對本發(fā)明進行詳細說明
實施例I
如圖I，本實施例的導航儀包括CPU、與該CPU相連的觸摸顯示屏、與該CPU相連的GPS単元、與該CPU相連的程序數(shù)據(jù)庫、與該CPU相連的攝像頭、以及與該CPU相連的地圖數(shù)據(jù)庫。地圖數(shù)據(jù)庫中存儲有道路路徑信息，道路路徑信息包括各路段的屬性，該屬性包括相應(yīng)的路段是否為主路或輔路，以及主、輔路之間是否相鄰等信息。上述導航儀的工作方法包括
若當前車輛在一主路上，且在當前車輛前方的2Km內(nèi)存在一通向該主路右側(cè)的輔路的出口，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述主路上的行車道圖像，以判斷當前車輛是否在所述主路的最右側(cè)的行車道內(nèi)；若當前車輛在所述主路的最右側(cè)的行車道內(nèi)，則在即將到達所述出ロ(一般為距離該出ロ 50m內(nèi))吋，實時判斷所述圖像中的行車道線是否發(fā)生順時針偏轉(zhuǎn)，若所述行車道線發(fā)生順時針偏轉(zhuǎn)，則CPU判斷當前車輛進入所述輔路；導航儀將當前行駛路徑匹配至所述輔路上；若所述行車道線未發(fā)生順時針偏轉(zhuǎn)，則判斷當前車輛仍在所述主路上。為進ー步提高判斷的正確性，若所述行車道線發(fā)生順時針偏轉(zhuǎn)的角度大于5°，則判斷當前車輛進入所述輔路。所述CPU獲得所述主路上的行車道圖像后，為提高判斷的正確性和便捷性，可以先判斷在所述行車道圖像中分析該右行車道線的右側(cè)是否存在道路護欄或植物；若存在道路護欄或植物，則判斷當前車輛在所述主路的最右側(cè)的行車道內(nèi)。若不存在道路護欄或植物，則先提取出該圖像中的鄰近車輛右側(cè)的右行車道線，然后在所述圖像中分析該右行車道線的右側(cè)后方是否存在另一條行車道線；若不存在另一條行車道線，則判斷當前車輛在所述主路的最右側(cè)的行車道內(nèi)；反之，則判斷當前車輛不在所述主路的最右側(cè)的行車道內(nèi)。在判斷鄰近當前車輛右側(cè)的右行車道線的右側(cè)是否存在道路護欄或植物時，通過顔色，或采用與預(yù)存在所述地圖數(shù)據(jù)庫中的道路護欄或植物的多種模型比較的方式，來判斷。實施例2
在實施例I的基礎(chǔ)上，本實施例的導航儀還包括與該CPU相連的轉(zhuǎn)向燈撥桿傳感器，轉(zhuǎn)向燈撥桿傳感器采用與所述CPU相連的磁感應(yīng)開關(guān)或撥動開關(guān)，用于檢測當前車輛的轉(zhuǎn)向燈撥桿是否在零位、左轉(zhuǎn)向位或右轉(zhuǎn)向位。在實施例I的基礎(chǔ)上，本實施例的導航儀的道路主輔路的匹配方法存在如下變型
本實施例的導航儀的工作方法包括若當前車輛在一主路上，且在當前車輛前方的2Km內(nèi)存在一通向該主路右側(cè)的輔路的出口，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述主路上的行車道圖像，以判斷當前車輛是否在所述主路的最右側(cè)的行車道內(nèi)；若當前車輛在所述主路的最右側(cè)的行車道內(nèi)，則在即將到達所述出口(一般為距離該出ロ 50m內(nèi))時，所述CPU實時通過所述轉(zhuǎn)向燈撥桿傳感器檢測當前車輛的轉(zhuǎn)向燈撥桿是否 向右發(fā)生撥動；若測得所述轉(zhuǎn)向燈撥桿發(fā)生向右撥動，則CPU判斷當前車輛進入所述輔路；導航儀將當前行駛路徑匹配至所述輔路上；若所述轉(zhuǎn)向燈撥桿未發(fā)生向右撥動，則判斷當前車輛仍在所述主路上。
實施例3
本實施例的導航儀的道路主輔路的匹配方法包括若當前車輛在ー輔路上，且存在一主路與該輔路相鄰，同時在當前車輛前方的I. 5Km內(nèi)存在一通向該輔路左側(cè)的主路的入ロ，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述輔路上的行車道圖像，以判斷當前車輛是否在所述輔路的最左側(cè)的行車道內(nèi)；若當前車輛在所述輔路的最左側(cè)的行車道內(nèi)，則在即將到達所述入口(一般為距離該出ロ 30至40m內(nèi))時，實時判斷所述圖像中的行車道線是否發(fā)生逆時針偏轉(zhuǎn)，若所述行車道線發(fā)生逆時針偏轉(zhuǎn)，則CPU判斷當前車輛進入所述主路；導航儀就當前行駛路徑匹配至所述主路上；若所述行車道線未發(fā)生逆時針偏轉(zhuǎn)，則判斷當前車輛仍在所述輔路上。若所述行車道線發(fā)生逆時針偏轉(zhuǎn)的角度大于5°，則判斷當前車輛進入所述主路。為提高判斷的正確性和便捷性，所述CPU獲得所述輔路上的行車道圖像后，先在所述行車道圖像中分析鄰近當前車輛左側(cè)的左行車道線的左側(cè)是否存在道路護欄或植物；若存在道路護欄或植物，則判斷當前車輛在所述輔路的最左側(cè)的行車道內(nèi)。若不存在道路護欄或植物，則先提取出該圖像中的鄰近車輛左側(cè)的左行車道線，然后在圖像中分析該左行車道線的左側(cè)后方是否存在另一條行車道線；若不存在另一條行車道線，則判斷當前車輛在所述輔路的最左側(cè)的行車道內(nèi)；反之，則判斷當前車輛不在所述輔路的最左側(cè)的行車道內(nèi)。在判斷鄰近當前車輛左側(cè)的左行車道線的左側(cè)是否存在道路護欄或植物時，通過顔色，或采用與道路護欄或植物的模型比較的方式，來判斷。實施例4
本實施例的導航儀的道路主輔路的匹配方法，其包括若當前車輛在ー輔路上，且存在一主路與該輔路相鄰，同時在當前車輛前方的I. 5Km內(nèi)存在一通向該輔路左側(cè)的主路的入ロ，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述輔路上的行車道圖像，以判斷當前車輛是否在所述輔路的最左側(cè)的行車道內(nèi)；若當前車輛在所述輔路的最左側(cè)的行車道內(nèi)，則在即將到達所述入ロ時，所述CPU實時通過ー轉(zhuǎn)向燈撥桿傳感器檢測當前車輛的轉(zhuǎn)向燈撥桿是否向左發(fā)生撥動；若測得所述轉(zhuǎn)向燈撥桿發(fā)生向左撥動，則CPU判斷當前車輛進入所述主路；導航儀將當前行駛路徑匹配至所述主路上；若所述轉(zhuǎn)向燈撥桿未發(fā)生向左撥動，則判斷當前車輛仍在所述輔路上。所述攝像頭設(shè)于當前車輛后方中央處，所述CPU獲得所述行車道圖像后，在圖像中分析是否存在一對行車道線分別在預(yù)設(shè)區(qū)域內(nèi)；若存在一對行車道線分別在預(yù)設(shè)區(qū)域內(nèi)，則判斷當前車輛在一行車道內(nèi)；反之，則判斷當前車輛在一對相鄰的行車道的中央。
顯然，上述實施例僅僅是為清楚地說明本發(fā)明所作的舉例，而并非是對本發(fā)明的實施方式的限定。對于所屬領(lǐng)域的普通技術(shù)人員來說，在上述說明的基礎(chǔ)上還可以做出其它不同形式的變化或變動。這里無需也無法對所有的實施方式予以窮舉。而這些屬于本發(fā)明的精神所引伸出的顯而易見的變化或變動仍處于本發(fā)明的保護范圍之中。
權(quán)利要求
1.一種導航儀的道路主輔路的匹配方法，其特征在于包括 若當前車輛在一主路上，且在當前車輛前方的2Km內(nèi)存在一通向該主路右側(cè)的輔路的出口，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述主路上的行車道圖像，以判斷當前車輛是否在所述主路的最右側(cè)的行車道內(nèi)； 若當前車輛在所述主路的最右側(cè)的行車道內(nèi)，則在即將到達所述出口時，實時判斷所述圖像中的行車道線是否發(fā)生順時針偏轉(zhuǎn)，若所述行車道線發(fā)生順時針偏轉(zhuǎn)，則CPU判斷當前車輛進入所述輔路；導航儀將當前行駛路徑匹配至所述輔路上； 若所述行車道線未發(fā)生順時針偏轉(zhuǎn)，則判斷當前車輛仍在所述主路上。
2.根據(jù)權(quán)利要求I所述的導航儀的道路主輔路的匹配方法，其特征在于若所述行車道線發(fā)生順時針偏轉(zhuǎn)的角度大于5°，則判斷當前車輛進入所述輔路。
3.根據(jù)權(quán)利要求I或2所述的導航儀的道路主輔路的匹配方法，其特征在于所述CPU獲得所述主路上的行車道圖像后，先提取出該圖像中的鄰近車輛右側(cè)的右行車道線，然后在圖像中分析該右行車道線的右側(cè)后方是否存在另一條行車道線；若不存在另一條行車道線，則判斷當前車輛在所述主路的最右側(cè)的行車道內(nèi)；反之，則判斷當前車輛不在所述主路的最右側(cè)的行車道內(nèi)。
4.根據(jù)權(quán)利要求I或2所述的導航儀的道路主輔路的匹配方法，其特征在于所述CPU獲得所述主路上的行車道圖像后，先判斷在所述行車道圖像中分析該右行車道線的右側(cè)是否存在道路護欄或植物；若存在道路護欄或植物，則判斷當前車輛在所述主路的最右側(cè)的行車道內(nèi)；若不存在道路護欄或植物，則先提取出該圖像中的鄰近車輛右側(cè)的右行車道線，然后在所述圖像中分析該右行車道線的右側(cè)后方是否存在另一條行車道線；若不存在另一條行車道線，則判斷當前車輛在所述主路的最右側(cè)的行車道內(nèi)；反之，則判斷當前車輛不在所述主路的最右側(cè)的行車道內(nèi)。
5.一種導航儀的道路主輔路的匹配方法，其特征在于包括 若當前車輛在一主路上，且在當前車輛前方的2Km內(nèi)存在一通向該主路右側(cè)的輔路的出口，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述主路上的行車道圖像，以判斷當前車輛是否在所述主路的最右側(cè)的行車道內(nèi)； 若當前車輛在所述主路的最右側(cè)的行車道內(nèi)，則在即將到達所述出口時，所述CPU實時通過一傳感器檢測當前車輛的轉(zhuǎn)向燈撥桿是否向右發(fā)生撥動；若測得所述轉(zhuǎn)向燈撥桿發(fā)生向右撥動，則CPU判斷當前車輛進入所述輔路；導航儀將當前行駛路徑匹配至所述輔路上； 若所述轉(zhuǎn)向燈撥桿未發(fā)生向右撥動，則判斷當前車輛仍在所述主路上。
6.一種導航儀的道路主輔路的匹配方法，其特征在于包括 若當前車輛在一輔路上，且存在一主路與該輔路相鄰，同時在當前車輛前方的I. 5Km內(nèi)存在一通向該輔路左側(cè)的主路的入口，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述輔路上的行車道圖像，以判斷當前車輛是否在所述輔路的最左側(cè)的行車道內(nèi)； 若當前車輛在所述輔路的最左側(cè)的行車道內(nèi)，則在即將到達所述入口時，實時判斷所述圖像中的行車道線是否發(fā)生逆時針偏轉(zhuǎn)，若所述行車道線發(fā)生逆時針偏轉(zhuǎn)，則CPU判斷當前車輛進入所述主路；導航儀就當前行駛路徑匹配至所述主路上；若所述行車道線未發(fā)生逆時針偏轉(zhuǎn)，則判斷當前車輛仍在所述輔路上。
7.根據(jù)權(quán)利要求6所述的導航儀的道路主輔路的匹配方法，其特征在于若所述行車道線發(fā)生逆時針偏轉(zhuǎn)的角度大于5°，則判斷當前車輛進入所述主路。
8.根據(jù)權(quán)利要求6或7所述的導航儀的道路主輔路的匹配方法，其特征在于所述CPU獲得所述輔路上的行車道圖像后，先提取出該圖像中的鄰近車輛左側(cè)的左行車道線，然后在圖像中分析該左行車道線的左側(cè)后方是否存在另一條行車道線；若不存在另一條行車道線，則判斷當前車輛在所述輔路的最左側(cè)的行車道內(nèi)；反之，則判斷當前車輛不在所述輔路的最左側(cè)的行車道內(nèi)。
9.根據(jù)權(quán)利要求6或7所述的導航儀的道路主輔路的匹配方法，其特征在于所述CPU獲得所述輔路上的行車道圖像后，先在所述行車道圖像中分析鄰近當前車輛左側(cè)的左行車道線的左側(cè)是否存在道路護欄或植物；若存在道路護欄或植物，則判斷當前車輛在所述輔路的最左側(cè)的行車道內(nèi)；若不存在道路護欄或植物，則先提取出該圖像中的鄰近車輛左側(cè)的左行車道線，然后在圖像中分析該左行車道線的左側(cè)后方是否存在另一條行車道線；若不存在另一條行車道線，則判斷當前車輛在所述輔路的最左側(cè)的行車道內(nèi)；反之，則判斷當前車輛不在所述輔路的最左側(cè)的行車道內(nèi)。
10.ー種導航儀的道路主輔路的匹配方法，其特征在于包括 若當前車輛在ー輔路上，且存在一主路與該輔路相鄰，同時在當前車輛前方的I. 5Km內(nèi)存在一通向該輔路左側(cè)的主路的入口，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述輔路上的行車道圖像，以判斷當前車輛是否在所述輔路的最左側(cè)的行車道內(nèi)； 若當前車輛在所述輔路的最左側(cè)的行車道內(nèi)，則在即將到達所述入ロ吋，所述CPU實時通過一傳感器檢測當前車輛的轉(zhuǎn)向燈撥桿是否向左發(fā)生撥動；若測得所述轉(zhuǎn)向燈撥桿發(fā)生向左撥動，則CPU判斷當前車輛進入所述主路；導航儀將當前行駛路徑匹配至所述主路上； 若所述轉(zhuǎn)向燈撥桿未發(fā)生向左撥動，則判斷當前車輛仍在所述輔路上。
全文摘要
本發(fā)明涉及的導航儀的道路主輔路的匹配方法包括若當前車輛在一主路上，且在當前車輛前方的2Km內(nèi)存在一通向該主路右側(cè)的輔路的出口，則導航儀的CPU通過設(shè)于當前車輛后方的攝像頭實時獲取所述主路上的行車道圖像，以判斷當前車輛是否在所述主路的最右側(cè)的行車道內(nèi)；若當前車輛在所述主路的最右側(cè)的行車道內(nèi)，則在即將到達所述出口時，實時判斷所述圖像中的行車道線是否發(fā)生順時針偏轉(zhuǎn)，若所述行車道線發(fā)生順時針偏轉(zhuǎn)，則CPU判斷當前車輛進入所述輔路；導航儀將當前行駛路徑匹配至所述輔路上；若所述行車道線未發(fā)生順時針偏轉(zhuǎn)，則判斷當前車輛仍在所述主路上。
文檔編號G01C21/30GK102661747SQ20121017302
公開日2012年9月12日 申請日期2012年5月30日 優(yōu)先權(quán)日2012年5月30日
發(fā)明者李曉華, 秦春達 申請人:常州市新科汽車電子有限公司