[go: up one dir, main page]

CN102029941B - Headlamp adaptive control method and device - Google Patents

Headlamp adaptive control method and device Download PDF

Info

Publication number
CN102029941B
CN102029941B CN 201010593738 CN201010593738A CN102029941B CN 102029941 B CN102029941 B CN 102029941B CN 201010593738 CN201010593738 CN 201010593738 CN 201010593738 A CN201010593738 A CN 201010593738A CN 102029941 B CN102029941 B CN 102029941B
Authority
CN
China
Prior art keywords
headlight
car
unit
horizontal
control
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
CN 201010593738
Other languages
Chinese (zh)
Other versions
CN102029941A (en
Inventor
孙炜
孟步敏
王亮
王羽
谢岚
赵国瑞
王聪
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hunan University
Original Assignee
Hunan University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hunan University filed Critical Hunan University
Priority to CN 201010593738 priority Critical patent/CN102029941B/en
Publication of CN102029941A publication Critical patent/CN102029941A/en
Application granted granted Critical
Publication of CN102029941B publication Critical patent/CN102029941B/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Lighting Device Outwards From Vehicle And Optical Signal (AREA)

Abstract

本发明公开了一种汽车前照灯自适应控制方法及装置,方法包括:1)实时获取汽车的当前速度v、获取汽车在当前速度下的安全制动距离S;2)获取前照灯最佳照明位置对应的水平偏转角ω;3)获取前照灯最佳照明位置对应的垂直偏转角β;4)输出控制信号实时控制前照灯转动;装置包括控制单元(1)和分别与控制单元(1)相连的检测单元(2)、驱动机构(3),检测单元(2)包括速度传感器(21)、方向盘转角传感器(22)、前轮车身高度传感器(23)、后轮车身高度传感器(24)、阳光雨量传感器(25)和加速度传感器(26)。本发明具有照射范围大、照明效果好、不易产生反射眩光、结构简单、控制精确、环境适应性好、安全可靠、驾驶舒适的优点。

Figure 201010593738

The invention discloses an adaptive control method and device for automobile headlights. The method includes: 1) acquiring the current speed v of the automobile in real time, and obtaining the safe braking distance S of the automobile at the current speed; 2) obtaining the maximum speed of the headlight. 3) obtain the vertical deflection angle β corresponding to the best lighting position of the headlight; 4) output control signals to control the rotation of the headlight in real time; the device includes a control unit (1) and a control unit (1) respectively The detection unit (2) and the drive mechanism (3) connected to the unit (1), the detection unit (2) includes a speed sensor (21), a steering wheel angle sensor (22), a front wheel vehicle height sensor (23), a rear wheel vehicle height sensor Sensor (24), sunlight and rain sensor (25) and acceleration sensor (26). The invention has the advantages of large irradiation range, good lighting effect, difficult reflection glare, simple structure, precise control, good environmental adaptability, safety and reliability, and comfortable driving.

Figure 201010593738

Description

汽车前照灯自适应控制方法及装置Automobile headlight adaptive control method and device

技术领域 technical field

本发明涉及汽车领域,具体涉及一种汽车前照灯自适应控制方法及装置。The invention relates to the field of automobiles, in particular to an adaptive control method and device for automobile headlights.

背景技术 Background technique

传统汽车前照灯的照射方向与车身平行,不能够随着车辆方向的调整而偏转。因此在实际应用中,往往存在着许多问题,例如:夜间在交通状况比较复杂的市区照明有效性会降低,特别是在转弯的时候存在照明的暗区;车辆在前后载荷发生变化,或起步及行进中的加速和制动时,前照灯会随着车身做俯仰运动,造成照射范围减小;车辆在雨天行驶的时候,地面积水反射前照灯的光线,容易产生反射眩光,这些都严重影响了司机对前方道路的判断,导致汽车的安全性能和驾驶舒适度的降低。The irradiation direction of traditional car headlights is parallel to the body and cannot be deflected with the adjustment of the direction of the vehicle. Therefore, in practical applications, there are often many problems, such as: the effectiveness of lighting in urban areas with complex traffic conditions at night will be reduced, especially when there are dark areas of lighting when turning; the front and rear loads of the vehicle change, or start And when accelerating and braking while driving, the headlights will move along with the vehicle body, resulting in a reduction in the irradiation range; when the vehicle is driving in rainy days, the water on the ground reflects the light of the headlights, which is prone to reflective glare. It seriously affects the driver's judgment on the road ahead, resulting in a reduction in the safety performance and driving comfort of the car.

发明内容 Contents of the invention

本发明要解决的技术问题为:提供一种照射范围大、照明效果好、不容易产生反射眩光、结构简单高效、控制精确、环境适应性好、安全可靠、驾驶舒适的汽车前照灯自适应控制方法及装置。The technical problem to be solved by the present invention is to provide a self-adaptive automobile headlight with large irradiation range, good lighting effect, not easy to produce reflected glare, simple and efficient structure, precise control, good environmental adaptability, safety and reliability, and comfortable driving. Control method and device.

为了解决上述技术问题,本发明采用的技术方案为:一种汽车前照灯自适应控制方法,其实施步骤如下:In order to solve the above-mentioned technical problems, the technical solution adopted in the present invention is: a kind of automobile headlamp self-adaptive control method, and its implementation steps are as follows:

1)实时获取汽车的当前速度v,获取汽车在当前速度下的安全制动距离S;1) Get the current speed v of the car in real time, and get the safe braking distance S of the car at the current speed;

2)实时获取汽车的方向盘转角

Figure GDA00002060118500011
并根据式(101)2) Obtain the steering wheel angle of the car in real time
Figure GDA00002060118500011
And according to formula (101)

Figure GDA00002060118500012
式(101)
Figure GDA00002060118500012
Formula (101)

得到前照灯当前最佳照明位置对应的水平偏转角ω,其中k为前轮转向角与方向盘转角

Figure GDA00002060118500013
的比例系数,D为汽车前后轮轮轴之间的距离;Obtain the horizontal deflection angle ω corresponding to the current optimal lighting position of the headlight, where k is the steering angle of the front wheel and the steering wheel angle
Figure GDA00002060118500013
The proportional coefficient of D is the distance between the front and rear wheel axles of the car;

3)实时获取前轮车身高度变化量ΔH1,后轮车身高度变化量ΔH0,并根据式(102)3) Obtain the change amount ΔH 1 of the front wheel body height and the change amount ΔH 0 of the rear wheel body height in real time, and according to formula (102)

β = tan - 1 Δ H 0 - Δ H 1 D + tan - 1 L - D D ( Δ H 0 - Δ H 1 ) + H D - tan - 1 H C 式(102) β = the tan - 1 Δ h 0 - Δ h 1 D. + the tan - 1 L - D. D. ( Δ h 0 - Δ h 1 ) + h D. - the tan - 1 h C Formula (102)

得到前照灯当前最佳照明位置对应的垂直偏转角β,其中L为前照灯与后轮轮轴的水平距离,C为前照灯水平时的照明距离、H为前照灯灯光光轴的离地高度;The vertical deflection angle β corresponding to the current optimal lighting position of the headlight is obtained, where L is the horizontal distance between the headlight and the rear wheel axle, C is the lighting distance when the headlight is horizontal, and H is the distance of the light axis of the headlight height above the ground;

4)根据上述水平偏转角ω和垂直偏转角β输出控制信号实时控制前照灯转动。4) Output the control signal according to the above-mentioned horizontal deflection angle ω and vertical deflection angle β to control the rotation of the headlight in real time.

作为本发明汽车前照灯自适应控制方法的进一步改进:As a further improvement of the adaptive control method for automobile headlights of the present invention:

所述步骤1)中获取安全制动距离S前预设拟合参数数据表,所述获取安全制动距离S时先获取当前的雨量、光线强度、汽车前后倾斜状态和道路平坦度,然后根据上述信息查找拟合参数数据表获取拐弯距离拟合参数K1、K2、K3,并根据所述步骤1)获得的当前速度v以及S=K1v2+K2v+K3获得安全制动距离S。In the step 1), the preset fitting parameter data table is obtained before the safe braking distance S. When obtaining the safe braking distance S, the current rainfall, light intensity, vehicle front and rear tilt state and road flatness are obtained first, and then according to Find the fitting parameter data table for the above information to obtain the turning distance fitting parameters K 1 , K 2 , and K 3 , and obtain the current speed v and S=K 1 v 2 +K 2 v+K 3 according to the current speed v obtained in the above step 1) Safe braking distance S.

所述获取拐弯距离拟合参数K1、K2、K3的详细步骤如下:The detailed steps of obtaining the fitting parameters K 1 , K 2 , and K 3 of the turning distance are as follows:

①对雨量进行决策,判定其属于晴天、小雨或者大雨;① Make a decision on the amount of rainfall and determine whether it is sunny, light rain or heavy rain;

②对光线强度进行决策,判定其属于强光、微光或者黑夜;② Make a decision on the light intensity, and determine whether it belongs to strong light, dim light or night;

③对汽车前后倾斜状态进行决策,判定其属于前倾、正常或者后倾;③Decision-making on the forward and backward tilt state of the car, and determine whether it is forward tilt, normal or backward tilt;

④对道路平坦度进行决策,判定其属于平坦、正常或者不平坦;④ Make a decision on the flatness of the road, and determine whether it is flat, normal or uneven;

⑤对汽车行驶速度进行决策,判定其属于高速、正常或者低速;⑤ Make a decision on the driving speed of the car, and determine whether it belongs to high speed, normal or low speed;

⑥根据上述①~⑤的决策结果查询拟合参数数据表得到拐弯距离拟合参数K1、K2、K3⑥ According to the decision results of ①~⑤ above, query the fitting parameter data table to obtain the turning distance fitting parameters K 1 , K 2 , and K 3 .

所述步骤1)中获取汽车的当前速度v前包括对汽车前照灯进行转动检测的步骤,如果前照灯转动发生故障,则将前照灯的位置复位并停止对前照灯的自适应控制。The step 1) before obtaining the current speed v of the car includes the step of detecting the rotation of the headlights of the car. If the rotation of the headlights fails, reset the position of the headlights and stop the adaptation to the headlights control.

所述步骤4)中输出的控制信号为渐变式控制信号。The control signal output in step 4) is a gradually changing control signal.

