JP2001319299A - Road curvature estimating device for vehicle and preceding vehicle selecting device - Google Patents

Road curvature estimating device for vehicle and preceding vehicle selecting device

Info

Publication number
JP2001319299A
JP2001319299A JP2000140100A JP2000140100A JP2001319299A JP 2001319299 A JP2001319299 A JP 2001319299A JP 2000140100 A JP2000140100 A JP 2000140100A JP 2000140100 A JP2000140100 A JP 2000140100A JP 2001319299 A JP2001319299 A JP 2001319299A
Authority
JP
Japan
Prior art keywords
vehicle
curvature
road
estimating
lane
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.)
Pending
Application number
JP2000140100A
Other languages
Japanese (ja)
Inventor
Yoshifumi Takigawa
能史 瀧川
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.)
Denso Corp
Original Assignee
Denso Corp
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 Denso Corp filed Critical Denso Corp
Priority to JP2000140100A priority Critical patent/JP2001319299A/en
Publication of JP2001319299A publication Critical patent/JP2001319299A/en
Pending legal-status Critical Current

Links

Landscapes

  • Controls For Constant Speed Travelling (AREA)
  • Control Of Vehicle Engines Or Engines For Specific Uses (AREA)
  • Traffic Control Systems (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide a technique by which the curvature of a road in a front part is properly estimated even in a road which has a curve in the front part though a vehicle is traveling along a straight part. SOLUTION: A curvature radius is calculated based on a changer rate when the change with time of an object horizontal position is linearly approximated. Since a triangle OAB consisting of a curvature center O, its own vehicle A and an object B is an isosceles triangle, θ+2ψ=π, and θ=2ϕ from ϕ+ψ=(1/2) π. Since Rsinθ is Dcosϕ and Vx being the X-direction component of the relative velociaty V of an object to be recognized is Vsinθ, R=Dcosϕ×V/Vx is obtained. R=Dvsens/Vx is obtained since Vsens being the relative velocity of the object B is equal to Vcos(θ-ϕ) and to Vcosϕ. Vx being the X-direction component of the relative velocity V is dX/dt. When it is replaced with a different ΔX/Δt, the inclination (a) of a graph which indicates the locus of the object to be recognized is obtained. Therefore, the curvature radius = (a distance to the object to be recognized) × (the relative velocity)/the inclination.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、車幅方向の所定角
度範囲内に渡り送信波を照射し、その反射波に基づいて
車両前方の道路曲率を推定する技術などに関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a technique for irradiating a transmission wave within a predetermined angle range in a vehicle width direction and estimating a curvature of a road ahead of the vehicle based on a reflected wave.

【0002】[0002]

【従来の技術及び発明が解決しようとする課題】従来よ
り、車両前方の所定角度に渡り、例えば光波,ミリ波な
どの送信波を照射し、その反射波を検出することによっ
て、上記車両前方の障害物を認識する車両用障害物認識
装置が考えられている。この種の装置としては、例え
ば、先行車両などの障害物を検出して警報を発生する装
置や、先行車両と所定の車間距離を保持するように車速
を制御する装置などに適用され、制御対象の先行車両な
どの障害物を認識するものが考えられている。
2. Description of the Related Art Conventionally, a transmission wave such as a light wave or a millimeter wave is radiated over a predetermined angle in front of a vehicle, and a reflected wave is detected. An obstacle recognition device for a vehicle that recognizes an obstacle has been considered. This type of device is applied to, for example, a device that detects an obstacle such as a preceding vehicle and generates an alarm, and a device that controls a vehicle speed so as to maintain a predetermined inter-vehicle distance with the preceding vehicle, and is a control target. A vehicle that recognizes an obstacle such as a preceding vehicle has been considered.

【0003】この車両用障害物検出装置では、認識した
障害物の中から自車の前を走行する先行車を特定する必
要があり、これには、例えばステアリング操舵角センサ
やヨーレートセンサなどを用いるのが一般的である。し
かし、例えば自車が道路の直線部分を走行しているが、
その道路は前方でカーブしており、且つ先行車が既にそ
のカーブ部分に入っていると、先行車を誤って特定して
しまうおそれがある。このような状況で先行車の特定を
適切に行うためには、車両前方の道路の曲率を適切に推
定する必要がある。
In this vehicle obstacle detecting device, it is necessary to specify a preceding vehicle traveling in front of the own vehicle from the recognized obstacles. For this purpose, for example, a steering angle sensor, a yaw rate sensor, or the like is used. It is common. However, for example, if your car is traveling on a straight part of the road,
If the road curves ahead and the preceding vehicle is already in the curve, the preceding vehicle may be erroneously identified. In order to properly identify the preceding vehicle in such a situation, it is necessary to appropriately estimate the curvature of the road ahead of the vehicle.

【0004】そこで、本発明は、自車は直線部分を走行
しているが前方でカーブしている道路であっても、その
前方での道路の曲率を適切に推定することのできる技術
及びその推定した道路曲率に基づいて先行車を選択する
技術を提供することを目的とする。
[0004] Therefore, the present invention provides a technique capable of appropriately estimating the curvature of a road ahead even on a road where the vehicle is traveling in a straight line but curves ahead. An object of the present invention is to provide a technique for selecting a preceding vehicle based on an estimated road curvature.

【0005】[0005]

【課題を解決するための手段】請求項1記載の道路曲率
推定装置によれば、車幅方向の所定角度範囲内に渡り送
信波を照射し、その反射波に基づいて車両前方の道路曲
率を推定するにあたり、次のような処理を行う。つま
り、少なくとも物体までの距離及び物体横位置を算出
し、その算出された物体横位置の時間経過に伴う履歴か
ら物体横位置の変化率を算出し、その算出された変化率
に基づいて、車両前方の道路の曲率を算出するのであ
る。
According to a first aspect of the present invention, there is provided a road curvature estimating apparatus which irradiates a transmission wave over a predetermined angle range in a vehicle width direction, and calculates a road curvature ahead of the vehicle based on the reflected wave. For estimation, the following processing is performed. That is, at least the distance to the object and the object lateral position are calculated, the change rate of the object lateral position is calculated from the history of the calculated object lateral position over time, and the vehicle is calculated based on the calculated change rate. It calculates the curvature of the road ahead.

【0006】ここで、「物体横位置」とは、自車の前後
方向(正面方向)軸の延長線を基準とした場合に、その
物体が自車の車幅方向へどの程度離れているかを示す物
理量である。直線道路における自車線上の先行車の物体
横位置は基本的には変化しない。「基本的には」と表現
したのは、例えば同一車線内であっても多少の変化はあ
ることを考慮したためである。これに対して、例えば図
2(a)に示すように、自車両は直線部分を走行してい
るが前方でカーブしている道路の場合、そのカーブして
いる部分を先行車が走行していると、たとえ同一車線上
であっても、物体横位置は変化する。つまり、図2
(a)の状況で言えば、先行車が右側車線を走行してお
り、右カーブであるため、両車両が同じように直線部分
を走行している場合の先行車の物体横位置よりも、先行
車のみがカーブ部分を走行している場合の先行車の物体
横位置の方が大きくなるのである。したがって、このよ
うな物体横位置の時間的変化に着目すれば、前方道路の
曲率を適切に推定することができると考えたのである。
もちろん、移動物体ではなく、路側物などの停止物体で
あっても同様に物体横位置の変化率に基づくことで前方
道路の曲率を適切に推定することができる。図2
(b),(c)には、左カーブの場合右カーブの場合の
物体横位置の時間的変化(軌跡)のグラフ例を示す。
Here, the "object lateral position" refers to how far the object is located in the vehicle width direction with respect to an extension line of the longitudinal axis (front direction) of the own vehicle. It is a physical quantity shown. The object lateral position of the preceding vehicle on the own lane on a straight road basically does not change. The term "basically" is used in consideration of, for example, a slight change even in the same lane. On the other hand, for example, as shown in FIG. 2A, in a case where the own vehicle is traveling on a straight line portion, but is on a curved road ahead, the preceding vehicle travels on the curved portion. In such a case, the object lateral position changes even on the same lane. That is, FIG.
In the situation of (a), since the preceding vehicle is traveling in the right lane and has a right curve, the preceding vehicle's object lateral position when both vehicles are traveling in a straight line in the same manner, When only the preceding vehicle is traveling on a curved portion, the object lateral position of the preceding vehicle is larger. Therefore, if attention is paid to such a temporal change in the lateral position of the object, it is considered that the curvature of the road ahead can be appropriately estimated.
Of course, not only a moving object but also a stationary object such as a roadside object can similarly appropriately estimate the curvature of the road ahead based on the change rate of the lateral position of the object. FIG.
(B) and (c) show graph examples of temporal changes (trajectories) of the object lateral position in the case of a left curve and in the case of a right curve.

【0007】そして、この変化率の算出に関しては、請
求項2に示すように、物体横位置の時間経過に伴う履歴
を直線で近似して算出することが考えられる。この手法
で曲率が適切に算出できることを以下に説明する。な
お、曲率の算出に際しては、曲率半径(R)を求めるこ
とが一般的であるので、図3を参照して、曲率半径Rが
適切に求められることを説明する。
As for the calculation of the rate of change, it is conceivable that the history of the lateral position of the object over time is approximated by a straight line, as described in claim 2. The fact that the curvature can be appropriately calculated by this method will be described below. In calculating the curvature, it is general to calculate the radius of curvature (R), and therefore, it will be described with reference to FIG. 3 that the radius of curvature R is appropriately calculated.

【0008】図3(a)に示すように、自車両Aが曲率
半径Rのカーブ路上を走行し、そのカーブ路内にて物標
Bを認識した際のカーブ路の曲率は、以下のように求め
られる。まず、図3中において原点Oと自車両Aと物標
Bとから成る△OABについて考える。なお、原点Oは
曲率中心であり、自車両の車幅方向をX軸、前後方向と
同じ方向をZ軸とする。この△OABにおいて、∠AO
B=θ、∠OAB=ψとすると、△OABは二等辺三角
形であることから∠OBA=∠OAB=ψであるため、
以下の式1が成り立つ。
As shown in FIG. 3A, the curvature of a curved road when the vehicle A travels on a curved road having a radius of curvature R and recognizes a target B in the curved road is as follows. Required. First, consider △ OAB including the origin O, the host vehicle A, and the target B in FIG. The origin O is the center of curvature, the X-axis is the width direction of the host vehicle, and the Z-axis is the same direction as the front-rear direction. In this $ OAB, $ AO
Assuming that B = θ and ∠OAB = ψ, since で あ OAB is an isosceles triangle, ∠OBA = ∠OAB = ψ.
The following equation 1 holds.

【0009】 θ+2ψ=π …[式1] A点における曲率半径Rの円弧の接線と線分ABのなす
角をφとすると、以下の式2が成り立つ。 φ+ψ=(1/2)π …[式2] 式1,2から、θ=2φの関係が導かれる。
Θ + 2ψ = π [Equation 1] When the angle between the tangent to the arc of the curvature radius R at the point A and the line segment AB is φ, the following equation 2 is established. φ + ψ = (1/2) π (Expression 2) From Expressions 1 and 2, the relationship of θ = 2φ is derived.

【0010】また、線分ABの長さをDとすると、以下
の式3が成り立つ。 Rsinθ=Dcosφ …[式3] ここで、認識物が曲率半径Rの円弧の接線方向に相対速
度Vを持つとすると、そのX方向成分Vxは、Vx=V
sinθ となる。したがって、この関係を用いて式3のsi
nθ を消去すると、以下の式4が成り立つ。
If the length of the line segment AB is D, the following equation 3 holds. R sin θ = D cos φ (Equation 3) Here, assuming that the recognized object has a relative velocity V in a tangential direction of an arc having a radius of curvature R, its X-direction component Vx is Vx = V
sinθ. Therefore, using this relationship,
When nθ is eliminated, the following Expression 4 is established.

【0011】 R=Dcosφ・V/Vx …[式4] また、自車両Aからセンシングされる物標Bの相対速度
Vsensは、以下の式5で表される。 Vsens=Vcos(θ−φ)=Vcosφ …[式5] これを式4に代入すると、以下の式6が得られる。
R = Dcosφ · V / Vx (Equation 4) The relative speed Vsens of the target B sensed from the host vehicle A is expressed by the following Equation 5. Vsens = Vcos (θ−φ) = Vcosφ (Expression 5) When this is substituted into Expression 4, the following Expression 6 is obtained.

【0012】 R=DVsens/Vx …[式6] ここで、相対速度VのX方向成分であるVxは、dX/
dtであり、これを差分ΔX/Δtで置き換えると、認
識物標の軌跡を示すグラフの傾きとなる(図3(b)参
照)。例えばある物標を、時刻t=t0の際に横位置X0
[m]より認識を開始し、Δt[sec]間認識を行った時点
での横位置をXt[m]とし、そのときの物標までの距離
をd[m]、相対速度をv[m]とする。認識物標の軌跡を
直線近似して、X(t)=at+bと表したならば、Vx
=a[m/sec]となる。
R = DVsens / Vx [Equation 6] Here, Vx which is the X-direction component of the relative speed V is dX /
dt, and when this is replaced with the difference ΔX / Δt, it becomes the slope of the graph showing the trajectory of the recognized target (see FIG. 3B). For example, a target is moved to a horizontal position X0 at time t = t0.
Recognition starts from [m], the horizontal position at the time of performing recognition for Δt [sec] is Xt [m], the distance to the target at that time is d [m], and the relative speed is v [m]. ]. If the locus of the recognized target is linearly approximated and expressed as X (t) = at + b, then Vx
= A [m / sec].

