JP4670841B2 - Vehicle travel control device - Google Patents

Vehicle travel control device Download PDF

Info

Publication number
JP4670841B2
JP4670841B2 JP2007172404A JP2007172404A JP4670841B2 JP 4670841 B2 JP4670841 B2 JP 4670841B2 JP 2007172404 A JP2007172404 A JP 2007172404A JP 2007172404 A JP2007172404 A JP 2007172404A JP 4670841 B2 JP4670841 B2 JP 4670841B2
Authority
JP
Japan
Prior art keywords
vehicle
optical axis
control
sensor
axis deviation
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 - Lifetime
Application number
JP2007172404A
Other languages
Japanese (ja)
Other versions
JP2007290708A (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.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
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 Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2007172404A priority Critical patent/JP4670841B2/en
Publication of JP2007290708A publication Critical patent/JP2007290708A/en
Application granted granted Critical
Publication of JP4670841B2 publication Critical patent/JP4670841B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Images

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Regulating Braking Force (AREA)

Description

本発明は、自車両前方の物体との相対位置関係に応じて走行制御を行うようにした車両用走行制御装置に関する。   The present invention relates to a vehicular travel control apparatus that performs travel control according to a relative positional relationship with an object in front of the host vehicle.

従来の車両用走行制御装置としては、自車両前方の物体を認識するセンサで停止物(前方路側のデリニエータ)を検出した場合に、その移動軌跡を統計的に処理することにより、センサの光軸ずれ量(車両の前後軸線方向からのずれ量)を検出し、光軸ずれ量に基づいて前方物体との相対位置情報を補正するというものが知られている(例えば、特許文献1参照)。
特開平10−132939号公報
As a conventional vehicle travel control device, when a stop (a delineator on the front road side) is detected by a sensor that recognizes an object in front of the host vehicle, the movement trajectory is statistically processed, whereby the optical axis of the sensor is detected. It is known that a deviation amount (a deviation amount from the front-rear axis direction of the vehicle) is detected, and relative position information with respect to a front object is corrected based on the optical axis deviation amount (see, for example, Patent Document 1).
JP-A-10-132939

しかしながら、上記従来の車両用走行制御装置にあっては、停止物の移動軌跡を統計的に処理することでセンサの光軸ずれを検出するため、実際に光軸ずれが発生してから、かなり時間が経過しないと検出することができない。そのため、軽衝突等により光軸ずれが発生した場合には、光軸ずれが検出されるまでは、光軸がずれたままシステムが作動してしまうという未解決の課題がある。   However, in the above conventional vehicle travel control device, since the optical axis deviation of the sensor is detected by statistically processing the movement trajectory of the stationary object, the optical axis deviation actually occurs. It cannot be detected until the time has passed. Therefore, when an optical axis shift occurs due to a light collision or the like, there is an unsolved problem that the system operates with the optical axis shifted until the optical axis shift is detected.

そこで、本発明は、上記従来例の未解決の課題に着目してなされたものであり、自車両前方の物体を認識するためのセンサの検出範囲にずれが発生した場合に、直ちにそれを検出することが可能な車両用走行制御装置を提供することを目的としている。   Accordingly, the present invention has been made paying attention to the unsolved problems of the conventional example described above, and when a deviation occurs in the detection range of a sensor for recognizing an object ahead of the host vehicle, it is immediately detected. It is an object of the present invention to provide a vehicular travel control device that can do this.

上記目的を達成するために、本発明に係る車両用走行制御装置は、衝突回避判断手段が衝突回避不可能と判断し、且つ所定の作動条件が満たされた場合に自車両を自動制動制御する自動制動制御の終了後であって、前記衝突回避判断手段が衝突回避不可能と判断した衝突により前記前方物体検出手段の検出範囲が変化した場合に、自動制動制御手段による自動制動制御、又は走行制御手段による走行制御が作動され難くなるように作動条件を変更する。 In order to achieve the above object, the vehicular travel control apparatus according to the present invention performs automatic braking control of the host vehicle when the collision avoidance determining means determines that collision avoidance is impossible and a predetermined operating condition is satisfied. After the end of automatic braking control, when the detection range of the front object detecting means changes due to a collision determined by the collision avoidance determining means that collision avoidance is impossible, automatic braking control by the automatic braking control means or traveling The operating conditions are changed so that the travel control by the control means is hardly operated.

本発明によれば、衝突回避判断手段が衝突回避不可能と判断した衝突により前方物体検出手段の検出範囲が変化した場合に、自動制動制御手段による自動制動制御、又は走行制御手段による走行制御が作動され難くなるように作動条件を変更するので、衝突による前方物体検出手段の検出範囲の変化により前方物体の位置を正確に認識することができないまま自動制動制御又は走行制御を行うことを確実に防止できると共に、安全走行を確保することができるという効果が得られる。 According to the present invention, when the detection range of the front object detection unit changes due to a collision that the collision avoidance determination unit determines that collision avoidance is impossible, the automatic braking control by the automatic braking control unit or the traveling control by the traveling control unit is performed. Since the operating condition is changed so that it is difficult to be operated, it is ensured that automatic braking control or traveling control is performed without being able to accurately recognize the position of the front object due to a change in the detection range of the front object detection means due to a collision. In addition to preventing this, it is possible to obtain an effect of ensuring safe driving.

以下、本発明の実施の形態を図面に基づいて説明する。
まず、第1の実施形態を説明する。
図1は本発明を、衝突速度低減装置を搭載した後輪駆動車に適用した場合の実施形態を示す概略構成図であり、図中、1FL,1FRは従動輪としての前輪、1RL,1RRは駆動輪としての後輪であって、後輪1RL,1RRは、エンジン2の駆動力が自動変速機3、プロペラシャフト4、最終減速装置5及び車軸6を介して伝達されて回転駆動される。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
First, the first embodiment will be described.
FIG. 1 is a schematic configuration diagram showing an embodiment in which the present invention is applied to a rear wheel drive vehicle equipped with a collision speed reduction device. In the figure, 1FL and 1FR are front wheels as driven wheels, 1RL and 1RR are The rear wheels 1RL and 1RR as driving wheels are driven to rotate by the driving force of the engine 2 being transmitted through the automatic transmission 3, the propeller shaft 4, the final reduction gear 5 and the axle 6.

前輪1FL,1FR及び後輪1RL,1RRには、夫々制動力を発生する例えばディスクブレーキで構成されるブレーキアクチュエータ7が設けられていると共に、これらブレーキアクチュエータ7の制動油圧が制動制御装置8によって制御される。
ここで、制動制御装置8は、図示しないブレーキペダルの踏込みに応じて制動油圧を発生すると共に、走行制御コントローラ20からの制動圧指令値PBRに応じて制動油圧を発生し、これをブレーキアクチュエータ7に出力するように構成されている。また、自動変速機3の出力側に配設された出力軸の回転速度を検出することにより、自車速Vsを検出する車速センサ13が配設されている。
The front wheels 1FL, 1FR and the rear wheels 1RL, 1RR are each provided with a brake actuator 7 composed of, for example, a disc brake that generates a braking force, and the braking hydraulic pressure of these brake actuators 7 is controlled by a braking control device 8. Is done.
Here, the braking control device 8 generates a braking hydraulic pressure in response to depression of a brake pedal (not shown), and also generates a braking hydraulic pressure in accordance with a braking pressure command value P BR from the travel control controller 20, and this is generated as a brake actuator. 7 to output to. Further, a vehicle speed sensor 13 for detecting the host vehicle speed Vs by detecting the rotation speed of the output shaft provided on the output side of the automatic transmission 3 is provided.

一方、車両の前方側の車体下部には、前方物体検出手段としての前方物体センサ14が設けられており、スキャニング式のレーザレーダにより、一定角度ずつ水平方向にずれながら周期的に車両の前方方向に所定の照射範囲(例えば、水平方向で12°〜24°、上下方向で4°)内で細かいレーザ光を照射し、前方物体から反射して戻ってくる反射光を受光して、出射タイミングから反射光の受光タイミングまでの時間差に基づいて、図2に示すように、各角度における自車両MCと前方物体PCとの間の相対距離drを検出する。検出された前方物体までの相対距離drの時間的変化から前方物体と自車両との相対速度Vrを算出し、前方物体センサ14の検出信号及びそのスキャニング角度に基づいて、自車両の進行方向を基準とし、これに対する前方物体の左右エッジの角度範囲θR及びθLを検出する。 On the other hand, a front object sensor 14 as a front object detection means is provided at the lower part of the vehicle body on the front side of the vehicle, and is periodically scanned in the forward direction of the vehicle while being shifted in the horizontal direction by a predetermined angle by a scanning laser radar. Is irradiated with a fine laser beam within a predetermined irradiation range (for example, 12 ° to 24 ° in the horizontal direction and 4 ° in the vertical direction), and the reflected light reflected and returned from the front object is received, and the emission timing As shown in FIG. 2, the relative distance dr between the host vehicle MC and the front object PC at each angle is detected based on the time difference from the received light timing to the reflected light reception timing. The relative speed Vr between the front object and the host vehicle is calculated from the detected temporal change in the relative distance dr to the front object, and the traveling direction of the host vehicle is determined based on the detection signal of the front object sensor 14 and its scanning angle. As a reference, the angle ranges θ R and θ L of the left and right edges of the front object relative to this are detected.

この前方物体センサ14は、通常、その光軸方向が自車両の前後軸線から許容誤差範囲内(例えば、±0.5°)の高精度で締結具等により取り付けられているが、車両に何らかの衝撃が加わること等により、センサの光軸方向が自車両の前後軸線方向から許容誤差範囲内を超えて左右にずれると、斜め前方の物体を自車両前方の物体と誤認識し、上下にずれると前方物体を認識できないなど、前方物体との相対位置関係を正確に検出することができない。   The front object sensor 14 is usually attached with a fastener or the like with a high accuracy whose optical axis direction is within an allowable error range (for example, ± 0.5 °) from the longitudinal axis of the host vehicle. If the sensor's optical axis direction deviates from the front / rear axis direction of the host vehicle to the left or right, for example, due to an impact, the object in front of the vehicle is misrecognized as the object in front of the host vehicle and shifts up and down. Therefore, the relative positional relationship with the front object cannot be detected accurately.

また、この車両には、自車両に発生する前後加速度Xgを検出する加速度センサ15、自車両に発生するヨーレートφを検出するヨーレートセンサ16が設けられている。さらに、車室内には光軸ずれ表示装置17が設けられており、前方物体センサ14の光軸ずれを検出して走行制御コントローラ20から光軸ずれ報知指令が入力されると、運転者に光軸ずれ状態を提示する。   Further, this vehicle is provided with an acceleration sensor 15 for detecting the longitudinal acceleration Xg generated in the host vehicle and a yaw rate sensor 16 for detecting the yaw rate φ generated in the host vehicle. Further, an optical axis misalignment display device 17 is provided in the vehicle interior. When the optical axis misalignment notification command is input from the travel controller 20 by detecting the optical axis misalignment of the front object sensor 14, a light is transmitted to the driver. Presents the off-axis state.

そして、車速センサ13から出力される自車速Vs、前方物体センサ14から出力される相対距離dr、相対速度Vr、角度範囲θR、θL、加速度センサ15から出力される加速度Xg、及びヨーレートセンサ16から出力されるヨーレートφが走行制御コントローラ20に入力され、この走行制御コントローラ20によって、車速センサ13、前方物体センサ14、加速度センサ15、及びヨーレートセンサ16の何れか一つのセンサから入力される信号をもとに前方物体センサ14に検出範囲が変化する衝撃が加わったか否かを判断し、前方物体センサ14の光軸ずれ量Δθを推定する。また、この走行制御コントローラ20は、前方物体センサ14で検出した前方物体との相対距離drが、光軸ずれ量Δθに基づいて設定される制動制御作動距離dSET以下のときに、制動圧指令値PBRを制動制御装置8に出力して自車両の制動制御を行うことを許可する。 Then, the host vehicle speed Vs output from the vehicle speed sensor 13, the relative distance dr output from the front object sensor 14, the relative speed Vr, the angle ranges θ R and θ L , the acceleration Xg output from the acceleration sensor 15, and the yaw rate sensor 16 is input to the travel controller 20, and is input from the vehicle controller 13 by any one of the vehicle speed sensor 13, the front object sensor 14, the acceleration sensor 15, and the yaw rate sensor 16. Based on the signal, it is determined whether or not an impact that changes the detection range is applied to the front object sensor 14, and the optical axis deviation amount Δθ of the front object sensor 14 is estimated. The travel controller 20 also determines a braking pressure command when the relative distance dr detected by the front object sensor 14 is equal to or less than the braking control operating distance d SET set based on the optical axis deviation amount Δθ. The value P BR is output to the braking control device 8 to permit the braking control of the host vehicle.

次に、第1の実施形態の動作を走行制御コントローラ20で実行する制動制御作動判断処理手順を示す図3を伴って説明する。
この制動制御作動判断処理は、所定時間(例えば10msec)毎のタイマ割込処理として実行され、先ず、ステップS1で、前方物体センサ14で検出した相対距離dr、相対速度Vr、角度範囲θR、θLを読込む。
Next, the operation of the first embodiment will be described with reference to FIG. 3 showing a braking control operation determination processing procedure executed by the travel controller 20.
This brake control operation determination process is executed as a timer interruption process at predetermined time intervals (for example, 10 msec). First, in step S1, the relative distance dr, the relative speed Vr, the angle range θ R detected by the front object sensor 14, It reads the θ L.

次いで、ステップS2に移行して、後述する衝撃判断処理で前方物体センサ14への検出範囲が変化する衝撃を検知して、制動制御の禁止判断及び制動制御作動距離dSETの設定を行い、ステップS3に移行する。
このステップS3では、前記ステップS2で設定した制動制御禁止フラグFCAが制御禁止を表す“1”にセットされており、且つ自動制動が非作動中であるか否かを判定し、FCA=1且つ自動制動非作動中であるときには、ステップS4に移行して制動制御の作動を禁止してからタイマ割込処理を終了して所定のメインプログラムに復帰する。
Next, the process proceeds to step S2, in which an impact change in the detection range to the front object sensor 14 is detected in an impact determination process described later, a brake control prohibition determination and a brake control operating distance dSET are set. The process proceeds to S3.
In this step S3, it is determined whether or not the braking control prohibition flag F CA set in step S2 is set to “1” indicating control prohibition, and whether or not automatic braking is inactive, and F CA = 1 and when the automatic braking is not in operation, the process proceeds to step S4, the operation of the braking control is prohibited, the timer interruption process is terminated, and the process returns to the predetermined main program.

ステップS3の判定結果が、FCA=0又は自動制動作動中であるときには、ステップS5に移行して、自車両が制動制御許可領域内を走行しているか否かを判定する。この判定は、前方物体との相対距離drが前記ステップS2で設定した制動制御作動距離dSETを超えているか否かによって行い、FCA=0且つdr>dSETであるときには、自車両が制動制御禁止領域内を走行していると判断して前記ステップS4に移行する。一方、それ以外の場合にはステップS6に移行し、ドライバの制動操作によって前方物体との衝突が回避可能か否かを判断する。 If the determination result in step S3 is F CA = 0 or the automatic braking operation is being performed, the process proceeds to step S5 to determine whether or not the host vehicle is traveling in the braking control permission area. This determination is made based on whether or not the relative distance dr with the front object exceeds the braking control operating distance d SET set in step S2, and when F CA = 0 and dr> d SET , the host vehicle brakes. It is determined that the vehicle is traveling in the control prohibited area, and the process proceeds to step S4. On the other hand, in other cases, the process proceeds to step S6, and it is determined whether or not the collision with the front object can be avoided by the driver's braking operation.

ステップS6では、前記ステップS1で読込んだ相対距離drと相対速度Vrが下記(1)式のような関係にあるか否かを判定する。下記(1)式が不成立の場合には、制動による衝突回避が可能であると判断してステップS7に移行し、制動衝突回避フラグFBを“1”にセットする。一方、下記(1)式が成立する場合には、制動による衝突回避は不可能であると判断してステップS8に移行し、制動衝突回避フラグFBを“0”にリセットする。 In step S6, it is determined whether or not the relative distance dr and the relative speed Vr read in step S1 have a relationship as shown in the following equation (1). If the following formula (1) is not satisfied, it is determined that the possible collision avoidance by the braking proceeds to step S7, sets to "1" the braking collision avoidance flag F B. On the other hand, when the following equation (1) is satisfied, the collision by the braking avoidance is determined that it is impossible proceeds to step S8, is reset to "0" the braking collision avoidance flag F B.

dr<−Vr・Td+Vr2/2a ………(1)
ここで、Tdはドライバのブレーキ操作時に減速度が発生するまでの無駄時間、aはドライバのブレーキ操作により発生する減速度である。
次に、ドライバの操舵操作によって前方物体との衝突が回避可能か否かを判断する。先ず、ステップS9で操舵回避に必要な横移動量を算出する。自車両MCと前方物体PCとが図4に示すような関係にあるとき、右側に操舵回避する場合に必要な横移動量YRと、左側に操舵回避する場合に必要な横移動量YLはそれぞれ下記(2)及び(3)式のようになる。
dr <−Vr · Td + Vr 2 / 2a (1)
Here, Td is a dead time until deceleration occurs when the driver operates the brake, and a is a deceleration generated by the driver's braking operation.
Next, it is determined whether or not a collision with a front object can be avoided by a driver's steering operation. First, in step S9, a lateral movement amount necessary for avoiding steering is calculated. When the host vehicle MC and the front object PC are in a relationship as shown in FIG. 4, the lateral movement amount Y R necessary for avoiding steering to the right side and the lateral movement amount Y L necessary for avoiding steering to the left side. Are expressed by the following equations (2) and (3), respectively.

R=dr・tanθR−dr・tan{1/2・sin-1(φ/Vs)}
+Wb/2+WS ………(2)
L=−dr・tanθL+dr・tan{1/2・sin-1(φ/Vs)}
+Wb/2−WS ………(3)
ここで、図2に示すように、θRは前方物体センサ14が検出している前方物体の右端の角度範囲、θLは前方物体センサ14が検出している前方物体の左端の角度範囲、Wbは自車両の幅、WSはセンサ取り付け位置の自車両センタからのオフセット量である。
Y R = dr · tan θ R −dr · tan {1/2 · sin −1 (φ / Vs)}
+ W b / 2 + W S (2)
Y L = −dr · tan θ L + dr · tan {1/2 · sin −1 (φ / Vs)}
+ W b / 2−W S (3)
Here, as shown in FIG. 2, θ R is the angle range of the right end of the front object detected by the front object sensor 14, θ L is the angle range of the left end of the front object detected by the front object sensor 14, W b is the width of the host vehicle, and W S is the amount of offset from the host vehicle center of the sensor mounting position.

操舵回避に必要な横移動量Yは、右側に操舵回避する場合に必要な横移動量YRと左側に操舵回避する場合に必要な横移動量YLの小さい方を選択して設定する。
Y=min(YR,YL) ……… (4)
ここで、min( )は、括弧内の小さい方を選択する関数である。
次いでステップS10に移行して、前記ステップS9で算出した操舵回避に必要な横移動量Yより、図5に示す横移動量Yと横移動にかかる時間Tyとの関係に基づいて操舵回避にかかる時間Tyを算出し、ステップS11に移行する。なお、図5において、横軸は操舵回避に必要な横移動量Y、縦軸は横移動にかかる時間Tyであり、操作回避に必要な横移動量Yが増加するほど、横移動にかかる時間Tyも増加するように設定される。
Lateral movement amount Y required for steering avoidance is set by selecting the smaller lateral movement amount Y L required when steering avoidance in lateral movement amount Y R and the left required when steering avoidance on the right.
Y = min (Y R , Y L ) (4)
Here, min () is a function that selects the smaller one in parentheses.
At a step S10, from the lateral movement amount Y required steering avoidance calculated in step S9, the steering avoidance based on the relationship between the time T y according to the lateral movement amount Y and the lateral movement shown in FIG. 5 The time T y is calculated, and the process proceeds to step S11. In FIG. 5, the horizontal axis is the lateral movement amount Y necessary for steering avoidance, and the vertical axis is the time T y required for lateral movement. The larger the lateral movement amount Y necessary for operation avoidance, the lateral movement is required. The time T y is also set to increase.

ステップS11では、下記(5)式が成立するか否かを判定する。下記(5)式が不成立の場合には、操舵による衝突回避が可能であると判断してステップS12に移行し、操舵衝突回避フラグFSを“1”にセットする。一方、下記(5)式が成立する場合には、操舵による衝突回避が不可能であると判断してステップS13に移行し、操舵衝突回避フラグFSを“0”にリセットする。 In step S11, it is determined whether the following equation (5) is satisfied. If the following equation (5) is not established, it is determined that collision avoidance by steering is possible, the process proceeds to step S12, and the steering collision avoidance flag F S is set to “1”. On the other hand, if the following expression (5) is satisfied, it is determined that collision avoidance by steering is impossible, the process proceeds to step S13, and the steering collision avoidance flag F S is reset to “0”.

dr<Vr・Ty ………(5)
次いでステップS14で、制動による衝突回避が不可能且つ操舵による衝突回避が不可能であるか否かを判定し、制動衝突回避フラグFBが衝突回避不可能を示す“0”で、且つ操舵衝突回避フラグFSが衝突回避不可能を示す“0”である場合には、ステップS15に移行して自動制動を所定時間、所定の大きさで作動させる。一方、ステップS14の判定結果がFB=1又はFS=1である場合には、ステップS16に移行して自動制動を解除する。
dr <Vr · T y (5)
Then at step S14, the collision avoidance by the collision avoidance and is not steering by braking it is equal to or impossible, braking collision avoidance flag F B indicates the possible collision avoidance "0", and steering collision If the avoidance flag F S is “0” indicating that collision avoidance is impossible, the process proceeds to step S15, and automatic braking is operated for a predetermined time for a predetermined magnitude. On the other hand, when the determination result in step S14 is F B = 1 or F S = 1, the process proceeds to step S16 and the automatic braking is released.

また、ステップS2の衝撃判断処理は、図6に示すように、先ずステップS201で、前方物体センサ14に検出範囲の変化が発生するような衝撃が発生したか否かを判定する。衝撃発生の判断は、加速度センサ15で検出した加速度信号Xgによって行い、加速度センサ15が所定値以上の減速度を検出した場合、光軸ずれが発生する大きさの衝撃が発生したと判断する。また、その減速度が負の方向に大きいほど光軸ずれが大きいと判断し、図7に示すようなマップを参照して加速度センサ15で検出した減速度に基づいた光軸ずれ量Δθを推定し、その光軸ずれ量Δθを記憶する。なお、図7において、横軸は減速度の絶対値、縦軸は光軸ずれ量Δθであり、光軸ずれ量Δθは減速度に対して線形に変化するように設定される。   In the impact determination process in step S2, as shown in FIG. 6, first, in step S201, it is determined whether or not an impact that causes a change in the detection range has occurred in the front object sensor. The determination of the occurrence of the impact is made based on the acceleration signal Xg detected by the acceleration sensor 15, and when the acceleration sensor 15 detects a deceleration of a predetermined value or more, it is determined that an impact with a magnitude that causes an optical axis shift has occurred. Further, it is determined that the optical axis deviation is larger as the deceleration is larger in the negative direction, and the optical axis deviation amount Δθ based on the deceleration detected by the acceleration sensor 15 is estimated with reference to a map as shown in FIG. Then, the optical axis deviation amount Δθ is stored. In FIG. 7, the horizontal axis represents the absolute value of deceleration, the vertical axis represents the optical axis deviation amount Δθ, and the optical axis deviation amount Δθ is set to change linearly with respect to the deceleration.

次にステップS202に移行して、前方物体センサ14の光軸調整実施の有無を判定する。整備工場や販売店等で光軸調整が実施されていない場合には、ステップS203に移行して、記憶されている光軸ずれ量Δθを保持してから後述するステップS205に移行する。一方、ステップS202の判定結果が、光軸調整を実施されている場合には、ステップS204に移行して記憶されている光軸ずれ量Δθを“0”にリセットすると共に、光軸ずれ表示装置17の光軸ずれ表示を非表示としてからステップS205に移行する。   Next, the process proceeds to step S202, and it is determined whether or not the optical axis adjustment of the front object sensor 14 is performed. If the optical axis adjustment has not been performed at a maintenance shop, a store, or the like, the process proceeds to step S203, the stored optical axis deviation amount Δθ is held, and then the process proceeds to step S205 described later. On the other hand, if the result of determination in step S202 is that optical axis adjustment has been performed, the process shifts to step S204 to reset the stored optical axis deviation amount Δθ to “0” and to display the optical axis deviation display device. After the 17 optical axis deviation display is not displayed, the process proceeds to step S205.

このステップS205では、光軸ずれ量Δθが光軸ずれ表示閾値ΔθSET以上であるか否かを判定し、Δθ≧ΔθSETであるときにはステップS206に移行して光軸ずれ表示装置17に光軸ずれ状態を表示してからステップS207に移行し、Δθ<ΔθSETであるときには以前の表示状態を保持するものとして、そのままステップS207に移行する。 In this step S205, it is determined whether or not the optical axis deviation amount Δθ is equal to or larger than the optical axis deviation display threshold value Δθ SET . If Δθ ≧ Δθ SET , the process proceeds to step S206 and the optical axis deviation display device 17 receives the optical axis deviation. After displaying the shift state, the process proceeds to step S207, and when Δθ <Δθ SET , the previous display state is maintained, and the process proceeds to step S207 as it is.

ステップS207では、光軸ずれ量Δθが所定値ΔθTH2以下であるか否かを判定し、Δθ≦ΔθTH2であるときにはステップS208に移行して制動制御禁止フラグFCAを、制御許可を表す“0”にリセットすると共に、図8に示すように光軸ずれ量Δθに応じて制動制御作動距離dSETを設定する。制動制御作動距離dSETは、光軸ずれ量Δθが所定値ΔθTH1以下であるときには、光軸ずれがない状態と同じ距離範囲d1に固定され、ΔθTH1<Δθ≦ΔθTH2であるときには、光軸ずれが大きいほど短く設定されてΔθ=ΔθTH2で距離範囲d2に設定される。 In step S207, it is determined whether or not the optical axis deviation amount Δθ is equal to or smaller than a predetermined value ΔθTH2. If Δθ ≦ ΔθTH2 , the process proceeds to step S208, and the braking control prohibition flag FCA is set to indicate that the control is permitted. In addition to resetting to 0 ″, the braking control operating distance d SET is set according to the optical axis deviation amount Δθ as shown in FIG. The braking control operating distance d SET is fixed to the same distance range d 1 as when there is no optical axis deviation when the optical axis deviation amount Δθ is equal to or less than the predetermined value Δθ TH1 , and when Δθ TH1 <Δθ ≦ Δθ TH2 , is set as the light axis deviation is large short is set by [Delta] [theta] = [Delta] [theta] TH2 in distance range d 2.

一方、ステップS207の判定結果が、Δθ>ΔθTH2であるときにはステップS209に移行して、制動制御禁止フラグFCAを、制御禁止を表す“1”にセットする。
この図3の処理において、ステップS6〜S13の処理が衝突回避判断手段に対応し、ステップS14〜S16の処理が自動制動制御手段に対応している。また、図6の処理において、ステップS207〜S209の処理が作動条件変更手段に対応している。
On the other hand, when the determination result in step S207 is Δθ> ΔθTH2 , the process proceeds to step S209, and the braking control prohibition flag FCA is set to “1” indicating control prohibition.
In the process of FIG. 3, the processes of steps S6 to S13 correspond to the collision avoidance determining means, and the processes of steps S14 to S16 correspond to the automatic braking control means. In the process of FIG. 6, the processes in steps S207 to S209 correspond to the operating condition changing means.

したがって、今、自車両が、自動制動を非作動状態として走行中であるとする。この状態で、自車両に何らかの衝撃が加わって前方物体センサ14に所定値ΔθTH2より大きい光軸ずれが発生した場合には、図6の衝撃判断処理において、ステップS201で加速度センサ15にて減速度方向に所定値以上の値が検出されて、所定値ΔθTH2より大きい光軸ずれ量Δθを推定する。整備工場や販売店等で光軸調整を施していないため、ステップS202からステップS203に移行して記憶された光軸ずれ量Δθを保持し、光軸ずれ量Δθは光軸ずれ表示閾値ΔθSET以上であるので、ステップS205の判定によりステップS206に移行して、光軸ずれ表示装置17に光軸ずれ表示を行う。そして、Δθ>ΔθTH2であるので、ステップS207からステップS208に移行して制動制御禁止フラグFCAを、制御禁止を表す“1”にセットする。FCA=1で、且つ自車両は自動制動中でないため、図3の制動制御作動判断処理において、ステップS3からステップS4に移行して自動制動を禁止し、運転者のアクセル及びブレーキ操作に応じた走行を継続する。 Accordingly, it is assumed that the host vehicle is currently traveling with automatic braking being inoperative. In this state, when some impact is applied to the host vehicle and an optical axis shift larger than the predetermined value Δθ TH2 occurs in the front object sensor 14, the acceleration sensor 15 reduces the acceleration sensor 15 in step S201 in the impact determination process of FIG. A value greater than or equal to a predetermined value is detected in the speed direction, and an optical axis deviation amount Δθ larger than the predetermined value Δθ TH2 is estimated. Since the optical axis is not adjusted at a maintenance shop or a store, the process shifts from step S202 to step S203 to store the stored optical axis deviation amount Δθ. The optical axis deviation amount Δθ is the optical axis deviation display threshold value Δθ SET. Therefore, the process proceeds to step S206 based on the determination in step S205, and the optical axis deviation display device 17 displays the optical axis deviation. Since Δθ> Δθ TH2 , the process proceeds from step S207 to step S208, and the braking control prohibition flag FCA is set to “1” indicating control prohibition. Since F CA = 1 and the host vehicle is not in automatic braking, in the braking control operation determination process of FIG. 3, the process proceeds from step S3 to step S4 to prohibit automatic braking, and depending on the driver's accelerator and brake operation. Continue running.

また、自車両が自動制動を作動状態として走行している場合で、自車両に何らかの衝撃が加わって前方物体センサ14に所定値ΔθTH2より大きい光軸ずれが発生した場合には、図6の衝撃判断処理において、ステップS207からステップS208に移行して制動制御禁止フラグFCAを、制御禁止を表す“1”にセットする。自車両は自動制動中であるため、図3の制動制御作動判断処理において、ステップS3からステップS5に移行する。FCA=1であるので、ステップS5の判定によりステップS6に移行してドライバによる制動回避の可否を判断し、次いでドライバによる操舵回避の可否を判断する。制動回避及び操舵回避の何れかにおいて回避可能であると判断された場合には、ステップS14からステップS16に移行し、自動制動を解除して運転者のアクセル及びブレーキ操作に応じた走行に移行する。したがって、その後は光軸調整を行うまでΔθ>ΔθTH2の状態が継続され、FCA=1且つ自動制動非作動状態となるため、ステップS3からステップS4に移行して自動制動を禁止し、運転者のアクセル及びブレーキ操作に応じた走行を継続する。つまり、前方物体センサ14が、制動制御作動距離dSET以下となる相対距離drを検出し、自車両が制動制御許可領域内を走行している場合であっても、自動制動は禁止され、運転者のアクセル及びブレーキ操作に応じた走行が継続されることになる。 Further, in the case where the host vehicle is running with automatic braking in an operating state, when some sort of impact is applied to the host vehicle and an optical axis shift greater than the predetermined value Δθ TH2 occurs in the front object sensor 14, FIG. In the impact determination process, the process proceeds from step S207 to step S208, and the braking control prohibition flag FCA is set to “1” indicating control prohibition. Since the host vehicle is under automatic braking, the process proceeds from step S3 to step S5 in the braking control operation determination process of FIG. Since F CA = 1, the process proceeds to step S6 based on the determination in step S5 to determine whether or not the driver can avoid braking, and then determines whether or not the driver can avoid steering. If it is determined that the vehicle can be avoided by either braking avoidance or steering avoidance, the process proceeds from step S14 to step S16, the automatic braking is canceled, and the vehicle travels according to the driver's accelerator and brake operation. . Therefore, thereafter, the state of Δθ> Δθ TH2 is continued until the optical axis adjustment is performed, and F CA = 1 and automatic braking is not activated. Therefore, the process proceeds from step S3 to step S4 to prohibit the automatic braking, The vehicle continues to travel according to the accelerator and brake operation of the person. In other words, even when the front object sensor 14 detects the relative distance dr that is equal to or less than the braking control working distance d SET and the host vehicle is traveling in the braking control permission area, automatic braking is prohibited and driving is performed. The traveling according to the accelerator and brake operation of the person is continued.

このように、光軸ずれが発生するような衝撃が発生したと判断した場合には、光軸ずれ量Δθを推定し、この光軸ずれ量Δθが所定値ΔθTH2より大きい場合に自動制動を禁止するので、光軸ずれにより前方物体との相対位置関係を正確に認識できない状態のまま走行制御を行うことを確実に防止することができる。
一方、所定値ΔθTH2以下のわずかな光軸ずれが発生している状態で、自車両が、前方物体との相対距離drが制動制御作動距離dSETを超える制動制御禁止領域を走行中であるとする。この場合には、先ず、図6の衝撃判断処理において、ステップS201でΔθ≦ΔθTH2となる光軸ずれ量Δθが推定される。整備工場や販売店等で光軸調整を施していないため、ステップS202からステップS203に移行して記憶された光軸ずれ量Δθを保持し、光軸ずれ量Δθが光軸ずれ表示閾値ΔθSET以上である場合には、ステップS205の判定によりステップS206に移行して、光軸ずれ表示装置17に光軸ずれ表示を行う。そして、ステップS207からステップS209に移行して、制動制御禁止フラグFCAを、制御許可を表す“0”にリセットすると共に、図8に示すように光軸ずれ量Δθに応じた距離範囲が制動制御作動距離dSETとして設定される。FCA=0且つdr>dSETであるので、図3の制動制御作動判断処理において、ステップS5からステップS4に移行して自動制動を禁止し、運転者のアクセル及びブレーキ操作に応じた走行を行う。
In this way, when it is determined that an impact that would cause an optical axis deviation has occurred, the optical axis deviation amount Δθ is estimated, and automatic braking is performed when the optical axis deviation amount Δθ is greater than a predetermined value Δθ TH2. Since the prohibition is prohibited, it is possible to reliably prevent the traveling control from being performed in a state where the relative positional relationship with the front object cannot be accurately recognized due to the optical axis deviation.
On the other hand, the host vehicle is traveling in the braking control prohibition region in which the relative distance dr with the front object exceeds the braking control operating distance d SET in a state where a slight optical axis deviation of the predetermined value Δθ TH2 or less occurs. And In this case, first, in the impact determination process of FIG. 6, an optical axis deviation amount Δθ that satisfies Δθ ≦ Δθ TH2 is estimated in step S201. Since the optical axis is not adjusted at a maintenance shop or a store, the process shifts from step S202 to step S203 to store the stored optical axis deviation amount Δθ, and the optical axis deviation amount Δθ is the optical axis deviation display threshold value Δθ SET. In the case above, the process proceeds to step S206 based on the determination in step S205, and the optical axis deviation display device 17 displays the optical axis deviation. Then, the process proceeds from step S207 to step S209, where the braking control prohibition flag FCA is reset to “0” indicating control permission, and the distance range corresponding to the optical axis deviation Δθ is braked as shown in FIG. Set as control working distance d SET . Since F CA = 0 and dr> d SET , in the braking control operation determination process of FIG. 3, the process proceeds from step S5 to step S4 to prohibit automatic braking and travel according to the driver's accelerator and brake operation. Do.

その後、前方物体との相対距離drが制動制御作動距離dSET以下となり、制動制御許可領域内を走行している状態となると、自車両が前方物体へ接近することを抑制するように制動制御可能となる。FCA=0且つdr≦dSETであるので、ステップS5からステップS6に移行して、ドライバによる制動回避の可否を判断し、次いでドライバによる操舵回避の可否を判断する。制動回避及び操舵回避の何れかにおいて回避可能であると判断された場合には、ステップS14からステップS16に移行し、運転者のアクセル及びブレーキ操作に応じた走行を継続する。 Thereafter, when the relative distance dr with the front object becomes equal to or less than the braking control operating distance d SET and the vehicle is traveling in the braking control permission area, the braking control can be performed so as to suppress the approach of the host vehicle to the front object. It becomes. Since F CA = 0 and dr ≦ d SET , the process proceeds from step S5 to step S6 to determine whether or not braking by the driver can be avoided, and then whether or not steering by the driver can be avoided. If it is determined that the vehicle can be avoided in either braking avoidance or steering avoidance, the process proceeds from step S14 to step S16, and the traveling according to the driver's accelerator and brake operation is continued.

一方、制動回避及び操舵回避が不可能であると判断されたときには、ステップS14からステップS15に移行して、所定の大きさの制動油圧が発生するような制動圧指令値PBRを制動制御装置8に出力し、自車両の制動制御に移行する。
ここで、制動制御作動距離dSETは光軸ずれ量Δθが大きいほど小さい値に設定されるので、ΔθTH1<Δθ≦ΔθTH2であるときには、光軸ずれがない場合と比較して、前方物体との相対位置関係がより近いものに対してのみ制動制御を行うことになる。
On the other hand, when the braking avoidance and steering avoidance is judged to be impossible, the process proceeds from step S14 to step S15, braking control device the braking pressure command value P BR such as the braking hydraulic pressure of a predetermined magnitude is generated 8 to shift to the braking control of the own vehicle.
Here, the braking control operating distance d SET is set to a smaller value as the optical axis deviation amount Δθ is larger. Therefore, when Δθ TH1 <Δθ ≦ Δθ TH2 , the front object is compared with the case where there is no optical axis deviation. Therefore, the braking control is performed only for those having a relative positional relationship closer to that.

このように、上記第1の実施形態では、自車両に何らかの衝撃が加わって自車両前方の物体を認識するためのセンサの取り付け位置がずれるなどにより、センサの検出範囲に変化が生じた場合に、直ちにそれを検出し、自車両が自動制動中でないときに制動制御の作動を禁止するので、センサの検出範囲が変化したまま走行制御が作動してしまうことを確実に防止できると共に、自動制動中であるときには、ドライバによる制動回避及び操舵回避の可否を判定し、衝突回避可能であると判断された場合にのみ制動制御の作動を解除するので、安全走行を確保することができる。   As described above, in the first embodiment, when a change occurs in the detection range of the sensor due to some impact on the host vehicle and a shift of the sensor mounting position for recognizing an object in front of the host vehicle. Since this is detected immediately and the braking control operation is prohibited when the vehicle is not in automatic braking, it is possible to reliably prevent the traveling control from operating while the detection range of the sensor is changed, and to perform automatic braking. When the vehicle is in the middle, it is determined whether or not braking by the driver can be avoided and steering can be avoided, and the braking control operation is released only when it is determined that collision can be avoided, so that safe driving can be ensured.

さらに、自車両前方の物体を認識するためのセンサの検出範囲変化量が大きいほど、検出した前方物体との相対位置関係が近いものに対してのみ制動制御を行い、変化量が小さいほど、変化量が大きい場合と比較して検出した前方物体との相対位置関係が遠いものに対しても制動制御を行うので、前方物体位置の正確性を悪化させずに前方物体の位置を検出できると共に、検出範囲の変化の状態に応じて最適な制動制御を行うことができる。   Furthermore, the larger the detection range change amount of the sensor for recognizing the object in front of the host vehicle, the more the braking control is performed only on the object whose relative positional relationship with the detected front object is closer. Since the braking control is also performed for the object whose relative positional relationship with the detected front object is far compared with the case where the amount is large, the position of the front object can be detected without deteriorating the accuracy of the front object position, Optimal braking control can be performed according to the state of change of the detection range.

また、広く普及しているエアバック等に使用されている加速度センサの加速度信号を用いて、前方物体センサに加わった衝撃の大きさを検出するので、新たに衝撃を検出するためのセンサを設置する必要がなく、コストアップを削減することができる。
なお、上記第1の実施形態においては、加速度検出手段として加速度センサを適用する場合について説明したが、これに限定されるものではなく、車速センサで検出した自車両の車速から加速度を算出するようにしてもよい。
Also, since the magnitude of the impact applied to the front object sensor is detected using the acceleration signal of the acceleration sensor that is widely used for airbags, a new sensor for detecting the impact is installed. There is no need to do so, and cost increases can be reduced.
In the first embodiment, the case where the acceleration sensor is applied as the acceleration detecting means has been described. However, the present invention is not limited to this, and the acceleration is calculated from the vehicle speed detected by the vehicle speed sensor. It may be.

次に、本発明の第2の実施形態について説明する。
この第2の実施形態は、前述した第1の実施形態において、前方物体センサ14の検出範囲が変化する衝撃の判断を、ヨーレートセンサ16の信号を用いて行うようにしたものである。
図9は、第2の実施形態において、走行制御コントローラ20において実行される衝撃判断処理の処理手順を示すフローチャートであって、図6に示す第1の実施形態における衝撃判断処理において、ステップS201の処理が、ヨーレートセンサ16で検出したヨーレートφの変化率により、光軸ずれが発生する大きさの衝撃を検出して光軸ずれ量Δθを推定するステップS221の処理に置換されていることを除いては図6と同様の処理を行い、図6と同一部には同一符号を付与しその詳細な説明は省略する。
Next, a second embodiment of the present invention will be described.
In the second embodiment, in the first embodiment described above, the determination of the impact that changes the detection range of the front object sensor 14 is performed using the signal of the yaw rate sensor 16.
FIG. 9 is a flowchart showing a processing procedure of impact determination processing executed in the travel controller 20 in the second embodiment. In the impact determination processing in the first embodiment shown in FIG. Except that the processing is replaced with the processing in step S221 in which the impact of the optical axis deviation is detected and the optical axis deviation amount Δθ is estimated by the change rate of the yaw rate φ detected by the yaw rate sensor 16. The same processing as in FIG. 6 is performed, the same reference numerals are given to the same parts as in FIG. 6, and the detailed description thereof is omitted.

この第2の実施形態によると、ステップS221で、ヨーレートセンサ16で検出したヨーレートφの変化率を演算し、その演算値の絶対値が所定値以上である場合には、前方物体センサ14に光軸ずれが発生するような衝撃が発生したと判断する。また、その演算値の絶対値が大きいほど光軸ずれが大きいと判断し、図7に示すようなマップを参照してヨーレートφの変化率に基づいた光軸ずれ量Δθを推定し、その光軸ずれ量Δθを記憶してから前述したステップS202に移行する。なお、図7において、横軸はヨーレートφの変化率の絶対値、縦軸は光軸ずれ量Δθであり、光軸ずれ量Δθはヨーレートφの変化率の絶対値に対して線形に変化するように設定される。   According to the second embodiment, in step S221, the rate of change of the yaw rate φ detected by the yaw rate sensor 16 is calculated, and if the absolute value of the calculated value is greater than or equal to a predetermined value, the front object sensor 14 is illuminated. It is determined that an impact that causes an axis deviation has occurred. Further, it is determined that the larger the absolute value of the calculated value is, the larger the optical axis deviation is, and an optical axis deviation amount Δθ based on the rate of change of the yaw rate φ is estimated with reference to a map as shown in FIG. After storing the axis deviation amount Δθ, the process proceeds to step S202 described above. In FIG. 7, the horizontal axis represents the absolute value of the change rate of the yaw rate φ, the vertical axis represents the optical axis deviation amount Δθ, and the optical axis deviation amount Δθ changes linearly with respect to the absolute value of the change rate of the yaw rate φ. Is set as follows.

このように、上記第2の実施形態では、前方物体を認識するためのセンサにも使用されているヨーレートセンサのヨーレート信号を用いて、前方物体センサに加わった衝撃の大きさを検出するので、新たに衝撃を検出するためのセンサを設置する必要がなく、コストアップを削減することができる。
次に、本発明の第3の実施形態について説明する。
Thus, in the second embodiment, since the magnitude of the impact applied to the front object sensor is detected using the yaw rate signal of the yaw rate sensor that is also used for the sensor for recognizing the front object, It is not necessary to newly install a sensor for detecting an impact, and cost increase can be reduced.
Next, a third embodiment of the present invention will be described.

この第3の実施形態は、前述した第1の実施形態において、前方物体センサ14の検出範囲が変化する衝撃の判断を、車速センサ13の信号を用いて行うようにしたものである。
図10は、第3の実施形態において、走行制御コントローラ20において実行される衝撃判断処理の処理手順を示すフローチャートであって、図6に示す第1の実施形態における衝撃判断処理において、ステップS201の処理が、車速センサ13で検出した自車速Vsの変化率により、光軸ずれが発生する大きさの衝撃を検出して光軸ずれ量Δθを推定するステップS231の処理に置換されていることを除いては図6と同様の処理を行い、図6と同一部には同一符号を付与しその詳細な説明は省略する。
In the third embodiment, in the first embodiment described above, the determination of an impact that changes the detection range of the front object sensor 14 is performed using a signal from the vehicle speed sensor 13.
FIG. 10 is a flowchart showing a processing procedure of impact determination processing executed in the travel controller 20 in the third embodiment. In the impact determination processing in the first embodiment shown in FIG. That the processing is replaced with the processing in step S231 in which the impact of the optical axis deviation is detected and the optical axis deviation amount Δθ is estimated by the change rate of the own vehicle speed Vs detected by the vehicle speed sensor 13. Except for this, the same processing as in FIG. 6 is performed, and the same parts as in FIG.

この第3の実施形態によると、ステップS231で車速センサ13の自車速Vsの変化率を演算し、その演算値が減速方向に所定値以上である場合には、前方物体センサ14に光軸ずれが発生するような衝撃が発生したと判断する。また、その演算値が減速方向に大きいほど光軸ずれが大きいと判断し、図7に示すようなマップを参照して自車速の変化率に基づいた光軸ずれ量Δθを推定し、その光軸ずれ量Δθを記憶してから前述したステップS202に移行する。なお、図7において、横軸は自車速Vsの変化率の絶対値、縦軸は光軸ずれ量Δθであり、光軸ずれ量Δθは自車速Vsの変化率の絶対値に対して線形に変化するように設定される。   According to the third embodiment, the rate of change of the vehicle speed Vs of the vehicle speed sensor 13 is calculated in step S231, and if the calculated value is equal to or greater than a predetermined value in the deceleration direction, the front object sensor 14 is shifted in optical axis. It is determined that an impact has occurred. Further, it is determined that the optical axis deviation is larger as the calculated value is larger in the deceleration direction, the optical axis deviation amount Δθ based on the rate of change of the own vehicle speed is estimated with reference to a map as shown in FIG. After storing the axis deviation amount Δθ, the process proceeds to step S202 described above. In FIG. 7, the horizontal axis represents the absolute value of the change rate of the own vehicle speed Vs, the vertical axis represents the optical axis deviation amount Δθ, and the optical axis deviation amount Δθ is linear with respect to the absolute value of the change rate of the own vehicle speed Vs. Set to change.

このように、上記第3の実施形態では、ほとんどの車両に使用されている車速センサの自車速変化率を用いて、前方物体センサに加わった衝撃の大きさを検出するので、新たに衝撃を検出するためのセンサを設置する必要がなく、コストアップを削減することができる。
次に、本発明の第4の実施形態について説明する。
As described above, in the third embodiment, since the magnitude of the impact applied to the front object sensor is detected using the own vehicle speed change rate of the vehicle speed sensor used in most vehicles, a new impact is applied. It is not necessary to install a sensor for detection, and cost increase can be reduced.
Next, a fourth embodiment of the present invention will be described.

この第4の実施形態は、前述した第1の実施形態において、前方物体センサ14の検出範囲が変化する衝撃の判断を、前方物体センサ14の信号を用いて行うようにしたものである。
図11は、第4の実施形態において、走行制御コントローラ20において実行される衝撃判断処理の処理手順を示すフローチャートであって、図6に示す第1の実施形態における衝撃判断処理において、ステップS201の処理が、前方物体センサ14で検出した相対距離dr及び相対速度Vrにより、光軸ずれが発生する大きさの衝撃を検出して光軸ずれ量Δθを推定するステップS241の処理に置換されていることを除いては図6と同様の処理を行い、図6と同一部には同一符号を付与しその詳細な説明は省略する。
In the fourth embodiment, in the first embodiment described above, an impact that changes the detection range of the front object sensor 14 is determined using a signal from the front object sensor 14.
FIG. 11 is a flowchart showing a processing procedure of impact determination processing executed in the travel controller 20 in the fourth embodiment. In the impact determination processing in the first embodiment shown in FIG. The process is replaced with the process of step S241 in which the impact of the magnitude of the optical axis deviation is detected based on the relative distance dr and the relative speed Vr detected by the front object sensor 14 and the optical axis deviation amount Δθ is estimated. Except for this, the same processing as in FIG. 6 is performed, and the same parts as in FIG.

この第4の実施形態によると、ステップS241で前方物体センサ14で検出した相対距離drが所定値以下である場合には、前方物体センサ14に光軸ずれが発生するような衝突が発生したと判断する。また、そのときの接近方向の相対速度Vrが大きいほど光軸ずれが大きいと判断し、図7に示すようなマップを参照して接近方向の相対速度に基づいた光軸ずれ量Δθを推定し、その光軸ずれ量Δθを記憶してから前述したステップS202に移行する。なお、図7において、横軸は接近方向の相対速度Vr、縦軸は光軸ずれ量Δθであり、光軸ずれ量Δθは接近方向の相対速度Vrに対して線形に変化するように設定される。   According to the fourth embodiment, when the relative distance dr detected by the front object sensor 14 in step S241 is equal to or smaller than a predetermined value, the front object sensor 14 has a collision that causes an optical axis shift. to decide. Further, it is determined that the optical axis deviation is larger as the relative speed Vr in the approaching direction is larger at that time, and the optical axis deviation amount Δθ based on the relative speed in the approaching direction is estimated with reference to a map as shown in FIG. After storing the optical axis deviation amount Δθ, the process proceeds to step S202 described above. In FIG. 7, the horizontal axis represents the relative speed Vr in the approach direction, the vertical axis represents the optical axis deviation amount Δθ, and the optical axis deviation amount Δθ is set to change linearly with respect to the relative speed Vr in the approach direction. The

このように、上記第4の実施形態では、前方物体センサの検出値を用いて、前方物体センサに加わった衝撃の大きさを検出するので、新たに衝撃を検出するためのセンサを設置する必要がなく、コストアップを大幅に削減することができる。
なお、上記第4の実施形態においては、前方物体との相対距離が所定値以下であるときに、光軸ずれが発生するような衝撃が発生したと判断する場合について説明したが、これに限定されるものではなく、ステップS14で制動による衝突回避及び操舵による衝突回避が不可能、且つ自動制動中であるときに、自動制動終了後に前方物体を認識するためのセンサに衝撃が発生したと判断するようにしてもよい。この場合には、相対速度が接近方向に所定値以上であるときに、光軸ずれが発生するような衝撃が発生したと判断し、接近方向の相対速度が大きいほど光軸ずれが大きいと判断すればよい。これにより、衝突回避が不可能な状態を検出した後に、前方物体を検出できない状態となった場合であっても、衝突が発生したことを推定可能であるため、光軸ずれが発生するような衝撃の発生をより確実に検出することができる。
As described above, in the fourth embodiment, since the magnitude of the impact applied to the front object sensor is detected using the detection value of the front object sensor, it is necessary to newly install a sensor for detecting the impact. The cost increase can be greatly reduced.
In the fourth embodiment, the case has been described in which it is determined that an impact that causes an optical axis shift occurs when the relative distance to the front object is equal to or less than a predetermined value. However, the present invention is not limited to this. In step S14, when collision avoidance by braking and collision avoidance by steering are impossible, and during automatic braking, it is determined that an impact has occurred in a sensor for recognizing a front object after the end of automatic braking. You may make it do. In this case, when the relative speed is equal to or greater than a predetermined value in the approach direction, it is determined that an impact that causes an optical axis shift has occurred, and it is determined that the greater the relative speed in the approach direction, the greater the optical axis shift. do it. This makes it possible to estimate that a collision has occurred even if a forward object cannot be detected after detecting a state where collision avoidance is impossible. The occurrence of impact can be detected more reliably.

次に、本発明の第5の実施形態について説明する。
この第5の実施形態は、本発明を、車間距離制御装置を搭載した後輪駆動車に適用したものである。
すなわち、第5の実施形態における概略構成を図12に示すように、エンジン出力を制御するエンジン出力制御装置11を設け、前述した第1の実施形態におけるスキャニング式の構成を有する前方物体センサ14の代わりに、レーダ方式の構成を有する前方物体センサ18を設け、走行制御コントローラ20の代わりに、自車両前方の車両を捕捉しているときに車間距離が目標車間距離となるように目標車速を設定して自車速を制御し、自車両前方の車両を捕捉していないときに自車速Vsを運転者が設定した設定車速VSET に制御する追従制御コントローラ30を設けたことを除いては、図1と同様の構成を有するため、図1との対応部分には同一符号を付与し、その詳細な説明は省略する。
Next, a fifth embodiment of the present invention will be described.
In the fifth embodiment, the present invention is applied to a rear wheel drive vehicle equipped with an inter-vehicle distance control device.
That is, as shown in FIG. 12, the schematic configuration in the fifth embodiment is provided with an engine output control device 11 for controlling the engine output, and the front object sensor 14 having the scanning type configuration in the first embodiment described above. Instead, a front object sensor 18 having a radar-type configuration is provided, and the target vehicle speed is set so that the inter-vehicle distance becomes the target inter-vehicle distance when the vehicle ahead of the host vehicle is captured instead of the travel controller 20. The following control controller 30 is provided for controlling the own vehicle speed and controlling the own vehicle speed Vs to the set vehicle speed V SET set by the driver when the vehicle ahead of the own vehicle is not captured. 1 has the same configuration as that of FIG. 1, the same reference numerals are given to corresponding parts in FIG.

前方物体センサ18は、所定の照射範囲(例えば、水平方向で9°、上下方向で3°)でレーザ光を掃射して先行車両からの反射光を受光するレーダ方式の構成を有し、自車両と先行車両との間の車間距離Dを検出する。そして、この車間距離Dの時間的変化から先行車両と自車両との相対速度ΔVが算出される。
この前方物体センサ18は、通常、その光軸方向が自車両の前後軸線から許容誤差範囲内(例えば、±0.5°)の高精度で締結具等により車両前部に取り付けられているが、車両に何らかの衝撃が加わること等により、センサの光軸方向が自車両の前後軸線方向から許容誤差範囲を超えて左右にずれると、隣接車線を走行している斜め前方の車両を自車走行車線前方の車両と誤認識し、上下にずれると先行車両を認識できないなど、先行車両との相対位置関係を正確に検出することができない。
The forward object sensor 18 has a radar-type configuration in which laser light is swept within a predetermined irradiation range (for example, 9 ° in the horizontal direction and 3 ° in the vertical direction) to receive reflected light from the preceding vehicle. The inter-vehicle distance D between the vehicle and the preceding vehicle is detected. Then, the relative speed ΔV between the preceding vehicle and the host vehicle is calculated from the temporal change in the inter-vehicle distance D.
The front object sensor 18 is usually attached to the front part of the vehicle with a fastener or the like with a high accuracy whose optical axis direction is within an allowable error range (for example, ± 0.5 °) from the longitudinal axis of the host vehicle. If the optical axis direction of the sensor deviates from the front / rear axis direction of the host vehicle beyond the allowable error range due to some impact on the vehicle, the vehicle traveling diagonally forward in the adjacent lane If the vehicle is misrecognized as a vehicle in front of the lane and the vehicle is shifted up and down, the relative position relationship with the preceding vehicle cannot be accurately detected.

車速センサ13から出力される自車速Vs、前方物体センサ18から出力される車間距離D、相対速度ΔV、加速度センサ15から出力される加速度Xg、及びヨーレートセンサ16から出力されるヨーレートφが追従制御コントローラ30に入力され、この追従制御コントローラ30によって、車速センサ13、前方物体センサ18、加速度センサ15、及びヨーレートセンサ16の何れか一つのセンサから入力される信号をもとに前方物体センサ18に検出範囲が変化する衝撃が加わったか否かを判断し、前方物体センサ18の光軸ずれ量Δθを推定する。また、この追従制御コントローラ30では、自車両の走行車線前方の車両を捕捉しているときに車間距離が目標車間距離となるように目標車速を設定して自車速を制御し、自車両の走行車線前方の車両を捕捉していないときに自車速VS を運転者が設定した設定車速VSET に制御する制動圧指令値PBR及び目標スロットル開度θ* を制動制御装置8及びエンジン出力制御装置11に出力する。 The own vehicle speed Vs output from the vehicle speed sensor 13, the inter-vehicle distance D output from the front object sensor 18, the relative speed ΔV, the acceleration Xg output from the acceleration sensor 15, and the yaw rate φ output from the yaw rate sensor 16 are track-controlled. Input to the controller 30, and the follow-up control controller 30 causes the front object sensor 18 to receive the signal from any one of the vehicle speed sensor 13, the front object sensor 18, the acceleration sensor 15, and the yaw rate sensor 16. It is determined whether or not an impact that changes the detection range is applied, and the optical axis deviation amount Δθ of the front object sensor 18 is estimated. Further, the tracking controller 30 controls the own vehicle speed by setting the target vehicle speed so that the inter-vehicle distance becomes the target inter-vehicle distance when the vehicle ahead of the traveling lane of the own vehicle is captured. When the vehicle ahead of the lane is not captured, the braking pressure command value P BR and the target throttle opening θ * for controlling the own vehicle speed V S to the set vehicle speed V SET set by the driver are set to the braking control device 8 and the engine output control. Output to the device 11.

この追従制御コントローラ30は、マイクロコンピュータとその周辺機器を備え、マイクロコンピュータのソフトウェア形態により、図13に示す制御ブロックを構成している。
この制御ブロックは、前方物体センサ18でレーザ光を掃射してから先行車両の反射光を受光するまでの時間を計測し、先行車両との車間距離Dを演算する測距信号処理部21と、測距信号処理部21で演算された車間距離D、自車速Vs及び相対速度ΔVに基づいて車間距離Dを目標車間距離D* に維持する目標車速VL *を演算する車間距離制御部40と、この車間距離制御部40で演算した目標車速VL *に基づいて目標駆動軸トルクTW *を演算する車速制御部50と、この車速制御部50で演算した目標駆動軸トルクTW *に基づいてスロットルアクチュエータ12及びブレーキアクチュエータ7に対するスロットル開度指令値θR及び制動圧指令値PBRを演算し、これらをスロットルアクチュエータ12及びブレーキアクチュエータ7に出力する駆動軸トルク制御部60とを備えている。
The follow-up control controller 30 includes a microcomputer and its peripheral devices, and constitutes a control block shown in FIG. 13 according to the software form of the microcomputer.
This control block measures the time from when the front object sensor 18 sweeps the laser light until it receives the reflected light of the preceding vehicle, and calculates a distance D between the preceding vehicle and a ranging signal processing unit 21; An inter-vehicle distance control unit 40 that calculates a target vehicle speed V L * that maintains the inter-vehicle distance D at the target inter-vehicle distance D * based on the inter-vehicle distance D, the host vehicle speed Vs, and the relative speed ΔV calculated by the ranging signal processing unit 21; The vehicle speed control unit 50 that calculates the target drive shaft torque T W * based on the target vehicle speed V L * calculated by the inter-vehicle distance control unit 40, and the target drive shaft torque T W * calculated by the vehicle speed control unit 50 based calculates a throttle opening command value theta R and the braking pressure command value P BR to the throttle actuator 12 and a brake actuator 7, these throttle actuator 12 and the brake actuator 7 And a drive shaft torque controller 60 for force.

車間距離制御部40は、自車速Vsと相対速度ΔVから算出される先行車速Vtに基づいて先行車両と自車両との間の目標車間距離D* を算出する目標車間距離設定部42と、この目標車間距離設定部42で算出された目標車間距離D* と、測距信号処理部21から入力される車間距離Dと、自車速Vsとに基づいて車間距離Dを目標車間距離D* に一致させるための目標車速VL *を演算する車間距離制御演算部43とを備えている。 The inter-vehicle distance control unit 40 calculates a target inter-vehicle distance setting unit 42 that calculates a target inter-vehicle distance D * between the preceding vehicle and the host vehicle based on the preceding vehicle speed Vt calculated from the host vehicle speed Vs and the relative speed ΔV. The inter-vehicle distance D matches the target inter-vehicle distance D * based on the target inter-vehicle distance D * calculated by the target inter-vehicle distance setting unit 42, the inter-vehicle distance D input from the ranging signal processing unit 21, and the own vehicle speed Vs. And an inter-vehicle distance control calculation unit 43 that calculates a target vehicle speed V L * for causing the vehicle to travel.

ここで、目標車間距離設定部42は、先行車両に一定車速、一定車間距離で追従走行中の目標車間距離、つまり先行車両と自車両との間の定常目標車間距離D*を算出する。本実施形態では、車間時間を一定とするために、下記(6)式により定常目標車間距離D*を算出する。
* =Vt×Th ………(6)
ここで、Vtは先行車速、Thは車間時間である。
Here, the target inter-vehicle distance setting unit 42 calculates a target inter-vehicle distance that is following the preceding vehicle at a constant vehicle speed and a constant inter-vehicle distance, that is, a steady target inter-vehicle distance D * between the preceding vehicle and the host vehicle. In this embodiment, in order to make the inter-vehicle time constant, the steady target inter-vehicle distance D * is calculated by the following equation (6).
D * = Vt × Th (6)
Here, Vt is the preceding vehicle speed, and Th is the inter-vehicle time.

また、車間距離制御演算部43は、車間距離Dと相対速度ΔVとに基づいて、車間距離Dを目標車間距離D*に保ちながら先行車両に追従走行するための目標車速VL *を、次式をもとに算出する。
L *=KL(D−D*)+KV(ΔV−ΔV*)+Vt ………(7)
ここで、KLは車間距離制御ゲイン、KVは相対速度制御ゲインである。
Further, the inter-vehicle distance control calculation unit 43 calculates a target vehicle speed V L * for traveling following the preceding vehicle while maintaining the inter-vehicle distance D at the target inter-vehicle distance D * based on the inter-vehicle distance D and the relative speed ΔV. Calculate based on the formula.
V L * = K L (D−D * ) + K V (ΔV−ΔV * ) + Vt (7)
Here, K L is distance control gain, the K V is the relative velocity control gain.

車速制御部50は、追従制御状態であるときには、前方物体センサ18で先行車両を捕捉しているときには車間距離制御部40から入力される目標車速VL *と運転者が設定した設定車速VSET との何れか小さい値を目標車速V* として設定し、先行車両を捕捉していないときには運転者が設定した設定車速VSET を目標車速V* として設定する目標車速設定部51と、この目標車速設定部51で設定された目標車速V* に自車速Vsを一致させるための目標駆動軸トルクTW *を演算する目標駆動軸トルク演算部53とを備えている。 When the vehicle speed control unit 50 is in the following control state, the target vehicle speed V L * input from the inter-vehicle distance control unit 40 and the set vehicle speed V SET set by the driver when the preceding object sensor 18 is capturing the preceding vehicle. Is set as the target vehicle speed V * , and when the preceding vehicle is not captured, the target vehicle speed setting unit 51 that sets the set vehicle speed V SET set by the driver as the target vehicle speed V * , and the target vehicle speed A target drive shaft torque calculator 53 for calculating a target drive shaft torque T W * for making the host vehicle speed Vs coincide with the target vehicle speed V * set by the setting unit 51.

また、駆動軸トルク制御部60は、目標駆動トルクTW *を実現するためのスロットル開度指令値θR とブレーキ液圧指令値PBRとを演算し、スロットル開度指令値θR をエンジン出力制御装置11に出力すると共に、ブレーキ液圧指令値PBRを制動制御装置8に出力する。
なお、上述した車間距離制御部40、車速制御部50及び駆動軸トルク制御部60で走行制御手段を構成している。
Further, the drive shaft torque control unit 60 calculates a throttle opening command value θ R and a brake fluid pressure command value P BR for realizing the target driving torque T W *, and uses the throttle opening command value θ R as the engine. In addition to outputting to the output control device 11, the brake fluid pressure command value P BR is output to the braking control device 8.
The inter-vehicle distance control unit 40, the vehicle speed control unit 50, and the drive shaft torque control unit 60 described above constitute travel control means.

また、目標車速設定部51では、図14に示す目標車速設定処理を実行する。
この目標車速設定処理は、所定時間(例えば10msec)毎のタイマ割込処理として実行され、先ず、ステップS101で、車速センサ13で検出した自車速Vs、前方物体センサ18で検出した先行車両との車間距離Dを読込み、次いでステップS102に移行して、後述する衝撃判断処理で前方物体センサ18への検出範囲が変化する衝撃を検知して車間距離制御の禁止判断及び車間距離検出限界DMAXの設定を行う。
Further, the target vehicle speed setting unit 51 executes a target vehicle speed setting process shown in FIG.
This target vehicle speed setting process is executed as a timer interrupt process at predetermined time intervals (for example, 10 msec). First, in step S101, the vehicle speed Vs detected by the vehicle speed sensor 13 and the preceding vehicle detected by the front object sensor 18 are detected. The inter-vehicle distance D is read, and then the process proceeds to step S102, where an impact that changes the detection range to the front object sensor 18 is detected in an impact determination process, which will be described later, and an inter-vehicle distance control prohibition determination and an inter-vehicle distance detection limit D MAX are set. Set up.

ステップS103では、追従走行制御中か否かを判定する。この判定は、前方物体センサ18で先行車両を検出しており、且つステップS102で設定した車間制御禁止フラグFCAが制御許可を表す“0”にリセットされているか否かによって行い、前方物体センサ18で検出した車間距離DがステップS102で設定された車間距離検出限界DMAX以下であるか否かを判定し、FCA=0且つD≦DMAXであるときには、先行車両を検出しており追従走行制御中であると判断してステップS104に移行する。 In step S103, it is determined whether follow-up running control is being performed. This determination is performed by whether or has detected the preceding vehicle with the preceding object sensor 18, and vehicle control inhibition flag F CA set in step S102 is reset to "0" representing the control permission, the forward object sensor It is determined whether or not the inter-vehicle distance D detected in 18 is less than or equal to the inter-vehicle distance detection limit D MAX set in step S102. If F CA = 0 and D ≦ D MAX , the preceding vehicle is detected. It is determined that the following traveling control is being performed, and the process proceeds to step S104.

ステップS104では、車間距離制御演算部43で前記(7)式により算出した目標車速VL *と運転者が設定した設定車速VSET との大きさを比較して、小さい方の値を目標車速V*として設定してからステップS105に移行し、目標車速V*を目標駆動軸トルク演算部53へ入力してからタイマ割込処理を終了して所定のメインプログラムに復帰する。 In step S104, the target vehicle speed V L * calculated by the inter-vehicle distance control calculation unit 43 using the equation (7) is compared with the set vehicle speed V SET set by the driver, and the smaller value is set as the target vehicle speed. After setting as V * , the process proceeds to step S105, the target vehicle speed V * is input to the target drive shaft torque calculation unit 53, the timer interruption process is terminated, and the process returns to the predetermined main program.

*=min(VL *,VSET) ………(8)
ここで、min( )は、括弧内の小さい方を選択する関数である。
一方、ステップS103の判定結果が、FCA=1又はD>DMAXであるときには、車間距離制御禁止状態であるか先行車両を検出していないと判断してステップS106に移行し、予め運転者が設定した設定車速VSET を目標車速V*として設定してから前記ステップS105に移行する。
V * = min (V L * , V SET ) (8)
Here, min () is a function that selects the smaller one in parentheses.
On the other hand, when the determination result in step S103 is F CA = 1 or D> D MAX , it is determined that the inter-vehicle distance control is prohibited or the preceding vehicle is not detected, the process proceeds to step S106, and the driver is There proceeds to step S105 to set vehicle speed V sET set after setting the target vehicle speed V *.

また、図15はステップS102の光軸ずれ判断処理手順を示すフローチャートであって、図6に示す第1の実施形態における衝撃判断処理において、ステップS208、S209の処理が、車間距離検出限界DMAXを設定するステップS251、車間距離制御を禁止するS252の処理に置換されていることを除いては図6と同様の処理を行い、図6と同一部には同一符号を付与しその詳細な説明は省略する。 FIG. 15 is a flowchart showing the optical axis deviation determination processing procedure in step S102. In the impact determination processing in the first embodiment shown in FIG. 6, the processing in steps S208 and S209 is the inter-vehicle distance detection limit D MAX. The same processing as in FIG. 6 is performed except that the processing is replaced by the processing in step S251 for setting the distance and S252 for prohibiting the inter-vehicle distance control, and the same parts as in FIG. Is omitted.

ステップS207で、光軸ずれ量Δθが所定値ΔθTH2以下であるか否かを判定し、Δθ≦ΔθTH2であるときにはステップS251に移行して、車間制御禁止フラグFCAを、制御許可を表す“0”にリセットすると共に、図16に示すように光軸ずれΔθに応じて車間距離検出限界DMAXを設定する。一方、ステップS207の判定結果が、Δθ>ΔθTH2であるときにはステップS252に移行して、車間制御禁止フラグFCAを、制御禁止を表す“1”にセットして車間距離制御を作動させないようにする。 In step S207, it is determined whether or not the optical axis deviation amount Δθ is equal to or smaller than a predetermined value Δθ TH2 . If Δθ ≦ Δθ TH2 , the process proceeds to step S251, and the inter-vehicle control prohibition flag F CA indicates control permission. In addition to resetting to “0”, the inter-vehicle distance detection limit D MAX is set according to the optical axis deviation Δθ as shown in FIG. On the other hand, when the determination result in step S207 is Δθ> Δθ TH2 , the process proceeds to step S252, and the inter-vehicle control prohibition flag F CA is set to “1” indicating the control prohibition so as not to operate the inter-vehicle distance control. To do.

したがって、今、自車両が、整備工場や販売店等で光軸調整を施して前方物体センサ18に光軸ずれが発生していない状態で走行中であるとする。この場合には、図15の衝撃判断処理において、ステップS202からステップS204に移行して、記憶された光軸ずれ量Δθを“0”にリセットすると共に、光軸ずれ表示装置17の光軸ずれ表示を非表示とする。光軸ずれ量Δθ=0であるので、ステップS207からステップS251に移行して、車間制御禁止フラグFCAが制御許可を表す“0”にリセットされると共に、図16に示すように車間距離D1が車間距離検出限界DMAXとして設定される。自車両が先行車両を検出していない場合には、前方物体センサ18が車間距離検出限界DMAXより大きい車間距離Dを検出するので、図14の目標車速設定処理において、ステップS103からステップS106に移行して、運転者が設定した設定車速VSET を目標車速V*として設定してからステップS105に移行し、目標車速V*を目標駆動軸トルク演算部53へ入力することにより、自車速Vsを運転者が設定した設定車速VSET に一致させるような走行制御を行う。 Therefore, it is assumed that the host vehicle is currently traveling in a state where the optical axis adjustment is not performed in the front object sensor 18 by adjusting the optical axis at a maintenance shop or a store. In this case, in the impact determination process of FIG. 15, the process proceeds from step S202 to step S204 to reset the stored optical axis deviation amount Δθ to “0” and the optical axis deviation of the optical axis deviation display device 17. Hide display. Since the optical axis deviation amount Δθ = 0, the process proceeds from step S207 to step S251, the inter-vehicle control prohibition flag F CA is reset to “0” indicating control permission, and the inter-vehicle distance D as shown in FIG. 1 is set as the inter-vehicle distance detection limit D MAX. If the host vehicle has not detected the preceding vehicle, the forward object sensor 18 detects the inter-vehicle distance D that is greater than the inter-vehicle distance detection limit D MAX, and therefore, in the target vehicle speed setting process of FIG. and migrated, by transition from set to set vehicle speed V sET set by the driver as the target vehicle speed V * in step S105, and inputs the target vehicle speed V * to the target drive shaft torque calculating unit 53, vehicle speed Vs Is controlled to match the set vehicle speed V SET set by the driver.

この状態から、自車両に何らかの衝撃が加わって前方物体センサ18に所定値ΔθTH2より大きい光軸ずれが発生した場合には、図15の衝撃判断処理において、ステップS201で減速度方向に所定値以上の値を検出して、所定値ΔθTH2より大きい光軸ずれ量Δθを推定する。次いで、ステップS202からステップS203に移行して記憶された光軸ずれ量Δθを保持し、光軸ずれ量Δθは光軸ずれ表示閾値ΔθSET以上であるので、ステップS205の判定によりステップS206に移行して、光軸ずれ表示装置17に光軸ずれ表示を行う。そして、Δθ>ΔθTH2であるので、ステップS207からステップS208に移行して車間制御禁止フラグFCAを、制御禁止を表す“1”にセットする。FCA=1であるため、図14の目標車速設定処理において、ステップS103からステップS106に移行して運転者が設定した設定車速VSET を目標車速V*として設定してからステップS105に移行し、目標車速V*を目標駆動軸トルク演算部53へ入力することにより、車間距離Dが車間距離検出限界DMAX以下となっている場合であっても、追従走行制御は作動せず、自車速Vsを運転者が設定した設定車速VSET に一致させるような走行制御を継続する。 From this state, when the predetermined value [Delta] [theta] TH2 greater than the optical axis shifted in the forward object sensor 18 applied is any impact on the vehicle occurs, the impact judgment processing of FIG. 15, a predetermined value in the deceleration direction at step S201 by detecting the above values, estimating a larger amount of optical axis misalignment [Delta] [theta] a predetermined value [Delta] [theta] TH2. Next, the process proceeds from step S202 to step S203, and the stored optical axis deviation amount Δθ is held. Since the optical axis deviation amount Δθ is equal to or larger than the optical axis deviation display threshold value Δθ SET , the process proceeds to step S206 according to the determination in step S205. Then, the optical axis deviation display device 17 displays the optical axis deviation. Since Δθ> Δθ TH2 , the process proceeds from step S207 to step S208, and the inter-vehicle control prohibition flag F CA is set to “1” indicating control prohibition. Since F CA = 1, in the target vehicle speed setting process of FIG. 14, the process proceeds from step S103 to step S106, the set vehicle speed V SET set by the driver is set as the target vehicle speed V * , and then the process proceeds to step S105. By inputting the target vehicle speed V * to the target drive shaft torque calculation unit 53, even if the inter-vehicle distance D is equal to or less than the inter-vehicle distance detection limit D MAX , the follow-up travel control does not operate and the own vehicle speed Travel control is continued so that Vs matches the set vehicle speed V SET set by the driver.

このように、光軸ずれが発生するような衝撃が発生したと判断した場合には、光軸ずれ量Δθを推定し、この光軸ずれ量Δθが所定値ΔθTH2より大きい場合に車間距離制御を禁止するので、大幅な光軸ずれにより先行車両との車間距離を正確に認識できない状態のまま追従走行制御を行うことを確実に防止することができる。
一方、前方物体センサ18に所定値ΔθTH2以下のわずかな光軸ずれが発生している状態で走行中であるとする。この場合には、図15の衝撃判断処理において、ステップS201でΔθ≦ΔθTH2となる光軸ずれ量Δθが推定される。整備工場や販売店等で光軸調整を施していないため、ステップS202からステップS203に移行して記憶された光軸ずれ量Δθを保持し、光軸ずれ量Δθが光軸ずれ表示閾値ΔθSET以上であるときには、ステップS205の判定によりステップS206に移行して、光軸ずれ表示装置17に光軸ずれ表示を行う。そして、ステップS207からステップS209に移行して、図16に示すように光軸ずれ量Δθに応じた車間距離が車間距離検出限界DMAXとして設定される。
In this way, when it is determined that an impact that would cause an optical axis deviation has occurred, the optical axis deviation amount Δθ is estimated, and if this optical axis deviation amount Δθ is greater than a predetermined value Δθ TH2 , the inter-vehicle distance control is performed. Therefore, it is possible to reliably prevent the following traveling control from being performed in a state where the distance between the preceding vehicle and the preceding vehicle cannot be accurately recognized due to a large optical axis deviation.
On the other hand, it is assumed that the vehicle is traveling in a state in which a slight optical axis deviation of a predetermined value Δθ TH2 or less occurs in the front object sensor 18. In this case, in the impact determination process of FIG. 15, the optical axis deviation amount Δθ that satisfies Δθ ≦ Δθ TH2 is estimated in step S201. Since the optical axis is not adjusted at a maintenance shop or a store, the process shifts from step S202 to step S203 to store the stored optical axis deviation amount Δθ, and the optical axis deviation amount Δθ is the optical axis deviation display threshold value Δθ SET. When it is above, the process proceeds to step S206 based on the determination in step S205, and the optical axis deviation display device 17 displays the optical axis deviation. Then, the process proceeds from step S207 to step S209, and the inter-vehicle distance according to the optical axis deviation amount Δθ is set as the inter-vehicle distance detection limit D MAX as shown in FIG.

前方物体センサ18で車間距離検出限界DMAX以下の車間距離Dを検出し、自車両が先行車両を検出しているときには、図14の目標車速設定処理において、ステップS103からステップS104に移行して車間距離Dを目標車間距離D* に保ちながら追従走行するための目標車速V*を設定し、次いでステップS105に移行して目標車速V*を目標駆動軸トルク演算部53へ入力することにより追従走行制御を行う。 When the front object sensor 18 detects the inter-vehicle distance D equal to or less than the inter-vehicle distance detection limit D MAX and the own vehicle detects the preceding vehicle, the process proceeds from step S103 to step S104 in the target vehicle speed setting process of FIG. By setting a target vehicle speed V * to follow the vehicle while keeping the inter-vehicle distance D at the target inter-vehicle distance D * , the process proceeds to step S105 to input the target vehicle speed V * to the target drive shaft torque calculation unit 53. Run control.

ここで、車間距離検出限界DMAXは光軸ずれ量Δθが大きいほど小さい値に設定されるので、ΔθTH1<Δθ≦ΔθTH2であるときには、光軸ずれがない場合と比較して、先行車両との相対位置関係がより近いものに対してのみ追従走行制御を行うことになる。
このように、上記第5の実施形態では、自車両に何らかの衝撃が加わって先行車両を認識するためのセンサの取り付け位置がずれるなどにより、センサに検出範囲の変化が生じた場合には、直ちにそれを検出して車間距離制御を禁止するので、センサの検出範囲が変化したまま追従走行制御が作動してしまうことを確実に防止できると共に、検出範囲の変化が発生していない場合には、通常通りの追従走行制御を行うので、運転者に違和感のない走行制御を行うことができる。
Here, since the inter-vehicle distance detection limit D MAX is set to a smaller value the larger the amount of optical axis misalignment [Delta] [theta], when it is Δθ TH1 <Δθ ≦ Δθ TH2, compared with the case where there is no optical axis misalignment, the preceding vehicle The follow-up running control is performed only for those having a relative positional relationship closer to.
As described above, in the fifth embodiment, when a change in the detection range occurs in the sensor due to, for example, an attachment of the sensor for recognizing the preceding vehicle due to some impact applied to the own vehicle, Since it detects this and prohibits inter-vehicle distance control, it is possible to reliably prevent the follow-up running control from operating while the detection range of the sensor is changed, and when the detection range has not changed, Since the normal follow-up running control is performed, it is possible to perform the running control without feeling uncomfortable for the driver.

さらに、先行車両を認識するためのセンサの検出範囲変化量が大きいほど、検出した先行車両との相対位置関係が近いものに対してのみ車間距離制御を行い、変化量が小さいほど、変化量が大きい場合と比較して検出した先行車両との相対位置関係が遠いものに対しても車間距離制御を行うので、先行車両位置の正確性を悪化させずに先行車両の位置を検出できると共に、検出範囲の変化の状態に応じて最適な車間距離制御を行うことができる。   Furthermore, the greater the detection range change amount of the sensor for recognizing the preceding vehicle, the more the inter-vehicle distance control is performed only for the detected relative positional relationship with the preceding vehicle, and the smaller the change amount, the more the change amount. The inter-vehicle distance control is performed even when the relative positional relationship with the preceding vehicle is far compared with the case where it is large, so that the position of the preceding vehicle can be detected and detected without deteriorating the accuracy of the preceding vehicle position. Optimal inter-vehicle distance control can be performed according to the state of range change.

また、広く普及しているエアバック等に使用されている加速度センサの加速度信号を用いて、先行車両を認識するためのセンサに加わった衝撃の大きさを検出するので、新たに衝撃検出センサを設置する必要がなく、コストアップを削減することができる。
なお、上記第5の実施形態においては、加速度検出手段として加速度センサを適用する場合について説明したが、これに限定されるものではなく、車速センサで検出した自車両の車速から加速度を算出するようにしてもよい。
In addition, since the magnitude of the impact applied to the sensor for recognizing the preceding vehicle is detected using the acceleration signal of the acceleration sensor that is widely used in airbags and the like, a new impact detection sensor is provided. There is no need for installation, and the cost increase can be reduced.
In the fifth embodiment, the case where the acceleration sensor is applied as the acceleration detecting means has been described. However, the present invention is not limited to this, and the acceleration is calculated from the vehicle speed detected by the vehicle speed sensor. It may be.

また、上記第5の実施形態においては、図15の衝撃判断処理において、ステップS201で加速度センサの加速度信号を用いる場合について説明したが、これに限定されるものではなく、ステップS201で図9に示す第2の実施形態におけるステップS221と同様にヨーレートセンサで検出したヨーレートの変化率を用いるようにしてもよく、ステップS201で図10に示す第3の実施形態におけるステップS231と同様に車速センサで検出した自車速の変化率を用いるようにしてもよく、さらにステップS201で図11に示す第4の実施形態におけるステップS241と同様に前方物体センサで検出した先行車両との車間距離及び相対速度を用いるようにしてもよい。   In the fifth embodiment, the case where the acceleration signal of the acceleration sensor is used in step S201 in the impact determination process of FIG. 15 has been described. However, the present invention is not limited to this, and FIG. The change rate of the yaw rate detected by the yaw rate sensor may be used in the same manner as in step S221 in the second embodiment shown. In step S201, the vehicle speed sensor is used in the same manner as in step S231 in the third embodiment shown in FIG. The change rate of the detected vehicle speed may be used, and the inter-vehicle distance and relative speed with the preceding vehicle detected by the front object sensor in step S201 as in step S241 in the fourth embodiment shown in FIG. You may make it use.

なお、上記各実施形態においては、図6、図9〜図11及び図15の衝撃判断処理において、ステップS202で光軸調整を実施したと判断されたときに、ステップS204で光軸ずれ量Δθを“0”にリセットする場合について説明したが、これに限定されるものではなく、衝突等により検出範囲が変化したと判断された後に、従来からある停止物(前方路側のデリニエータ)の検出軌跡に基づく検出範囲変化判断処理に必要な距離だけ走行し、検出範囲の変化が検出されなかった場合に、記憶された光軸ずれ量Δθを“0”にリセットするようにしてもよい。   In each of the above embodiments, when it is determined in step S202 that the optical axis adjustment has been performed in the impact determination processing of FIGS. 6, 9 to 11 and 15, the optical axis deviation amount Δθ in step S204. However, the present invention is not limited to this, but the detection locus of a conventional stationary object (forward roadside delineator) after it is determined that the detection range has changed due to a collision or the like. When the vehicle travels a distance required for the detection range change determination process based on the above and no change in the detection range is detected, the stored optical axis deviation amount Δθ may be reset to “0”.

また、上記各実施形態においては、光軸ずれ量Δθが光軸ずれ表示閾値ΔθSET以上であるときに、車室内に設置されている光軸ずれ表示装置に光軸ずれ状態であることを直ちに表示する場合について説明したが、これに限定されるものではなく、光軸ずれ表示装置に光軸ずれ状態であることを記憶しておき、整備工場や販売店等で診断装置を接続したときに、その診断装置に光軸ずれ状態であることを表示するようにしてもよい。また、光軸ずれ状態をモニタに表示するのではなく、音声やブザー等によって報知するようにしてもよい。 Further, in each of the above embodiments, when the optical axis deviation amount Δθ is equal to or larger than the optical axis deviation display threshold Δθ SET , the optical axis deviation display device installed in the passenger compartment is immediately in the optical axis deviation state. The case of displaying was explained, but the present invention is not limited to this. When the optical axis misalignment display device remembers that the optical axis is misaligned, and when a diagnostic device is connected at a maintenance shop or a store, etc. The diagnostic apparatus may display that the optical axis is shifted. Further, instead of displaying the optical axis deviation state on the monitor, it may be notified by voice or buzzer.

さらに、上記各実施形態においては、前方物体センサ14としてレーザレーダを使用する場合について説明したが、これに限定されるものではなく、ミリ波レーダ等の他の測距装置を適用してもよい。
また、上記各実施形態においては、後輪駆動車に本発明を適用した場合について説明したが、前輪駆動車に本発明を適用することもでき、また回転駆動源としてエンジン2を適用した場合について説明したが、これに限定されるものではなく、電動モータを適用することもでき、さらには、エンジンと電動モータとを使用するハイブリッド仕様車にも本発明を適用することができる。
Further, in each of the above embodiments, the case where the laser radar is used as the front object sensor 14 has been described. However, the present invention is not limited to this, and other ranging devices such as a millimeter wave radar may be applied. .
In each of the above embodiments, the case where the present invention is applied to a rear wheel drive vehicle has been described. However, the present invention can also be applied to a front wheel drive vehicle, and the case where the engine 2 is applied as a rotational drive source. Although explained, it is not limited to this, An electric motor can also be applied, Furthermore, this invention is applicable also to the hybrid specification vehicle which uses an engine and an electric motor.

本発明の実施形態を示す概略構成図である。It is a schematic structure figure showing an embodiment of the present invention. 前方物体センサの説明図である。It is explanatory drawing of a front object sensor. 本発明の実施形態における走行制御コントローラ20で実行する制動制御作動判断処理を示すフローチャートである。It is a flowchart which shows the brake control action | judging determination process performed with the traveling controller 20 in embodiment of this invention. 操舵回避に必要な横移動量の説明図である。It is explanatory drawing of the amount of lateral movement required for steering avoidance. 横移動量と横移動にかかる時間との関係図である。It is a relationship diagram between the amount of lateral movement and the time required for lateral movement. 第1の実施の形態における衝撃判断処理を示すフローチャートである。It is a flowchart which shows the impact determination process in 1st Embodiment. 光軸ずれ量の算出マップである。It is a calculation map of the amount of optical axis deviation. 光軸ずれ量と制動制御作動距離との関係図である。FIG. 5 is a relationship diagram between an optical axis deviation amount and a braking control working distance. 第2の実施の形態における衝撃判断処理を示すフローチャートである。It is a flowchart which shows the impact determination process in 2nd Embodiment. 第3の実施の形態における衝撃判断処理を示すフローチャートである。It is a flowchart which shows the impact judgment process in 3rd Embodiment. 第4の実施の形態における衝撃判断処理を示すフローチャートである。It is a flowchart which shows the impact judgment process in 4th Embodiment. 本発明の第5の実施形態を示す概略構成図である。It is a schematic block diagram which shows the 5th Embodiment of this invention. 図12の追従制御コントローラの具体例を示すブロック図である。It is a block diagram which shows the specific example of the tracking control controller of FIG. 第5の実施の形態における図13の目標車速設定部の目標車速設定処理を示すフローチャートである。It is a flowchart which shows the target vehicle speed setting process of the target vehicle speed setting part of FIG. 13 in 5th Embodiment. 第5の実施の形態における衝撃判断処理を示すフローチャートである。It is a flowchart which shows the impact judgment process in 5th Embodiment. 光軸ずれ量と車間距離検出限界との関係図である。FIG. 6 is a relationship diagram between the amount of optical axis deviation and the inter-vehicle distance detection limit.

符号の説明Explanation of symbols

2 エンジン
3 自動変速機
7 ディスクブレーキ
8 制動制御装置
11 エンジン出力制御装置
13 車速センサ
14 前方物体センサ
15 加速度センサ
16 ヨーレートセンサ
17 光軸ずれ表示装置
20 走行制御コントローラ
30 追従制御コントローラ
50 車速制御部
51 目標車速設定部
53 目標駆動軸トルク演算部
60 駆動軸トルク制御部
2 Engine 3 Automatic transmission 7 Disc brake 8 Braking control device 11 Engine output control device 13 Vehicle speed sensor 14 Front object sensor 15 Acceleration sensor 16 Yaw rate sensor 17 Optical axis deviation display device 20 Travel control controller 30 Follow-up control controller 50 Vehicle speed control unit 51 Target vehicle speed setting unit 53 Target drive shaft torque calculation unit 60 Drive shaft torque control unit

Claims (4)

自車両前方の物体を検出する前方物体検出手段と、該前方物体検出手段で検出した前方物体と自車両との相対位置関係に基づいて、前方物体への衝突回避が不可能であることを判断する衝突回避判断手段と、該衝突回避判断手段が衝突回避不可能と判断し、且つ所定の作動条件が満たされた場合に自車両を自動制動制御する自動制動制御手段と、該自動制動制御の終了後であって、前記衝突回避判断手段が衝突回避不可能と判断した衝突により前記前方物体検出手段の検出範囲が変化した場合に、前記自動制動制御手段による自動制動制御が作動され難くなるように当該自動制動制御の前記作動条件を変更する作動条件変更手段と、を備えていることを特徴とする車両用走行制御装置。 Based on the forward object detection means for detecting an object in front of the host vehicle and the relative positional relationship between the forward object detected by the forward object detection means and the host vehicle, it is determined that a collision with the forward object cannot be avoided. A collision avoidance determining means for determining whether the collision avoidance determining means determines that the collision avoidance is impossible and a predetermined operation condition is satisfied ; After completion , when the detection range of the front object detection means changes due to a collision that the collision avoidance determination means determines is impossible to avoid collision, the automatic braking control by the automatic braking control means becomes difficult to operate. the vehicle control system, characterized in that it comprises an actuating condition changing means for changing the operation condition of the automatic brake control, to. 前記作動条件変更手段は、前記自動制動制御手段による自動制動制御の作動を禁止することを特徴とする請求項1に記載の車両用走行制御装置。 Said operating condition changing means, vehicle control system according to claim 1, characterized in that prohibiting the operation of the automatic brake control by the prior SL automatic brake control means. 自車両前方の物体を検出する前方物体検出手段と、該前方物体検出手段で検出した前方物体と自車両との相対位置関係に基づいて、前記相対位置関係が所定の関係となるように自車両の走行を制御する走行制御手段と、前記前方物体検出手段で検出した前方物体と自車両との相対位置関係に基づいて、前方物体への衝突回避が不可能であることを判断する衝突回避判断手段と、該衝突回避判断手段が衝突回避不可能と判断し、且つ所定の作動条件が満たされた場合に自車両を自動制動制御する自動制動制御手段と、該自動制動制御の終了後であって、前記衝突回避判断手段が衝突回避不可能と判断した衝突により前記前方物体検出手段の検出範囲が変化した場合に、前記走行制御手段による走行制御が作動され難くなるように当該走行制御の前記作動条件を変更する作動条件変更手段と、を備えていることを特徴とする車両用走行制御装置。 Based on the forward object detection means for detecting an object in front of the own vehicle and the relative position relation between the forward object detected by the forward object detection means and the own vehicle, the own vehicle so that the relative positional relation becomes a predetermined relation. A collision avoidance determination that determines that it is impossible to avoid a collision with a front object based on a relative positional relationship between the front object detected by the front object detection means and the host vehicle. and means, the collision avoidance judging means judges that not collision avoidance, and an automatic braking control means for automatic braking control vehicle when a predetermined operating condition is satisfied, met after the completion of the automatic brake control Te, wherein if the detection range of the forward object detecting unit by the collision avoidance determining unit determines that not the collision avoidance collision is changed, the running control means according to the running control of the running control such that hardly operated Serial vehicle control system characterized in that it and a operating condition changing means for changing operating conditions. 前記作動条件変更手段は、前記走行制御手段による走行制御の作動を禁止することを特徴とする請求項3に記載の車両用走行制御装置。 Said operating condition changing means, vehicle control system according to claim 3, characterized in that prohibiting the operation of the travel control by the prior SL running control means.
JP2007172404A 2007-06-29 2007-06-29 Vehicle travel control device Expired - Lifetime JP4670841B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2007172404A JP4670841B2 (en) 2007-06-29 2007-06-29 Vehicle travel control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2007172404A JP4670841B2 (en) 2007-06-29 2007-06-29 Vehicle travel control device

Related Parent Applications (1)

Application Number Title Priority Date Filing Date
JP2003145202A Division JP4013825B2 (en) 2003-05-22 2003-05-22 Vehicle travel control device

Publications (2)

Publication Number Publication Date
JP2007290708A JP2007290708A (en) 2007-11-08
JP4670841B2 true JP4670841B2 (en) 2011-04-13

Family

ID=38761729

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2007172404A Expired - Lifetime JP4670841B2 (en) 2007-06-29 2007-06-29 Vehicle travel control device

Country Status (1)

Country Link
JP (1) JP4670841B2 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6475543B2 (en) 2015-03-31 2019-02-27 株式会社デンソー Vehicle control apparatus and vehicle control method
JP6363549B2 (en) 2015-03-31 2018-07-25 株式会社デンソー Vehicle control apparatus and vehicle control method
JP6527369B2 (en) 2015-03-31 2019-06-05 株式会社デンソー Vehicle control device and vehicle control method
JP6321576B2 (en) 2015-05-12 2018-05-09 トヨタ自動車株式会社 Limiting device and vehicle

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0481330A (en) * 1990-07-25 1992-03-16 Hitachi Ltd Constant speed travelling control method
JPH0911870A (en) * 1995-07-03 1997-01-14 Toyota Motor Corp Vehicle travel control device
JP2001138880A (en) * 1999-11-11 2001-05-22 Nissan Motor Co Ltd Braking control device for vehicle
JP2002036908A (en) * 2000-07-28 2002-02-06 Denso Corp Cruise control device, distance alarm device between vehicles and recording medium

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0481330A (en) * 1990-07-25 1992-03-16 Hitachi Ltd Constant speed travelling control method
JPH0911870A (en) * 1995-07-03 1997-01-14 Toyota Motor Corp Vehicle travel control device
JP2001138880A (en) * 1999-11-11 2001-05-22 Nissan Motor Co Ltd Braking control device for vehicle
JP2002036908A (en) * 2000-07-28 2002-02-06 Denso Corp Cruise control device, distance alarm device between vehicles and recording medium

Also Published As

Publication number Publication date
JP2007290708A (en) 2007-11-08

Similar Documents

Publication Publication Date Title
JP4013825B2 (en) Vehicle travel control device
US11186278B2 (en) Driving control apparatus for vehicle
JP7189509B2 (en) Vehicle travel control device
US10996672B2 (en) Driving control apparatus for vehicle
EP3611069B1 (en) Vehicle control device
JP7205773B2 (en) Vehicle travel control device
US11161513B2 (en) Driving control apparatus for vehicle
JP3783562B2 (en) Vehicle travel control device
US20090143951A1 (en) Forward Collision Avoidance Assistance System
US9406230B2 (en) Drive control apparatus
JP2020144789A (en) Cruising controller for vehicle
US11370430B2 (en) Driving control apparatus for vehicle
KR20100106570A (en) Device, method, and computer program for avoiding collisions or minimizing the collision severity in case of a collision, for vehicles, particularly commercial vehicles
US8548709B2 (en) Drive assisting device
US11407427B2 (en) Driving control apparatus for vehicle
JP2007186141A (en) Running control device for vehicle
JP2008516851A (en) How to check related objects
EP3096992B1 (en) Road departure protection system
JP2022024322A (en) Collision avoidance support device
US20200255012A1 (en) Driving Control Apparatus for Vehicle
US11364952B2 (en) System for recognizing trailer of vehicle and method thereof
JP4670841B2 (en) Vehicle travel control device
JP7222343B2 (en) Driving support device
KR101511860B1 (en) Driver assistance systems and controlling method for the same
JP7140092B2 (en) Driving support device

Legal Events

Date Code Title Description
A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20100520

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20100525

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20100616

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20100917

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20101221

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20110103

R150 Certificate of patent or registration of utility model

Ref document number: 4670841

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20140128

Year of fee payment: 3

EXPY Cancellation because of completion of term