所述控制信号为PWM信号,所述渐变式控制信号是指控制信号与初始控制信号之间的关系为(P-P0)=nt,其中P为当前输出PWM信号的占空比参数,P0为初始PWM信号的占空比参数,n为每次调整的变化量,t为调整时间,所述t取值与所述步骤④得到的道路平坦度决策结果和所述步骤⑤得到的汽车行驶速度决策结果相关,汽车高速行驶、道路不平坦时,t取值无穷大,PWM信号保持不变;汽车高速行驶、道路正常时,t取值0.75s;汽车高速行驶、道路平坦时,t取值0.5s;汽车正常行驶、道路不平坦时,t取值1.5s;汽车正常行驶、道路正常时,t取值1s;汽车正常行驶、道路平坦时,t取值0.75s;汽车低速行驶、道路不平坦时,t取值2s;汽车低速行驶、道路正常时,t取值1.5s;汽车低速行驶、道路平坦时,t取值1.25s。The control signal is a PWM signal, and the gradual change control signal means that the relationship between the control signal and the initial control signal is (PP 0 )=nt, where P is the duty ratio parameter of the current output PWM signal, and P 0 is The duty ratio parameter of the initial PWM signal, n is the variation of each adjustment, and t is the adjustment time, and the value of t is related to the road flatness decision result obtained in the step 4 and the vehicle speed obtained in the step 5 The decision result is related. When the car is driving at high speed and the road is uneven, the value of t is infinite, and the PWM signal remains unchanged; when the car is driving at high speed and the road is normal, the value of t is 0.75s; when the car is driving at high speed and the road is flat, the value of t is 0.5 s; when the car is driving normally and the road is uneven, the value of t is 1.5s; when the car is driving normally and the road is normal, the value of t is 1s; When the vehicle is flat, the value of t is 2s; when the car is running at a low speed and the road is normal, the value of t is 1.5s; when the car is driving at a low speed and the road is flat, the value of t is 1.25s.

本发明还提供一种汽车前照灯自适应控制装置,包括控制单元和分别与控制单元相连的检测单元、驱动机构,所述检测单元实时获取汽车的当前速度v、方向盘转角

Figure GDA00002060118500021
前轮车身高度变化量ΔH1以及后轮车身高度变化量ΔH0并输出至控制单元,所述控制单元获取汽车在当前速度v下的安全制动距离S,并根据所述检测单元的输出信息以及安全制动距离S获取前照灯当前最佳照明位置对应的水平偏转角ω、垂直偏转角β,并将所述水平偏转角ω和垂直偏转角β转换为对前照灯的转动控制信号并输出至驱动机构实时控制前照灯转动。The present invention also provides an adaptive control device for automobile headlights, which includes a control unit, a detection unit and a driving mechanism respectively connected to the control unit, and the detection unit obtains the current speed v and steering wheel angle of the vehicle in real time
Figure GDA00002060118500021
The front wheel body height change ΔH 1 and the rear wheel body height change ΔH 0 are output to the control unit. The control unit obtains the safe braking distance S of the car at the current speed v, and according to the output information of the detection unit And the safe braking distance S obtains the horizontal deflection angle ω and the vertical deflection angle β corresponding to the current optimal lighting position of the headlight, and converts the horizontal deflection angle ω and the vertical deflection angle β into a rotation control signal for the headlight And output to the driving mechanism to control the rotation of the headlight in real time.

作为本发明汽车前照灯自适应控制装置的进一步改进:所述控制单元根据式(101)As a further improvement of the adaptive control device for automobile headlights of the present invention: the control unit according to formula (101)

Figure GDA00002060118500022
式(101)
Figure GDA00002060118500022
Formula (101)

得到前照灯当前最佳照明位置对应的水平偏转角ω、根据式(102)Obtain the horizontal deflection angle ω corresponding to the current best lighting position of the headlight, according to formula (102)

β = tan - 1 Δ H 0 - Δ H 1 D + tan - 1 L - D D ( Δ H 0 - Δ H 1 ) + H D - tan - 1 H C 式(102) β = the tan - 1 Δ h 0 - Δ h 1 D. + the tan - 1 L - D. D. ( Δ h 0 - Δ h 1 ) + h D. - the tan - 1 h C Formula (102)

得到前照灯当前最佳照明位置对应的垂直偏转角β,其中v为汽车的当前速度,k为前轮转向角与方向盘转角

Figure GDA00002060118500032
的比例系数,D为汽车前后轮轮轴之间的距离,L为前照灯与后轮轮轴的水平距离,C为前照灯水平时的照明距离、H为前照灯灯光光轴的离地高度。Get the vertical deflection angle β corresponding to the current optimal lighting position of the headlight, where v is the current speed of the car, and k is the front wheel steering angle and steering wheel angle
Figure GDA00002060118500032
D is the distance between the front and rear wheel axles of the car, L is the horizontal distance between the headlight and the rear wheel axle, C is the illumination distance when the headlight is horizontal, and H is the ground clearance of the light axis of the headlight high.

所述控制单元包括拟合参数数据表和依次相连的信号调理单元、控制决策单元、输出运算单元和执行单元,所述拟合参数数据表与控制决策单元相连,所述检测单元包括用于获取汽车的当前速度v的速度传感器、用于获取汽车的方向盘转角

Figure GDA00002060118500033
的方向盘转角传感器、用于获取汽车的前轮车身高度变化量ΔH1的前轮车身高度传感器、用于获取汽车的后轮车身高度变化量ΔH0的后轮车身高度传感器、用于获取环境的雨量和光线强度的阳光雨量传感器和用于获取汽车加速度的加速度传感器,所述信号调理单元将阳光雨量传感器输出的雨量判定为晴天、小雨或者大雨,将阳光雨量传感器输出的光线强度判定为强光、微光或者黑夜,根据前轮车身高度传感器、后轮车身高度传感器输出的高度信息判定汽车前后倾斜状态为前倾、正常或者后倾,根据加速度传感器输出的加速度信息判定路面平坦度为平坦、正常或者不平坦,将速度传感器输出的汽车行驶速度判定为高速、正常或者低速,所述控制决策单元根据信号调理单元的决策结果从所述拟合参数数据表中查找拐弯距离拟合参数K1、K2、K3,所述输出运算单元获得安全制动距离S,并根据所述检测单元输出的检测数据和所述安全制动距离S输出前照灯当前最佳照明位置对应的水平偏转角ω和垂直偏转角β,所述执行单元将所述水平偏转角ω和垂直偏转角β转换为对前照灯的控制信号并输出至驱动机构。The control unit includes a fitting parameter data table and a sequentially connected signal conditioning unit, a control decision-making unit, an output operation unit and an execution unit, the fitting parameter data table is connected to the control decision-making unit, and the detection unit includes a function for obtaining The speed sensor of the car's current speed v, used to obtain the steering wheel angle of the car
Figure GDA00002060118500033
The steering wheel angle sensor, the front wheel body height sensor used to obtain the vehicle body height change of the front wheel ΔH 1 , the rear wheel body height sensor used to obtain the rear wheel body height change ΔH 0 of the car, the environment The sunlight and rain sensor of rainfall and light intensity and the acceleration sensor used to obtain the acceleration of the car, the signal conditioning unit determines the rainfall output by the sunlight and rain sensor as sunny, light rain or heavy rain, and determines the light intensity output by the sunlight and rain sensor as strong light , twilight or dark night, according to the height information output by the front wheel vehicle height sensor and rear wheel vehicle height sensor, it can be judged whether the front and rear tilt state of the car is forward, normal or backward, and the road surface flatness can be determined according to the acceleration information output by the acceleration sensor. Normal or uneven, determine the vehicle speed output by the speed sensor as high speed, normal or low speed, and the control decision-making unit searches the curve distance fitting parameter K from the fitting parameter data table according to the decision result of the signal conditioning unit , K 2 , K 3 , the output calculation unit obtains the safe braking distance S, and outputs the horizontal deflection corresponding to the current optimal lighting position of the headlight according to the detection data output by the detection unit and the safe braking distance S Angle ω and vertical deflection angle β, the execution unit converts the horizontal deflection angle ω and vertical deflection angle β into control signals for the headlights and outputs them to the drive mechanism.

所述驱动机构包括水平驱动单元和垂直驱动单元,所述水平驱动单元包括用于驱动前照灯沿水平方向转动的水平调整舵机,所述水平调整舵机的输入端与控制单元相连,所述垂直驱动单元包括用于驱动前照灯沿垂直方向转动的垂直调整舵机,所述垂直调整舵机的输入端与控制单元相连,所述水平驱动单元包括水平截止点检测电路,所述水平截止点检测电路在前照灯转动至水平方向最大转角位置时输出检测信号至控制单元;所述垂直驱动单元包括垂直截止点检测电路,所述垂直截止点检测电路在前照灯转动至垂直方向最大转角位置时输出检测信号至控制单元。The drive mechanism includes a horizontal drive unit and a vertical drive unit. The horizontal drive unit includes a horizontal adjustment steering gear for driving the headlamp to rotate in the horizontal direction. The input end of the horizontal adjustment steering gear is connected to the control unit. The vertical drive unit includes a vertical adjustment steering gear for driving the headlight to rotate in the vertical direction, the input end of the vertical adjustment steering gear is connected to the control unit, the horizontal drive unit includes a horizontal cut-off point detection circuit, and the horizontal The cut-off point detection circuit outputs a detection signal to the control unit when the headlight rotates to the maximum angle position in the horizontal direction; the vertical drive unit includes a vertical cut-off point detection circuit, and the vertical cut-off point detection circuit when the headlight rotates to the vertical direction Output a detection signal to the control unit at the maximum rotation angle position.

本发明具有下述优点:The present invention has the following advantages:

1、本发明汽车前照灯自适应控制方法通过先获取安全制动距离,然后根据式(101)和式(102)计算应驱动前照灯的转动角度,转弯的时候自动向内弯一侧调整以增加弯道的可视距离,车辆在前后载荷发生变化时可自动调整前照灯的纵向角度,从而保证最大的可视范围,具有照射范围大、照明效果好、不容易产生反射眩光、结构简单高效、控制精确、环境适应性好、安全可靠、驾驶舒适的优点。1. The self-adaptive control method for automobile headlights of the present invention obtains the safe braking distance first, and then calculates the rotation angle of the headlights that should be driven according to formula (101) and formula (102), and automatically bends inward to one side when turning It can be adjusted to increase the viewing distance of the curve. When the front and rear loads of the vehicle change, the longitudinal angle of the headlight can be automatically adjusted to ensure the largest viewing range. It has the advantages of simple and efficient structure, precise control, good environmental adaptability, safety and reliability, and comfortable driving.

2、本发明根据检测信息进行策略匹配查找预设的拐弯距离拟合参数K1、K2、K3,通过拐弯距离拟合参数K1、K2、K3获取安全制动距离S,可以有效简化处理,提高处理器处理的效率,对硬件的性能要求较低。2. The present invention performs strategy matching according to the detection information to find the preset turning distance fitting parameters K 1 , K 2 , and K 3 , and obtains the safe braking distance S through the turning distance fitting parameters K 1 , K 2 , and K 3 , which can The processing is effectively simplified, the processing efficiency of the processor is improved, and the performance requirements of the hardware are lower.