【0013】また、D及びVsensはそれぞれ認識物標ま
での距離及び相対速度であるため、以下の式7のように
曲率半径Rを求めることができる。 R=dv/a …[式7] ところで、変化率を算出する際、請求項3に示すよう
に、物体の検出初期において、少なくとも第1回目と第
2回目のデータが連続して検出されている場合にのみ、
変化率を算出するようにしてもよい。これは、変化率を
算出するには複数のデータ(横位置データ)が必要であ
るが、それらの複数のデータが同一物体に係るものであ
ることが前提となる。その点を鑑みた場合、検出初期の
第1回目と第2回目のデータがあれば、たとえ第3回目
のデータが検出されずに第4回目のデータが検出された
場合に、それらが同一物体にかかる検出結果であると判
断し易い。これが、第1回目のデータは存在するが第2
回目のデータはなく、第3回目のデータが検出されたと
しても、第1回目と第3回目のデータとがはたして同一
物体にかかる検出結果であるかどうかは疑わしい。つま
り、第3回目のデータと思っていたものは、実は別の物
体のデータである可能性も高くなる。したがって、この
ような条件を課すことでより適切な曲率推定が可能とな
る。
Since D and Vsens are the distance to the target and the relative speed, respectively, the radius of curvature R can be obtained as in the following equation (7). R = dv / a (Equation 7) By the way, when calculating the rate of change, at least in the first and second data are detected continuously at the initial stage of object detection. Only if
The rate of change may be calculated. This requires a plurality of data (horizontal position data) to calculate the rate of change, but it is premised that the plurality of data relate to the same object. In view of this point, if there is the first and second data at the initial stage of detection, even if the third data is not detected and the fourth data is detected, they are the same object. It is easy to determine that this is the detection result. This is because the first data exists but the second
There is no data for the first time, and even if the data for the third time is detected, it is doubtful whether the data for the first time and the data for the third time are a detection result on the same object. That is, it is highly likely that what is considered the third data is actually data of another object. Therefore, by imposing such conditions, more appropriate curvature estimation can be performed.

【0014】停止物体・移動物体のいずれを対象として
も道路曲率の推定ができるが、停止物の方が好ましい。
なぜなら、移動物体の場合にはその速度が変化したり、
あるいは車線変更する場合もあり、さらには同一車線内
でも走行位置が左右に移動する可能性があるため、停止
物であれば、そのような変化による推定誤差を考慮しな
くてもよいからである。そのため、請求項4に示すよう
に、移動物体か停止物体かという認識種別も判定できる
場合は、停止物体が認識されている場合はその停止物体
の物体横位置を用いた変化率を算出し、停止物体が認識
されておらず移動物体が認識されている場合はその移動
物体の物体横位置を用いた変化率を算出するようにする
ことが考えられる。
Although the curvature of the road can be estimated for any of a stationary object and a moving object, a stationary object is preferable.
Because, in the case of a moving object, its speed changes,
Alternatively, the lane may be changed, and the traveling position may move left and right even in the same lane. Therefore, if the vehicle is a stationary object, the estimation error due to such a change need not be considered. . Therefore, as described in claim 4, when the recognition type of the moving object or the stationary object can also be determined, if the stationary object is recognized, the change rate using the lateral position of the stationary object is calculated, When the stationary object is not recognized but the moving object is recognized, it is conceivable to calculate the rate of change using the lateral position of the moving object.

【0015】また、曲率算出手段によって算出された曲
率をそのまま道路曲率として採用するのではなく、請求
項5に示すように、所定回数分の平均値を算出し、その
平均値を道路曲率として採用することも考えられる。こ
のように平均値を取ることで値がなまされ、一時的なノ
イズデータによる影響を防止することができる。
Also, the curvature calculated by the curvature calculation means is not directly used as the road curvature, but an average value for a predetermined number of times is calculated, and the average value is used as the road curvature. It is also possible to do. By taking the average value in this way, the value is smoothed, and the influence of temporary noise data can be prevented.

【0016】なお、このように平均値を取る場合に、変
化率を算出できる条件が成立しない場合にはその変化率
を用いた曲率が算出できないこととなる。例えば変化率
は横位置の時間的変化に基づくため、その時間的変化を
特定するのに十分な横位置の過去の履歴が得られていな
い場合などである。したがって、このような状況でも平
均値を算出するために、請求項6のようにしてもよい。
つまり、ステアリングセンサやヨーレートセンサなどの
旋回検出手段によって自車の旋回状態を検出し、その旋
回状態と自車速とに基づいて、道路の曲率を推定する第
2の曲率推定手段を備える。そして、平均値算出手段
は、変化率算出手段が変化率を算出できる条件が成立し
ない場合には、第2の曲率推定手段にて推定された曲率
を採用し、その曲率も含めた所定回数分の平均値を算出
するのである。
When the condition for calculating the rate of change is not satisfied when taking the average value in this way, the curvature using the rate of change cannot be calculated. For example, the change rate is based on the temporal change of the horizontal position, and thus there is a case where a sufficient past history of the horizontal position is not obtained to specify the temporal change. Therefore, in order to calculate the average value even in such a situation, the invention may be configured as in claim 6.
That is, there is provided a second curvature estimating means for detecting a turning state of the own vehicle by a turning detecting means such as a steering sensor or a yaw rate sensor, and estimating a curvature of the road based on the turning state and the own vehicle speed. When the condition that the change rate calculating means can calculate the change rate is not satisfied, the average value calculating means adopts the curvature estimated by the second curvature estimating means and performs the predetermined number of times including the curvature. Is calculated.

【0017】一方、このような自車の旋回状態と自車速
とに基づいて、道路の曲率を推定する第2の曲率推定手
段を備える場合には、請求項7に示すように、その第2
の曲率推定手段にて推定された曲率と上述の物体の横位
置の変化率に基づいて推定した曲率とに基づいて、最終
的な道路曲率を推定してもよい。あくまで「推定」とい
う手法を用いているため、このようにすれば極力誤判定
を避けるという観点からは有効である。
On the other hand, when a second curvature estimating means for estimating the curvature of the road based on the turning state of the own vehicle and the own vehicle speed is provided, the second curvature estimating means is provided.
The final road curvature may be estimated based on the curvature estimated by the curvature estimating means and the curvature estimated based on the change rate of the lateral position of the object. Since the technique of "estimation" is used, this is effective from the viewpoint of avoiding erroneous determination as much as possible.

【0018】また、請求項8に示すように、以上説明し
た車両用道路曲率推定装置を備え、そこから得られた道
路曲率と物体の相対位置とに基づいて、物体が自車と同
一車線上にいる確率を求め、その確率に基づいて先行車
を選択する先行車選択装置として実現することができ
る。なお、この自車線確率に基づいて先行車を選択する
手法としては、例えば本願出願人による特開平8−27
9099号に開示されたものなどが考えられる。
Further, the present invention is provided with the vehicle road curvature estimating apparatus described above, and based on the road curvature obtained from the apparatus and the relative position of the object, the object is positioned on the same lane as the own vehicle. , And a preceding vehicle selecting device that selects a preceding vehicle based on the probability. As a method of selecting a preceding vehicle based on the own lane probability, for example, Japanese Unexamined Patent Application Publication No.
No. 9099 can be considered.

【0019】一方、上述した自車線確率に基づくのでは
なく、上述した車両用道路曲率推定装置によって得た物
体毎の道路曲率に基づいて先行車を選択することもでき
る。つまり、請求項9に示すように、車両用道路曲率推
定装置によって、道路の両端にそれぞれ存在すると想定
される停止物体を基にした道路曲率を得る。その道路曲
率が得られている場合には、それらの道路曲率と移動物
体を基にして得た道路曲率の大小関係に基づいて、当該
移動物体が自車と同一車線上にいる可能性を判定する。
そして、その判定結果に基づいて先行車を選択するので
ある。
On the other hand, the preceding vehicle may be selected based on the road curvature for each object obtained by the above-described vehicle road curvature estimating apparatus instead of the above-described own lane probability. That is, according to the ninth aspect, the road curvature estimating device for a vehicle obtains a road curvature based on a stationary object which is assumed to exist at both ends of the road. If the road curvature is obtained, the possibility that the moving object is in the same lane as the own vehicle is determined based on the magnitude relationship between the road curvature and the road curvature obtained based on the moving object. I do.
Then, the preceding vehicle is selected based on the determination result.

【0020】この技術思想の概念について図8を参照し
て説明する。ここでは、図8(a)に示すように、2車
線の道路を想定する。そして、道路が右カーブしている
部分の左右道路端にそれぞれ停止物1・停止物2が存在
し、右車線に移動物1が存在し、左車線を走行する自車
両と同一車線上に移動物2が存在し、T時間後に移動物
1,2が共にカーブ部分を走行している状況を考える。
図8(b)は各認識物標(移動物1,2及び停止物1,
2)の横位置の軌跡を示すグラフである。移動物の場合
には、走行する車線によって横位置の変化率が異なる。
これは、走行車線によって曲率(半径)が異なるからで
ある。また、停止物は存在位置によって横位置の変化率
が異なる。同様に曲率(半径)が異なるからである。
The concept of this technical idea will be described with reference to FIG. Here, a two-lane road is assumed as shown in FIG. There is a stop 1 and a stop 2 at the left and right road edges, respectively, in a portion where the road curves right, a moving object 1 exists in the right lane, and the vehicle moves in the same lane as the own vehicle traveling in the left lane. Consider a situation in which the object 2 is present and the moving objects 1 and 2 are both traveling on a curved portion after T time.
FIG. 8B shows each of the recognition targets (moving objects 1 and 2 and stationary objects 1 and 2).
It is a graph which shows the locus | trajectory of the horizontal position of 2). In the case of a moving object, the rate of change in the lateral position differs depending on the lane in which the vehicle is traveling.
This is because the curvature (radius) differs depending on the traveling lane. In addition, the rate of change of the lateral position of the stationary object differs depending on the existing position. Similarly, the curvature (radius) is different.

【0021】そのため、図8(a)に示すように、T時
間後の移動物2の曲率半径をR1、停止物1の曲率半径
をR2、停止物2の曲率半径をR3、T時間後の移動物
1の曲率半径をR4とすると、それらの大小関係はR3
<R4<R1<R2となる。このような大小関係を利用
すれば、移動物体が同一車線上に存在するか否かを判定
することができ、先行車選択を行うことができる。
Therefore, as shown in FIG. 8A, the radius of curvature of the moving object 2 after T time is R1, the radius of curvature of the stopped object 1 is R2, the radius of curvature of the stopped object 2 is R3, and the time after T time is elapsed. Assuming that the radius of curvature of the moving object 1 is R4, their magnitude relation is R3
<R4 <R1 <R2. By utilizing such a magnitude relationship, it can be determined whether or not the moving object is on the same lane, and the preceding vehicle can be selected.

【0022】なお、道路の両端にそれぞれ存在すると想
定される停止物体を基にした道路曲率であるか否かは、
道路曲率半径の差が所定値以上であるか否かで判定する
ことが考えられる(請求項10)。例えばその曲率半径
差が想定される道路幅以上あれば、道路両端に存在する
停止物体であると考えられるからである。なお、走行し
ている道路の車線数が判るのであれば、その車線数に応
じた道路幅を基準に所定値を定めればよい。
It should be noted that whether or not the road curvature is based on a stationary object which is assumed to be present at each end of the road is determined as follows.
The determination may be made based on whether or not the difference between the road curvature radii is equal to or larger than a predetermined value (claim 10). For example, if the curvature radius difference is equal to or larger than the assumed road width, it is considered that the stationary object exists at both ends of the road. If the number of lanes of the road on which the vehicle is traveling is known, a predetermined value may be determined based on the road width according to the number of lanes.

【0023】また、車線同一判定手法に関しては、例え
ば請求項11に示すようなものが考えられる。つまり、
道路の両端にそれぞれ存在すると想定される停止物体の
物体横位置に基づいて、自車が左右いずれの道路端に近
い側に存在するかを判定する。そして、その判定結果、
及び車線同一か否かの判定対象の移動物を基にした道路
曲率と道路の両端にそれぞれ存在すると想定される停止
物体を基にした道路曲率との大小関係に基づいて判定す
るのである。
Further, as a method of determining the same lane, for example, the following method can be considered. That is,
Based on the object lateral positions of the stationary objects that are assumed to be present at both ends of the road, it is determined whether the vehicle is on the right or left side of the road. And, as a result of the determination,
The determination is made on the basis of the magnitude relationship between the curvature of the road based on the moving object to be determined whether the lanes are the same or not and the curvature of the road based on the stationary objects assumed to be present at both ends of the road.

【0024】なお、上述した道路曲率判定装置や先行車
選択装置における曲率推定手段、平均値算出手段、第2
の曲率推定手段、自車線確率算出手段、先行車選択手
段、車線同一判定手段をコンピュータシステムにて実現
する機能は、例えば、コンピュータシステム側で起動す
るプログラムとして備えることができる。このようなプ
ログラムの場合、例えば、フロッピー(登録商標)ディ
スク、光磁気ディスク、CD−ROM、ハードディスク
等のコンピュータ読み取り可能な記録媒体に記録し、必
要に応じてコンピュータシステムにロードして起動する
ことにより用いることができる。この他、ROMやバッ
クアップRAMをコンピュータ読み取り可能な記録媒体
として前記プログラムを記録しておき、このROMある
いはバックアップRAMをコンピュータシステムに組み
込んで用いても良い。
The curvature estimating means, the average value calculating means, and the second
The function of realizing the curvature estimating means, the own lane probability calculating means, the preceding vehicle selecting means, and the same lane determining means in the computer system can be provided as, for example, a program started on the computer system side. In the case of such a program, for example, it is recorded on a computer-readable recording medium such as a floppy (registered trademark) disk, a magneto-optical disk, a CD-ROM, and a hard disk, and is loaded into a computer system as needed and activated. Can be used. Alternatively, the program may be recorded in a ROM or a backup RAM as a computer-readable recording medium, and the ROM or the backup RAM may be incorporated in a computer system and used.

【0025】[0025]

【発明の実施の形態】次に、本発明が適用された車両制
御装置1について、図面と共に説明する。この車両制御
装置1は、自動車に搭載され、警報すべき領域に障害物
が所定の状況で存在する場合に警報を出力したり、前車
(先行車両)に合わせて車速を制御したりする装置であ
る。
Next, a vehicle control device 1 to which the present invention is applied will be described with reference to the drawings. The vehicle control device 1 is mounted on an automobile and outputs a warning when an obstacle exists in a region to be warned in a predetermined situation, or controls a vehicle speed in accordance with a preceding vehicle (preceding vehicle). It is.

