1.一種用于汽車前照燈的控制方法,其特征在于,該控制方法包括:
步驟1,采集當(dāng)前外界環(huán)境光強度,在外界環(huán)境光強度低于預(yù)設(shè)環(huán)境光強度的情況下,開啟前照燈;
步驟2,采集當(dāng)前汽車前方的障礙物和該汽車的距離值S,在所述距離值大于預(yù)設(shè)距離的情況下,開啟前照燈的遠光燈;
在所述距離值小于預(yù)設(shè)距離的情況下,開啟前照燈的近光燈;
步驟3,采集當(dāng)前汽車的方向盤轉(zhuǎn)角值γ、當(dāng)前汽車的行駛速度值v和汽車的橫擺角速度ω,以如下公式計算得到前照燈的遠光燈或近光燈在水平方向上旋轉(zhuǎn)的角度θ1旋轉(zhuǎn),其中,所述遠光燈或近光燈的初始朝向與車身的長度方向相同:
v′=cos(γ/N),θ1=90×S×ω/(π×v′),
其中,N為汽車方向盤轉(zhuǎn)角和車身實際轉(zhuǎn)角的比值,N為常量10:1;
采集前照燈的遠光燈或近光燈的實際轉(zhuǎn)動角度θ,在所述實際水平轉(zhuǎn)動角度θ等于角度θ1的情況下,水平方向上的電機停止調(diào)節(jié);
步驟4,采集當(dāng)前汽車的上坡或下坡的俯仰角δ,將前照燈的遠光燈或近光燈在豎直方向上旋轉(zhuǎn)的角度θ2旋轉(zhuǎn)至當(dāng)前汽車的上坡或下坡的俯仰角δ相同;
采集前照燈的遠光燈或近光燈的實際轉(zhuǎn)動角度θ′,在所述實際豎直轉(zhuǎn)動角度θ′等于角度θ2的情況下,豎直方向上的電機停止調(diào)節(jié)。
2.根據(jù)權(quán)利要求1所述的用于汽車前照燈的控制方法,其特征在于,在步驟3中,前照燈的遠光燈或近光燈水平旋轉(zhuǎn)的方法包括:
采集水平步進電機的實際工作頻率f1,通過PID控制算法算出水平步進電機所需要的工作頻率f2,并將所述所需要的工作頻率f2輸出給水平步進電機驅(qū)動器。
3.根據(jù)權(quán)利要求1所述的用于汽車前照燈的控制方法,其特征在于,在步驟4中,前照燈的遠光燈或近光燈豎直旋轉(zhuǎn)的方法包括:
采集垂直步進電機的實際的工作頻率f3,通過PID控制算法算出垂直步進電機所需要的工作頻率f4,并將所述所需要的工作頻率f4輸出給垂直步進電機驅(qū)動器。
4.根據(jù)權(quán)利要求3所述的用于汽車前照燈的控制方法,其特征在于,PID控制算法包括:
通過如下公式進行計算:
△f=Kp*Err(k)+Ki*Err(k-1)+Kd*Err(k-2);
f4=f3+△f;
其中,Kp,Ki,Kd分別是比例、積分和微分調(diào)節(jié)系數(shù),Err(k)、Err(k-1)、Err(k-2)分別是理論值與此次的誤差、理論值與上次的誤差、理論值與上上一次的誤差。
5.根據(jù)權(quán)利要求1所述的用于汽車前照燈的控制方法,其特征在于,在步驟2中,所述預(yù)設(shè)距離為40m。
6.根據(jù)權(quán)利要求1所述的用于汽車前照燈的控制方法,其特征在于,在步驟1中,所述預(yù)設(shè)環(huán)境光強度為5LUX。
7.根據(jù)權(quán)利要求1所述的用于汽車前照燈的控制方法,其特征在于,所述水平方向上旋轉(zhuǎn)的角度θ1的范圍為(0,15°)。
8.根據(jù)權(quán)利要求1所述的用于汽車前照燈的控制方法,其特征在于,所述豎直方向上旋轉(zhuǎn)的角度θ2的范圍為(-30°,30°)。