3、本发明依次根据雨量、光线强度、汽车前后倾斜状态、道路平坦度、汽车行驶速度进行策略匹配来查找拐弯距离拟合参数K1、K2、K3,可以有效简化数据处理模型,而且决策顺序上,由于雨量和光强信息的变化是一个渐变过程,而速度和路面平坦程度的变化是实时的,因此首先对阳关和雨量进行决策有利于增加决策效率。在雨天行驶的时候会抬高前照灯的纵向角度,不易因为地面积水反射光线,可防止地面积水反射眩光,在夜间交通状况比较复杂的市区照射距离更远,灯光更汇集,亮度更强。3. The present invention searches for the curve fitting parameters K 1 , K 2 , and K 3 by performing strategy matching according to rainfall, light intensity, vehicle front and rear inclination, road flatness, and vehicle speed in sequence, which can effectively simplify the data processing model, and In the decision-making sequence, since the change of rainfall and light intensity information is a gradual process, and the change of speed and road surface flatness is real-time, it is beneficial to increase the decision-making efficiency to make decisions on the sun and rainfall first. When driving in rainy days, the longitudinal angle of the headlights will be raised, so that it is not easy to reflect light due to ground water, which can prevent ground water from reflecting glare. In urban areas with complicated traffic conditions at night, the illumination distance is longer, and the lights are more concentrated and brighter. stronger.

4、本发明运用错误检测机制,一旦前照灯控制系统出现初始化错误、前照灯转动故障或者在运行过程中获取传感器数据读取失败,则将前照灯的位置复位,并停止对前照灯的自适应控制,可以有效防止车前照灯的自适应控制出现意外,安全性和有效性好。4. The present invention uses an error detection mechanism. Once an initialization error occurs in the headlight control system, the rotation of the headlight fails, or the reading of sensor data fails during operation, the position of the headlight is reset and the headlight is stopped. The adaptive control of lights can effectively prevent accidents in the adaptive control of headlights, and has good safety and effectiveness.

5、本发明步骤4)中输出的控制信号为渐变式控制信号,因此每个相邻的两个周期输出的信号是逐渐变化的,不会产生信号突变,从而提高了前照灯照明的连续稳定性、安全性和有效性,可以减少舵机突然加速导致的磨损和噪声,同时避免突然的角度调整导致失控的危险。5. The control signal output in step 4) of the present invention is a gradual control signal, so the output signal of each adjacent two cycles changes gradually, and no signal mutation occurs, thereby improving the continuity of the headlight lighting. Stability, safety and effectiveness can reduce the wear and noise caused by the sudden acceleration of the steering gear, and at the same time avoid the risk of loss of control caused by sudden angle adjustments.

6、本发明控制信号为PWM信号,且PWM信号的调整时间与步骤④得到的道路平坦度决策结果和步骤⑤得到的汽车行驶速度决策结果相关,因此可以根据不同路况来调整PWM信号的变化周期,从而可以提高前照灯控制的智能程序和适应性,更加安全可靠。6. The control signal of the present invention is a PWM signal, and the adjustment time of the PWM signal is related to the road flatness decision result obtained in step ④ and the vehicle speed decision result obtained in step ⑤, so the change period of the PWM signal can be adjusted according to different road conditions , so that the intelligent program and adaptability of the headlight control can be improved, making it safer and more reliable.

本发明汽车前照灯自适应控制装置由于具有上述前照灯的自适应控制方法对应的硬件装置,因此也具有与上述方法相对应的优点。The auto headlight adaptive control device of the present invention has hardware devices corresponding to the above-mentioned adaptive control method of headlights, so it also has the advantages corresponding to the above method.

附图说明 Description of drawings

图1为本发明方法实施例的实施流程示意图;Fig. 1 is the implementation flow schematic diagram of the method embodiment of the present invention;

图2为本发明实施例的水平拐角情况数学模型示意图;Fig. 2 is the schematic diagram of the mathematical model of the horizontal corner situation of the embodiment of the present invention;

图3为本发明实施例的垂直调整情况数学模型示意图;Fig. 3 is the schematic diagram of the mathematical model of the vertical adjustment situation of the embodiment of the present invention;

图4为本发明方法实施例策略匹配查找预设的拐弯距离拟合参数的流程示意图;Fig. 4 is a schematic flowchart of strategy matching search for preset turning distance fitting parameters according to the method embodiment of the present invention;

图5为本发明装置实施例的结构示意图;Fig. 5 is the structural representation of the device embodiment of the present invention;

图6为本发明装置实施例中控制单元的结构示意图;Fig. 6 is a schematic structural diagram of a control unit in an embodiment of the device of the present invention;

图7为本发明装置实施例中控制单元的处理流程示意图;Fig. 7 is a schematic diagram of the processing flow of the control unit in the device embodiment of the present invention;

图8为本发明装置实施例中驱动机构的俯视结构示意图;Fig. 8 is a top view structural schematic diagram of the driving mechanism in the device embodiment of the present invention;

图9为本发明装置实施例中驱动机构的后视结构示意图;Fig. 9 is a rear view structural schematic diagram of the driving mechanism in the device embodiment of the present invention;

图10为本发明装置实施例中截止点检测电路的电路原理示意图。Fig. 10 is a schematic diagram of the circuit principle of the cut-off point detection circuit in the device embodiment of the present invention.

图例说明:1、控制单元;11、信号调理单元;12、控制决策单元;13、输出运算单元;14、执行单元;15、拟合参数数据表;2、检测单元;21、速度传感器;22、方向盘转角传感器;23、前轮车身高度传感器;24、后轮车身高度传感器;25、阳光雨量传感器;26、加速度传感器;3、驱动机构;31、水平驱动单元;310、水平调整舵机;311、水平截止点检测电路;32、垂直驱动单元;320、垂直调整舵机;321、垂直截止点检测电路;4、前照灯;41、触点。Legend: 1. Control unit; 11. Signal conditioning unit; 12. Control decision-making unit; 13. Output calculation unit; 14. Execution unit; 15. Fitting parameter data table; 2. Detection unit; 21. Speed sensor; 22 , steering wheel angle sensor; 23, front wheel vehicle height sensor; 24, rear wheel vehicle height sensor; 25, sunlight and rain sensor; 26, acceleration sensor; 3, driving mechanism; 31, horizontal drive unit; 310, horizontal adjustment steering gear; 311. Horizontal cutoff point detection circuit; 32. Vertical drive unit; 320. Vertical adjustment servo; 321. Vertical cutoff point detection circuit; 4. Headlight; 41. Contact.

具体实施方式 Detailed ways

如图1所示,本发明实施例的汽车前照灯自适应控制方法的实施步骤如下:As shown in Figure 1, the implementation steps of the adaptive control method for automobile headlights in the embodiment of the present invention are as follows:

1)实时获取汽车的当前速度v,获取汽车在当前速度v下的安全制动距离S;1) Obtain the current speed v of the car in real time, and obtain the safe braking distance S of the car at the current speed v;

2)实时获取汽车的方向盘转角

Figure GDA00002060118500051
并根据式(101)2) Obtain the steering wheel angle of the car in real time
Figure GDA00002060118500051
And according to formula (101)

Figure GDA00002060118500052
式(101)
Figure GDA00002060118500052
Formula (101)

得到前照灯当前最佳照明位置对应的水平偏转角ω,其中k为前轮转向角与方向盘转角的比例系数,D为汽车前后轮轮轴之间的距离;Obtain the horizontal deflection angle ω corresponding to the current optimal lighting position of the headlight, where k is the steering angle of the front wheel and the steering wheel angle The proportional coefficient of D is the distance between the front and rear wheel axles of the car;

3)实时获取前轮车身高度变化量ΔH1,后轮车身高度变化量ΔH0,并根据式(102)3) Obtain the change amount ΔH 1 of the front wheel body height and the change amount ΔH 0 of the rear wheel body height in real time, and according to formula (102)

β = tan - 1 Δ H 0 - Δ H 1 D + tan - 1 L - D D ( Δ H 0 - Δ H 1 ) + H D - tan - 1 H C 式(102) β = the tan - 1 Δ h 0 - Δ h 1 D. + the tan - 1 L - D. D. ( Δ h 0 - Δ h 1 ) + h D. - the tan - 1 h C Formula (102)

得到前照灯当前最佳照明位置对应的垂直偏转角β,其中L为前照灯与后轮轮轴的水平距离,C为前照灯水平时的照明距离、H为前照灯灯光光轴的离地高度;The vertical deflection angle β corresponding to the current optimal lighting position of the headlight is obtained, where L is the horizontal distance between the headlight and the rear wheel axle, C is the lighting distance when the headlight is horizontal, and H is the distance of the light axis of the headlight height above the ground;

4)根据上述水平偏转角ω和垂直偏转角β输出控制信号实时控制前照灯转动。4) Output the control signal according to the above-mentioned horizontal deflection angle ω and vertical deflection angle β to control the rotation of the headlight in real time.

如图2所示,δ为外侧前轮转向角,因此可知

Figure GDA00002060118500055
根据阿克曼转向几何原理:sinδ=D/R对安全制动距离S采用拟合方法进行预估,则有S=2Rsinω,由此可以推导得出式(101)。汽车的方向盘转角
Figure GDA00002060118500056
与前轮转向角之间呈线性关系,k即为前轮转向角与方向盘转角
Figure GDA00002060118500057
的比例系数,车型不同,比例系数k的具体取值也会有所不同。As shown in Figure 2, δ is the steering angle of the outer front wheel, so we know
Figure GDA00002060118500055
According to Ackermann's steering geometry principle: sinδ=D/R, the safe braking distance S is estimated by fitting method, then S=2Rsinω, from which the formula (101) can be derived. car steering wheel angle
Figure GDA00002060118500056
There is a linear relationship between it and the front wheel steering angle, k is the front wheel steering angle and the steering wheel angle
Figure GDA00002060118500057
The specific value of the proportional coefficient k will be different for different models.

如图3所示,车身前后倾角为α,ρ为前照灯4水平时的照明角度,则有

Figure GDA00002060118500058
As shown in Figure 3, the fore and aft inclination angle of the vehicle body is α, and ρ is the illumination angle when the headlight 4 is horizontal, then there is
Figure GDA00002060118500058

因此 α = tan - 1 Δ H 0 - Δ H 1 D , 又根据therefore α = the tan - 1 Δ h 0 - Δ h 1 D. , And according to

ρρ == tanthe tan -- 11 ΔHΔH ++ Hh DD. -- tanthe tan -- 11 Hh CC ,,

ΔHΔH == LL -- DD. DD. (( ΔΔ Hh 00 -- ΔΔ Hh 11 )) ,,

β=α+ρβ=α+ρ

其中ΔH为灯光光轴高度变化量,由此可以推导得出式(102)。Where ΔH is the change in height of the optical axis of the light, from which formula (102) can be derived.

安全制动距离S理论上可以通过路面平均摩擦系数结合汽车的当前速度v进行估算。为了提高安全制动距离S的估算精度,本实施例通过结合雨量、光线强度、汽车前后倾斜状态、道路平坦度和汽车行驶速度信息的方式来估算安全制动距离S。步骤1)中获取安全制动距离S前预设拟合参数数据表,获取安全制动距离S时先获取当前的雨量、光线强度、汽车前后倾斜状态和道路平坦度,然后根据上述信息查找拟合参数数据表获取拐弯距离拟合参数K1、K2、K3,并根据步骤1)获得的当前速度v以及S=K1v2+K2v+K3获得安全制动距离S。The safe braking distance S can theoretically be estimated by combining the average friction coefficient of the road surface with the current speed v of the vehicle. In order to improve the estimation accuracy of the safe braking distance S, in this embodiment, the safe braking distance S is estimated by combining the information of rainfall, light intensity, vehicle tilt state, road flatness and vehicle speed. In step 1), obtain the preset fitting parameter data table before the safe braking distance S. When obtaining the safe braking distance S, first obtain the current rainfall, light intensity, vehicle front and rear tilt status, and road flatness, and then search for the proposed model according to the above information. Obtain the curve distance fitting parameters K 1 , K 2 , and K 3 according to the parameter data table, and obtain the safe braking distance S according to the current speed v obtained in step 1) and S=K 1 v 2 +K 2 v+K 3 .