【0026】図1は、そのシステムブロック図である。
車両制御装置1はコンピュータ3を中心に構成されてい
る。コンピュータ3はマイクロコンピュータを主な構成
として入出力インターフェース(I/O)および各種の
駆動回路や検出回路を備えている。これらのハード構成
は一般的なものであるので詳細な説明は省略する。
FIG. 1 is a system block diagram of the system.
The vehicle control device 1 mainly includes a computer 3. The computer 3 mainly includes a microcomputer and includes an input / output interface (I / O) and various drive circuits and detection circuits. Since these hardware configurations are general, detailed description will be omitted.

【0027】コンピュータ3は、レーダ装置5、車速セ
ンサ7、ブレーキスイッチ9、スロットル開度センサ1
1から各々所定の検出データを入力している。またコン
ピュータ3は、警報音発生器13、距離表示器15、セ
ンサ異常表示器17、ブレーキ駆動器19、スロットル
駆動器21および自動変速機制御器23に所定の駆動信
号を出力している。
The computer 3 includes a radar device 5, a vehicle speed sensor 7, a brake switch 9, and a throttle opening sensor 1.
1, predetermined detection data is input. Further, the computer 3 outputs a predetermined drive signal to the alarm sound generator 13, the distance indicator 15, the sensor abnormality indicator 17, the brake driver 19, the throttle driver 21, and the automatic transmission controller 23.

【0028】更にコンピュータ3は、警報音量を設定す
る警報音量設定器24、後述の警報判定処理における感
度を設定する警報感度設定器25、クルーズコントロー
ルスイッチ26、図示しないステアリングホイールの操
作量を検出するステアリングセンサ27及びヨーレート
センサ28を備えている。またコンピュータ3は、電源
スイッチ29を備え、その「オン」により、所定の処理
を開始する。
Further, the computer 3 detects an alarm volume setting device 24 for setting an alarm volume, an alarm sensitivity setting device 25 for setting a sensitivity in an alarm determination process described later, a cruise control switch 26, and an operation amount of a steering wheel (not shown). A steering sensor 27 and a yaw rate sensor 28 are provided. Further, the computer 3 includes a power switch 29, and starts a predetermined process when the power switch 29 is turned on.

【0029】ここでレーダ装置5について説明する。レ
ーダ装置5は、変調信号に応じて所定の周波数に変調さ
れたレーダ波を送信し、障害物に反射されたレーダ波を
受信する送受信部5aと、送受信部5aに変調信号を供
給すると共に、送受信部5aから出力される中間周波の
ビート信号に基づき、障害物を検出するための処理を実
行する信号処理部5bとにより構成されている。そし
て、本実施形態では、当該装置5によって自動車前方の
障害物を検出するために、送受信部5aが自動車の前面
に取り付けられ、信号処理部5bが、車室内又は車室近
傍の所定位置に取り付けられている。
Here, the radar device 5 will be described. The radar device 5 transmits a radar wave modulated to a predetermined frequency according to the modulation signal, and receives a radar wave reflected by an obstacle, a transmission / reception unit 5a, and supplies a modulation signal to the transmission / reception unit 5a. The signal processing unit 5b executes a process for detecting an obstacle based on the intermediate frequency beat signal output from the transmission / reception unit 5a. In this embodiment, in order to detect an obstacle in front of the vehicle by the device 5, the transmitting / receiving unit 5a is mounted on the front of the vehicle, and the signal processing unit 5b is mounted at a predetermined position in or near the vehicle. Have been.

【0030】送受信部5aが有する送信アンテナは、そ
の送信ビームにより、当該レーダ装置5が障害物の検出
が可能な検出範囲をすべてカバーできるものが用いられ
ている。また、レーダ波を受信する受信アンテナは、指
向性の強い受信ビームを形成するものが用いられてお
り、しかも、受信ビームの照射方向を、水平面に沿った
任意の方向に回動可能に構成されている。そして、送受
信部5aは、この受信アンテナを、信号処理部5bから
の制御信号に従って、所定のステップ角度単位で受信ビ
ームの照射方向を順次切り替えて上述の検出範囲内の走
査を行う。
The transmitting antenna included in the transmitting / receiving section 5a is such that the transmitting beam can cover the entire detection range in which the radar device 5 can detect an obstacle. The receiving antenna that receives radar waves is one that forms a highly directional receiving beam, and is configured to be able to rotate the irradiating direction of the receiving beam in any direction along the horizontal plane. ing. Then, the transmitting / receiving unit 5a performs scanning within the above-described detection range by sequentially switching the irradiation direction of the receiving beam in units of a predetermined step angle according to the control signal from the signal processing unit 5b.

【0031】一方、信号処理部5bは、変調信号を発生
する三角波発生器や、送受信部5aからのビート信号を
デジタルデータに変換するA/D変換器や、CPU,R
OM,RAMを中心に構成され、三角波発生器,A/D
変換器などを動作させることによりデータの収集を行う
データ収集処理、及び、データ収集処理により収集され
たデジタルデータに基づき障害物の検出を行う障害物検
出処理等を実行する周知のマイクロコンピュータ(マイ
コン)や、そのマイコンの指令に基づき高速フーリエ変
換(FFT)の演算を実行する演算処理部などにより構
成されている。そして、送受信部5aの受信アンテナを
初期位置(例えば、その受信ビームが検出範囲内の一方
の端にくる位置)に移動させ、続けて、変調信号の三角
波状の波形の上り勾配に応じて所定の割合で周波数が増
大(上り変調部)し、それに引き続く下り勾配に応じて
周波数が減少(下り変調部)するように変調された送信
信号を出力する。つまり、本実施形態のレーダ装置5
は、いわゆるFMCWレーダとして動作するものであ
り、このように周波数変調された送信信号に応じたレー
ダ波が送出され、障害物に反射したレーダ波が受信され
ると、送受信部5aでは、受信アンテナから出力される
受信信号と送信信号とが混合されることによりビート信
号が生成される。なお、受信信号は、レーダ波が障害物
まで間を往復する時間だけ送信信号に対して遅延し、且
つ、障害物との間に相対速度がある場合には、これに応
じてドップラシフトを受ける。このため、ビート信号
は、この遅延成分とドップラ成分とを含んだものとな
る。
On the other hand, the signal processing section 5b includes a triangular wave generator for generating a modulation signal, an A / D converter for converting a beat signal from the transmission / reception section 5a into digital data,
OM, RAM, triangular wave generator, A / D
A well-known microcomputer (microcomputer) that executes a data collection process of collecting data by operating a converter and the like, and an obstacle detection process of detecting an obstacle based on digital data collected by the data collection process. ), And an arithmetic processing unit that executes an operation of fast Fourier transform (FFT) based on a command from the microcomputer. Then, the receiving antenna of the transmission / reception unit 5a is moved to an initial position (for example, a position where the receiving beam comes to one end in the detection range), and subsequently, a predetermined value is determined according to the rising gradient of the triangular waveform of the modulation signal. The transmission signal is modulated so that the frequency increases (upward modulation section) at a rate of and the frequency decreases (downward modulation section) in accordance with the subsequent downward gradient. That is, the radar device 5 of the present embodiment
Operates as a so-called FMCW radar. When a radar wave corresponding to the frequency-modulated transmission signal is transmitted and a radar wave reflected on an obstacle is received, the transmission / reception unit 5a outputs a reception antenna. A beat signal is generated by mixing the reception signal and the transmission signal output from the control unit. Note that the received signal is delayed with respect to the transmitted signal by the time that the radar wave travels back and forth to the obstacle, and if there is a relative speed between the radar signal and the obstacle, the received signal is subjected to a Doppler shift according to the relative speed. . For this reason, the beat signal includes the delay component and the Doppler component.

【0032】このビート信号をA/D変換し、その結果
得られたデジタルデータは信号処理部5b内のRAMに
順次格納される。ところで、A/D変換器は変調信号が
出力されている間に所定回数のA/D変換を行うように
されている。つまり、前半の半数のデータが、送信信号
の上り変調部に対応した上り変調部データとなり、後半
の半数のデータが、送信信号の下り変調部に対応した下
り変調部データとなる。このようにして変調信号の1周
期分の処理が終了すると、受信アンテナの受信ビームの
照射方向を1ステップ分移動させ、引き続き、上述の処
理を繰り返し実行する。そして、全検出範囲に渡って受
信ビームの走査が終了すると障害物検出処理を起動し、
その後も本処理は、この障害物検出処理と並行して繰り
返し実行される。
The beat signal is A / D converted, and the digital data obtained as a result is sequentially stored in the RAM in the signal processing unit 5b. The A / D converter performs A / D conversion a predetermined number of times while the modulated signal is being output. That is, the first half of the data is the uplink modulation data corresponding to the uplink modulation section of the transmission signal, and the second half of the data is the downlink modulation data corresponding to the downlink modulation section of the transmission signal. When the processing for one cycle of the modulation signal is completed in this way, the irradiation direction of the receiving beam of the receiving antenna is moved by one step, and the above processing is repeatedly executed. Then, when scanning of the reception beam is completed over the entire detection range, an obstacle detection process is started,
Thereafter, the present process is repeatedly executed in parallel with the obstacle detection process.

【0033】障害物検出処理は、RAMに書き込まれた
デジタルデータを順次読み出し、各受信ビーム毎且つ各
変調部(上り変調部/下り変調部)毎に、高速フーリエ
変換(FFT)の演算を実行することによりビート信号
の周波数解析を行う。そして、周波数スペクトルのピー
クを検出して、その周波数をビート周波数(上り変調部
ではfu,下り変調部ではfd)として特定すると共
に、その検出された周波数成分について各受信ビーム間
で振幅を比較し、その信号強度分布から、ピークとなる
受信ビームを特定する。そして、この特定された受信ビ
ームの照射方向を、レーダ波の到来方向、即ち、障害物
が存在する方向を表す角度データとする。但し、角度デ
ータは、車両正面の進行方向を0°として右回り方向を
正値、左回り方向を負値にて表すものとする。そして、
ピークとなる周波数成分が複数存在する場合、即ち複数
の障害物が検出されている場合、上り変調部と下り変調
部とで、同じ障害物に基づく周波数成分を正しく組み合
わせるペアリング処理を実行する。このペアリング処理
は、例えば、周波数の低いもの順に組み合わせたり、信
号強度のほぼ同じもの同士を組み合わせる等して行う。
また、このペアリング処理では、当該処理が前回起動さ
れた時に検出された障害物に関する情報との比較を行う
ことにより同一性の判定も行う。そして、上昇部及び下
降部のビート周波数fu,fdから障害物との距離デー
タ及び相対速度データを算出する。
In the obstacle detection processing, digital data written in the RAM is sequentially read out, and a fast Fourier transform (FFT) operation is performed for each reception beam and each modulation unit (up / down modulation unit). By doing so, the frequency analysis of the beat signal is performed. Then, the peak of the frequency spectrum is detected, the frequency is specified as a beat frequency (fu in the up-modulation unit, fd in the down-modulation unit), and the detected frequency component is compared with the amplitude of each received beam. From the signal intensity distribution, a peak receiving beam is specified. Then, the irradiation direction of the specified reception beam is set as angle data representing the arrival direction of the radar wave, that is, the direction in which the obstacle exists. However, the angle data is defined such that the clockwise direction is represented by a positive value and the counterclockwise direction is represented by a negative value, with the traveling direction in front of the vehicle being 0 °. And
When there are a plurality of peak frequency components, that is, when a plurality of obstacles have been detected, the up-modulation unit and the down-modulation unit perform a pairing process of correctly combining frequency components based on the same obstacle. This pairing process is performed by, for example, combining the components in the order of lower frequency or combining components having substantially the same signal strength.
In this pairing process, the identity is also determined by comparing the information with information on an obstacle detected when the process was last activated. Then, distance data to the obstacle and relative speed data are calculated from the beat frequencies fu and fd of the rising part and the falling part.

【0034】レーダ装置5の説明は以上にして、コンピ
ュータ3の説明に戻る。コンピュータ3は、レーダ装置
5からの情報に基づくなどして、障害物が所定の警報領
域に所定時間存在した場合等に警報する警報判定処理を
実施している。障害物としては、自車の前方を走行する
前車やまたは停止している前車あるいは路側にある物体
(ガードレールや支柱物体)等が該当する。また、コン
ピュータ3は、ブレーキ駆動器19、スロットル駆動器
21および自動変速機制御器23に駆動信号を出力する
ことにより、前車の状況に合わせて車速を制御する、い
わゆる車間制御も同時に実施している。
The description of the radar device 5 has been described above, and returns to the description of the computer 3. The computer 3 performs an alarm determination process for alarming when an obstacle exists in a predetermined alarm area for a predetermined time based on information from the radar device 5 or the like. As the obstacle, a preceding vehicle traveling in front of the own vehicle, a preceding vehicle that is stopped, or an object (a guardrail or a support object) on the roadside corresponds to the obstacle. The computer 3 also outputs so-called drive signals to the brake driver 19, the throttle driver 21, and the automatic transmission controller 23, thereby simultaneously controlling the vehicle speed according to the situation of the preceding vehicle, that is, so-called inter-vehicle control. ing.

【0035】続いてコンピュータ3の内部構成について
制御ブロックとして説明する。レーダ装置5の信号処理
部5bから出力された距離Dと受信ビームの照射角度θ
と相対速度Vのデータは、極座標−直交座標間の座標変
換ブロック41に送られる。ここで、レーザレーダ中心
を原点(0,0)とし、車幅方向をX軸、車両前方方向
をZ軸とするXZ直交座標に変換された後、物体認識ブ
ロック43及び道路曲率推定ブロック45へ出力され
る。なお、距離Dと相対速度Vのデータの状態でも同様
に出力される。
Next, the internal configuration of the computer 3 will be described as a control block. The distance D output from the signal processing unit 5b of the radar device 5 and the irradiation angle θ of the reception beam
And the data of the relative speed V are sent to a coordinate conversion block 41 between polar coordinates and rectangular coordinates. Here, the laser radar center is set to the origin (0, 0), and is converted into XZ orthogonal coordinates having the vehicle width direction as the X axis and the vehicle front direction as the Z axis. Is output. It should be noted that the same is output in the state of the data of the distance D and the relative speed V.

