1.一種基于寬度探測的汽車路線校正方法,其特征在于,依次包括以下步驟:
(1)初始化,對汽車的車頭中心位置的兩側(cè)相距L的位置分別設(shè)置的所述第一、第二距離探測器的探測方向的角度進(jìn)行校準(zhǔn),對可調(diào)整角度范圍進(jìn)行預(yù)先標(biāo)定,即對第一、第二距離探測器探測方向與車頭正前方的方向之間的夾角α和β進(jìn)行預(yù)先標(biāo)定;
(2)第一、第二距離探測器以周期T發(fā)射探測信號,實(shí)時(shí)調(diào)整夾角α和β,在前方探測范圍內(nèi)進(jìn)行掃描,當(dāng)?shù)谝?、第二距離探測器探測到前方行駛空間的邊緣時(shí),記錄此時(shí)α和β的角度值,以及第一、二距離探測器此時(shí)的探測距離值L1和L2,并且減小周期T;
計(jì)算行駛空間的寬度M1=L1·sinα+L2·sinβ+L,如果M1大于第一閾值,則發(fā)出第一警報(bào);
(3)汽車在連續(xù)的時(shí)間段繼續(xù)行駛距離S,調(diào)整夾角α和β,使得第一、第二距離探測器依然探測到前方行駛空間的邊緣,記錄此時(shí)α和β的角度值,以及第一、二距離探測器此時(shí)的探測距離值L3和L4;
計(jì)算行駛空間的寬度比較M1和M2的值是相同或滿足一定的容許誤差范圍內(nèi),且M2大于第一閾值時(shí),發(fā)出警報(bào)并播報(bào)探測的寬度值M1或M2或平均值;
(4)比較步驟(2)和步驟(3)中不同時(shí)間的α和β的角度值,根據(jù)此時(shí)間段α和β的角度值的變化程度,調(diào)整車頭的位置;
(5)重復(fù)步驟(2)-(4),根據(jù)探測的寬度值和角度值的變化程度調(diào)整汽車行駛方向,通過行駛空間。
2.如權(quán)利要求1所述的方法,其特征在于:步驟(4)中調(diào)整車頭的位置具體是將車頭向變化程度低得一側(cè)靠近。
3.如權(quán)利要求1所述的方法,其特征在于:第一閾值為預(yù)先設(shè)定的。
4.如權(quán)利要求1所述的方法,其特征在于:所述行駛空間為門洞。
5.如權(quán)利要求1所述的方法,其特征在于:第一、第二距離探測器為超聲波距離探測器或激光距離探測器。
6.如權(quán)利要求4所述的方法,其特征在于:警報(bào)為震動和/或語音的形式。