本实施例中雨量根据数值范围分为晴天、小雨和大雨,光线强度根据数值范围分为强光、微光和黑夜,汽车前后倾斜状态根据数值范围分为前倾、正常和后倾,道路平坦度根据数值范围分为平坦、正常和不平坦,汽车行驶速度根据数值范围分为高速、正常和低速。设置拐弯距离拟合参数K1、K2、K3时,首先针对雨量、光线强度、汽车前后倾斜状态、道路平坦度、汽车行驶速度五种因素组合的集合中的每一个元素进行实验,获取该元素对应因素下的速度和安全制动距离S的多组对应实验值,然后通过最小二乘法二次曲线拟合获取该元素对应因素下的拐弯距离拟合参数K1、K2、K3。例如在某元素对应因素下的速度和安全制动距离S的多组对应实验值如下表所示:In this embodiment, the rainfall is divided into sunny, light rain and heavy rain according to the numerical range, and the light intensity is divided into strong light, dim light and night according to the numerical range. The speed is divided into flat, normal and uneven according to the numerical range, and the driving speed of the car is divided into high speed, normal and low speed according to the numerical range. When setting the fitting parameters K 1 , K 2 , and K 3 of the turning distance, first conduct an experiment on each element in the set of five factors including rainfall, light intensity, vehicle front and rear tilt, road flatness, and vehicle speed, and obtain Multiple sets of corresponding experimental values of speed and safe braking distance S under the corresponding factors of this element, and then obtain the fitting parameters K 1 , K 2 , K 3 of the turning distance under the corresponding factors of this element through quadratic curve fitting of the least square method . For example, multiple sets of corresponding experimental values of speed and safe braking distance S under the corresponding factors of a certain element are shown in the following table:

  i i   0 0   1 1   2 2   3 3   4 4   5 5   6 6   7 7   8 8   9 9   xi x i   10 10   20 20   30 30   40 40   50 50   60 60   70 70   80 80   90 90   100 100   yi y i   7 7   12 12   15 15   22 twenty two   27 27   41 41   58 58   64 64   83 83   102 102

其中,i为序号,xi为车速(单位为米/秒),yi为安全制动距离(单位为米)。Among them, i is the serial number, x i is the vehicle speed (in m/s), and y i is the safe braking distance (in m).

采用最小二乘法二次曲线拟合:Quadratic curve fitting using the least squares method:

1010 ΣΣ ii == 00 99 xx ii ΣΣ ii == 00 99 xx ii 22 ΣΣ ii == 00 99 xx ii ΣΣ ii == 00 99 xx ii 22 ΣΣ ii == 00 99 xx ii 33 ΣΣ ii == 00 99 xx ii 22 ΣΣ ii == 00 99 xx ii 33 ΣΣ ii == 00 99 xx ii 44 KK 11 KK 22 KK 33 == ΣΣ ii == 00 99 ythe y ii ΣΣ ii == 00 99 xx ii ythe y ii ΣΣ ii == 00 99 xx ii nno ythe y ii

得到拐弯距离拟合参数:K1=0.0095833 K2=-0.012348,K3=6.8833。最后针对雨量、光线强度、汽车前后倾斜状态、道路平坦度五种因素进行任意组合得到五种因素组合的集合,针对该集合的每一个元素进行实验,最终可以得到35组拐弯距离拟合参数K1、K2、K3并预先存储于拟合参数数据表15中。在工作过程中,只需要根据传感器数据得到雨量、光线强度、汽车前后倾斜状态、道路平坦度信息并将其调理成相匹配的信息,然后根据调理结果进行策略匹配查找预设的拐弯距离拟合参数K1、K2、K3即可快速获得安全制动距离S。The fitting parameters of the turning distance are obtained: K 1 =0.0095833 K 2 =-0.012348, K 3 =6.8833. Finally, any combination of the five factors of rainfall, light intensity, car tilt state, and road flatness can be combined to obtain a set of five factor combinations. Experiments are carried out on each element of the set, and finally 3 to 5 sets of turning distance fitting parameters can be obtained. K 1 , K 2 , and K 3 are stored in the fitting parameter data table 15 in advance. During the working process, it is only necessary to obtain the rainfall, light intensity, vehicle front and rear tilt status, and road flatness information according to the sensor data and adjust them into matching information, and then carry out strategy matching according to the adjustment results to find the preset turning distance fitting Parameters K 1 , K 2 , and K 3 can quickly obtain the safe braking distance S.

如图4所示,本实施例中获取拐弯距离拟合参数K1、K2、K3的详细步骤如下:As shown in Figure 4, the detailed steps for obtaining the curve fitting parameters K 1 , K 2 , and K 3 in this embodiment are as follows:

①对雨量进行决策,判定其属于晴天、小雨或者大雨;① Make a decision on the amount of rainfall and determine whether it is sunny, light rain or heavy rain;

②对光线强度进行决策,判定其属于强光、微光或者黑夜;② Make a decision on the light intensity, and determine whether it belongs to strong light, dim light or night;

③对汽车前后倾斜状态进行决策,判定其属于前倾、正常或者后倾;③Decision-making on the forward and backward tilt state of the car, and determine whether it is forward tilt, normal or backward tilt;

④对道路平坦度进行决策,判定其属于平坦、正常或者不平坦;④ Make a decision on the flatness of the road, and determine whether it is flat, normal or uneven;

⑤对汽车行驶速度进行决策,判定其属于高速、正常或者低速;⑤ Make a decision on the driving speed of the car, and determine whether it belongs to high speed, normal or low speed;

⑥根据上述①~⑤的决策结果查询拟合参数数据表得到拐弯距离拟合参数K1、K2、K3⑥ According to the decision results of ①~⑤ above, query the fitting parameter data table to obtain the turning distance fitting parameters K 1 , K 2 , and K 3 .

通过采用不同的控制策略,做到在路面平坦车速较快的高速路上照射距离更远,灯光更汇集,亮度更强;在车速较慢路面平坦的城市道路上,将光轴向左下方旋转,提高驾驶员侧人行道上的照明;在有雨光强较弱的雨雪雾天时,通过压低分散前照灯的照明角度,防止在车前形成聚光,减小光线通过地面积水反射对迎面车辆造成眩光的效应,同时,提高驾驶员近前方和左右侧的照明;根据车速,方向盘转角及车身倾角,动态调整前照灯角度,保证弯道安全照明范围。在各种颠簸路面和短时间路面冲击(减速路障)下,前照灯照射距离不进行频繁的调整,防止驾驶员眼睛疲劳。By adopting different control strategies, the irradiation distance is longer, the light is more concentrated and the brightness is stronger on the expressway with flat road surface and fast speed; Improve the lighting on the sidewalk on the driver's side; in rainy, snowy and foggy days with weak rain light intensity, by reducing the lighting angle of the scattered headlights, prevent the formation of concentrated light in front of the car, and reduce the light reflected by the ground water to the head The glare effect caused by the vehicle, at the same time, the lighting near the front and the left and right sides of the driver is improved; according to the speed of the vehicle, the angle of the steering wheel and the inclination of the body, the angle of the headlights is dynamically adjusted to ensure the safe lighting range of the curve. Under various bumpy roads and short-term road impacts (deceleration roadblocks), the headlight irradiation distance will not be adjusted frequently to prevent driver's eye fatigue.

步骤1)中获取汽车的当前速度v前包括对汽车前照灯进行转动检测的步骤,如果前照灯转动发生故障,则将前照灯的位置复位并停止对前照灯的自适应控制。此外,如果在初始化出错,或者运行过程中发生故障,同样将前照灯的位置复位,并停止对前照灯的自适应控制。前照灯的初始位置复位检测可以保证了安全性和有效性,防止车前照灯的自适应控制出现意外。Step 1) before obtaining the current speed v of the car includes the step of detecting the rotation of the headlights of the car. If the rotation of the headlights fails, reset the position of the headlights and stop the adaptive control of the headlights. In addition, if there is an error in initialization or a fault occurs during operation, the position of the headlight is also reset, and the adaptive control of the headlight is stopped. The initial position reset detection of the headlights can ensure safety and effectiveness, and prevent accidents in the adaptive control of the headlights.

步骤4)中输出的控制信号为渐变式控制信号。本实施例中,控制信号为PWM信号,渐变式控制信号是指控制信号与初始控制信号之间的关系为(P-P0)=nt,其中P为当前输出PWM信号的占空比参数,P0为初始PWM信号的占空比参数,n为每次调整的变化量,t为调整时间,t取值与步骤④得到的道路平坦度决策结果和步骤⑤得到的汽车行驶速度决策结果相关,汽车高速行驶、道路不平坦时,t取值无穷大,PWM信号保持不变;汽车高速行驶、道路正常时,t取值0.75s;汽车高速行驶、道路平坦时,t取值0.5s;汽车正常行驶、道路不平坦时,t取值1.5s;汽车正常行驶、道路正常时,t取值1s;汽车正常行驶、道路平坦时,t取值0.75s;汽车低速行驶、道路不平坦时,t取值2s;汽车低速行驶、道路正常时,t取值1.5s;汽车低速行驶、道路平坦时,t取值1.25s。其关系如下表所示:The control signal output in step 4) is a gradual control signal. In this embodiment, the control signal is a PWM signal, and the gradually changing control signal means that the relationship between the control signal and the initial control signal is (PP 0 )=nt, where P is the duty ratio parameter of the current output PWM signal, and P 0 is the duty cycle parameter of the initial PWM signal, n is the amount of change for each adjustment, t is the adjustment time, and the value of t is related to the decision result of road flatness obtained in step ④ and the decision result of vehicle speed obtained in step ⑤. When driving at high speed and the road is uneven, the value of t is infinite, and the PWM signal remains unchanged; when the car is driving at high speed and the road is normal, the value of t is 0.75s; when the car is driving at high speed and the road is flat, the value of t is 0.5s; the car is running normally 1. When the road is uneven, t is 1.5s; when the car is driving normally and the road is normal, t is 1s; when the car is driving normally and the road is flat, t is 0.75s; The value of t is 2s; when the car is running at low speed and the road is normal, t takes the value of 1.5s; when the car is running at low speed and the road is flat, t takes the value of 1.25s. The relationship is shown in the table below:

  不平坦 Uneven   正常 normal   平坦 flat   高速 high speed   t=∞ t=∞   t=0.75 t=0.75   t=0.5 t=0.5   正常 normal   t=1.5 t=1.5   t=1 t=1   t=0.75 t=0.75   低速 low speed   t=2 t=2   t=1.5 t=1.5   t=1.25 t=1.25