【0036】物体認識ブロック43では、直交座標に変
換された計測データに基づいて、物体の中心位置(X,
Z)を求める。このXの値が「物体横位置」を示す値と
なる。また物体認識ブロック43では、車速センサ7の
検出値に基づいて車速演算ブロック47から出力される
車速(自車速)と上記求められた相対速度(Vx,V
z)とから物体が停止物体であるか移動物体であるかの
認識種別が求められ、この認識種別と物体の中心位置と
に基づいて自車両の走行に影響する物体が選択され、そ
の距離が距離表示器15により表示される。
In the object recognition block 43, the center position of the object (X,
Z). The value of X becomes a value indicating the “object lateral position”. In the object recognition block 43, the vehicle speed (own vehicle speed) output from the vehicle speed calculation block 47 based on the detection value of the vehicle speed sensor 7 and the relative speed (Vx, V
z), a recognition type of whether the object is a stationary object or a moving object is obtained, and an object that affects the traveling of the own vehicle is selected based on the recognition type and the center position of the object. It is displayed by the distance indicator 15.

【0037】この物体認識ブロック43にて求めたデー
タが異常な範囲の値がどうかがセンサ異常検出ブロック
44にて検出され、異常な範囲の値である場合には、セ
ンサ異常表示器17にその旨の表示がなされる。また、
ステアリングセンサ27からの信号に基づいて操舵角演
算ブロック49にて操舵角が求められ、ヨーレートセン
サ28からの信号に基づいてヨーレート演算ブロック5
1にてヨーレートが演算される。曲率半径算出ブロック
63では、車速演算ブロック47からの車速と操舵角演
算ブロック49からの操舵角とヨーレート演算ブロック
51からのヨーレートとに基づいて、曲率半径を算出す
る。
The sensor abnormality detection block 44 detects whether the data obtained in the object recognition block 43 has a value in an abnormal range. If the data is in an abnormal range, the sensor abnormality display 17 displays the value. Is displayed. Also,
A steering angle is obtained in a steering angle calculation block 49 based on a signal from the steering sensor 27, and a yaw rate calculation block 5 based on a signal from the yaw rate sensor 28.
At 1, the yaw rate is calculated. The curvature radius calculation block 63 calculates a curvature radius based on the vehicle speed from the vehicle speed calculation block 47, the steering angle from the steering angle calculation block 49, and the yaw rate from the yaw rate calculation block 51.

【0038】一方、道路曲率推定ブロック45では、直
交座標に変換された計測データと、物体認識ブロック4
3にて求めたデータと、曲率半径算出ブロック63にて
求められた操舵角などに基づく曲率半径に基づいて道路
曲率の推定を行う。この道路曲率の推定処理の詳細は後
述する。なお、道路曲率推定ブロック45にて得られた
データは先行車判定ブロック53へ出力される。
On the other hand, in the road curvature estimating block 45, the measured data converted into the rectangular coordinates and the object recognition block 4 are used.
The road curvature is estimated based on the data obtained in step 3 and the radius of curvature based on the steering angle and the like obtained in the radius of curvature calculation block 63. Details of the road curvature estimation processing will be described later. The data obtained by the road curvature estimation block 45 is output to the preceding vehicle determination block 53.

【0039】先行車判定ブロック53では、この推定さ
れた曲率半径Rおよび物体認識ブロック43にて求めら
れた認識種別、中心位置座標(X,Z)、相対速度(V
x,Vz)に基づいて先行車を選択し、その先行車に対
する距離Zおよび相対速度Vzを求める。
In the preceding vehicle determination block 53, the estimated radius of curvature R, the type of recognition obtained in the object recognition block 43, the center position coordinates (X, Z), and the relative speed (V
(x, Vz), a preceding vehicle is selected, and a distance Z and a relative speed Vz to the preceding vehicle are determined.

【0040】そして、車間制御部及び警報判定部ブロッ
ク55が、この先行車との距離Z、相対速度Vz、自車
速Vn、先行車加速度、物体中心位置、物体幅、認識種
別、クルーズコントロールスイッチ26の設定状態およ
びブレーキスイッチ9の踏み込み状態、スロットル開度
センサ11からの開度および警報感度設定器25による
感度設定値に基づいて、警報判定ならば警報するか否か
を判定し、クルーズ判定ならば車速制御の内容を決定す
る。その結果を、警報が必要ならば、警報発生信号を警
報音発生器13に出力する。また、クルーズ判定なら
ば、自動変速機制御器23、ブレーキ駆動器19および
スロットル駆動器21に制御信号を出力して、必要な制
御を実施する。そして、これらの制御実行時には、距離
表示器15に対して必要な表示信号を出力して、状況を
ドライバーに告知している。
Then, the inter-vehicle control unit and the alarm determination unit block 55 determine the distance Z to the preceding vehicle, the relative speed Vz, the own vehicle speed Vn, the preceding vehicle acceleration, the object center position, the object width, the recognition type, and the cruise control switch 26. Based on the setting state of the brake switch 9, the depression state of the brake switch 9, the opening from the throttle opening sensor 11, and the sensitivity set value by the alarm sensitivity setting device 25, it is determined whether or not to give an alarm if it is an alarm judgment, For example, the content of the vehicle speed control is determined. The result is output to the alarm sound generator 13 if an alarm is required. If the cruise is determined, a control signal is output to the automatic transmission controller 23, the brake driver 19, and the throttle driver 21 to perform necessary control. When these controls are executed, a necessary display signal is output to the distance display 15 to notify the driver of the situation.

【0041】次に、以上のように構成される車両制御装
置1において実行される道路曲率の推定にかかる動作に
ついて、図4のフローチャートに従って説明する。図4
の最初のステップであるS10では、レーダ信号処理を
行う。この処理はレーダ装置5にて実行されるのである
が、上述したように、ビート信号の読み込み、FFT演
算によるビート信号の周波数解析、ピークサーチによる
物標ピークの抽出、抽出ピークのペアリングなどを行
う。そして、続くS20では物標認識処理を実行する。
この処理は、上述したように、上昇部及び下降部のビー
ト周波数fu,fdから障害物との距離D及び相対速度
Vを算出し、さらに距離Dと受信ビームの照射角度とか
ら物体の横位置Xを算出するものである。このS20で
の認識結果は、物体認識ブロック43に準備されたメモ
リに記憶される(S30)。
Next, the operation for estimating the road curvature, which is performed in the vehicle control device 1 configured as described above, will be described with reference to the flowchart of FIG. FIG.
In the first step S10, radar signal processing is performed. This processing is performed by the radar device 5. As described above, the read of the beat signal, the frequency analysis of the beat signal by the FFT operation, the extraction of the target peak by the peak search, the pairing of the extracted peak, and the like are performed. Do. Then, in S20, a target recognition process is executed.
In this process, as described above, the distance D to the obstacle and the relative speed V are calculated from the beat frequencies fu and fd of the ascending and descending portions, and the lateral position of the object is calculated from the distance D and the irradiation angle of the reception beam. X is calculated. The recognition result in S20 is stored in the memory prepared in the object recognition block 43 (S30).

【0042】続くS40では車速演算ブロック47にて
演算した自車速度を読み込み、S50では、ステアリン
グセンサ27から得られたステアリング操舵角(あるい
はヨーレートセンサ28から得られたヨーレート)に基
づいて、道路曲率を算出することとし、ここでは、基本
的にはステアリング操舵角を用いて算出するため、操舵
角に基づく推定Rと呼ぶことにする。以下のように求め
る。 操舵角に基づく推定R=f(自車速度)÷操舵角 なお、操舵角から推定R(カーブ半径)を求めるための
自車速度を変数とする関数は、車両の運動特性から決定
される関数であり、当業者において一般的に知られてい
るものであるので、詳細な説明は省略する。
At S40, the vehicle speed calculated by the vehicle speed calculation block 47 is read. At S50, the road curvature is calculated based on the steering angle obtained from the steering sensor 27 (or the yaw rate obtained from the yaw rate sensor 28). Here, since it is basically calculated using the steering angle, it is referred to as an estimated R based on the steering angle. We ask as follows. Estimated R based on steering angle = f (own vehicle speed) ÷ steering angle Note that the function using the own vehicle speed as a variable for obtaining the estimated R (curve radius) from the steering angle is a function determined from the vehicle motion characteristics. , Which is generally known to those skilled in the art, and a detailed description thereof will be omitted.

【0043】続くS70,S80は認識した物標から道
路曲率を推定するための処理であり、まずS70では、
S30にて物体認識ブロック43に記憶されたS20で
の認識結果が、一定条件を満たしているか否かを判断す
る。この一定条件は、本実施形態では「物体の検出初期
において、少なくとも第1回目と第2回目のデータが連
続して検出されている」という条件である。これは次の
意図からの条件である。つまり、S80では物標の横位
置の変化率に基づいて道路曲率を推定しているが、変化
率を算出するには複数のデータ(横位置データ)が必要
であり、それらの複数のデータが同一物体に係るもので
あることが前提となる。その点を鑑みた場合、検出初期
の第1回目と第2回目のデータがあれば、たとえ第3回
目のデータが検出されずに第4回目のデータが検出され
た場合に、それらが同一物体にかかる検出結果であると
判断し易い。これが、第1回目のデータは存在するが第
2回目のデータはなく、第3回目のデータが検出された
としても、第1回目と第3回目のデータとがはたして同
一物体にかかる検出結果であるかどうかは疑わしい。つ
まり、第3回目のデータと思っていたものは、実は別の
物体のデータである可能性も高くなる。したがって、こ
のような条件を課すことでより適切な曲率推定が可能と
するためである。
The following S70 and S80 are processes for estimating the road curvature from the recognized target.
It is determined whether the recognition result in S20 stored in the object recognition block 43 in S30 satisfies a certain condition. In the present embodiment, the fixed condition is a condition that “at least the first and second data are continuously detected at the initial stage of object detection”. This is a condition from the following intentions. That is, although the road curvature is estimated based on the change rate of the lateral position of the target in S80, a plurality of data (lateral position data) are required to calculate the change rate, and the plurality of data are It is assumed that they are related to the same object. In view of this point, if there is the first and second data at the initial stage of detection, even if the third data is not detected and the fourth data is detected, they are the same object. It is easy to determine that this is the detection result. This is because even if the first data is present but the second data is not present and the third data is detected, the first and third data are finally detected on the same object. It is questionable. That is, it is highly likely that what is considered the third data is actually data of another object. Therefore, imposing such conditions enables more appropriate curvature estimation.

【0044】このような条件を満たす場合(S70:Y
ES)には、S80へ移行して、認識物標に基づく道路
曲率推定処理をしてからS90へ移行する。一方、条件
を満たさない場合(S70:NO)は、S80の処理を
実行することなくS90へ移行する。
When such a condition is satisfied (S70: Y
In ES), the flow shifts to S80 to perform a road curvature estimation process based on the recognized target, and then shifts to S90. On the other hand, when the condition is not satisfied (S70: NO), the process proceeds to S90 without executing the process of S80.

【0045】S80の処理は道路曲率推定ブロック45
にて実行されるものであるが、このS80での処理の詳
細を図5,図6を参照して説明する。図5の最初のステ
ップS310では、認識物標のデータとして相対速度
V、横位置X及び距離Dを取り出す。そして、認識物標
の内に停止物が1つでも存在する場合には(S320:
YES)、S330へ移行して停止物数をMとして、S
340〜S390の処理をM回繰り返して行う。具体的
には、連続認識回数がn回を越えており(S340:Y
ES)、且つ認識開始距離がdを越えている場合には
(S350:YES)、S360へ移行し、それ以外の
場合にはS380へ移行する。
The processing in S80 is performed by the road curvature estimation block 45.
The details of the process in S80 will be described with reference to FIGS. In the first step S310 in FIG. 5, the relative speed V, the lateral position X, and the distance D are extracted as the data of the recognized target. Then, when at least one stop exists in the recognition target (S320:
YES), the process proceeds to S330, and the number of stopped objects is M, and S
The processing of 340 to S390 is repeated M times. Specifically, the number of consecutive recognitions exceeds n (S340: Y
ES), and if the recognition start distance exceeds d (S350: YES), the flow shifts to S360; otherwise, the flow shifts to S380.

【0046】S360では、横位置XM(t)データの履歴
に基づき、直線式XM(t)=at+bを用いて直線近似を
行い、傾きaを求める。そして、続くS370では、物
標履歴データの距離D及び相対速度Vと、S360で求
めた直線の傾きaとを用い、道路の曲率半径R(M)
を、R(M)=DV/aで求める。この式にて曲率半径
が求められる理由は上述したのでここでは繰り返さな
い。一方、S370では、R(M)へステアリングセン
サ27にて得た操舵角等(上述したようにヨレーレート
でもよい)によって推定した曲率半径、つまり曲率半径
算出部63(図1参照)にて算出した曲率半径を代入す
る。
In S360, based on the history of the horizontal position X M (t) data, a straight line approximation is performed by using a linear equation X M (t) = at + b, and a slope a is obtained. Then, in S370, using the distance D and the relative speed V of the target history data and the inclination a of the straight line obtained in S360, the curvature radius R (M) of the road is used.
Is determined by R (M) = DV / a. The reason why the radius of curvature is obtained by this equation has been described above, and will not be repeated here. On the other hand, in S370, the radius of curvature estimated to the R (M) by the steering angle or the like obtained by the steering sensor 27 (or the yaw rate may be used as described above), that is, the radius of curvature calculated by the radius of curvature calculator 63 (see FIG. 1). Substitute the radius of curvature.

【0047】S370又はS380の処理後は、停止物
数Mをデクリメント(M=M−1)し(S390)、M
が0よりも大きければ(S400:YES)、S340
へ戻り、M=0となったら(S400:NO)、S37
0又はS380の処理にて得られたM個のR(M)の平
均値を求め、それを物標に基づく曲率半径とする。
After the processing of S370 or S380, the number M of stopped objects is decremented (M = M-1) (S390), and M
Is larger than 0 (S400: YES), S340
When M = 0 (S400: NO), the process returns to S37.
The average value of the M R (M) obtained in the processing of 0 or S380 is obtained, and the obtained average value is set as the radius of curvature based on the target.

【0048】このように、停止物が存在する場合には
(S320:YES)、停止物を優先して物標に基づく
曲率半径を求めるが、停止物がない場合には(S32
0:NO)、S420へ移行して移動物の場合の処理を
行う。このS420の処理内容を図6を参照して説明す
る。
As described above, if there is a stationary object (S320: YES), the radius of curvature based on the target is obtained by giving priority to the stationary object, but if there is no stationary object (S32).
0: NO), and proceeds to S420 to perform processing for a moving object. The contents of the process in S420 will be described with reference to FIG.

