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