对于水平偏转角ω有ω=mP,对于垂直偏转角β有β=m′P,其中m为车灯水平转向偏角与占空比的比例系数,m′为车灯垂直转向偏角与占空比的比例系数,P为输出偏转控制信号的占空比参数。在旋转角度调整过程中,控制信号的输出值采用逐级变化的方法,在每一个系统周期增加一个变量,直到输出值变为运算要求值。因此每个相邻的两个周期输出的信号是逐渐变化的,不会产生信号突变,从而提高了前照灯照明的连续稳定性、安全性和有效性,可以减少舵机突然加速导致的磨损和噪声,同时避免突然的角度调整导致失控的危险。For the horizontal deflection angle ω, there is ω=mP, and for the vertical deflection angle β, there is β=m′P, where m is the ratio coefficient of the horizontal steering deflection angle of the vehicle light to the duty cycle, and m’ is the vertical deflection angle of the vehicle light and the duty ratio The proportional coefficient of the duty ratio, P is the duty ratio parameter of the output deflection control signal. In the process of adjusting the rotation angle, the output value of the control signal adopts the method of step-by-step change, and a variable is increased in each system cycle until the output value becomes the operation required value. Therefore, the output signal of each adjacent two cycles changes gradually, and no signal mutation occurs, thereby improving the continuous stability, safety and effectiveness of the headlight lighting, and reducing the wear caused by the sudden acceleration of the steering gear and noise, while avoiding the risk of loss of control due to sudden angle adjustments.

如图5所示,本发明实施例的汽车前照灯自适应控制装置包括控制单元1和分别与控制单元1相连的检测单元2、驱动机构3,检测单元2实时获取汽车的当前速度v、方向盘转角前轮车身高度变化量ΔH1以及后轮车身高度变化量ΔH0并输出至控制单元1,控制单元1获取汽车在当前速度v下的安全制动距离S,并安全制动距离S和检测单元2输出的检测数据获取前照灯当前最佳照明位置对应的水平偏转角ω、垂直偏转角β,并将水平偏转角ω和垂直偏转角β转换为对前照灯的转动控制信号并输出至驱动机构3实时控制前照灯转动,其中v为汽车的当前速度,k为前轮转向角与方向盘转角

Figure GDA00002060118500082
的比例系数,D为汽车前后轮轮轴之间的距离,L为前照灯与后轮轮轴的水平距离,C为前照灯水平时的照明距离、H为前照灯灯光光轴的离地高度。As shown in Figure 5, the adaptive control device for automobile headlights of the embodiment of the present invention includes a control unit 1 and a detection unit 2 and a drive mechanism 3 that are respectively connected to the control unit 1, and the detection unit 2 obtains the current speed v, steering wheel angle The front wheel body height change ΔH 1 and the rear wheel body height change ΔH 0 are output to the control unit 1, the control unit 1 obtains the safe braking distance S of the car at the current speed v, and the safe braking distance S and the detection unit 2 The output detection data obtains the horizontal deflection angle ω and the vertical deflection angle β corresponding to the current optimal lighting position of the headlamp, and converts the horizontal deflection angle ω and the vertical deflection angle β into rotation control signals for the headlamp and outputs them to The driving mechanism 3 controls the rotation of the headlights in real time, where v is the current speed of the car, and k is the steering angle of the front wheels and the steering wheel angle
Figure GDA00002060118500082
D is the distance between the front and rear wheel axles of the car, L is the horizontal distance between the headlight and the rear wheel axle, C is the illumination distance when the headlight is horizontal, and H is the ground clearance of the light axis of the headlight high.

本实施例中,控制单元1根据式(101)In this embodiment, the control unit 1 according to formula (101)

式(101) Formula (101)

得到前照灯当前最佳照明位置对应的水平偏转角ω、根据式(102)Obtain the horizontal deflection angle ω corresponding to the current best lighting position of the headlight, according to formula (102)

β = tan - 1 Δ H 0 - Δ H 1 D + tan - 1 L - D D ( Δ H 0 - Δ H 1 ) + H D - tan - 1 H C 式(102) β = the tan - 1 Δ h 0 - Δ h 1 D. + the tan - 1 L - D. D. ( Δ h 0 - Δ h 1 ) + h D. - the tan - 1 h C Formula (102)

得到前照灯当前最佳照明位置对应的垂直偏转角β,其中v为汽车的当前速度,k为前轮转向角与方向盘转角的比例系数,D为汽车前后轮轮轴之间的距离,L为前照灯与后轮轮轴的水平距离,C为前照灯水平时的照明距离、H为前照灯灯光光轴的离地高度。Get the vertical deflection angle β corresponding to the current optimal lighting position of the headlight, where v is the current speed of the car, and k is the front wheel steering angle and steering wheel angle D is the distance between the front and rear wheel axles of the car, L is the horizontal distance between the headlight and the rear wheel axle, C is the illumination distance when the headlight is horizontal, and H is the ground clearance of the light axis of the headlight high.

如图5和图6所示,控制单元1包括拟合参数数据表15和依次相连的信号调理单元11、控制决策单元12、输出运算单元13和执行单元14,拟合参数数据表15与控制决策单元12相连,检测单元2包括用于获取汽车的当前速度v的速度传感器21、用于获取汽车的方向盘转角

Figure GDA00002060118500091
的方向盘转角传感器22、用于获取汽车的前轮车身高度变化量ΔH1的前轮车身高度传感器23、用于获取汽车的后轮车身高度变化量ΔH0的后轮车身高度传感器24、用于获取环境的雨量和光线强度的阳光雨量传感器25和用于获取汽车加速度的加速度传感器26,信号调理单元11将阳光雨量传感器25输出的雨量判定为晴天、小雨或者大雨,将阳光雨量传感器25输出的光线强度判定为强光、微光或者黑夜,根据前轮车身高度传感器23、后轮车身高度传感器24输出的高度信息判定汽车前后倾斜状态为前倾、正常或者后倾,根据加速度传感器26输出的加速度信息判定路面平坦度为平坦、正常或者不平坦,将速度传感器21输出的汽车行驶速度判定为高速、正常或者低速,控制决策单元12根据信号调理单元11的决策结果从拟合参数数据表15中查找拐弯距离拟合参数K1、K2、K3,输出运算单元13获得安全制动距离S,并根据检测单元2输出的检测数据和安全制动距离S输出前照灯当前最佳照明位置对应的水平偏转角ω和垂直偏转角β,执行单元14将水平偏转角ω和垂直偏转角β转换为对前照灯的控制信号并输出至驱动机构3。As shown in Figure 5 and Figure 6, the control unit 1 includes a fitting parameter data table 15 and a signal conditioning unit 11, a control decision-making unit 12, an output operation unit 13 and an execution unit 14 connected in sequence, the fitting parameter data table 15 and the control The decision-making unit 12 is connected, and the detection unit 2 includes a speed sensor 21 for obtaining the current speed v of the automobile, and a steering wheel angle for obtaining the automobile.
Figure GDA00002060118500091
Steering wheel angle sensor 22, the front wheel body height sensor 23 for obtaining the front wheel body height variation ΔH 1 of the automobile, the rear wheel body height sensor 24 for obtaining the rear wheel body height variation ΔH 0 of the automobile, Obtain the sunshine rain sensor 25 of the rainfall of environment and light intensity and be used to obtain the acceleration sensor 26 of automobile acceleration, the signal conditioning unit 11 judges the rainfall that sunshine rain sensor 25 outputs as sunny day, light rain or heavy rain, the output of sunshine rain sensor 25 The light intensity is judged as glare, low light or night, and the height information output by the front wheel vehicle height sensor 23 and the rear wheel vehicle height sensor 24 is used to determine whether the front and rear tilt state of the car is forward, normal or backward, and according to the output of the acceleration sensor 26 Acceleration information determines that the road surface flatness is flat, normal or uneven, and the vehicle speed output by the speed sensor 21 is determined as high speed, normal or low speed, and the control decision unit 12 selects from the fitting parameter data table 15 according to the decision result of the signal conditioning unit 11. Find the fitting parameters K 1 , K 2 , and K 3 of the turning distance, and the output operation unit 13 obtains the safe braking distance S, and outputs the current optimal lighting of the headlight according to the detection data output by the detection unit 2 and the safe braking distance S The position corresponds to the horizontal deflection angle ω and the vertical deflection angle β. The execution unit 14 converts the horizontal deflection angle ω and the vertical deflection angle β into control signals for the headlights and outputs them to the drive mechanism 3 .

本实施例中,控制单元1通过LIN总线与阳光雨量传感器25相连,通过CAN总线与速度传感器21、方向盘转角传感器22相连。前轮车身高度传感器23和后轮车身高度传感器24通过与车轴或车轮悬挂装置相连接的传动杆上的转动杆检测车身高度变化量,前轮车身高度传感器23和后轮车身高度传感器24通常放置于车身和悬架之间,通过光耦组件的开关状态判断车身的高度,一般通过电控悬架采集然后通过车身网络共享信息。对于没有电控悬架的车辆,只需要加装车身高度传感器即可。阳光雨量传感器25为科士达生产的传感器模块,阳光雨量传感器25通过LIN总线与控制单元1相连。阳光雨量传感器25包括光线传感器、发射和接收二极管,光敏传感器是一种光电管,检测到的光强信息也通过LIN总线传送给控制单元1。发射和接收二极管分别发射和接收红外线,光线离开发射器二极管经过多次反射到达接收二极管,如果光学单元周围的风窗玻璃变湿或者变脏,部分反射光将会被损失掉,接收到的光由阳光雨量传感器25进行评估,并转化为信号值。雨量传感器中的微控元件会检测信号的变化,并通过LIN总线将信号传给控制单元1。加速度传感器26采用ADXL330加速度传感器,ADXL330加速度传感器输出信号为三维坐标轴的加速度大小信息,通过AD采样取得相应方向的加速度值,对加速度大小的实时监测能够有效的判断类似减速带导致的短暂车身倾角变化,结合车身高度变化量信息能够有效的判断路面状况。In this embodiment, the control unit 1 is connected to the sunlight and rain sensor 25 through the LIN bus, and connected to the speed sensor 21 and the steering wheel angle sensor 22 through the CAN bus. The front wheel vehicle height sensor 23 and the rear wheel vehicle height sensor 24 detect the change in vehicle height through the rotating rod on the transmission rod connected to the axle or wheel suspension. The front wheel vehicle height sensor 23 and the rear wheel vehicle height sensor 24 are usually placed Between the vehicle body and the suspension, the height of the vehicle body is judged by the switch state of the optocoupler component, and the information is generally collected by the electronically controlled suspension and then shared through the vehicle body network. For vehicles without electronically controlled suspension, it is only necessary to install a vehicle height sensor. The sunlight and rain sensor 25 is a sensor module produced by KSTAR, and the sunlight and rain sensor 25 is connected with the control unit 1 through the LIN bus. The sunlight and rain sensor 25 includes a light sensor, emitting and receiving diodes, the photosensitive sensor is a photoelectric tube, and the detected light intensity information is also transmitted to the control unit 1 through the LIN bus. The emitting and receiving diodes emit and receive infrared rays respectively. The light leaves the emitter diode and reaches the receiving diode after multiple reflections. If the windshield around the optical unit becomes wet or dirty, part of the reflected light will be lost, and the received light It is evaluated by the sun and rain sensor 25 and converted into a signal value. The micro-control element in the rain sensor can detect the change of the signal, and transmit the signal to the control unit 1 through the LIN bus. The acceleration sensor 26 adopts the ADXL330 acceleration sensor. The output signal of the ADXL330 acceleration sensor is the acceleration information of the three-dimensional coordinate axis. The acceleration value in the corresponding direction is obtained through AD sampling. The real-time monitoring of the acceleration can effectively judge the short-term vehicle body inclination caused by similar speed bumps Changes, combined with the vehicle height change information, can effectively judge the road condition.