【0049】図6の最初のステップS510では、相対
速度Vが正である物標数をMとし、続くS350では、
M>Nであるかを判断し、M>Nである場合には(S5
20:YES)、S530〜S590の処理をM回繰り
返して行う。具体的には、連続認識回数がn回を越えて
おり(S530:YES)、且つ認識開始距離がdを越
えている場合には(S540:YES)、S550へ移
行し、それ以外の場合にはS580へ移行する。S55
0では、横位置XM(t)データの履歴に基づき、直線式X
M(t)=at+bを用いて直線近似を行い、傾きaを求め
る。そして、続くS560では、物標履歴データの距離
D及び相対速度Vと、S550で求めた直線の傾きaと
を用い、道路の曲率半径R(M)を、R(M)=DV/
aで求める。また、S580では、R(M)へステアリ
ングセンサ27にて得た操舵角等によって推定した曲率
半径を代入する。
In the first step S510 in FIG. 6, the number of targets for which the relative speed V is positive is set to M. In the subsequent S350,
It is determined whether M> N, and if M> N (S5
20: YES), the process of S530 to S590 is repeated M times. More specifically, if the number of continuous recognitions exceeds n (S530: YES) and the recognition start distance exceeds d (S540: YES), the process proceeds to S550, otherwise. Shifts to S580. S55
At 0, the linear formula X M (t) is based on the history of the horizontal position X M (t) data.
A linear approximation is performed using M (t) = at + b, and a gradient a is obtained. Then, in S560, using the distance D and the relative speed V of the target history data and the gradient a of the straight line obtained in S550, the curvature radius R (M) of the road is calculated as R (M) = DV /
Obtain with a. In S580, the radius of curvature estimated from the steering angle or the like obtained by the steering sensor 27 is substituted for R (M).

【0050】S560又はS580の処理後は、停止物
数Mをデクリメント(M=M−1)し(S690)、M
が0よりも大きければ(S600:YES)、S530
へ戻り、M=0となったら(S600:NO)、S56
0又はS580の処理にて得られた個々のR(M)の差
が所定値diff未満か否かを判定し(S610)、R
(M)の差が所定値diff未満であれば(S610:YE
S)、)、個々のR(M)の平均値を求め、それを曲率
半径とする(S620)。また、R(M)の差が所定値
diff以上であれば(S610:NO)、ステアリングセ
ンサ27にて得た操舵角等によって推定した曲率半径を
用いる(S630)。
After the processing of S560 or S580, the number M of stopped objects is decremented (M = M-1) (S690), and M
Is larger than 0 (S600: YES), S530
When M = 0 (S600: NO), S56
It is determined whether or not the difference between the individual R (M) obtained in the process of 0 or S580 is less than a predetermined value diff (S610).
If the difference of (M) is less than the predetermined value diff (S610: YE
S),), the average value of the individual R (M) is determined, and this is set as the radius of curvature (S620). Further, the difference of R (M) is a predetermined value.
If it is not less than diff (S610: NO), the radius of curvature estimated by the steering angle or the like obtained by the steering sensor 27 is used (S630).

【0051】一方、S520での判断においてM≦Nで
ある場合には(S520:NO)、物標に基づく曲率半
径の算出は行わず、S570へ移行してM=1としてか
らS580へ移行する。S580では、R(M)へステ
アリングセンサ27にて得た操舵角等によって推定した
曲率半径を代入する。この場合は、S580からS59
0へ移行してMをデクリメントするとM=0となるた
め、即座にS600で否定判断となり、S610へ移行
することとなる。
On the other hand, if M ≦ N in the determination in S520 (S520: NO), the radius of curvature based on the target is not calculated, the process proceeds to S570, where M = 1, and then the process proceeds to S580. . In S580, the radius of curvature estimated from the steering angle or the like obtained by the steering sensor 27 is substituted for R (M). In this case, S580 to S59
When M is decremented after shifting to 0, M becomes 0, so a negative determination is made immediately in S600, and the flow shifts to S610.

【0052】このように、移動物に基づく場合には、自
車両又は先行車などの移動物が車線変更を行うと、実際
の道路と異なった曲率を推定することとなるため、これ
らを防ぐために、N個よりも大きな(複数の)移動物を
認識し(S520:YES)、且つそれら個々の曲率半
径の推定値同士の差が所定のしきい値diff未満である場
合(S610:YES)にのみ、移動物に基づく曲率半
径の推定を行うようにした(S620)。
As described above, when the vehicle is based on a moving object, if the moving object such as the own vehicle or the preceding vehicle changes lanes, a curvature different from that of an actual road will be estimated. , The moving objects larger than N are recognized (S520: YES), and the difference between the estimated values of the respective curvature radii is smaller than a predetermined threshold diff (S610: YES). Only, the radius of curvature based on the moving object is estimated (S620).

【0053】図4のフローチャートに戻り、S90では
推定結果の合算処理を行う。これは、S60にて推定し
た操舵角に基づく曲率半径と、S80にて推定した認識
物標に基づく曲率半径とを用いて例えば加重平均演算を
行うことによって、最終的な曲率半径(R)とする処理
である。そして、このように合算処理した曲率半径に基
づいて先行車判定ブロック53が認識物標の車線判定を
行う(S100)。
Returning to the flowchart of FIG. 4, in S90, a process of adding the estimation results is performed. This is achieved by performing, for example, a weighted average operation using the radius of curvature based on the steering angle estimated in S60 and the radius of curvature based on the recognized target estimated in S80, to obtain the final radius of curvature (R). This is the processing to be performed. Then, the preceding vehicle determination block 53 performs the lane determination of the recognized target based on the radius of curvature obtained by the addition processing as described above (S100).

【0054】ここでS100での車線判定処理について
説明する。本実施形態では、認識物標の自車線確率に基
づいて車線の同一性を判定する。自車線確率とは、物標
が自車と同一レーンを走行している車両である確からし
さを表すパラメータである。自車線確率瞬時値とは、そ
の瞬間の検出データに基づいて算出された値である。
Here, the lane determination processing in S100 will be described. In the present embodiment, the lane identity is determined based on the own lane probability of the recognition target. The own lane probability is a parameter indicating the likelihood that the target is a vehicle running on the same lane as the own vehicle. The instantaneous value of the own lane probability is a value calculated based on the detection data at that instant.

【0055】まず、物体認識処理(S20)にて得られ
たすべての物標の位置を、直線路走行時の位置に換算す
る。もともとの物標の中心位置を(Xo,Zo)とした
とき、次の変換式により、直線路変換位置(X,Z)が
得られる(図7(a)参照)。 X ← Xo−Zo^2/2R …[式8] Z ← Zo …[式9] R:図4のS90で得た推定R 右カーブ:符号正 左カーブ:符号負 なお、式8中の「^」は「^」の前の数値を「^」の後
の数値の回数、累乗することを意味する。本明細書の他
の部分でも同じである。ここでは、円の方程式は、|X
|≪|R|,Zという仮定のもとで、近似した。また、
レーダ装置5が車両中心から離れたところに取り付けら
れている場合には、車両中心が原点になるようにX座標
を補正するものとする。すなわち、ここでは実質的には
X座標のみ変換している。
First, the positions of all targets obtained in the object recognition processing (S20) are converted into the positions when traveling on a straight road. Assuming that the original center position of the target is (Xo, Zo), a straight road conversion position (X, Z) is obtained by the following conversion formula (see FIG. 7A). X ← Xo−Zo ^ 2 / 2R (Equation 8) Z ← Zo (Equation 9) R: Estimated R obtained in S90 of FIG. 4 Right curve: positive sign Left curve: negative sign “^” means that the number before “^” is raised to the power of the number after “^”. The same applies to other parts of this specification. Here, the equation of the circle is | X
The approximation was performed under the assumption that | ≪ | R |, Z. Also,
When the radar device 5 is mounted at a position distant from the vehicle center, the X coordinate is corrected so that the vehicle center becomes the origin. That is, here, only the X coordinate is substantially converted.

【0056】このように直進路に変換して得られた中心
位置(X,Z)を、図8に示す自車線確率マップ上に配
置して、各物体の瞬時自車線確率、すなわち、その時点
で自車線に存在する確率を求める。確率として存在する
のは、図4のS90にて求めた曲率半径Rは認識物標あ
るいは操舵角などから推定した値であり、実際のカーブ
の曲率半径との間に誤差が存在するからである。その誤
差を考慮した制御をするために、ここで各物体の瞬時自
車線確率を求める。
The center position (X, Z) obtained as a result of the conversion to the straight road is placed on the own lane probability map shown in FIG. 8, and the instantaneous own lane probability of each object, that is, Calculates the probability of being in the own lane. The probability exists because the radius of curvature R obtained in S90 of FIG. 4 is a value estimated from the recognized target or the steering angle, and an error exists between the radius of curvature R and the actual radius of curvature of the curve. . In order to perform control in consideration of the error, an instantaneous own lane probability of each object is obtained here.

【0057】図8において、横軸はX軸、すなわち自車
の左右方向であり、縦軸はZ軸、すなわち自車の前方を
示している。本実施形態では、左右5m、前方100m
までの領域を示している。ここで領域は、領域a(自車
線確率80%)、領域b(自車線確率60%)、領域c
(自車線確率30%)、領域d(自車線確率100
%)、それ以外の領域(自車線確率0%)に別れてい
る。この領域の設定は、実測により定めたものである。
特に、領域dは自車直前への割込も考慮することにより
設定された領域である。
In FIG. 8, the horizontal axis is the X axis, that is, the horizontal direction of the own vehicle, and the vertical axis is the Z axis, that is, the front of the own vehicle. In the present embodiment, left and right 5 m, front 100 m
The area up to is shown. Here, the area is area a (own lane probability 80%), area b (own lane probability 60%), area c
(Own lane probability 30%), area d (own lane probability 100)
%), And other areas (own lane probability 0%). The setting of this area is determined by actual measurement.
In particular, the area d is an area set by taking into consideration the interruption immediately before the own vehicle.

【0058】領域a,b,c,dを区切る境界線La、
Lb,Lc,Ldは、例えば次の式10〜13で与えら
れるものである。なお、境界線La′、Lb′,L
c′,Ld′は、それぞれ境界線La、Lb,Lc,L
dとはY軸で対称の関係にある。 La: X=0.7+(1.75-0.7)・(Z/100)^2 …[式10] Lb: X=0.7+( 3.5-0.7)・(Z/100)^2 …[式11] Lc: X=1.0+( 5.0-1.0)・(Z/100)^2 …[式12] Ld: X=1.5・(1-Z/60) …[式13] これを一般式で表すと次式14〜17のようになる。 La: X=A1+B1・(Z/C1)^2 …[式14] Lb: X=A2+B2・(Z/C2)^2 …[式15] Lc: X=A3+B3・(Z/C3)^2 …[式16] Ld: X=A4・(B4-Z/C4) …[式17] この式14〜17から一般的には、次の式18〜20を
満足させるように領域を設定する。実際の数値の決定
は、実験にて決定する。 A1≦A2≦A3<A4 …[式18] B1≦B2≦B3 および B4=1 …[式19] C1=C2=C3 (C4に制約無し) …[式20] なお、図8の境界線La、Lb,Lc,La′、L
b′,Lc′は、計算処理速度の点から、放物線として
いるが、処理速度が許すならば、円弧にて表す方が良
い。境界線Ld,Ld′についても処理速度が許すなら
ば外側に膨らんだ放物線または円弧にて表す方が良い。
Boundaries La, which delimit areas a, b, c, d,
Lb, Lc, and Ld are given by, for example, the following equations 10 to 13. Note that the boundary lines La ', Lb', L
c ′ and Ld ′ are boundary lines La, Lb, Lc and L, respectively.
d has a symmetrical relationship with the Y axis. La: X = 0.7 + (1.75-0.7) ・ (Z / 100) ^ 2 [Equation 10] Lb: X = 0.7 + (3.5-0.7) ・ (Z / 100) ^ 2 ... [Equation 11] Lc: X = 1.0 + (5.0-1.0) · (Z / 100) ^ 2 [Equation 12] Ld: X = 1.5 · (1-Z / 60) [Equation 13] When this is expressed by a general equation, the following equation 14 is obtained. ~ 17. La: X = A1 + B1 · (Z / C1) ^ 2 [Expression 14] Lb: X = A2 + B2 · (Z / C2) ^ 2 [Expression 15] Lc: X = A3 + B3 · (Z / C3) ^ 2 [Expression 16] Ld: X = A4 · (B4-Z / C4) [Expression 17] From Expressions 14 to 17, in general, the following Expressions 18 to 20 should be satisfied. Set the area. The actual numerical values are determined by experiments. A1 ≦ A2 ≦ A3 <A4 [Equation 18] B1 ≦ B2 ≦ B3 and B4 = 1 [Equation 19] C1 = C2 = C3 (C4 is not restricted) [Equation 20] The boundary line La in FIG. , Lb, Lc, La ', L
Although b 'and Lc' are parabolic from the viewpoint of calculation processing speed, if processing speed permits, it is better to represent them with arcs. The boundary lines Ld and Ld 'are preferably represented by parabolas or arcs bulging outward if the processing speed permits.