本实施例中,根据加速度传感器26输出的加速度信息判定路面平坦度时,通过连续采用加速度信息,如果加速度变化超过0.5g,则判定为发生一次跳变,然后根据一定周期内的跳变次数判定路面状况。本实施例的跳变次数与路面平坦度的关系如下表所示:In this embodiment, when judging the flatness of the road surface according to the acceleration information output by the acceleration sensor 26, by continuously using the acceleration information, if the acceleration change exceeds 0.5g, it is determined that a jump occurs, and then it is judged according to the number of jumps in a certain period road conditions. The relationship between the number of jumps and the flatness of the road surface in this embodiment is shown in the table below:

  采样时间 sampling time   采样次数 Sampling times   跳变阈值 jump threshold   跳变次数 Number of jumps   路面平坦度 road flatness   0.1s 0.1s   20 20   0.5g 0.5g   大于6 Greater than 6   不平坦 Uneven   0.1s 0.1s   20 20   0.5g 0.5g   2~6 2~6   正常 normal   0.1s 0.1s   20 20   0.5g 0.5g   小于2 Less than 2   平坦 flat

本实施例中,控制单元1的主控芯片采用freescale的八位控制器MC9S08DZ60,该控制器集成了SCI、CAN、A/D、PWM、SPI等模块。电源控制器采用MC33742,MC33742为集成CAN收发器和电源转换功能的系统基础芯片,电源控制器与汽车的12V电源相连,将12V电源转换为5V电源后为控制单元1供电。如图7所示,系统上电后,控制单元1的主控芯片首先进行上电初始化,待内部锁相环工作稳定,对SCI、CAN、I/O、PWM等模块寄存器进行初始化,同时对LIN总线进行配置,对CAN总线数据进行监测。然后调用自检子程序,PWM控制舵机使前照灯调整到上下左右极大角,同时读取I/O口状态。待自检完成后,对自检结果进行判断:如果出现故障,禁用前照灯的自适应控制功能,发送大灯调整至原点控制命令,并输出故障信息;如果没有出现故障,读取雨量、光线强度、汽车前后倾斜高度、加速度、汽车行驶速度信息,信号调理单元11将上述信息进行调理,得到适合控制决策的信息;控制决策单元12调理的决策结果进行控制决策,选择拐弯距离拟合参数;输出运算单元13根据拐弯距离拟合参数获取汽车的安全制动距离,并根据检测单元2输出的检测数据和安全制动距离输出水平偏转角ω和垂直偏转角β;执行单元14将水平偏转角ω和垂直偏转角β转换为PWM信号后输出。In this embodiment, the main control chip of the control unit 1 adopts a freescale eight-bit controller MC9S08DZ60, which integrates modules such as SCI, CAN, A/D, PWM, and SPI. The power controller adopts MC33742. MC33742 is a system basic chip integrating CAN transceiver and power conversion function. The power controller is connected to the 12V power supply of the car, and the 12V power supply is converted into a 5V power supply to supply power to the control unit 1. As shown in Figure 7, after the system is powered on, the main control chip of the control unit 1 is first powered on and initialized. After the internal phase-locked loop works stably, the module registers such as SCI, CAN, I/O, and PWM are initialized. Configure the LIN bus and monitor the CAN bus data. Then call the self-inspection subroutine, PWM controls the steering gear to adjust the headlight to the maximum angle of up, down, left, and right, and reads the state of the I/O port at the same time. After the self-inspection is completed, judge the self-inspection result: if there is a fault, disable the adaptive control function of the headlight, send the headlight adjustment to the origin control command, and output the fault information; if there is no fault, read the rainfall, The signal conditioning unit 11 adjusts the above information to obtain information suitable for control decision-making; the control decision-making unit 12 adjusts the decision-making results for control decision-making, and selects the curve fitting parameters The output operation unit 13 obtains the safe braking distance of the automobile according to the curve distance fitting parameters, and outputs the horizontal deflection angle ω and the vertical deflection angle β according to the detection data and the safe braking distance output by the detection unit 2; the execution unit 14 will deflect the horizontal The angle ω and the vertical deflection angle β are converted into PWM signals and output.

如图8和图9所示,前照灯4通过触点41与汽车的电源相连。驱动机构3包括水平驱动单元31和垂直驱动单元32,水平驱动单元31包括用于驱动前照灯沿水平方向转动的水平调整舵机310,水平调整舵机310的输入端与控制单元1相连,垂直驱动单元32包括用于驱动前照灯沿垂直方向转动的垂直调整舵机320,垂直调整舵机320的输入端与控制单元1相连。本实施例中,水平驱动单元31包括水平截止点检测电路311,水平截止点检测电路311在前照灯转动至水平方向最大转角位置时输出检测信号至控制单元1;垂直驱动单元32包括垂直截止点检测电路321,垂直截止点检测电路321在前照灯转动至垂直方向最大转角位置时输出检测信号至控制单元1。As shown in FIG. 8 and FIG. 9 , the headlight 4 is connected with the power supply of the automobile through a contact 41 . The drive mechanism 3 includes a horizontal drive unit 31 and a vertical drive unit 32. The horizontal drive unit 31 includes a horizontal adjustment steering gear 310 for driving the headlamp to rotate in the horizontal direction. The input end of the horizontal adjustment steering gear 310 is connected to the control unit 1. The vertical driving unit 32 includes a vertical adjustment steering gear 320 for driving the headlamp to rotate in the vertical direction, and the input end of the vertical adjustment steering gear 320 is connected to the control unit 1 . In this embodiment, the horizontal drive unit 31 includes a horizontal cut-off point detection circuit 311, and the horizontal cut-off point detection circuit 311 outputs a detection signal to the control unit 1 when the headlamp rotates to the maximum horizontal angle position; the vertical drive unit 32 includes a vertical cut-off point detection circuit 311. The point detection circuit 321 , the vertical cut-off point detection circuit 321 outputs a detection signal to the control unit 1 when the headlamp rotates to the maximum rotation angle position in the vertical direction.

如图10所示,水平截止点检测电路311包括水平设于前照灯两侧的两个截止点检测开关K1和K2,垂直截止点检测电路321包括垂直设于前照灯两侧的两个截止点检测开关K3和K4,截止点检测开关K1、K2、K3和K4分别对应输出端口PB0、PB1、PB2和PB3,输出端口PB0、PB1、PB2和PB3与控制单元1相连。当前照灯转动至截止点检测开关对应的最大转角位置时,其对应的输出端输出高电平信号至控制单元1。在初始化的时候,控制单元1控制水平调整舵机310和垂直调整舵机320进行最大角度转动,当输出控制信号后与PB0、PB1、PB2和PB3相连的端口中一个或者多个没有输入高电平,则可以判定出错,此时控制单元1通过CAN总线输出报警信号,并停用前照灯的自适应控制功能。As shown in Figure 10, the horizontal cut-off point detection circuit 311 includes two cut-off point detection switches K1 and K2 horizontally arranged on both sides of the headlight, and the vertical cut-off point detection circuit 321 includes two vertically arranged on both sides of the headlight The cut-off detection switches K3 and K4, the cut-off detection switches K1, K2, K3 and K4 respectively correspond to the output ports PB0, PB1, PB2 and PB3, and the output ports PB0, PB1, PB2 and PB3 are connected to the control unit 1. When the headlight rotates to the maximum rotation angle position corresponding to the cut-off point detection switch, its corresponding output terminal outputs a high-level signal to the control unit 1 . At the time of initialization, the control unit 1 controls the horizontal adjustment steering gear 310 and the vertical adjustment steering gear 320 to perform the maximum angle rotation. After outputting the control signal, one or more of the ports connected to PB0, PB1, PB2 and PB3 do not input high power. Ping, then it can be judged that there is an error. At this time, the control unit 1 outputs an alarm signal through the CAN bus, and disables the adaptive control function of the headlight.

以上所述仅是本发明的优选实施方式,本发明的保护范围并不仅局限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。The above descriptions are only preferred implementations of the present invention, and the protection scope of the present invention is not limited to the above-mentioned embodiments, and all technical solutions under the idea of the present invention belong to the protection scope of the present invention. It should be pointed out that for those skilled in the art, some improvements and modifications without departing from the principles of the present invention should also be regarded as the protection scope of the present invention.

Claims (7)