【0059】次に、各物標の直線路換算位置を図8の自
車線確率マップと照合する。下記要領で、マップと照合
することで、自車線確率瞬時値P0 が得られる。 領域dを少しでも有する物体 → P0=100% 領域a内に中心が存在する物体 → P0= 80% 領域b内に中心が存在する物体 → P0= 60% 領域c内に中心が存在する物体 → P0= 30% 上記〜を全て満たさない物体 → P0= 0% そして、各物標ごとに自車線確率瞬時値を算出したら、
次に、下式を用いて、フィルタ処理をする。ここで、α
は距離Zに依存するパラメータであり、図7(b)のマ
ップを用いて求める。自車線確率の初期値は、0%とす
る。 自車線確率←自車線確率前回値×α+自車線確率瞬時値
×(1−α) そして、この自車線確率を用いて先行車を判定する。具
体的には、自車線確率が50%以上の物標の中で、距離
Zが最小のものを先行車と判断する。この判断結果、す
なわち先行車と判定した認識物標とそれに対する自車線
確率を車間制御部及び警報判定部ブロック55に出力す
る(S110)。
Next, the straight road conversion position of each target is compared with the own lane probability map of FIG. By collating with the map in the following manner, the own lane probability instantaneous value P0 can be obtained. An object having any area d → P0 = 100% An object having a center in area a → P0 = 80% An object having a center in area b → P0 = 60% An object having a center in area c → P0 = 30% An object that does not satisfy all of the above-> P0 = 0% Then, when the own lane probability instantaneous value is calculated for each target,
Next, filter processing is performed using the following equation. Where α
Is a parameter that depends on the distance Z, and is determined using the map of FIG. The initial value of the own lane probability is set to 0%. Own lane probability ← previous own lane probability × α + instantaneous lane probability instantaneous value × (1-α) Then, the preceding vehicle is determined using the own lane probability. Specifically, among the targets having the own lane probability of 50% or more, the target having the minimum distance Z is determined to be the preceding vehicle. The result of this determination, that is, the recognized target determined to be the preceding vehicle and the own lane probability thereof are output to the inter-vehicle control unit and the warning determination unit block 55 (S110).

【0060】なお、本実施形態においては、レーダ装置
5がレーダ手段に相当し、物体認識ブロック43及び道
路曲率推定ブロック45が曲率推定手段に相当する。こ
の内の物体認識ブロック43が物体認識手段に相当し、
道路曲率推定ブロック45が変化率算出手段、曲率算出
手段、平均値算出手段に相当する。また、ステアリング
センサ27及び操舵角演算ブロック49、ヨーレートセ
ンサ28及びヨーレート演算ブロック51の少なくとも
1組が旋回検出手段に相当し、曲率半径算出ブロック6
3が第2の曲率推定手段に相当する。さらに、先行車判
定ブロック53が自車線確率算出手段及び先行車選択手
段手段に相当する。
In this embodiment, the radar device 5 corresponds to radar means, and the object recognition block 43 and the road curvature estimation block 45 correspond to curvature estimation means. Of these, the object recognition block 43 corresponds to the object recognition means,
The road curvature estimation block 45 corresponds to a change rate calculation unit, a curvature calculation unit, and an average value calculation unit. At least one set of the steering sensor 27, the steering angle calculation block 49, the yaw rate sensor 28, and the yaw rate calculation block 51 corresponds to turning detection means, and the curvature radius calculation block 6
3 corresponds to a second curvature estimating means. Further, the preceding vehicle determination block 53 corresponds to own lane probability calculating means and preceding vehicle selecting means.

【0061】以上説明したように、本実施形態において
は、認識物標の横位置の過去の履歴に基づき、物体横位
置の時間経過に伴う変化を直線で近似して変化率を算出
し、その算出された変化率に基づいて、車両前方の道路
の曲率を推定している。したがって、自車は直線部分を
走行しているが前方でカーブしている道路であっても、
その前方での道路の曲率を適切に推定することができ、
その推定した道路曲率に基づいて先行車を適切に選択す
ることができる。
As described above, in the present embodiment, based on the past history of the horizontal position of the recognized target, the change with time of the horizontal position of the object is approximated by a straight line, and the change rate is calculated. The curvature of the road ahead of the vehicle is estimated based on the calculated change rate. Therefore, even if the vehicle is traveling on a straight line but curves ahead,
It can properly estimate the curvature of the road ahead of it,
The preceding vehicle can be appropriately selected based on the estimated road curvature.

【0062】また、図4のS70での一定条件を満たす
場合(少なくとも第1回目と第2回目のデータが連続し
て検出されている場合)にのみ認識物標に基づく曲率半
径を推定を行っているため、より適切な曲率推定が可能
となる。また、本実施形態では、停止物体が認識されて
いる場合(図5のS320でYES)は、優先的にその
停止物体に基づく曲率半径の推定を行っている。停止物
体・移動物体のいずれを対象としても道路曲率の推定が
できるが、停止物の方が好ましい。なぜなら、移動物体
の場合にはその速度が変化したり、あるいは車線変更す
る場合もあり、さらには同一車線内でも走行位置が左右
に移動する可能性があるため、停止物であれば、そのよ
うな変化による推定誤差を考慮しなくてもよいからであ
る。
The radius of curvature based on the recognition target is estimated only when the predetermined condition in S70 of FIG. 4 is satisfied (at least when the first and second data are continuously detected). Therefore, more appropriate curvature estimation can be performed. In the present embodiment, when a stationary object is recognized (YES in S320 of FIG. 5), the curvature radius is preferentially estimated based on the stationary object. Although the curvature of the road can be estimated for either a stationary object or a moving object, a stationary object is preferable. Because, in the case of a moving object, its speed may change or the lane may change, and furthermore, the traveling position may move left and right even in the same lane, so if it is a stationary object, such This is because it is not necessary to consider an estimation error due to a significant change.

【0063】上述した実施形態では、図4のS100で
の車線判定処理において、認識物標の自車線確率に基づ
いて車線の同一性を判定した。これに対して、認識物標
に基づいた得た曲率半径に基づいて車線の同一性を判定
することも可能である。これを第2実施形態として説明
する。
In the above-described embodiment, in the lane determination process in S100 of FIG. 4, the identity of the lane is determined based on the own lane probability of the recognition target. On the other hand, it is also possible to determine lane identity based on the radius of curvature obtained based on the recognized target. This will be described as a second embodiment.

【0064】第2実施形態の場合も図1と同様の構成で
あり、道路曲率推定ブロック45及び先行車判定ブロッ
ク53で実行される処理が異なるだけである。図10
は、第2実施形態の場合の処理を示すフローチャートで
あるが、この処理中のS1010〜S1040は図4の
S10〜S40と同様の処理なので、説明は省略し、S
1050から説明する。
The configuration of the second embodiment is the same as that of FIG. 1, except that the processing executed in the road curvature estimation block 45 and the preceding vehicle determination block 53 is different. FIG.
Is a flowchart showing processing in the case of the second embodiment. In this processing, S1010 to S1040 are the same processing as S10 to S40 in FIG.
The description starts from 1050.

【0065】S1050では、認識物標に基づく道路曲
率推定を行うが、この処理を図11のフローチャートを
参照して説明する。図11においては、認識物標のデー
タとして相対速度V、横位置X及び距離Dを取り出し
(S1310)、認識した物標数をMとし(S132
0)、後の処理にて求められる曲率半径を格納するR
[M]を初期化する(S1330)。そして、S1340
〜S1380の処理をM回繰り返して行う。具体的に
は、連続認識回数がn回を越えており(S1340:Y
ES)、且つ認識開始距離がdを越えている場合には
(S1350:YES)、S1360へ移行し、それ以
外の場合にはS1380へ移行する。S1360では、
横位置XM(t)データの履歴に基づき、直線式XM(t)=a
t+bを用いて直線近似を行い、傾きaを求め、続くS
560では、物標履歴データの距離D及び相対速度V
と、S550で求めた直線の傾きaとを用い、道路の曲
率半径R[M]を、R[M]=DV/aで求める。こうして
S1340〜S1380の処理がM回繰り返された場合
には(S1390:NO)、本処理ルーチンを終了し
て、図10のS1060へ移行する。
In step S1050, the road curvature is estimated based on the recognized target. This process will be described with reference to the flowchart of FIG. In FIG. 11, the relative speed V, the lateral position X, and the distance D are extracted as data of the recognized target (S1310), and the number of recognized targets is set to M (S132).
0), R for storing the radius of curvature determined in a later process
[M] is initialized (S1330). And S1340
To S1380 are repeated M times. More specifically, the number of consecutive recognitions exceeds n (S1340: Y
ES), and if the recognition start distance is longer than d (S1350: YES), the flow shifts to S1360; otherwise, the flow shifts to S1380. In S1360,
Based on the history of the lateral position X M (t) data, the linear equation X M (t) = a
Linear approximation is performed using t + b to determine the slope a, and the following S
At 560, the distance D and the relative speed V of the target history data
And the slope a of the straight line obtained in S550, the curvature radius R [M] of the road is obtained by R [M] = DV / a. When the processing of S1340 to S1380 has been repeated M times (S1390: NO), this processing routine ends, and the flow shifts to S1060 in FIG.

【0066】S1060では、認識物標の車線判定を行
うが、この処理を図12のフローチャートを参照して説
明する。まず、停止物から求められた曲率半径R[M]を
取り出す(S1510)。そして、その取り出したR
[M]の個数をLとし(S1520)、L<2であれば
(S1530:NO)、S1700へ移行する。S17
00へ移行する場合というのはLが1又は0、つまり停
止物が2以上存在しないため、認識物標による曲率半径
の大小比較による車線同一判定はできない。したがっ
て、S1700ではS1510にて取り出した個々の曲
率半径R[M]の平均値を用いて、第1実施形態において
図4のS100にて説明した自車線確率を用いた判定を
行って、本処理を終了する。
In S1060, the lane of the recognized target is determined. This process will be described with reference to the flowchart of FIG. First, the curvature radius R [M] obtained from the stationary object is extracted (S1510). And the extracted R
The number of [M] is set to L (S1520), and if L <2 (S1530: NO), the process proceeds to S1700. S17
In the case of shifting to 00, since L is 1 or 0, that is, there are no more than two stationary objects, it is not possible to determine the same lane by comparing the curvature radii of the recognized targets. Therefore, in S1700, a determination using the own lane probability described in S100 of FIG. 4 in the first embodiment is performed using the average value of the individual radii of curvature R [M] extracted in S1510, and this processing is performed. To end.

【0067】一方、L≧2であれば(S1530:YE
S)、取り出した曲率半径R[M]を停止物に基づく曲率
半径Rs[L]へ代入する(S1540)。そして、停止
物に基づく曲率半径Rs[L]の内で絶対値が最大のもの
をRsmaxとし(S1550)、Rs[L]の内で絶対値が
最小のものをRsminとする(S1560)。
On the other hand, if L ≧ 2 (S1530: YE
S), the extracted radius of curvature R [M] is substituted into the radius of curvature Rs [L] based on the stationary object (S1540). The one having the largest absolute value among the curvature radii Rs [L] based on the stationary object is set to Rsmax (S1550), and the one having the smallest absolute value among Rs [L] is set to Rsmin (S1560).

【0068】続くS1570では、Rsmax−Rsminが所
定のしきい値diffRよりも大きいか否かを判断し、Rsm
ax−Rsmin>diffRの場合(S1570:YES)は、
S1580へ移行して、認識物標による曲率半径を用い
た車線同一判定の処理を続行する。一方、Rsmax−Rsm
in≦diffRの場合(S1570:NO)は、S1700
へ移行して、自車線確率を用いた判定を行う。S157
0にてこのような判定を行うのは、認識した停止物の個
々の器曲率半径を比較し、それらの差がある程度よりも
大きくなれば、道路両端に存在する停止物であると判断
できる。この場合に限り、移動物による曲率半径を用い
た車線同一判定を行うのである。
At S1570, it is determined whether or not Rsmax-Rsmin is larger than a predetermined threshold value diffR.
If ax-Rsmin> diffR (S1570: YES),
The flow shifts to S1580, where the process of lane identity determination using the radius of curvature of the recognized target is continued. On the other hand, Rsmax−Rsm
If in ≦ diffR (S1570: NO), S1700
Then, the determination using the own lane probability is performed. S157
When such a determination is made at 0, the individual radii of curvature of the recognized stationary object are compared, and if the difference between them is greater than a certain value, it can be determined that the stationary object exists at both ends of the road. Only in this case, the same lane determination using the radius of curvature of the moving object is performed.

【0069】S1580では、RsmaxとなるRs[L]を
求めた対象、つまり認識した停止物より求められるR
[M]がRsmaxとなるような停止物の横位置Xの最新デー
タを、RXsmaxとする。同様にS1590では、Rsmin
となるRs[L]を求めた対象、つまり認識した停止物よ
り求められるR[M]がRsminとなるような停止物の横位
置Xの最新データを、RXsminとする。そして、移動物
から求められた曲率半径R[M]を取り出し(S160
0)、その取り出したR[M]の個数をKとする(S16
10)。さらに、取り出した曲率半径R[M]を停止物に
基づく曲率半径Rm[K]へ代入する(S1620)。
In step S1580, the object for which Rs [L], which is Rsmax, has been obtained, that is, Rs obtained from the recognized stationary object.
The latest data of the lateral position X of the stationary object such that [M] becomes Rsmax is defined as RXsmax. Similarly, in S1590, Rsmin
Let RXsmin be the target for which Rs [L] is obtained, that is, the latest data of the horizontal position X of the stationary object such that R [M] obtained from the recognized stationary object is Rsmin. Then, the curvature radius R [M] obtained from the moving object is extracted (S160).
0), and the number of the extracted R [M] is set to K (S16).
10). Further, the retrieved radius of curvature R [M] is substituted into the radius of curvature Rm [K] based on the stationary object (S1620).