1.一种汽车前照灯自适应控制方法,其特征在于其实施步骤如下:1. A method for adaptive control of automobile headlights, characterized in that its implementation steps are as follows: 1)实时获取汽车的当前速度v,获取汽车在当前速度v下的安全制动距离S;1) Obtain the current speed v of the car in real time, and obtain the safe braking distance S of the car at the current speed v; 2)实时获取汽车的方向盘转角
Figure FDA00002060118400011
并根据式(101)
2) Obtain the steering wheel angle of the car in real time
Figure FDA00002060118400011
And according to formula (101)
Figure FDA00002060118400012
式(101)
Figure FDA00002060118400012
Formula (101)
得到前照灯当前最佳照明位置对应的水平偏转角ω,其中k为前轮转向角与方向盘转角
Figure FDA00002060118400013
的比例系数,D为汽车前后轮轮轴之间的距离;
Obtain the horizontal deflection angle ω corresponding to the current optimal lighting position of the headlight, where k is the steering angle of the front wheel and the steering wheel angle
Figure FDA00002060118400013
The proportional coefficient of D is the distance between the front and rear wheel axles of the car;
3)实时获取前轮车身高度变化量ΔH1、后轮车身高度变化量ΔH0,并根据式(102)3) Obtain the front wheel body height change ΔH 1 and the rear wheel body height change ΔH 0 in real time, and according to formula (102) β = tan - 1 Δ H 0 - Δ H 1 D + tan - 1 L - D D ( Δ H 0 - Δ H 1 ) + H D - tan - 1 H C 式(102) β = the tan - 1 Δ h 0 - Δ h 1 D. + the tan - 1 L - D. D. ( Δ h 0 - Δ h 1 ) + h D. - the tan - 1 h C Formula (102) 得到前照灯当前最佳照明位置对应的垂直偏转角β,其中L为前照灯与后轮轮轴的水平距离,C为前照灯水平时的照明距离、H为前照灯灯光光轴的离地高度;The vertical deflection angle β corresponding to the current optimal lighting position of the headlight is obtained, where L is the horizontal distance between the headlight and the rear wheel axle, C is the lighting distance when the headlight is horizontal, and H is the distance of the light axis of the headlight height above the ground; 4)根据上述水平偏转角ω和垂直偏转角β输出控制信号实时控制前照灯转动;4) Output the control signal according to the above horizontal deflection angle ω and vertical deflection angle β to control the rotation of the headlight in real time; 所述步骤1)中获取安全制动距离S前预设拟合参数数据表,所述获取安全制动距离S时先获取当前的雨量、光线强度、汽车前后倾斜状态和道路平坦度,然后根据上述信息查找拟合参数数据表获取拐弯距离拟合参数K1、K2、K3,并根据所述步骤1)获得的当前速度v以及S=K1v2+K2v+K3获得安全制动距离S。In the step 1), the preset fitting parameter data table is obtained before the safe braking distance S. When obtaining the safe braking distance S, the current rainfall, light intensity, vehicle front and rear tilt state and road flatness are obtained first, and then according to Find the fitting parameter data table for the above information to obtain the turning distance fitting parameters K 1 , K 2 , and K 3 , and obtain the current speed v and S=K 1 v 2 +K 2 v+K 3 according to the current speed v obtained in the above step 1) Safe braking distance S.
2.根据权利要求1所述的汽车前照灯自适应控制方法,其特征在于:所述获取拐弯距离拟合参数K1、K2、K3的详细步骤如下:2. The adaptive control method for automobile headlights according to claim 1, characterized in that: the detailed steps of obtaining the fitting parameters K 1 , K 2 , and K 3 of the turning distance are as follows: ①对雨量进行决策,判定其属于晴天、小雨或者大雨;① Make a decision on the amount of rainfall and determine whether it is sunny, light rain or heavy rain; ②对光线强度进行决策,判定其属于强光、微光或者黑夜;② Make a decision on the light intensity, and determine whether it belongs to strong light, dim light or night; ③对汽车前后倾斜状态进行决策,判定其属于前倾、正常或者后倾;③Decision-making on the forward and backward tilt state of the car, and determine whether it is forward tilt, normal or backward tilt; ④对道路平坦度进行决策,判定其属于平坦、正常或者不平坦;④ Make a decision on the flatness of the road, and determine whether it is flat, normal or uneven; ⑤对汽车行驶速度进行决策,判定其属于高速、正常或者低速;⑤ Make a decision on the driving speed of the car, and determine whether it belongs to high speed, normal or low speed; ⑥根据上述①~⑤的决策结果查询拟合参数数据表得到拐弯距离拟合参数K1、K2、K3⑥ According to the decision results of ①~⑤ above, query the fitting parameter data table to obtain the turning distance fitting parameters K 1 , K 2 , and K 3 . 3.根据权利要求1或2所述的汽车前照灯自适应控制方法,其特征在于:所述步骤1)中获取汽车的当前速度v前包括对汽车前照灯进行转动检测的步骤,如果前照灯转动发生故障,则将前照灯的位置复位并停止对前照灯的自适应控制。3. The adaptive control method for automobile headlights according to claim 1 or 2, wherein the step 1) includes the step of detecting the rotation of the automobile headlights before obtaining the current speed v of the automobile, if If the rotation of the headlight fails, the position of the headlight is reset and the adaptive control of the headlight is stopped. 4.根据权利要求1或2所述的汽车前照灯自适应控制方法,其特征在于:所述步骤4)中输出的控制信号为渐变式控制信号。4. The adaptive control method for automobile headlights according to claim 1 or 2, characterized in that the control signal output in step 4) is a gradual control signal. 5.根据权利要求4所述的汽车前照灯自适应控制方法,其特征在于:所述控制信号为PWM信号,所述渐变式控制信号是指控制信号与初始控制信号之间的关系为(P-P0)=nt,其中P为当前输出PWM信号的占空比参数,P0为初始PWM信号的占空比参数,n为每次调整的变化量,t为调整时间,所述t取值与所述步骤④得到的道路平坦度决策结果和所述步骤⑤得到的汽车行驶速度决策结果相关,汽车高速行驶、道路不平坦时,t取值无穷大,PWM信号保持不变;汽车高速行驶、道路正常时,t取值0.75s;汽车高速行驶、道路平坦时,t取值0.5s;汽车正常行驶、道路不平坦时,t取值1.5s;汽车正常行驶、道路正常时,t取值1s;汽车正常行驶、道路平坦时,t取值0.75s;汽车低速行驶、道路不平坦时,t取值2s;汽车低速行驶、道路正常时,t取值1.5s;汽车低速行驶、道路平坦时,t取值1.25s。5. The adaptive control method for automobile headlights according to claim 4, characterized in that: the control signal is a PWM signal, and the gradual change control signal means that the relationship between the control signal and the initial control signal is ( PP 0 )=nt, wherein P is the duty cycle parameter of the current output PWM signal, P 0 is the duty cycle parameter of the initial PWM signal, n is the variation of each adjustment, and t is the adjustment time, and the value of t is Relevant to the road flatness decision result obtained in step ④ and the vehicle speed decision result obtained in step ⑤, when the car runs at high speed and the road is uneven, t takes an infinite value, and the PWM signal remains unchanged; when the car runs at high speed, When the road is normal, the value of t is 0.75s; when the car is driving at high speed and the road is flat, the value of t is 0.5s; when the car is driving normally and the road is uneven, the value of t is 1.5s; 1s; when the car is driving normally and the road is flat, the value of t is 0.75s; when the car is driving at a low speed and the road is uneven, the value of t is 2s; when the car is driving at a low speed and the road is normal, the value of t is 1.5s; When t takes the value of 1.25s. 6.一种汽车前照灯自适应控制装置,包括控制单元(1)和分别与控制单元(1)相连的检测单元(2)、驱动机构(3),其特征在于:所述检测单元(2)实时获取汽车的当前速度v、方向盘转角前轮车身高度变化量ΔH1以及后轮车身高度变化量ΔH0并输出至控制单元(1),所述控制单元(1)获取汽车在当前速度v下的安全制动距离S,并根据所述检测单元(2)的输出信息以及安全制动距离S获取前照灯当前最佳照明位置对应的水平偏转角ω、垂直偏转角β,并将所述水平偏转角ω和垂直偏转角β转换为对前照灯的转动控制信号并输出至驱动机构(3)实时控制前照灯转动;所述控制单元(1)根据式(101)6. An adaptive control device for automobile headlights, comprising a control unit (1), a detection unit (2) connected to the control unit (1), and a drive mechanism (3), characterized in that: the detection unit ( 2) Obtain the current speed v and steering wheel angle of the car in real time The front wheel body height change ΔH 1 and the rear wheel body height change ΔH 0 are output to the control unit (1), and the control unit (1) obtains the safe braking distance S of the car at the current speed v, and according to the Obtain the horizontal deflection angle ω and the vertical deflection angle β corresponding to the current optimal lighting position of the headlamp from the output information of the detection unit (2) and the safe braking distance S, and convert the horizontal deflection angle ω and the vertical deflection angle β In order to control the rotation of the headlight and output the signal to the drive mechanism (3) to control the rotation of the headlight in real time; the control unit (1) according to formula (101)
Figure FDA00002060118400022
式(101)
Figure FDA00002060118400022
Formula (101)
得到前照灯当前最佳照明位置对应的水平偏转角ω、根据式(102)Obtain the horizontal deflection angle ω corresponding to the current best lighting position of the headlight, according to formula (102) β = tan - 1 Δ H 0 - Δ H 1 D + tan - 1 L - D D ( Δ H 0 - Δ H 1 ) + H D - tan - 1 H C 式(102) β = the tan - 1 Δ h 0 - Δ h 1 D. + the tan - 1 L - D. D. ( Δ h 0 - Δ h 1 ) + h D. - the tan - 1 h C Formula (102) 得到前照灯当前最佳照明位置对应的垂直偏转角β,其中v为汽车的当前速度,k为前轮转向角与方向盘转角
Figure FDA00002060118400024
的比例系数,D为汽车前后轮轮轴之间的距离,L为前照灯与后轮轮轴的水平距离,C为前照灯水平时的照明距离、H为前照灯灯光光轴的离地高度;所述控制单元(1)包括拟合参数数据表(15)和依次相连的信号调理单元(11)、控制决策单元(12)、输出运算单元(13)和执行单元(14),所述拟合参数数据表(15)与控制决策单元(12)相连,所述检测单元(2)包括用于获取汽车的当前速度v的速度传感器(21)、用于获取汽车的方向盘转角
Figure FDA00002060118400025
的方向盘转角传感器(22)、用于获取汽车的前轮车身高度变化量ΔH1的前轮车身高度传感器(23)、用于获取汽车的后轮车身高度变化量ΔH0的后轮车身高度传感器(24)、用于获取环境的雨量和光线强度的阳光雨量传感器(25)和用于获取汽车加速度的加速度传感器(26),所述信号调理单元(11)将阳光雨量传感器(25)输出的雨量判定为晴天、小雨或者大雨,将阳光雨量传感器(25)输出的光线强度判定为强光、微光或者黑夜,根据前轮车身高度传感器(23)、后轮车身高度传感器(24)输出的高度信息判定汽车前后倾斜状态为前倾、正常或者后倾,根据加速度传感器(26)输出的加速度信息判定路面平坦度为平坦、正常或者不平坦,将速度传感器(21)输出的汽车行驶速度判定为高速、正常或者低速,所述控制决策单元(12)根据信号调理单元(11)的决策结果从所述拟合参数数据表(15)中查找拐弯距离拟合参数K1、K2、K3,所述输出运算单元(13)获得安全制动距离S,并根据所述检测单元(2)输出的检测数据和所述安全制动距离S输出前照灯当前最佳照明位置对应的水平偏转角ω和垂直偏转角β,所述执行单元(14)将所述水平偏转角ω和垂直偏转角β转换为对前照灯的控制信号并输出至驱动机构(3)。
Get the vertical deflection angle β corresponding to the current optimal lighting position of the headlight, where v is the current speed of the car, and k is the front wheel steering angle and steering wheel angle
Figure FDA00002060118400024
D is the distance between the front and rear wheel axles of the car, L is the horizontal distance between the headlight and the rear wheel axle, C is the illumination distance when the headlight is horizontal, and H is the ground clearance of the light axis of the headlight Height; the control unit (1) includes a fitting parameter data table (15) and a signal conditioning unit (11), a control decision-making unit (12), an output calculation unit (13) and an execution unit (14), which are sequentially connected. The fitting parameter data table (15) is connected to the control decision-making unit (12), and the detection unit (2) includes a speed sensor (21) for obtaining the current speed v of the vehicle, a steering wheel angle for obtaining the vehicle
Figure FDA00002060118400025
The steering wheel angle sensor (22), the front wheel body height sensor (23) used to obtain the vehicle body height variation of the front wheels ΔH 1 , the rear wheel body height sensor used to obtain the vehicle body height change amount of the rear wheels ΔH 0 (24), the sunlight and rain sensor (25) used to obtain the environmental rain and light intensity and the acceleration sensor (26) used to obtain the acceleration of the vehicle, the signal conditioning unit (11) outputs the sunlight and rain sensor (25) The rainfall is judged as sunny, light rain or heavy rain, and the light intensity output by the sunlight and rain sensor (25) is judged as strong light, dim light or night, according to the output of the front wheel vehicle height sensor (23) and the rear wheel vehicle height sensor (24) Determine whether the front and rear tilt state of the car is forward, normal or backward based on the height information, determine whether the road surface flatness is flat, normal or uneven according to the acceleration information output by the acceleration sensor (26), and determine the vehicle speed output by the speed sensor (21) is high speed, normal or low speed, the control decision unit (12) looks up the curve distance fitting parameters K 1 , K 2 , K from the fitting parameter data table (15) according to the decision result of the signal conditioning unit (11) 3. The output calculation unit (13) obtains the safe braking distance S, and outputs the level corresponding to the current optimal lighting position of the headlight according to the detection data output by the detection unit (2) and the safe braking distance S The deflection angle ω and the vertical deflection angle β, the execution unit (14) converts the horizontal deflection angle ω and the vertical deflection angle β into control signals for the headlights and outputs them to the drive mechanism (3).
7.根据权利要求6所述的汽车前照灯自适应控制装置,其特征在于:所述驱动机构(3)包括水平驱动单元(31)和垂直驱动单元(32),所述水平驱动单元(31)包括用于驱动前照灯沿水平方向转动的水平调整舵机(310),所述水平调整舵机(310)的输入端与控制单元(1)相连,所述垂直驱动单元(32)包括用于驱动前照灯沿垂直方向转动的垂直调整舵机(320),所述垂直调整舵机(320)的输入端与控制单元(1)相连,所述水平驱动单元(31)包括水平截止点检测电路(311),所述水平截止点检测电路(311)在前照灯转动至水平方向最大转角位置时输出检测信号至控制单元(1);所述垂直驱动单元(32)包括垂直截止点检测电路(321),所述垂直截止点检测电路(321)在前照灯转动至垂直方向最大转角位置时输出检测信号至控制单元(1)。7. The adaptive control device for automobile headlights according to claim 6, characterized in that: the driving mechanism (3) includes a horizontal driving unit (31) and a vertical driving unit (32), and the horizontal driving unit ( 31) Including a horizontal adjustment steering gear (310) for driving the headlight to rotate in the horizontal direction, the input end of the horizontal adjustment steering gear (310) is connected to the control unit (1), and the vertical driving unit (32) It includes a vertical adjustment steering gear (320) for driving the headlamp to rotate in the vertical direction, the input end of the vertical adjustment steering gear (320) is connected to the control unit (1), and the horizontal driving unit (31) includes a horizontal Cutoff point detection circuit (311), the horizontal cutoff point detection circuit (311) outputs a detection signal to the control unit (1) when the headlamp rotates to the maximum horizontal angle position; the vertical drive unit (32) includes a vertical A cut-off point detection circuit (321), the vertical cut-off point detection circuit (321) outputs a detection signal to the control unit (1) when the headlamp rotates to the maximum vertical angle position.
CN 201010593738 2010-12-17 2010-12-17 Headlamp adaptive control method and device Expired - Fee Related CN102029941B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN 201010593738 CN102029941B (en) 2010-12-17 2010-12-17 Headlamp adaptive control method and device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN 201010593738 CN102029941B (en) 2010-12-17 2010-12-17 Headlamp adaptive control method and device