【0070】続くS1630では、S1580で得たR
Xsmaxの絶対値が、S1590で得たRXsminの絶対よ
りも大きいか否かを判断する。この判断の意味を説明す
る。判断の式自体は、認識した停止物の自車の進行方向
を基準とした横位置の大小を比較している。そのため、
|RXsmax|>|RXsmin|のときは、自車は、曲率半
径の小さい方の車線(例えば左カーブであれば左側の車
線)を走行していると考えられる。逆の場合、自車は、
曲率半径の大きい方の車線(例えば左カーブであれば右
側の車線)を走行していると考えられる。したがって、
道路両端にある停止物の一方を車線同一の判定のための
基準として使用する。具体的には、自車に近い方の道路
端にある停止物を基準とし、|RXsmax|>|RXsmin
|のときは|RXsmin|、|RXsmax|≦|RXsmin|
のときは|RXsmax|をそれぞれ基準とする。
In the following S1630, the R obtained in S1580
It is determined whether the absolute value of Xsmax is greater than the absolute value of RXsmin obtained in S1590. The meaning of this determination will be described. The judgment formula itself compares the magnitude of the lateral position of the recognized stationary object with reference to the traveling direction of the own vehicle. for that reason,
When | RXsmax |> | RXsmin |, it is considered that the own vehicle is traveling on the lane having a smaller radius of curvature (for example, the left lane in the case of a left curve). In the opposite case, your vehicle
It is considered that the vehicle is traveling on the lane with the larger radius of curvature (for example, the lane on the right side in the case of a left curve). Therefore,
One of the stationary objects at both ends of the road is used as a criterion for determining the same lane. Specifically, | RXsmax |> | RXsmin, based on a stationary object at the road end closer to the own vehicle.
| When | RXsmin |, | RXsmax | ≦ | RXsmin |
In this case, | RXsmax | is used as a reference.

【0071】そのため、|RXsmax|>|RXsmin|の
ときは(S1630:YES)、S1620で得たRm
[K]の絶対値からこの場合の基準となるRXsminの絶対
値を差し引いた値が所定のしきい値diffX未満(|Rm
[K]|−|RXsmin|<diffX)か否かを判断する(S
1640)。そして、この条件を満たす場合は(S16
40:YES)、Rm[K]を求めるために用いた認識物
は自車線上に存在すると判定し(S1660)、条件を
満たさない場合は(S1640:NO)、Rm[K]を求
めるために用いた認識物は自車線上に存在しないと判定
する(S1670)。これは、基準となる停止物から求
めた曲率半径Rsと、判定対象の移動物から求めた曲率
半径Rmとの差がある程度の範囲内であれば、その移動
物は自車線上に存在すると考えられるからである。
Therefore, when | RXsmax |> | RXsmin | (S1630: YES), Rm obtained in S1620
The value obtained by subtracting the absolute value of RXsmin, which is the reference in this case, from the absolute value of [K] is less than a predetermined threshold value diffX (| Rm
It is determined whether [K] | − | RXsmin | <diffX) (S
1640). If this condition is satisfied (S16
40: YES), it is determined that the recognized object used for obtaining Rm [K] is present on the own lane (S1660), and if the condition is not satisfied (S1640: NO), it is determined that Rm [K] is obtained. It is determined that the used recognition object does not exist on the own lane (S1670). This is because if the difference between the radius of curvature Rs obtained from the reference stationary object and the radius of curvature Rm obtained from the moving object to be determined is within a certain range, the moving object is considered to be on the own lane. Because it can be done.

【0072】一方、|RXsmax|≦|RXsmin|のとき
は(S1630:NO)、この場合の基準となるRXsm
axの絶対値からRm[K]の絶対値を差し引いた値が所定
のしきい値diffX未満(|RXsmax|−|Rm[K]|<
diffX)か否かを判断する(S1650)。そして、こ
の条件を満たす場合は(S1650:YES)、Rm
[K]を求めるために用いた認識物は自車線上に存在する
と判定し(S1660)、条件を満たさない場合は(S
1650:NO)、Rm[K]を求めるために用いた認識
物は自車線上に存在しないと判定する(S1670)。
On the other hand, when | RXsmax | ≦ | RXsmin | (S1630: NO), the reference RXsm
A value obtained by subtracting the absolute value of Rm [K] from the absolute value of ax is smaller than a predetermined threshold value diffX (| RXsmax |-| Rm [K] | <
diffX) (S1650). If this condition is satisfied (S1650: YES), Rm
It is determined that the recognized object used for obtaining [K] exists on the own lane (S1660), and if the condition is not satisfied (S1660).
1650: NO), it is determined that the recognized object used for obtaining Rm [K] does not exist on the own lane (S1670).

【0073】S1660又はS1670の処理後は、K
をデクリメントする(S1680)。このようなS16
30〜S1680の処理を、Kが0になるまで繰り返
し、K=0となった場合には(S1690:YES)、
本処理を終了する。なお、本第2実施形態においては、
先行車判定ブロック53が車線同一判定手段に相当す
る。
After the processing of S1660 or S1670, K
Is decremented (S1680). Such S16
The processing from 30 to S1680 is repeated until K becomes 0, and when K becomes 0 (S1690: YES),
This processing ends. In the second embodiment,
The preceding vehicle determination block 53 corresponds to a lane identicalness determination unit.

【0074】以上説明したように、本第2実施形態にお
いては、第1実施例のように自車線確率に基づくのでは
なく、認識物体から得た道路曲率に基づいて車線同一判
定を行うことができ、先行車を選択することができる。
なお、本発明はこのような実施形態に何等限定されるも
のではなく、本発明の主旨を逸脱しない範囲において種
々なる形態で実施し得る。
As described above, in the second embodiment, it is possible to perform the same lane determination based on the road curvature obtained from the recognition object instead of the own lane probability as in the first embodiment. Yes, you can select the preceding car.
It should be noted that the present invention is not limited to such embodiments at all, and can be implemented in various forms without departing from the gist of the present invention.

【0075】例えば、上記実施形態では、「レーダ手
段」としてミリ波等を用いたレーダ装置5を採用した
が、レーザ光を用いたレーザレーダ装置を採用してもよ
い。
For example, in the above embodiment, the radar device 5 using a millimeter wave or the like is employed as the "radar means", but a laser radar device using a laser beam may be employed.

【図面の簡単な説明】[Brief description of the drawings]

【図1】 本発明が適用された車両制御装置の構成を示
すブロック図である。
FIG. 1 is a block diagram illustrating a configuration of a vehicle control device to which the present invention has been applied.

【図2】 カーブ路における認識物標の軌跡に基づく横
位置変化の説明図である。
FIG. 2 is an explanatory diagram of a lateral position change based on a locus of a recognition target on a curved road.

【図3】 認識物標の軌跡に基づいて道路の曲率半径が
適切に求められることを示すための説明図である。
FIG. 3 is an explanatory diagram showing that a curvature radius of a road can be appropriately obtained based on a trajectory of a recognition target.

【図4】 車線同一判定処理の概要を示すフローチャー
トである。
FIG. 4 is a flowchart illustrating an outline of a lane identification process.

【図5】 図4中において実行される道路曲率推定処理
を示すフローチャートである。
FIG. 5 is a flowchart showing a road curvature estimation process executed in FIG. 4;

【図6】 図5中において実行される移動物の場合の処
理を示すフローチャートである。
FIG. 6 is a flowchart showing a process for a moving object executed in FIG. 5;

【図7】 (a)は各物標位置を直線路走行時の位置に
変換する際の説明図、(b)は自車線確率を求めるため
のパラメータαのマップの説明図である。
FIG. 7A is an explanatory diagram when converting each target position into a position on a straight road, and FIG. 7B is an explanatory diagram of a map of a parameter α for obtaining the own lane probability.

【図8】 自車線確率マップの説明図である。FIG. 8 is an explanatory diagram of an own lane probability map.

【図9】 認識物標から得た道路の曲率半径に基づい
て、移動物の車線同一性が適切に求められることを示す
ための説明図である。
FIG. 9 is an explanatory diagram showing that lane identity of a moving object is appropriately determined based on a radius of curvature of a road obtained from a recognition target.

【図10】 第2実施形態の場合の車線同一判定処理の概
要を示すフローチャートである。
FIG. 10 is a flowchart illustrating an outline of a lane identity determination process according to the second embodiment.

【図11】 図10中において実行される道路曲率推定処理
を示すフローチャートである。
11 is a flowchart illustrating a road curvature estimation process executed in FIG. 10;

【図12】 図10中において実行される認識物標の車線判
定処理を示すフローチャートである。
12 is a flowchart illustrating a lane determination process for a recognized target executed in FIG. 10;

【符号の説明】[Explanation of symbols]

1…車両制御装置 3…コンピュー
タ 5…レーダ装置 5a…送受信部 5b…信号処理部 7…車速セン
サ 9…ブレーキスイッチ 11…スロットル
開度センサ 13…警報音発生器 15…距離表示
器 17…センサ異常表示器 19…ブレーキ
駆動器 21…スロットル駆動器 23…自動変速
機制御器 24…警報音量設定器 25…警報感度
設定器 26…クルーズコントロールスイッチ 27…ステアリ
ングセンサ 28…ヨーレートセンサ 29…電源スイ
ッチ 41…極・直交座標変換ブロック 43…物体認識
ブロック 45…道路曲率推定ブロック 47…車速演算
ブロック 49…操舵角演算ブロック 51…ヨーレー
ト演算ブロック 53…先行車判定ブロック 55…車間制御部及び警報判定部ブロック 63…曲率半径算出ブロック
DESCRIPTION OF SYMBOLS 1 ... Vehicle control apparatus 3 ... Computer 5 ... Radar apparatus 5a ... Transmission / reception part 5b ... Signal processing part 7 ... Vehicle speed sensor 9 ... Brake switch 11 ... Throttle opening degree sensor 13 ... Alarm sound generator 15 ... Distance display 17 ... Sensor abnormality Indicator 19 ... Brake driver 21 ... Throttle driver 23 ... Automatic transmission controller 24 ... Alarm volume setting device 25 ... Alarm sensitivity setting device 26 ... Cruise control switch 27 ... Steering sensor 28 ... Yaw rate sensor 29 ... Power switch 41 ... Polar / Cartesian coordinate conversion block 43 ... Object recognition block 45 ... Road curvature estimation block 47 ... Vehicle speed calculation block 49 ... Steering angle calculation block 51 ... Yaw rate calculation block 53 ... Preceding vehicle judgment block 55 ... Vehicle control unit and alarm judgment unit block 63 … Curvature radius calculation block

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.7 識別記号 FI テーマコート゛(参考) B60R 21/00 624 B60R 21/00 624D 626 626B 626E F02D 29/02 301 F02D 29/02 301D Fターム(参考) 3D044 AA21 AA25 AB01 AC03 AC24 AC31 AC56 AC59 3G093 AA01 BA14 BA23 BA24 BA27 CB09 CB10 DA06 DB05 DB15 DB16 DB18 EA09 EB03 EB04 EC01 FA02 FA04 FA11 5H180 AA01 CC14 LL01 LL06 LL07 LL09 LL15 ──────────────────────────────────────────────────続 き Continued on the front page (51) Int.Cl. 7 Identification symbol FI Theme coat ゛ (Reference) B60R 21/00 624 B60R 21/00 624D 626 626B 626E F02D 29/02 301 F02D 29/02 301D F term (reference) 3D044 AA21 AA25 AB01 AC03 AC24 AC31 AC56 AC59 3G093 AA01 BA14 BA23 BA24 BA27 CB09 CB10 DA06 DB05 DB15 DB16 DB18 EA09 EB03 EB04 EC01 FA02 FA04 FA11 5H180 AA01 CC14 LL01 LL06 LL07 LL09 LL15

Claims (11)

【特許請求の範囲】[Claims] 【請求項1】車幅方向の所定角度範囲内に渡り送信波を
照射し、その反射波に基づいて物体を検出するレーダ手
段と、 該レーダ手段による検出結果に基づき、車両前方の道路
曲率を推定する曲率推定手段とを備えた車両用道路曲率
推定装置であって、 前記曲率推定手段は、 前記レーダ手段による検出結果に基づき、少なくとも物
体までの距離及び、自車の前後方向軸の延長線を基準と
した場合に、当該物体が自車の車幅方向へどの程度離れ
ているかを示す物理量である物体横位置を算出する物体
認識手段と、 その物体認識手段にて算出された物体横位置の時間経過
に伴う履歴から前記物体横位置の変化率を算出する変化
率算出手段と、 その変化率算出手段にて算出された変化率に基づいて、
車両前方の道路の曲率を算出する曲率算出手段とを備え
ることを特徴とする車両用道路曲率推定装置。
1. A radar means for irradiating a transmission wave over a predetermined angle range in the vehicle width direction and detecting an object based on the reflected wave, and a road curvature ahead of the vehicle based on a detection result by the radar means. A curvature estimating device for a vehicle, comprising: a curvature estimating means for estimating, wherein the curvature estimating means is based on a detection result by the radar means, at least a distance to an object and an extension of a longitudinal axis of the own vehicle. Object recognition means for calculating an object lateral position, which is a physical quantity indicating how far the object is in the vehicle width direction when the object is referred to, and an object lateral position calculated by the object recognition means Change rate calculating means for calculating a change rate of the object lateral position from a history with the passage of time, based on the change rate calculated by the change rate calculating means,
A curvature estimating device for a vehicle, comprising: a curvature calculating means for calculating a curvature of a road ahead of the vehicle.
【請求項2】請求項1記載の車両用道路曲率推定装置に
おいて、 前記変化率算出手段は、前記物体横位置の時間経過に伴
う履歴を直線で近似して前記変化率を算出することを特
徴とする車両用道路曲率推定装置。
2. The vehicle road curvature estimating apparatus according to claim 1, wherein the change rate calculating means calculates the change rate by approximating a history of the lateral position of the object over time with a straight line. Vehicle road curvature estimating device.
【請求項3】請求項1又は2記載の車両用道路曲率推定
装置において、 前記変化率算出手段は、物体の検出初期において、少な
くとも第1回目と第2回目のデータが連続して検出され
ている場合にのみ、変化率を算出することを特徴とする
車両用道路曲率推定装置。
3. The road curvature estimating device for a vehicle according to claim 1, wherein the change rate calculating means detects at least first and second data successively at an initial stage of detecting the object. A road curvature estimating device for a vehicle, which calculates a rate of change only when there is a vehicle.
【請求項4】請求項1〜3のいずれか記載の車両用道路
曲率推定装置において、 前記物体認識手段は、前記物体の相対速度及び自車速に
基づいて移動物体か停止物体かという認識種別も判定可
能であり、 前記変化率算出手段は、前記停止物体が認識されている
場合はその停止物体の物体横位置を用いた変化率を算出
し、前記停止物体が認識されておらず移動物体が認識さ
れている場合はその移動物体の物体横位置を用いた変化
率を算出することを特徴とする車両用道路曲率推定装
置。
4. The road curvature estimating device for a vehicle according to claim 1, wherein the object recognizing means also determines a recognition type as a moving object or a stationary object based on the relative speed of the object and the own vehicle speed. It is possible to determine, the change rate calculating means, when the stop object is recognized, calculates a change rate using the object lateral position of the stop object, the moving object is not recognized the stop object A road curvature estimating device for a vehicle, which calculates a rate of change using a lateral position of the moving object when the moving object is recognized.
【請求項5】請求項1〜4のいずれか記載の車両用道路
曲率推定装置において、 さらに、前記曲率算出手段によって算出された曲率の所
定回数分の平均値を算出する平均値算出手段を備えたこ
とを特徴とする車両用道路曲率推定装置。
5. The vehicle road curvature estimating device according to claim 1, further comprising an average value calculating means for calculating an average value of a predetermined number of curvatures calculated by said curvature calculating means. A road curvature estimating device for a vehicle.
【請求項6】請求項5記載の車両用道路曲率推定装置に
おいて、 自車の旋回状態を検出する旋回検出手段と、 その旋回検出手段にて検出された自車の旋回状態と自車
速とに基づいて、道路の曲率を推定する第2の曲率推定
手段を備え、 前記平均値算出手段は、前記変化率算出手段が前記変化
率を算出できる条件が成立しない場合には、前記第2の
曲率推定手段にて推定された曲率を採用し、その曲率も
含めた前記所定回数分の平均値を算出することを特徴と
する車両用道路曲率推定装置。
6. The vehicle road curvature estimating device according to claim 5, wherein the turning detecting means for detecting a turning state of the own vehicle, and the turning state of the own vehicle and the own vehicle speed detected by the turning detecting means. Second curvature estimating means for estimating the curvature of the road based on the second curvature when the condition that the change rate calculating means can calculate the change rate is not satisfied. An apparatus for estimating a road curvature for a vehicle, comprising: adopting a curvature estimated by an estimating means and calculating an average value of the predetermined number of times including the curvature.
【請求項7】請求項1〜6のいずれか記載の車両用道路
曲率推定装置において、 自車の旋回状態を検出する旋回検出手段と、 その旋回検出手段にて検出された自車の旋回状態と自車
速とに基づいて、道路の曲率を推定する第2の曲率推定
手段を備え、 その第2の曲率推定手段にて推定された曲率と前記曲率
推定手段にて推定された曲率とに基づいて、最終的な道
路曲率を推定することを特徴とする車両用道路曲率推定
装置。
7. A vehicle road curvature estimating apparatus according to claim 1, wherein said vehicle detecting means detects a turning state of said own vehicle, and said vehicle turning state detected by said turning detecting means. A second curvature estimating means for estimating the curvature of the road based on the vehicle speed and the vehicle speed based on the curvature estimated by the second curvature estimating means and the curvature estimated by the curvature estimating means. A vehicle road curvature estimating device for estimating a final road curvature.
【請求項8】請求項1〜7のいずれか記載の車両用道路
曲率推定装置と、 その車両用道路曲率推定装置によって得られた道路曲率
と前記物体の相対位置とに基づいて、前記物体が自車と
同一車線上にいる確率を求める自車線確率算出手段と、 前記自車線確率算出手段によって求められた確率に基づ
いて先行車を選択する先行車選択手段とを備えることを
特徴とする先行車選択装置。
8. The vehicle road curvature estimating device according to claim 1, wherein the object is determined based on a road curvature obtained by the vehicle road curvature estimating device and a relative position of the object. A preceding lane comprising: an own lane probability calculating means for calculating a probability of being on the same lane as the own vehicle; and a preceding vehicle selecting means for selecting a preceding vehicle based on the probability obtained by the own lane probability calculating means. Car selection device.
【請求項9】請求項1〜7のいずれか記載の車両用道路
曲率推定装置と、 その車両用道路曲率推定装置によって、道路の両端にそ
れぞれ存在すると想定される停止物体を基にした道路曲
率が得られている場合には、それらの道路曲率と移動物
体を基にして得た道路曲率の大小関係に基づいて、当該
移動物体が自車と同一車線上にいる可能性を判定する車
線同一判定手段と、 その車線同一判定手段による判定結果に基づいて先行車
を選択する先行車選択手段とを備えることを特徴とする
先行車選択装置。
9. A road curvature estimating device for a vehicle according to any one of claims 1 to 7, and the road curvature estimating device for a vehicle based on stationary objects assumed to be present at both ends of the road. Is obtained, based on the magnitude relationship between the road curvature and the road curvature obtained based on the moving object, it is determined that there is a possibility that the moving object is on the same lane as the own vehicle. A preceding vehicle selecting device, comprising: determining means; and preceding vehicle selecting means for selecting a preceding vehicle based on a result of the determination by the lane identity determining means.
【請求項10】請求項9記載の先行車選択装置におい
て、 前記道路の両端にそれぞれ存在すると想定される停止物
体を基にした道路曲率であるか否かは、道路曲率半径の
差が所定値以上であるか否かで判定することを特徴とす
る先行車選択装置。
10. The preceding vehicle selecting device according to claim 9, wherein the difference between the radius of curvature of the road is a predetermined value, based on whether the road curvature is based on a stationary object assumed to exist at both ends of the road. A preceding vehicle selecting device, wherein the determination is made based on whether or not the above is true.
【請求項11】請求項9又は10記載の先行車選択装置
において、 前記車線同一判定手段は、 前記道路の両端にそれぞれ存在すると想定される停止物
体の物体横位置に基づいて、自車が左右いずれの道路端
に近い側に存在するかを判定し、 その判定結果、及び車線同一か否かの判定対象の移動物
を基にした道路曲率と前記道路の両端にそれぞれ存在す
ると想定される停止物体を基にした道路曲率との大小関
係に基づいて、当該移動物体の車線同一性を判定するこ
とを特徴とする先行車選択装置。
11. The preceding vehicle selecting device according to claim 9, wherein the same lane judging means determines whether the own vehicle is left or right on the basis of an object lateral position of a stationary object assumed to be present at both ends of the road. It is determined which of the road ends is closer to the road end, the result of the determination, the road curvature based on the moving object to be determined whether or not the lanes are the same, and the stop assumed to be present at both ends of the road A preceding vehicle selecting apparatus for determining the lane identity of a moving object based on a magnitude relationship with a road curvature based on the object.
JP2000140100A 2000-05-12 2000-05-12 Road curvature estimating device for vehicle and preceding vehicle selecting device Pending JP2001319299A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2000140100A JP2001319299A (en) 2000-05-12 2000-05-12 Road curvature estimating device for vehicle and preceding vehicle selecting device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2000140100A JP2001319299A (en) 2000-05-12 2000-05-12 Road curvature estimating device for vehicle and preceding vehicle selecting device

Publications (1)

Publication Number Publication Date
JP2001319299A true JP2001319299A (en) 2001-11-16

Family

ID=18647444

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2000140100A Pending JP2001319299A (en) 2000-05-12 2000-05-12 Road curvature estimating device for vehicle and preceding vehicle selecting device

Country Status (1)

Country Link
JP (1) JP2001319299A (en)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004102421A (en) * 2002-09-05 2004-04-02 Mitsubishi Electric Corp Road curvature computing method
JP2007066047A (en) * 2005-08-31 2007-03-15 Mitsubishi Electric Corp Road shape recognition device
JPWO2010073300A1 (en) * 2008-12-26 2012-05-31 トヨタ自動車株式会社 Traveling route estimation device and traveling route estimation method used in the device
JP2012131496A (en) * 2003-12-24 2012-07-12 Automotive Systems Lab Inc Road curvature estimation system
JP2013142975A (en) * 2012-01-10 2013-07-22 Denso Corp Preceding vehicle selector and inter-vehicle controller
JP2013209085A (en) * 2002-07-15 2013-10-10 Automotive Systems Lab Inc Road curvature estimation system and automotive target state estimation system
KR101448506B1 (en) * 2012-12-13 2014-10-08 현대오트론 주식회사 Measurement Method and Apparatus for Measuring Curvature of Lane Using Behavior of Preceding Vehicle
KR20160040032A (en) * 2014-10-02 2016-04-12 주식회사 만도 Lane estimation system and method using a vehicle type radar
JP2017091094A (en) * 2015-11-06 2017-05-25 古河電気工業株式会社 Surrounding area monitoring device and surrounding area monitoring method
CN107010062A (en) * 2015-11-06 2017-08-04 福特全球技术公司 Method and apparatus for determining lane configurations file data
KR101789073B1 (en) 2011-08-24 2017-10-23 현대모비스 주식회사 Method and apparatus for estimating radius of curvature of vehicle
CN109116376A (en) * 2018-07-31 2019-01-01 福州大学 Parking of automobile anticollision range unit and its distance measuring method
CN111737633A (en) * 2020-06-23 2020-10-02 上海汽车集团股份有限公司 Method and device for calculating curvature radius of road in front of vehicle
CN112699575A (en) * 2021-01-22 2021-04-23 中汽创智科技有限公司 Method and system for measuring and calculating relative position in virtual vehicle test platform

Cited By (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013209085A (en) * 2002-07-15 2013-10-10 Automotive Systems Lab Inc Road curvature estimation system and automotive target state estimation system
JP2004102421A (en) * 2002-09-05 2004-04-02 Mitsubishi Electric Corp Road curvature computing method
JP2012131496A (en) * 2003-12-24 2012-07-12 Automotive Systems Lab Inc Road curvature estimation system
JP2007066047A (en) * 2005-08-31 2007-03-15 Mitsubishi Electric Corp Road shape recognition device
JP4637690B2 (en) * 2005-08-31 2011-02-23 三菱電機株式会社 Road shape recognition device
US8989913B2 (en) 2008-12-26 2015-03-24 Toyota Jidosha Kabushiki Kaisha Travel route estimation device and travel route estimation method used in the same device
JP5146542B2 (en) * 2008-12-26 2013-02-20 トヨタ自動車株式会社 Traveling route estimation device and traveling route estimation method used in the device
JPWO2010073300A1 (en) * 2008-12-26 2012-05-31 トヨタ自動車株式会社 Traveling route estimation device and traveling route estimation method used in the device
KR101789073B1 (en) 2011-08-24 2017-10-23 현대모비스 주식회사 Method and apparatus for estimating radius of curvature of vehicle
KR101428674B1 (en) 2012-01-10 2014-08-08 가부시키가이샤 덴소 Preceding-vehicle identifying apparatus and following-distance control appartus
JP2013142975A (en) * 2012-01-10 2013-07-22 Denso Corp Preceding vehicle selector and inter-vehicle controller
US9015100B2 (en) 2012-01-10 2015-04-21 Denso Corporation Preceding-vehicle identifying apparatus and following-distance control apparatus
KR101448506B1 (en) * 2012-12-13 2014-10-08 현대오트론 주식회사 Measurement Method and Apparatus for Measuring Curvature of Lane Using Behavior of Preceding Vehicle
KR20160040032A (en) * 2014-10-02 2016-04-12 주식회사 만도 Lane estimation system and method using a vehicle type radar
KR101992115B1 (en) 2014-10-02 2019-06-25 주식회사 만도 Lane estimation system and method using a vehicle type radar
JP2017091094A (en) * 2015-11-06 2017-05-25 古河電気工業株式会社 Surrounding area monitoring device and surrounding area monitoring method
CN107010062A (en) * 2015-11-06 2017-08-04 福特全球技术公司 Method and apparatus for determining lane configurations file data
CN107010062B (en) * 2015-11-06 2021-11-09 福特全球技术公司 Method and device for determining lane profile data
CN109116376A (en) * 2018-07-31 2019-01-01 福州大学 Parking of automobile anticollision range unit and its distance measuring method
CN111737633A (en) * 2020-06-23 2020-10-02 上海汽车集团股份有限公司 Method and device for calculating curvature radius of road in front of vehicle
CN112699575A (en) * 2021-01-22 2021-04-23 中汽创智科技有限公司 Method and system for measuring and calculating relative position in virtual vehicle test platform

Similar Documents

Publication Publication Date Title
JP3427815B2 (en) Method and apparatus for selecting preceding vehicle, recording medium
JP4837755B2 (en) Object detection device
US8781644B2 (en) Method and apparatus for recognizing shape of road for vehicles
JP3891011B2 (en) Cruise control device, program
JP4740449B2 (en) Vertical axis deviation detection device for automotive radar
JP3417381B2 (en) Road shape recognition device, preceding vehicle specifying device, and recording medium
JP2001319299A (en) Road curvature estimating device for vehicle and preceding vehicle selecting device
JP2002040139A (en) Method and device for body recognition, and recording medium
JP3417375B2 (en) Vehicle road shape recognition method and apparatus, recording medium
JP4736777B2 (en) Vehicle road shape recognition device
JP6788388B2 (en) Radar device and control method of radar device
JP2002022832A (en) Method and apparatus for recognizing object, recording medium
JP2001256600A (en) Method and device for recognizing road condition for vehicle and recording medium
WO2002075351A1 (en) Method for detecting stationary object on road by radar
JP2003344534A (en) On-vehicle radar equipment and program
WO2005091015A1 (en) Radar
JP5402968B2 (en) Vehicular road shape recognition method and apparatus, and recording medium
JP4107882B2 (en) Data storage method for radar apparatus, radar apparatus and program therefor
JP6314028B2 (en) Radar apparatus, vehicle control system, and signal processing method
JP2005049281A (en) Method and device for recognizing object
JP2002131433A (en) Method and device for recognizing object
JP2001080437A (en) Vehicular obstacle recognition device, car-to-car distance control device, car-to-car distance warning device and recording medium
CN116148860A (en) Method and device for identifying static obstacle, vehicle and storage medium
JP4407315B2 (en) Target estimation device
JP3475745B2 (en) Inter-vehicle distance alarm

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20060706

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20081120

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20081125

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20090122

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20091027

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20100302