Publications (2)

Publication Number Publication Date
CN102029941A CN102029941A (en) 2011-04-27
CN102029941B true CN102029941B (en) 2012-12-05

Family

ID=43883568

Family Applications (1)

Application Number Title Priority Date Filing Date
CN 201010593738 Expired - Fee Related CN102029941B (en) 2010-12-17 2010-12-17 Headlamp adaptive control method and device

Country Status (1)

Country Link
CN (1) CN102029941B (en)

Families Citing this family (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101478073B1 (en) * 2013-08-07 2015-01-02 주식회사 만도 Apparatus for controlling lamp of vehicle and method for controlling lamp thereof
CN104661360A (en) * 2013-11-18 2015-05-27 上海汽车集团股份有限公司 Device for achieving lighting function of daytime running lamp for dipped headlight of vehicle
CN103661084B (en) * 2013-11-29 2016-04-06 河北工业大学 The device of Based Intelligent Control car light crevice projection angle and projection intensity
CN104228665B (en) * 2014-09-17 2016-08-24 南京航空航天大学 A kind of control method of self-adapted car headlamp
CN104553962B (en) * 2014-12-12 2016-08-24 广西科技大学鹿山学院 A kind of vehicle servo-actuated headlamp redundancy control method
CN104786915A (en) * 2015-03-30 2015-07-22 无锡市崇安区科技创业服务中心 Irradiation direction adjusting method for automobile headlamp on curve
CN106772334B (en) * 2015-11-24 2019-07-05 同济大学 A kind of attitude control method of Vehicle radar
CN106341591B (en) * 2015-11-24 2019-10-01 同济大学 A kind of control method of automobile camera head
CN105501107A (en) * 2015-12-15 2016-04-20 长安大学 Automatic vehicle illumination control system and control method
CN107487254A (en) * 2016-08-03 2017-12-19 宝沃汽车(中国)有限公司 Lamp control system, method and vehicle before a kind of automotive self-adaptive
CN106828287B (en) * 2017-02-22 2020-03-03 北京经纬恒润科技有限公司 Headlamp rotation control method, device and system
JP6980486B2 (en) * 2017-10-24 2021-12-15 株式会社小糸製作所 Vehicle lighting control device and vehicle lighting system
CN107914632A (en) * 2017-11-30 2018-04-17 苏州切思特电子有限公司 The method of adjustment of vehicle front lighting light regulating system based on hall sensing
CN109969107A (en) * 2017-12-28 2019-07-05 中移物联网有限公司 A vehicle and its control method, device, system and storage medium
CN108638954B (en) * 2018-07-16 2020-04-14 河南科技大学 A method of vehicle headlight corner control based on safety equation
CN111731182A (en) * 2020-02-19 2020-10-02 江苏大学 A low beam lighting control system and method capable of adapting to bad weather
CN111559308B (en) * 2020-05-28 2023-02-07 哈尔滨工业大学 A vehicle adaptive curve lighting system and its control method
CN111595563A (en) * 2020-06-10 2020-08-28 中汽院智能网联科技有限公司 A vehicle-based dynamic test method for headlamp lighting performance
CN111595562A (en) * 2020-06-10 2020-08-28 中汽院智能网联科技有限公司 Dynamic test system for illumination performance of vehicle headlamp
CN113415233B (en) * 2021-06-11 2022-05-27 广州广日电气设备有限公司 MAP self-learning-based dot-matrix car lamp curve lighting control method and system
CN115805862B (en) * 2022-12-29 2024-01-23 苏州市欧冶半导体有限公司 Self-adaptive headlamp adjusting method and related equipment
CN116494863A (en) * 2023-04-18 2023-07-28 吉林大学 An adaptive headlight system and control method based on motion attitude perception

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6578993B2 (en) * 2000-08-09 2003-06-17 Koito Manufacturing Co., Ltd. Vehicle headlamp system
CN101365278A (en) * 2008-09-22 2009-02-11 中国汽车技术研究中心 Kinematics Model and Control Method of Adaptive Headlight System
CN101365277A (en) * 2008-09-22 2009-02-11 中国汽车技术研究中心 Adaptive front lighting system and its failure monitoring and processing method
CN201319679Y (en) * 2008-09-22 2009-09-30 中国汽车技术研究中心 Structure of adaptive front-lighting system based on network technologies

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4402909B2 (en) * 2003-06-25 2010-01-20 日立オートモティブシステムズ株式会社 Auto light device

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6578993B2 (en) * 2000-08-09 2003-06-17 Koito Manufacturing Co., Ltd. Vehicle headlamp system
CN101365278A (en) * 2008-09-22 2009-02-11 中国汽车技术研究中心 Kinematics Model and Control Method of Adaptive Headlight System
CN101365277A (en) * 2008-09-22 2009-02-11 中国汽车技术研究中心 Adaptive front lighting system and its failure monitoring and processing method
CN201319679Y (en) * 2008-09-22 2009-09-30 中国汽车技术研究中心 Structure of adaptive front-lighting system based on network technologies

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
陈建林,吴青,初秀民,王维锋.汽车AFS系统车灯转角动态模型研究.<<2008第四届中国智能交通年会论文集>>.2009,全文. *
陈建林.基于驾驶模拟器的汽车AFS系统控制策略研究.<<中国优秀硕士学位论文全文数据库>>.2009,正文第3章. *

Also Published As

Publication number Publication date
CN102029941A (en) 2011-04-27

Similar Documents

Publication Publication Date Title
CN102029941B (en) Headlamp adaptive control method and device
CN105291959B (en) A kind of two-dimensional adaptive headlamp control system and its control method
CN106004638A (en) Intelligent control device for automobile headlamps and method for controlling headlamps
CN201659924U (en) Adaptive system of headlight brightness
CN108790938B (en) Motor torque control method for different driving modes
CN108657062A (en) A kind of adjustable intelligent vehicle head lamp system of brightness based on environment and method
GB2324213A (en) Vehicle headlight beam pattern control
CN105501107A (en) Automatic vehicle illumination control system and control method
CN202782866U (en) Intelligent car headlamp system based on radar detection
CN202863243U (en) Light adjusting system and vehicle
CN104859593A (en) Automatic lamplight/automatic rain wiping realizing method according to external environment
CN105292062B (en) A kind of vehicle-mounted rainfall detection control device of low-consumption wireless
CN207274535U (en) The control system of intelligent headlight before a kind of automobile
CN104228665A (en) Adaptive automobile headlamp and control method thereof
US20060202812A1 (en) Turn signal indicator lamp system, a brake light system and a headlight system for a car
CN106043106A (en) Self-adaption headlamp system for automobile
KR101231511B1 (en) Adaptive front light system and operating method
CN108621917A (en) A kind of intelligence control system for vehicle head lamp
CN214564938U (en) Novel AFS headlamp
CN101157349A (en) An automatic regulating apparatus of front light of automobile
CN209833487U (en) turn lighting system
CN203020164U (en) Curve self-adaption lighting device of automotive headlamp
CN104442546A (en) Automobile light self-adaptation control device based on CAN (controller area network) bus and control method thereof
CN202345508U (en) Automatic regulation and control system for automobile light
CN202669608U (en) Intelligent auxiliary illuminating device for car

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
CI01 Publication of corrected invention patent application

Correction item: Claims

Correct: Correct

False: Error

Number: 17

Volume: 27

CI02 Correction of invention patent application

Correction item: Claims

Correct: Correct

False: Error

Number: 17

Page: Description

Volume: 27

ERR Gazette correction

Free format text: CORRECT: CLAIMS; FROM: WRONG TO: CORRECT

C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20121205

Termination date: 20151217

EXPY Termination of patent right or utility model