JP2001093094A - Curve approach controller - Google Patents
Curve approach controllerInfo
- Publication number
- JP2001093094A JP2001093094A JP26772899A JP26772899A JP2001093094A JP 2001093094 A JP2001093094 A JP 2001093094A JP 26772899 A JP26772899 A JP 26772899A JP 26772899 A JP26772899 A JP 26772899A JP 2001093094 A JP2001093094 A JP 2001093094A
- Authority
- JP
- Japan
- Prior art keywords
- curve
- allowable
- node
- speed
- approach speed
- 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.)
- Granted
Links
Landscapes
- Controls For Constant Speed Travelling (AREA)
- Regulating Braking Force (AREA)
- Navigation (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
【0001】[0001]
【発明の属する技術分野】本発明は、走行路前方のカー
ブの曲率半径が道路幅に対して設定割合以下のタイトコ
ーナでは、前方カーブに対する許容進入速度を道路幅と
許容横加速度とに基づいて設定するカーブ進入制御装置
に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention sets an allowable approach speed for a forward curve on the basis of a road width and an allowable lateral acceleration in a tight corner in which a curvature radius of a curve ahead of a traveling road is equal to or less than a set ratio with respect to a road width. To a curve approach control device.
【0002】[0002]
【従来の技術】従来より、ナビゲーション装置の道路マ
ップデータや前方視認装置(ステレオカメラ等)を用い
て検出された前方カーブに対する許容進入速度を算出
し、この許容進入速度以上の速度、すなわち前方カーブ
に対する自車のオーバスピード状態を検出し、警報或い
は減速制御を行う車両走行システムが、特開平4−23
6699号公報等で提案されている。2. Description of the Related Art Conventionally, an allowable approach speed for a forward curve detected by using road map data of a navigation device or a visual recognition device (a stereo camera or the like) is calculated, and a speed higher than the allowable approach speed, that is, a forward curve is calculated. Japanese Patent Application Laid-Open No. 4-23 discloses a vehicle traveling system which detects an overspeed state of the own vehicle with respect to the vehicle and performs an alarm or deceleration control.
No. 6699, for example.
【0003】[0003]
【発明が解決しようとする課題】しかし、図11に実線
で示す自車走行ラインのように、カーブ曲率半径が道路
幅に近いタイトコーナでは、運転者は、道路或いは自車
レーンを逸脱しない範囲で道路幅を有効に使用して、そ
の実際のカーブ曲率半径よりもやや大きな旋回半径で走
行(いわゆる、アウト−イン−アウト)する場合が多
い。However, in a tight corner where the radius of curvature is close to the road width, as in the case of a vehicle running line indicated by a solid line in FIG. In many cases, the vehicle travels (so-called out-in-out) with a turning radius slightly larger than the actual curve radius of curvature by effectively using the road width.
【0004】この場合、カーブに対する許容進入速度
は、カーブ曲率半径に応じて設定されるため、実際の走
行(アウト−イン−アウト)に対して、許容進入速度が
低すぎる値に設定されてしまう。その結果、実際の走行
に反して警報や減速制御が過敏となり、運転者に違和感
を与えてしまう。この傾向は、外カーブ(左側通行の国
では右カーブ、右側通行の国では左カーブ)を走行する
際に強く表れる。[0004] In this case, the allowable approach speed for the curve is set according to the radius of curvature of the curve, so that the allowable approach speed is set to a value that is too low for the actual running (out-in-out). . As a result, the warning and the deceleration control become too sensitive contrary to the actual running, and the driver feels strange. This tendency is more pronounced when traveling on an outside curve (right curve in a country traveling on the left, left curve in a country traveling on the right).
【0005】本発明は、上記事情に鑑み、カーブに対す
る許容進入速度を実際の走行軌跡のカーブ曲率に応じた
適正な値に設定することが可能となり、実際の走行に反
したわずらわしい警報や減速制御を解消し、運転者に与
える違和感を軽減するカーブ進入制御装置を提供するこ
とを目的とする。In view of the above circumstances, the present invention makes it possible to set the allowable approach speed for a curve to an appropriate value according to the curve curvature of the actual running locus, and to provide a troublesome alarm or deceleration control that is contrary to the actual running. It is an object of the present invention to provide a curve entry control device that eliminates the problem and reduces the uncomfortable feeling given to a driver.
【0006】[0006]
【課題を解決するための手段】上記目的を達成するため
本発明による第1のカーブ進入制御装置は、少なくとも
前方カーブの曲率半径に基いてそのカーブへの許容進入
速度を算出し、この許容進入速度に基いて警報あるいは
減速制御を行うカーブ進入制御装置において、上記曲率
半径が上記カーブの道路幅に対して設定割合以下のと
き、該カーブに対する許容進入速度を増大補正すること
を特徴とする。このような構成では、自車の前方カーブ
の曲率半径がカーブ道路幅に対して設定割合以下のタイ
トコーナのときは、カーブの曲率半径に基づいて算出し
た許容進入速度を増大補正することで、許容進入速度
が、実際の走行状態に対して低すぎることにより生じ
る、運転者の違和感が軽減される。In order to achieve the above object, a first curve approach control device according to the present invention calculates an allowable approach speed to a curve based on at least a radius of curvature of a forward curve, and calculates the allowable approach speed to the curve. In a curve approach control device that performs warning or deceleration control based on speed, when the radius of curvature is equal to or less than a set ratio with respect to the road width of the curve, the allowable approach speed for the curve is increased and corrected. In such a configuration, when the radius of curvature of the front curve of the vehicle is a tight corner that is equal to or smaller than the set ratio with respect to the curve road width, the allowable approach speed calculated based on the radius of curvature of the curve is increased and corrected to increase the allowable approach speed. The driver's discomfort caused by the approach speed being too low with respect to the actual running state is reduced.
【0007】第2のカーブ進入制御装置は、第1のカー
ブ進入制御装置において、前記設定割合は、自車が内カ
ーブを走行する場合より外カーブを走行する場合の方が
大きな値に設定されていることを特徴とする請求項1記
載のカーブ進入制御装置。A second curve entry control device is the first curve entry control device, wherein the set ratio is set to a larger value when the vehicle travels on an outer curve than when the vehicle travels on an inner curve. 2. The curve approach control device according to claim 1, wherein:
【0008】このような構成では、カーブの道路幅に対
する設定割合を、内カーブよりも外カーブを大きな値に
設定することで、外カーブの許容進入速度を、実際の走
行に即した適正な値とすることができる。In such a configuration, by setting the set ratio of the curve to the road width to a value larger for the outer curve than for the inner curve, the allowable approach speed of the outer curve is set to an appropriate value corresponding to the actual running. It can be.
【0009】第3のカーブ進入制御措置は、第1のカー
ブ進入制御装置において、前記設定割合は、前記カーブ
の道路種別に応じて可変に設定されていることを特徴と
する。このような構成では、カーブの道路幅対する設定
割合を、道路種別に応じて設定することで、道路環境に
応じた許容進入速度を設定することができる。A third curve approach control measure is characterized in that, in the first curve approach control device, the set ratio is variably set according to a road type of the curve. In such a configuration, the allowable approach speed according to the road environment can be set by setting the setting ratio of the curve to the road width according to the road type.
【0010】第4のカーブ進入制御装置は、少なくとも
前方カーブの曲率半径に基いてそのカーブへの許容進入
速度を算出し、この許容進入速度に基いて警報あるいは
減速制御を行うカーブ進入制御装置において、少なくと
も上記曲率半径に基いて設定される許容進入速度と、少
なくとも上記カーブの道路幅に応じて設定される所定ガ
ード値とを比較し、大きい方を許容進入速度として選択
することを特徴とする。このような構成では、許容進入
速度を、カーブの曲率半径に基づいて設定する許容進入
速度と、少なくともカープの道路幅に応じて設定する所
定ガード値とを比較し、この許容進入速度とガード値と
の大きい方を実際の許容進入速度として選択すること
で、実際の走行旋回半径に沿った適切な許容進入速度を
設定することができる。The fourth curve entry control device calculates a permissible approach speed to the curve based on at least a radius of curvature of a forward curve, and performs a warning or deceleration control based on the permissible entry speed. Comparing at least an allowable approach speed set based on the radius of curvature with at least a predetermined guard value set according to the road width of the curve, and selecting a larger one as the allowable approach speed. . In such a configuration, the allowable approach speed set based on the radius of curvature of the curve is compared with a predetermined guard value set at least according to the road width of the carp, and the allowable approach speed and the guard value are compared. Is selected as the actual allowable approach speed, an appropriate allowable approach speed along the actual traveling turning radius can be set.
【0011】[0011]
【発明の実施の形態】以下、図1〜図10の図面に基づ
いて本発明の一実施の形態を説明する。図1にカーブ進
入制御装置に設けられている制御部の機能ブロック図を
示す。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will be described below with reference to FIGS. FIG. 1 shows a functional block diagram of a control unit provided in the curve entry control device.
【0012】制御部1の入力側には、ヨーレートセンサ
2で検出したヨーレートτ、ハンドル角センサ3で検出
した舵角δf、横加速度センサ4で検出した横加速度G
y、車速センサ5で検出した車速V、前後加速度センサ
6で検出した前後加速度、ブレーキ圧センサ9で検出し
たブレーキ圧等の各データが入力されると共に、ナビゲ
ーション装置7、及び道路形状検出装置10から出力さ
れる各種信号が入力される。On the input side of the control unit 1, the yaw rate τ detected by the yaw rate sensor 2, the steering angle δf detected by the steering wheel angle sensor 3, and the lateral acceleration G detected by the lateral acceleration sensor 4 are provided.
y, the vehicle speed V detected by the vehicle speed sensor 5, the longitudinal acceleration detected by the longitudinal acceleration sensor 6, the brake pressure detected by the brake pressure sensor 9, and other data are input, and the navigation device 7 and the road shape detecting device 10 are input. Various signals output from are input.
【0013】図3に示すように、ナビゲーション装置7
からは、自車走行ルートに関して送出されるノード数
n、自車位置東経、自車位置北緯、及び、自車直後のノ
ードに関するデータ、自車直前のノードに関するデー
タ、自車前方2点目のノードに関するデータ、・・・・
・自車前方(n−1)点目のノードに関するデータ等の
情報が定期的(例えば、500ms毎)に出力される。As shown in FIG. 3, the navigation device 7
From, the number n of nodes transmitted on the own vehicle traveling route, the east longitude of the own vehicle, the north latitude of the own vehicle position, data on the node immediately after the own vehicle, data on the node immediately before the own vehicle, the second point in front of the own vehicle Data about nodes, ...
Information such as data relating to the node at the (n-1) th point in front of the vehicle is output periodically (for example, every 500 ms).
【0014】又、道路形状検出装置10は、CCDカメ
ラ等を用いて前方道路のカーブの状況(カーブの方向、
曲率の程度等)を検出し、その情報を制御部1へ出力す
る。Further, the road shape detecting device 10 uses a CCD camera or the like to determine the state of the curve (the direction of the curve,
The degree of curvature and the like are detected, and the information is output to the control unit 1.
【0015】制御部1では、各センサ2〜6,9、ナビ
ゲーション装置7、道路形状検出装置10等で検出した
情報に基づき、走行路前方のカーブに対して現在の速度
で進入しても安定した状態で曲がれるか否かを演算し、
必要に応じてブザー、音声警報、警告灯等からなる警報
装置11を駆動させて、運転者に報知する。In the control unit 1, based on information detected by the sensors 2 to 6, 9, the navigation device 7, the road shape detection device 10 and the like, the vehicle is stable even when entering a curve ahead of the traveling road at the current speed. Calculate whether or not you can turn in the state where
The alarm device 11 including a buzzer, an audio alarm, a warning light, and the like is driven as necessary to notify the driver.
【0016】又、強制的に減速させる必要があるときは
減速装置12に対して減速指令を出力する。減速装置1
2では、制御部1からの減速指令に従いトランスミッシ
ョンのシフトダウン、エンジントルクダウン、ブレーキ
作動等により減速制御を行う。When it is necessary to forcibly decelerate, a deceleration command is output to the deceleration device 12. Reduction gear 1
In 2, the deceleration control is performed by downshifting the transmission, reducing the engine torque, operating the brakes, etc. in accordance with the deceleration command from the control unit 1.
【0017】図1に示す制御部1では、先ず、路面摩擦
係数推定部21で、ヨーレートτ、舵角δf、横加速度
Gy、車速V等、車両の挙動を把握するパラメータに基
づき、路面摩擦係数μを、例えば本出願人が先に提出し
た特開平8−2274号公報において既述した算出方法
を用いて推定する。又、道路勾配推定部22において、
車速変化演算部23で算出した車速Vの設定時間毎の変
化率と前後加速度とに基づき道路勾配SLを推定する。In the control section 1 shown in FIG. 1, the road surface friction coefficient estimating section 21 first calculates the road surface friction coefficient based on parameters such as the yaw rate τ, the steering angle δf, the lateral acceleration Gy, and the vehicle speed V. μ is estimated using, for example, the calculation method described in Japanese Patent Application Laid-Open No. H8-2274 previously submitted by the present applicant. In the road gradient estimating unit 22,
The road gradient SL is estimated based on the rate of change of the vehicle speed V at each set time and the longitudinal acceleration calculated by the vehicle speed change calculation unit 23.
【0018】又、許容減速度設定部24で、路面摩擦係
数μと道路勾配SLとから得られる道路状況に基づき、
車両が許容できる減速度である許容減速度XgLimを設定
する。Further, the allowable deceleration setting unit 24 calculates the road condition based on the road surface friction coefficient μ and the road gradient SL based on the road condition.
An allowable deceleration XgLim, which is an allowable deceleration of the vehicle, is set.
【0019】尚、道路勾配SLの推定方法、及び許容減
速度XgLimの算出方法については、本出願人が先に提出
した特開平11−83501号公報に既述されているた
め、ここでの説明は省略する。The method of estimating the road gradient SL and the method of calculating the allowable deceleration XgLim have already been described in Japanese Patent Application Laid-Open No. H11-83501 previously submitted by the present applicant. Is omitted.
【0020】一方、前方道路属性演算記憶部25では、
ナビゲーション装置7から送出されるノードP毎の情報
(図3参照)に基づき、それら各々のノードについて一
つ前のノードとの間隔Lp、カーブ曲率半径rp等を演算
し、それぞれのノード属性として、RAM等の記憶手段
に格納する。また、交差点属性ip、道路幅属性wp等も
各々のノード属性として記憶手段に格納される。On the other hand, in the forward road attribute calculation storage unit 25,
Based on the information for each node P sent from the navigation device 7 (see FIG. 3), the distance Lp to the immediately preceding node, the radius of curvature rp of the curve, and the like are calculated for each of the nodes, and as the node attributes, It is stored in a storage means such as a RAM. In addition, the intersection attribute ip, the road width attribute wp, etc. are also stored in the storage means as respective node attributes.
【0021】すなわち、走行中のナビゲーション装置7
は、図4に示すように、自車位置を基準とした各ノード
の座標P0 (xp[0] ,yp[0] )、P1 (xp[1] ,yp[1]
)、…Pj-1 (xp[j-1] ,yp[j-1] )、 Pj (xp[j]
,yp[j] )、…Pn-1 (xp[n-1] ,yp[n-1] )に基づ
き、ノードPj に隣接するノードPj-1 とのノード間隔
Lp[j]を次式から算出する。 Lp[j]={(xp[j] −xp[j-1] )2 +(yp[j] −yp[j-
1] )2 }1/2 但し、1≦j≦n-1 である。That is, the navigation device 7 during traveling
Are the coordinates P0 (xp [0], yp [0]) and P1 (xp [1], yp [1] of each node based on the position of the vehicle, as shown in FIG.
),... Pj-1 (xp [j-1], yp [j-1]), Pj (xp [j]
, Yp [j]),... Pn-1 (xp [n-1], yp [n-1]), the node interval Lp [j] between the node Pj and the adjacent node Pj-1 is calculated from the following equation. calculate. Lp [j] = {(xp [j] −xp [j−1]) 2 + (yp [j] −yp [j−
1]) 2 } 1/2, where 1 ≦ j ≦ n−1.
【0022】次いで、ノードPj での、ノード間隔Lp
[j],Lp[j+1]の交差する角度であるノード角度tp[j]
(図5参照)を次式から算出する。 tp[j]=sin-1 [{(xp[j-1] −xp[j] )・(yp[j]
−yp[j+1] )−(xp[j]−xp[j+1] )・(yp[j-1] −yp
[j] )}/(Lp[j]・Lp[j+1] )] 尚、ここで得られたノード角度tp[j]は、右カーブの場
合、正値で表され、左カーブの場合、負値で表される。Next, the node interval Lp at the node Pj
Node angle tp [j] which is the angle at which [j] and Lp [j + 1] intersect
(See FIG. 5) is calculated from the following equation. tp [j] = sin -1 [{(xp [j-1] −xp [j]) · (yp [j]
−yp [j + 1]) − (xp [j] −xp [j + 1]) · (yp [j−1] −yp
[j])} / (Lp [j] · Lp [j + 1])] The node angle tp [j] obtained here is represented by a positive value in the case of a right curve, and in the case of a left curve. , Expressed as a negative value.
【0023】そして、ノード間隔Lp[j],Lp[j+1]とノ
ード角度tp[j]とに基づき、ノードPj でのカーブ曲率
半径rp[j]を次式から算出する。 rp[j]=min(Lp[j],Lp[j+1])/2/tan(|
tp[j]|/2) ここで、min(Lp[j],Lp[j+1])は、何れか短い方
のノード間隔を選択する意味であり、図5では、Lp[j]
<Lp[j+1]であるため、上式は、 rp[j]=Lp[j]/2/tan(|tp[j]|/2) となる。Then, based on the node intervals Lp [j], Lp [j + 1] and the node angle tp [j], the curvature radius rp [j] at the node Pj is calculated from the following equation. rp [j] = min (Lp [j], Lp [j + 1]) / 2 / tan (|
tp [j] | / 2) Here, min (Lp [j], Lp [j + 1]) means to select any shorter node interval, and in FIG. 5, Lp [j]
Since Lp [j + 1], the above equation is as follows: rp [j] = Lp [j] / 2 / tan (| tp [j] | / 2)
【0024】又、各ノードにおいて、交差点がある場合
は、ナビゲーション装置7から送出される交差点フラグ
の値をそのまま用い、交差点属性ip[j]として格納す
る。すなわち、交差点属性ip[j]は、ナビゲーション装
置から送出される交差点フラグの値に基づき、交差点以
外の場合は、 ip[j]=0 交差点の場合は、 ip[j]=1 ナビゲーション装置7による案内経路上の交差点の場合
には、 ip[j]=2 に各々設定される。If there is an intersection at each node, the value of the intersection flag sent from the navigation device 7 is used as it is and stored as the intersection attribute ip [j]. In other words, the intersection attribute ip [j] is based on the value of the intersection flag sent from the navigation device. If the intersection is not an intersection, ip [j] = 0. If the intersection is an intersection, ip [j] = 1. In the case of an intersection on a guide route, ip [j] = 2 is set.
【0025】更に、各ノードにおける道路幅についての
道路幅属性wp[j]は、ナビゲーション装置7から送られ
てくる道路幅フラグを用いて設定する。ナビゲーション
装置7から送出される道路幅フラグに対応する実際の道
路幅の範囲に対して、道路幅属性wp[j]は下表に示すよ
うな値となっている。 Further, the road width attribute wp [j] regarding the road width at each node is set using a road width flag sent from the navigation device 7. The road width attribute wp [j] has a value as shown in the following table for the range of the actual road width corresponding to the road width flag sent from the navigation device 7.
【0026】許容横加速度設定部26では、路面摩擦係
数μに応じて許容横加速度aylの基準値ayl1 を算出し、
この基準値ayl1 を道路勾配SLで補正して、許容横加
速度ayl2を設定し、この許容横加速度ayl2をカーブ進入
限界速度(( ayl1/rp[j] ) 1/2 )に応じて補正して最
終的な許容横加速度ayl を設定する。In the allowable lateral acceleration setting section 26, the road surface friction
Calculate the reference value ayl1 of the allowable lateral acceleration ayl according to several μ,
This reference value ayl1 is corrected by the road gradient SL, and the allowable lateral
Set the speed ayl2 and enter this allowable lateral acceleration ayl2 into the curve
Limit speed ((ayl1 / rp [j]) 1/2)
Set the final allowable lateral acceleration ayl.
【0027】ここで、基準値ayl1は、本出願人が先に提
出した特開平11−83501号公報に開示した通りで
あり、次式により求めることができる。 ayl1=μ・Kμ・g ここで、Kμは安全係数、gは重力加速度である。Here, the reference value ayl1 is as disclosed in Japanese Patent Application Laid-Open No. 11-83501 previously submitted by the present applicant, and can be obtained by the following equation. ayl1 = μ · Kμ · g where Kμ is a safety coefficient and g is a gravitational acceleration.
【0028】又、許容横加速度ayl2は、例えば次式から
求めることができる。 ayl2=(ayl12 −(g・SL/100 )2 )1/2 Further, the allowable lateral acceleration ayl2 can be obtained, for example, from the following equation. ayl2 = (ayl1 2 - (g · SL / 100) 2) 1/2
【0029】更に、許容横加速度aylは、例えば次式に
従って算出することができる。 ayl =ayl2・Kv ここで、Kvは車速補正係数であり、カーブ進入限界速
度が大きくなるに従い小さな値になるように設定されて
いる。すなわち、高速コーナンリング走行時の安全性を
高めるために、カーブ進入限界速度の増加に伴いカーブ
での許容横加速度aylが低下するように補正される。Further, the allowable lateral acceleration ayl can be calculated, for example, according to the following equation. ayl = ayl2 · Kv Here, Kv is a vehicle speed correction coefficient, which is set to a smaller value as the curve approach limit speed increases. That is, in order to increase the safety during high-speed coroning traveling, the correction is made so that the allowable lateral acceleration ayl on the curve decreases with an increase in the curve approach limit speed.
【0030】この許容横加速度aylは、許容進入速度設
定部27において読込まれる。図2に示すように、許容
進入速度設定部27は、基準値設定部27a、カーブ構
成ノード識別部27b、ノード角度足し込み演算部27
c、カーブ深さ補正部27d、タイトコーナ補正部27
e、速度平滑化補正部27fで構成されている。The allowable lateral acceleration ayl is read by the allowable approach speed setting section 27. As shown in FIG. 2, the allowable approach speed setting unit 27 includes a reference value setting unit 27a, a curve configuration node identification unit 27b, and a node angle addition calculation unit 27.
c, curve depth correction unit 27d, tight corner correction unit 27
e, a speed smoothing correction unit 27f.
【0031】基準値設定部27aは、各ノードについ
て、許容横加速度設定部26で設定した許容横加速度ay
l と、前方道路属性演算記憶部25に記憶されているカ
ーブ曲率半径rp[j]に基づき、ノードPj への許容進入
速度の基準値vap0 を、次式に従って算出する。 vap0 =(ayl ・|rp[j]|)1/2 カーブ構成ノード識別部27bは、一つのカーブを構成
するノード群を識別するもので、その目的は許容進入速
度基準値vap0を、後述するカーブ深さ(開き角度)tp
aで補正し、且つ、同一カーブ内の各ノードにおける許
容進入速度を平滑化処理することにある。The reference value setting unit 27a calculates the allowable lateral acceleration ay set by the allowable lateral acceleration setting unit 26 for each node.
Based on l and the curve curvature radius rp [j] stored in the front road attribute calculation storage unit 25, a reference value vap0 of the allowable approach speed to the node Pj is calculated according to the following equation. vap0 = (ayl · | rp [j] |) 1/2 Curve Configuration Node Identifying Unit 27b is for identifying a node group configuring one curve, the purpose of which is to specify an allowable approach speed reference value vap0, which will be described later. Curve depth (opening angle) tp
The object of the present invention is to perform a smoothing process for correcting the allowable approach speed at each node in the same curve by correcting with a.
【0032】一つのカーブを構成するパターンとして
は、図6に示すように、ノードPj ひとつだけのもの
と、図7に示すように複数のノードPj-1 ,Pj ,…で
構成されているものとがある。As shown in FIG. 6, a pattern that constitutes one curve is composed of a single node Pj, and a pattern composed of a plurality of nodes Pj-1, Pj,. There is.
【0033】ここで、隣接するノードPj-1 ,Pj が同
一カーブに属するか否かは、それらのノード間隔Lp[j]
と、ノード角度tp[j-1],tp[j]の符号(正値、或いは
負値)で判断する。Here, whether or not the adjacent nodes Pj-1 and Pj belong to the same curve is determined by their node interval Lp [j].
And the sign (positive value or negative value) of the node angles tp [j-1] and tp [j].
【0034】すなわち、ノード間隔Lp[j]が所定値(L
K ・wp[j] LK :定数)よりも小さく(Lp[j]<
(LK ・wp[j]))、且つ、各々のノード角度tp[j-1],
tp[j]の符号が同じ場合、ノードPj-1 ,Pj が同一カ
ーブに属していると判定する。That is, the node interval Lp [j] is a predetermined value (L
K · wp [j] LK (constant) (Lp [j] <
(LK · wp [j])) and each node angle tp [j-1],
If the sign of tp [j] is the same, it is determined that the nodes Pj-1 and Pj belong to the same curve.
【0035】この条件に基づき、図7に示すノードPj-
1 ,Pj ,Pj+1 ,Pj+2 を調べると、これらは、同一
カーブに属していることになる。Based on this condition, the node Pj- shown in FIG.
When examining 1, Pj, Pj + 1, Pj + 2, they belong to the same curve.
【0036】ノード角度足し込み演算部27cは、カー
ブ構成ノード識別部27bで判断された同一カーブ上の
各ノードのノード角度を順に足し込んで、カーブ深さt
paを算出する。The node angle addition calculation unit 27c sequentially adds the node angles of the nodes on the same curve determined by the curve configuration node identification unit 27b, and calculates the curve depth t.
Calculate pa.
【0037】図7では、ノードPj でのカーブ深さtpa
は、 tpa=tp[j-1]+tp[j] となり、同様に、ノードPj+1 のカーブ深さtpaは、 tpa=tp[j-1]+tp[j]+tp[j+1] となり、ノードPj+2 のカーブ深さtpaは、 tpa=tp[j-1]+tp[j]+tp[j+1]+tp[j+2] となる。尚、図7に示すノードPj-1 は、カーブの始ま
りであるため、このノードPj-1 のカーブ深さtpaは、 tpa=tp[j-1] となる。In FIG. 7, the curve depth tpa at the node Pj
Is: tpa = tp [j-1] + tp [j] Similarly, the curve depth tpa of the node Pj + 1 is: tpa = tp [j-1] + tp [j] + tp [j + 1] The curve depth tpa of the node Pj + 2 is as follows: tpa = tp [j-1] + tp [j] + tp [j + 1] + tp [j + 2]. Since the node Pj-1 shown in FIG. 7 is at the beginning of the curve, the curve depth tpa of the node Pj-1 is tpa = tp [j-1].
【0038】更に、図6に示すように、一つのノードP
j で一つのカーブが構成されている場合は、このノード
Pj に関するカーブ深さtpaは、ノード角度tp[j]がそ
のまま代入され、 tpa=tp[j] となる。Further, as shown in FIG.
When one curve is constituted by j, the node angle tp [j] is directly substituted for the curve depth tp regarding this node Pj, and tpa = tp [j].
【0039】カーブ深さ補正部27dは、先ず、オフセ
ット角T_OFSET を算出する。図8に示すように、オフセ
ット角T_OFSET は、カーブ進入時に、ステアリングを操
作しなくても、カーブを実質的に走行することの可能な
角度であり、カーブ曲率半径rp[j]から半径方向外側に
1mの幅を道路の許容幅と仮定した場合、次式に基づき
算出する。 T_OFSET=COS-1 {rp[j]/(1+rp[j])} そして、基準値設定手段27aで設定した許容進入速度
基準値vap0 を、カーブ深さtpa、オフセット角T_OFSE
T 、カーブ曲率半径rp、路面摩擦係数推定部21で求
めた路面摩擦係数μにて補正して、許容進入速度vap1
(m/sec)を算出する。 vap1={vap02+1/(|tpa|−T_OFSET )2・|1/
rp[j] |2・(μ/vap1_k1 )}1/2 尚、本実施の形態では、vap1_k1 =2に設定されてい
る。The curve depth correction unit 27d first calculates an offset angle T_OFSET. As shown in FIG. 8, the offset angle T_OFSET is an angle at which the vehicle can substantially travel on the curve without operating the steering wheel when entering the curve, and is located radially outward from the curve radius of curvature rp [j]. If the width of 1 m is assumed to be the allowable width of the road, it is calculated based on the following equation. T_OFSET = COS -1 {rp [j] / (1 + rp [j])} Then, the allowable approach speed reference value vap0 set by the reference value setting means 27a is converted to the curve depth tpa and the offset angle T_OFSE.
T, the curve radius of curvature rp, and the road surface friction coefficient μ obtained by the road surface friction coefficient estimating unit 21 to correct the allowable approach speed vap1.
(m / sec) is calculated. vap1 = {vap0 2 + 1 / (| tpa | −T_OFSET) 2 · | 1 /
rp [j] | 2 · (μ / vap1_k1)} 1/2 In the present embodiment, vap1_k1 = 2.
【0040】その結果、図9に示すように、許容進入速
度vap1は、カーブ深さtpaがオフセット角T_OFSETまで
は最大値vapHに設定され、カーブ深さtpaがオフセッ
ト角T_OFSETより深くなるに従い、次第に許容進入速度
基準値vap0に漸近する特性に設定される。すなわち、
ここでは、許容進入速度vapを、カーブ深さtpaが深く
なるに従い、次第に低下させる補正を行う。As a result, as shown in FIG. 9, the allowable approach speed vap1 is set to the maximum value vapH until the curve depth tpa reaches the offset angle T_OFSET, and gradually increases as the curve depth tpa becomes deeper than the offset angle T_OFSET. The characteristic is set so as to approach the allowable approach speed reference value vap0. That is,
Here, a correction is made so that the allowable approach speed vap gradually decreases as the curve depth tpa increases.
【0041】タイトコーナ補正部27eは、ノードPj
におけるカーブがタイトコーナであり、カーブ曲率半径
rp[j]が道路幅wp[j]の所定割合rwkの値wk以下となる場
合には、許容進入速度Vap1をより大きな許容進入速度
Vap2に増大補正して極端に小さくならないようにす
る。これにより、タイトコーナを実際のカーブ曲率半径
よりもやや大きな旋回半径で走行(アウト−イン−アウ
ト)するような場合に、運転者の意に反した警報や減速
制御が実行されることが防止される。なお、この補正の
大きさをカーブ曲率半径rp[j]と道路幅wp[j]の比率に応
じて可変に設定してもよい。The tight corner correction unit 27e is connected to the node Pj
The curve at is a tight corner and the curve radius of curvature is
When rp [j] is equal to or less than the value wk of the predetermined ratio rwk of the road width wp [j], the allowable approach speed Vap1 is corrected to increase to a larger allowable approach speed Vap2 so as not to become extremely small. As a result, when the vehicle travels in a tight corner with a turning radius slightly larger than the actual radius of curvature (out-in-out), it is possible to prevent a warning or deceleration control against the driver from being executed. You. Note that the magnitude of this correction may be variably set according to the ratio between the curve curvature radius rp [j] and the road width wp [j].
【0042】また、他の例として道路幅wp[j]に応じた
所定値(ayl ・wp ・rwk)1/2 を、カーブ深さ補正部
27dで求めた許容進入速度vap1 と比較して、大きい
方を選択し、その選択した値を許容進入速度vap2 とし
て設定するようにしてもよい。As another example, a predetermined value (ayl.wp.rwk) 1/2 corresponding to the road width wp [j] is compared with an allowable approach speed vap1 obtained by the curve depth correction unit 27d. The larger one may be selected, and the selected value may be set as the allowable approach speed vap2.
【0043】この場合、ノードPjにおけるカーブがタ
イトコーナであり、カーブ曲率半径rp[j]が道路幅wp[j]
の所定割合rwkの値wk以下となるような状況では、道路
幅wp[j]に応じた所定値(ayl・wp・rwk) が選択され、
許容進入速度が極端に小さくならないようにガードされ
る。In this case, the curve at the node Pj is a tight corner, and the curve radius of curvature rp [j] is the road width wp [j].
In a situation where the predetermined ratio rwk is equal to or less than the predetermined ratio rwk, a predetermined value (ayl · wp · rwk) corresponding to the road width wp [j] is selected,
It is guarded that the allowable approach speed does not become extremely small.
【0044】ここで、設定割合rwk は,1,1.5,2,
3等、道路幅wp の定数倍を示す値(設定割合)で、固
定値であっても、可変値であっても良く、可変値の場合
は、カーブ方向、又は道路種別等に応じて可変設定す
る。Here, the set ratio rwk is 1, 1.5, 2,
A value (set ratio) indicating a constant multiple of the road width wp, such as 3, which may be a fixed value or a variable value. In the case of a variable value, the value is variable depending on the curve direction, road type, or the like. Set.
【0045】カーブ方向により設定割合rwkが可変設定
される場合、外カーブ(左側通行の国では右カーブ、右
側通行の国では左カーブ)の設定割合rwkを内カーブの
設定割合rwkよりも大きな値、例えば内カーブの設定割
合rwkを1(100%)とした場合、外カーブの設定割合rwk
を1.5(150%)に設定する。これは、外カーブを走行する
際には、内カーブを走行する場合に比し、カーブ曲率半
径rpよりもやや大きな旋回半径で走行することが可能
であり、カーブに対する許容進入速度を、内カーブより
も外カーブを高めに設定することで、実際の運転状況に
適合した制御を行うことができる。When the set ratio rwk is variably set depending on the curve direction, the set ratio rwk of the outer curve (right curve in a country traveling on the left side, left curve in a country traveling on the right) is set to a value larger than the set ratio rwk of the inner curve. For example, if the set ratio rwk of the inner curve is 1 (100%), the set ratio rwk of the outer curve
Is set to 1.5 (150%). This means that when traveling on an outer curve, it is possible to travel with a slightly larger turning radius than the curve radius of curvature rp, as compared with traveling on an inner curve. By setting the outer curve to be higher than that, it is possible to perform control suitable for the actual driving situation.
【0046】又、設定割合rwkを道路種別に応じて可変
設定する場合は、高速道路の設定割合rwkを一般道路の
設定割合rwkよりも大きな値、例えば、一般道路の設定
割合rwkを1.5(150%)とした場合、高速道路の設定割合
rwkを、その2倍の3(300%)に設定する。これは、道路
環境の良い高速道路では、道路幅に近いような急カーブ
は、実際には存在しないからである。When the set ratio rwk is variably set according to the type of road, the set ratio rwk of the expressway is set to a value larger than the set ratio rwk of the general road, for example, the set ratio rwk of the general road is set to 1.5 (150 %), The highway setting ratio rwk is set to twice (3% (300%)). This is because a sharp curve close to the road width does not actually exist on a highway with a good road environment.
【0047】速度平滑化補正部27fは、カーブ構成ノ
ード識別部27bにより同一カーブ上にあると識別され
たノード群について、各々の許容進入速度vap2 の平滑
化処理補正を行う。例えば、図7ではノードPj-1 ,P
j ,Pj+1 ,Pj+2 における各許容進入速度vap2[j-
1],vap2[j],vap2[j+1],vap2[j+2]について平滑化
処理補正が行われる。この場合、ノード間隔Lp[j]が所
定値(WK2・wp[j]WK2:定数)よりも大きいときは
(Lp[j]≧WK2・wp[j])、平均化処理補正を行わな
い。The speed smoothing correction unit 27f performs a smoothing process correction of each allowable approach speed vap2 for the node group identified as being on the same curve by the curve configuration node identification unit 27b. For example, in FIG. 7, nodes Pj−1, P
j, Pj + 1, and Pj + 2, each allowable approach speed vap2 [j-
1], vap2 [j], vap2 [j + 1], and vap2 [j + 2] are subjected to smoothing processing correction. In this case, if the node interval Lp [j] is larger than a predetermined value (WK2 · wp [j] WK2: constant) (Lp [j] ≧ WK2 · wp [j]), the averaging process correction is not performed.
【0048】平滑化処理補正を行う理由は以下の通りで
ある。一つのカーブ内でも、そのカーブを構成する複数
のノードのそれぞれの許容進入速度vap2には、ばらつ
きが存在し、そのままその中の最低値に基いて警報・減
速制御を行うと、極めて敏感な警報・減速制御となって
しまう。一方、それを防止するため、それらの複数ノー
ドの許容進入速度vap2 を単純平均化した値に対して警
報・減速制御を行うと、許容進入速度が大きなノードに
強く影響されて鈍感な警報・減速制御となってしまう。
本実施の形態では、これらを防止するため、各構成ノー
ドの許容進入速度vap2 について補正を行う。The reason for performing the smoothing process correction is as follows. Even within one curve, there is variation in the allowable approach speed vap2 of each of a plurality of nodes constituting the curve, and if the alarm / deceleration control is performed based on the lowest value among them, an extremely sensitive alarm・ Deceleration control is performed. On the other hand, if the warning / deceleration control is performed on the value obtained by simply averaging the allowable approach speeds vap2 of the plurality of nodes in order to prevent such a problem, the alarm / deceleration is insensitive because the node having a large allowable approach speed is strongly affected. It becomes control.
In the present embodiment, in order to prevent these, the allowable approach speed vap2 of each component node is corrected.
【0049】補正は、対象となるノードPj の許容進入
速度を、その許容進入速度と、その前後のノードPj+1
,Pj-1 の許容進入速度との平均値と比較し、中央値
をノードPj における最終的な許容進入速度vapとして
採用する。The correction is performed by calculating the allowable approach speed of the target node Pj, the allowable approach speed, and the nodes Pj + 1 before and after the allowable approach speed.
, Pj-1 and the average value with the allowable approach speed, and the median value is adopted as the final allowable approach speed vap at the node Pj.
【0050】すなわち、例えば、図7では、 1)ノードPj の許容進入速度vap2[j]を読み込み、 2)ノードPj の許容進入速度vap2[j]と次のノードP
j+1 の許容進入速度vap2[j+1]との平均値vap21を算出
し、 vap21=(vap2[j]+vap2[j+1])/2 3)ノードPj の許容進入速度vap2[j]と手前のノード
Pj-1 の許容進入速度vap2[j-1]との平均値vap20を算
出する。 vap20=(vap2[j-1]+vap2[j])/2 そして、各値vap2[j],vap21,vap20の中央値をノー
ドPj における最終的な許容進入速度vapとして採用す
る。That is, for example, in FIG. 7, 1) the allowable approach speed vap2 [j] of the node Pj is read, and 2) the allowable approach speed vap2 [j] of the node Pj and the next node P
An average value vap21 with the allowable approach speed vap2 [j + 1] of j + 1 is calculated, and vap21 = (vap2 [j] + vap2 [j + 1]) / 2 3) The allowable approach speed vap2 [j] of the node Pj An average value vap20 of the allowable approach speed vap2 [j-1] of the preceding node Pj-1 is calculated. vap20 = (vap2 [j-1] + vap2 [j]) / 2 Then, the median of the values vap2 [j], vap21, and vap20 is adopted as the final allowable approach speed vap at the node Pj.
【0051】但し、カーブ入り口に相当するノードにつ
いては、そのノードの許容進入速度と次のノードの許容
進入速度との平均値を採用し、又カーブ出口に相当する
ノードでは、そのノードの許容進入速度と、その許容進
入速度と手前のノードの許容進入速度との平均値とを比
較し、大きい方の値を採用する。However, for a node corresponding to the entrance of the curve, the average value of the allowable entry speed of the node and the allowable entry speed of the next node is adopted, and for the node corresponding to the exit of the curve, the allowable entry speed of that node is used. The speed is compared with the average value of the allowable approach speed and the allowable approach speed of the preceding node, and the larger value is adopted.
【0052】尚、平均値vap21,vap20は次式に示す一
般的な演算式により求めても良い。Incidentally, the average values vap21 and vap20 may be obtained by a general arithmetic expression shown in the following equation.
【0053】f(vap21)={f(vap2[j])+f(v
ap2[j+1])}/2 f(vap20)={f(vap2[j-1])+f(vap2[j])}
/2 この場合、例えばf(X)=X2 とすれば、上式は、 vap212 =(vap2[j]2 +vap2[j+1]2 )/2 vap202 =(vap2[j-1]2 +vap2[j]2 )/2 となり、平均値vap21,vap20を二乗値により求めるよ
うにしても良い。F (vap21) = {f (vap2 [j]) + f (v
ap2 [j + 1]) / 2 f (vap20) = {f (vap2 [j-1]) + f (vap2 [j])}
/ 2 In this case, if, for example, f (X) = X 2 , the above equation becomes: vap21 2 = (vap2 [j] 2 + vap2 [j + 1] 2 ) / 2 vap20 2 = (vap2 [j−1] 2 + vap2 [j] 2 ) / 2, and the average values vap21 and vap20 may be obtained from the square values.
【0054】又、警報速度演算記憶部28は、ナビゲー
ション装置7から送られたn個のノードのうち自車通過
直後のノード座標P0 から最遠点のノードPn-1 迄の全
てのノードについて、許容進入速度設定部27で設定し
た許容進入速度vap[j] 、前方道路属性演算記憶部25
に記憶されている各ノードでのノード間隔Lp[j]、及び
許容減速度設定部24で設定した許容減速度XgLimに基
づき、現自車位置での警報速度vw[j]を求める。The alarm speed calculation storage unit 28 stores the farthest node Pn-1 from the node coordinates P0 immediately after passing the own vehicle among the n nodes sent from the navigation device 7. For all the nodes up to this point, the allowable approach speed vap [j] set by the allowable approach speed setting unit 27 and the forward road attribute calculation storage unit 25
The alarm speed vw [j] at the current vehicle position is obtained based on the node interval Lp [j] of each node and the allowable deceleration XgLim set by the allowable deceleration setting unit 24 stored in the.
【0055】ここで、自車位置から各ノード迄の道のり
LL[j] は、j=1のとき、 LL[j] =(xp[1] 2 +yp[1] 2 )1/2 2≦j≦n-1 のとき、 LL[j] =LL[1] +Lp[2]+Lp[3]+・・・+Lp[j] となる。これより、各ノードに対する警報速度vw[j]
は、 vw[j]=(vap[j] 2 +2・(Kx ・XgLiM)・LL
[j] )1/2 で設定することができる。ここで、Kxは安全係数で、
本実施の形態では、0.5、すなわち、許容減速度XgLim
の50%を安全減速度としている。Here, the distance LL [j] from the vehicle position to each node is LL [j] = (xp [1] 2 + yp [1] 2 ) 1/2 2 ≦ j when j = 1. When ≤n- 1 , LL [j] = LL [1] + Lp [2] + Lp [3] +... + Lp [j]. From this, the alarm speed vw [j] for each node
Is: vw [j] = (vap [j] 2 + 2 · (Kx · XgLiM) · LL
[j]) Can be set in 1/2 . Where Kx is the safety factor,
In the present embodiment, 0.5, that is, the allowable deceleration XgLim
50% of safety deceleration.
【0056】警報判定出力部29は、警報速度演算記憶
部28で求めた各ノードに対する警報速度vw[j]の中で
最小の警報速度vw[j] と車速センサ5の出力信号に基
づいて算出した自車速度vとを比較し、更に、自車速度
vと最小警報速度vw[j] となる対象ノードでの許容進
入速度vap[j] とを比較する。The alarm judgment output unit 29 calculates the alarm speed vw [j] of the alarm speed vw [j] for each node obtained by the alarm speed calculation storage unit 28 and the output signal of the vehicle speed sensor 5. The vehicle speed v is compared with the vehicle speed v, and further, the vehicle speed v is compared with the allowable approach speed vap [j] at the target node having the minimum alarm speed vw [j].
【0057】そして、自車速度vが最小の警報速度vw
[j] より大きく、且つ自車速度vと許容進入速度vap
[j] との差が、許容値vk1(例えば、5km/h )以上の
とき、オーバスピード状態であると判定する。The own vehicle speed v is the minimum warning speed vw.
[j] greater than vehicle speed v and allowable approach speed vap
When the difference from [j] is equal to or larger than the allowable value vk1 (for example, 5 km / h), it is determined that the vehicle is in the overspeed state.
【0058】従って、例えば、図10に示すように、自
車が一定速度vで走行している場合、この自車速度vが
警報速度vw[j] に対して、オーバスピード気味のとき
は、早期に警報が発せられ、或いは減速制御が行われ
る。一方、許容進入速度vap[j] に対して自車速度vの
超過量が、許容値vk1以下のときは、自車位置と対象ノ
ードの位置とが極めて近接したときに、自車速度vが警
報速度vw[j] を越えるが、警報及び減速制御は行われ
ない。これは許容進入速度vapには、予め安全余裕値が
加味されているため、実際上は問題とならないからであ
る。Therefore, for example, as shown in FIG. 10, when the own vehicle is traveling at a constant speed v, when the own vehicle speed v is slightly overspeed with respect to the alarm speed vw [j], An alarm is issued early or deceleration control is performed. On the other hand, when the excess amount of the own vehicle speed v with respect to the allowable approach speed vap [j] is equal to or less than the allowable value vk1, when the own vehicle position is extremely close to the target node position, the own vehicle speed v Although the speed exceeds the warning speed vw [j], no warning or deceleration control is performed. This is because there is no practical problem since the allowable approach speed vap has a safety margin value added in advance.
【0059】減速判定出力部30は、警報判定出力部2
9で警報対象と判定された場合、所定時間(例えば、2
sec )経過しても、運転者が適切な減速操作を行わない
場合は、対象ノードに対して減速対象であると判定す
る。尚、本実施の形態では、ブレーキ圧センサ9からの
出力信号によりブレーキ圧を検出し、このブレーキ圧に
基づき、運転者のブレーキ操作が許容減速度設定部24
で設定した減速度を達成しているか否かを調べ、減速度
が達成されていないときは減速対象と判定する。The deceleration judgment output section 30 is provided with the alarm judgment output section 2
9, when it is determined to be an alarm target, a predetermined time (for example, 2
If the driver does not perform an appropriate deceleration operation after sec), it is determined that the target node is to be decelerated. In the present embodiment, the brake pressure is detected based on the output signal from the brake pressure sensor 9, and based on the brake pressure, the driver's brake operation can be performed by the allowable deceleration setting unit 24.
It is determined whether or not the deceleration set in the step is achieved. If the deceleration has not been achieved, it is determined that the vehicle is to be decelerated.
【0060】制御実行判断部31は、上述した警報判定
出力部29で警報対象と判定され、或いは減速判定出力
部30で減速対象と判定されたノードに対し、実際に制
御を許可するか否かを判断する。The control execution judging section 31 determines whether or not to actually permit the control of the node judged to be an alarm by the above-mentioned alarm judgment output section 29 or to be judged to be a deceleration object by the deceleration judgment output section 30. Judge.
【0061】すなわち、先ず、警報対象と判定されたノ
ードに対し、この対象ノードが実際の道路上に存在する
か否かを、例えば前方道路属性演算記憶部25に記憶さ
れている道路属性の中から対象ノードのカーブ曲率半径
rpを読込み、更に警報速度演算記憶部28に記憶され
ている対象ノードまでの道のりLLを読込み、このカー
ブ曲率半径rp と道のりLLとを、道路形状検出装置1
0にて認識した前方道路のカーブ具合とカーブ開始点ま
での距離とに対してそれぞれ照合し、これらが一致した
場合は、対象ノードが実際の道路上に存在すると判断
し、警報、或いは減速制御の実行許可を付与する。又、
一致しない場合は、ナビゲーション装置7のCD−RO
等の記憶手段に記憶されている地図中の道路情報が、そ
の後の道路の新設や改修工事などで実際の道路と異なっ
ていることが考えられるため、対象ノードに対する警
報、および減速制御の実行は禁止する。That is, first, for a node determined to be an alarm target, whether or not this target node exists on an actual road is determined, for example, in the road attribute stored in the forward road attribute calculation storage unit 25. From the target node, and the road LL to the target node stored in the alarm speed calculation storage unit 28 is read. The curve radii rp and the road LL are read from the road shape detecting device 1.
The degree of curve of the road ahead and the distance to the start point of the curve recognized at 0 are compared, and if they match, it is determined that the target node exists on the actual road, and a warning or deceleration control is performed. Permission to execute. or,
If they do not match, the CD-RO of the navigation device 7
Since the road information in the map stored in the storage means such as the road may be different from the actual road when a new road is constructed or renovated, the warning for the target node and the execution of the deceleration control are not performed. Ban.
【0062】そして、制御実行判断部31で、対象ノー
ドの警報制御、或いは減速制御の実行が許可されると、
警報判定出力29から、警報装置11に対して警報指令
信号を出力し、運転者に対してカーブに差し掛かってい
ることを報知し、運転者に注意を促す。又、減速判定出
力部30から、減速装置12に対して減速指令信号を出
力する。減速装置12では、減速判定出力部30からの
減速指令に従いトランスミッションのシフトダウン、エ
ンジントルクダウン、ブレーキ作動等により減速操作を
強制的に行う。When the control execution determining unit 31 permits the execution of the alarm control or the deceleration control of the target node,
An alarm command signal is output from the alarm determination output 29 to the alarm device 11 to notify the driver that the vehicle is approaching a curve, and call the driver's attention. Further, the deceleration determination output section 30 outputs a deceleration command signal to the speed reduction device 12. The deceleration device 12 forcibly performs a deceleration operation according to a deceleration command from the deceleration determination output unit 30 by downshifting the transmission, lowering the engine torque, operating the brake, and the like.
【0063】このように、本実施の形態では、前方道路
属性演算記憶部25で求めたカーブ曲率半径rp[j]が、
道路幅Wp[j]の設定割合rwk以下となるようなタイトコ
ーナであるときは、道路幅wp[j]に応じた所定値(ayl
・wp ・rwk)1/2 を許容進入速度vap2 として採用す
るようにしたので、許容進入速度vapが極端に小さく設
定されることが無くなり、実際の走行に反したわずらわ
しい警報を未然に防止することができる。As described above, in the present embodiment, the curve curvature radius rp [j] obtained by the front road attribute calculation storage unit 25 is:
In a tight corner where the road width Wp [j] is equal to or less than the set ratio rwk, a predetermined value (ayl) corresponding to the road width wp [j] is used.
・ Wp ・ rwk) 1/2 is adopted as the permissible approach speed vap2, so that the permissible approach speed vap is not set to be extremely small, and a troublesome alarm against actual driving is prevented beforehand. Can be.
【0064】又、所定割合rwkを道路状況に応じ、高速
道路では、一般道路よりも大きな値に設定することで、
実際の道路形状に適合した許容進入速度vapを設定する
ことができる。Also, by setting the predetermined ratio rwk to a larger value on an expressway than on a general road, according to the road conditions,
An allowable approach speed vap suitable for the actual road shape can be set.
【0065】なお、本実施の形態に係るカーブ進入制御
装置においては、カーブ曲率半径を、ナビゲーション装
置から送出されるノードデータに基づいて算出している
が、本発明はこれに限らず、ナビゲーション装置から直
接取得するもの、カメラやレーダー等の視覚センサから
の信号に基づいて演算するもの、高度道路交通システム
(ITS)等の外部システムから取得するもの等、いか
なる形態にも適用可能である。In the curve entry control device according to the present embodiment, the radius of curvature of the curve is calculated based on the node data transmitted from the navigation device. However, the present invention is not limited to this, and the navigation device is not limited to this. The present invention can be applied to any form, such as one obtained directly from a computer, one calculated based on a signal from a visual sensor such as a camera or a radar, and one obtained from an external system such as an intelligent transportation system (ITS).
【0066】[0066]
【発明の効果】本発明によれば、前方カーブの曲率半径
を算出し、カーブの曲率半径がカーブの道路幅に対して
設定割合以下のタイトコーナのときは、このカーブに対
する許容進入速度を増大補正するようにしたので、カー
ブ許容進入速度を実際の走行の旋回に応じた適正な値に
設定することが可能となり、カーブ許容進入速度が、実
際の走行状態に対して低すぎることにより生じる、わず
らわしい警報や減速制御を解消でき、運転者に与える違
和感を軽減することができる。According to the present invention, the radius of curvature of the front curve is calculated, and when the radius of curvature of the curve is a tight corner of a set ratio or less with respect to the road width of the curve, the allowable approach speed for this curve is increased and corrected. As a result, it is possible to set the curve allowable approach speed to an appropriate value according to the turning of the actual running, and it is troublesome that the curve allowable approach speed is too low with respect to the actual running state. Warnings and deceleration control can be eliminated, and discomfort given to the driver can be reduced.
【0067】この場合、この設定割合を、内カーブ走行
時よりも外カーブ走行時の方が大きな値になるように設
定することで、外カーブの許容進入速度を、実際の走行
に適合した値に設定することができ、運転者に与える違
和感を、一層軽減させることができる。In this case, by setting this set ratio such that the value when the outer curve travels is larger than that when the inner curve travels, the allowable approach speed of the outer curve is adjusted to a value suitable for the actual travel. , And the sense of discomfort given to the driver can be further reduced.
【0068】更に、この設定割合を、道路種別に応じて
可変設定することで、道路環境に応じた最適なカーブ許
容進入速度を設定することが可能となる。Further, by setting the set ratio variably according to the type of road, it becomes possible to set an optimum curve allowable approach speed according to the road environment.
【0069】又、少なくともカーブの曲率半径に基づい
て設定される許容進入速度と、少なくともカードの道路
幅に応じて設定される所定カード値とを比較し、大きい
方を許容進入速度として設定することで、実際の走行の
旋回半径に沿った適正な許容進入速度を設定することが
できる。Further, the allowable approach speed set based on at least the radius of curvature of the curve is compared with at least a predetermined card value set according to the road width of the card, and the larger one is set as the allowable approach speed. Thus, it is possible to set an appropriate allowable approach speed along the turning radius of the actual traveling.
【図1】カーブ進入制御装置に設けた制御部の機能ブロ
ック図FIG. 1 is a functional block diagram of a control unit provided in a curve entry control device.
【図2】許容進入速度設定部の機能ブロック図FIG. 2 is a functional block diagram of an allowable approach speed setting unit.
【図3】ナビゲーション装置から送出される情報の説明
図FIG. 3 is an explanatory diagram of information transmitted from a navigation device.
【図4】自車位置を基準としたノード座標の説明図FIG. 4 is an explanatory diagram of node coordinates based on the position of the vehicle;
【図5】カーブ曲率半径の算出方法を示す説明図FIG. 5 is an explanatory diagram showing a method of calculating a curve radius of curvature.
【図6】カーブが一つのノードで構成されている場合の
説明図FIG. 6 is an explanatory diagram in the case where a curve is composed of one node;
【図7】カーブが複数のノードで構成されている場合の
説明図FIG. 7 is an explanatory diagram when a curve is configured by a plurality of nodes;
【図8】カーブ進入時のオフセット角の算出方法を示す
説明図FIG. 8 is an explanatory diagram showing a method of calculating an offset angle when entering a curve.
【図9】カーブ深さと許容進入速度との関係を示す特性
図FIG. 9 is a characteristic diagram showing a relationship between a curve depth and an allowable approach speed.
【図10】自車速度と警報速度との関係を示す特性図FIG. 10 is a characteristic diagram showing a relationship between a vehicle speed and a warning speed.
【図11】タイトコーナを通過する際の自車走行ライン
の説明図FIG. 11 is an explanatory view of a vehicle traveling line when passing through a tight corner.
7 ナビゲーション装置 25 前方道路属性演算記憶部 26 許容横加速度設定部 27 許容進入速度設定部 ayl 許容横加速度 rp カーブ曲率半径 rwk 設定割合 tpa カーブ深さ vap 許容進入速度 Wp 道路幅 7 Navigation device 25 Forward road attribute calculation storage unit 26 Allowable lateral acceleration setting unit 27 Allowable approach speed setting unit ayl Allowable lateral acceleration rp Curve radius of curvature rwk Setting ratio tpa Curve depth vap Allowable approach speed Wp Road width
─────────────────────────────────────────────────────
────────────────────────────────────────────────── ───
【手続補正書】[Procedure amendment]
【提出日】平成12年8月7日(2000.8.7)[Submission Date] August 7, 2000 (2000.8.7)
【手続補正1】[Procedure amendment 1]
【補正対象書類名】明細書[Document name to be amended] Statement
【補正対象項目名】請求項4[Correction target item name] Claim 4
【補正方法】変更[Correction method] Change
【補正内容】[Correction contents]
【手続補正2】[Procedure amendment 2]
【補正対象書類名】明細書[Document name to be amended] Statement
【補正対象項目名】0010[Correction target item name] 0010
【補正方法】変更[Correction method] Change
【補正内容】[Correction contents]
【0010】第4のカーブ進入制御装置は、少なくとも
前方カーブの曲率半径に基いてそのカーブへの許容進入
速度を算出し、この許容進入速度に基いて警報あるいは
減速制御を行うカーブ進入制御装置において、少なくと
も上記曲率半径に基いて設定される許容進入速度と、少
なくとも上記カーブの道路幅に応じて設定される所定値
とを比較し、大きい方を許容進入速度として選択するこ
とを特徴とする。このような構成では、許容進入速度
を、カーブの曲率半径に基づいて設定する許容進入速度
と、少なくともカーブの道路幅に応じて設定する所定値
とを比較し、この許容進入速度とガード値との大きい方
を実際の許容進入速度として選択することで、実際の走
行旋回半径に沿った適切な許容進入速度を設定すること
ができる。The fourth curve entry control device calculates a permissible approach speed to the curve based on at least a radius of curvature of a forward curve, and performs a warning or deceleration control based on the permissible entry speed. Comparing at least the allowable approach speed set based on the radius of curvature with at least a predetermined value set according to the road width of the curve, and selecting a larger one as the allowable approach speed. Features. In such a configuration, by comparing the allowable approach speed, the allowable approach speed set based on the curvature radius of the curve, and a predetermined value <br/> to be set according to the road width of at least curves, the allowable approach By selecting the larger of the speed and the guard value as the actual allowable approach speed, it is possible to set an appropriate allowable approach speed along the actual traveling turning radius.
【手続補正3】[Procedure amendment 3]
【補正対象書類名】明細書[Document name to be amended] Statement
【補正対象項目名】0029[Correction target item name] 0029
【補正方法】変更[Correction method] Change
【補正内容】[Correction contents]
【0029】更に、許容横加速度aylは、例えば次式に
従って算出することができる。 ayl =ayl2・Kv ここで、Kvは車速補正係数であり、カーブ進入限界速
度が大きくなるに従い小さな値になるように設定されて
いる。すなわち、高速コーナリング走行時の安全性を高
めるために、カーブ進入限界速度の増加に伴いカーブで
の許容横加速度aylが低下するように補正される。Further, the allowable lateral acceleration ayl can be calculated, for example, according to the following equation. ayl = ayl2 · Kv Here, Kv is a vehicle speed correction coefficient, which is set to a smaller value as the curve approach limit speed increases. That is, in order to enhance the safety during high-speed code binary ring running, the allowable lateral acceleration ayl at a curve with increasing curve approach limit speed is corrected so as to decrease.
フロントページの続き Fターム(参考) 2F029 AA02 AB12 AC02 AC04 AC14 AC18 3D044 AA01 AA35 AB01 AC24 AC26 AC28 AC31 AC55 AC56 AD04 AD17 AD21 AE04 AE14 3D046 BB18 BB21 EE01 HH00 HH22 5H180 AA01 CC04 CC27 EE02 FF03 FF27 LL07 LL08 LL09 LL15Continued on the front page F term (reference) 2F029 AA02 AB12 AC02 AC04 AC14 AC18 3D044 AA01 AA35 AB01 AC24 AC26 AC28 AC31 AC55 AC56 AD04 AD17 AD21 AE04 AE14 3D046 BB18 BB21 EE01 HH00 HH22 5H180 AA01 CC04 CC27 EE02 LL03 LL03
Claims (4)
そのカーブへの許容進入速度を算出し、この許容進入速
度に基いて警報あるいは減速制御を行うカーブ進入制御
装置において、上記曲率半径が上記カーブの道路幅に対
して設定割合以下のとき、該カーブに対する許容進入速
度を増大補正することを特徴とするカーブ進入制御装
置。1. A curve approach control device which calculates an allowable approach speed to a curve based on at least a radius of curvature of a forward curve and performs an alarm or a deceleration control based on the allowable approach speed. A curve entry control device for increasing the allowable entry speed for the curve when the ratio is equal to or less than a set ratio with respect to the road width.
る場合より外カーブを走行する場合の方が大きな値に設
定されていることを特徴とする請求項1記載のカーブ進
入制御装置。2. The curve entry control device according to claim 1, wherein the set ratio is set to a larger value when the vehicle travels on an outer curve than when the vehicle travels on an inner curve. .
応じて可変に設定されていることを特徴とする請求項1
記載のカーブ進入制御装置。3. The method according to claim 1, wherein the setting ratio is variably set according to a road type of the curve.
The described curve approach control device.
そのカーブへの許容進入速度を算出し、この許容進入速
度に基いて警報あるいは減速制御を行うカーブ進入制御
装置において、少なくとも上記曲率半径に基いて設定さ
れる許容進入速度と、少なくとも上記カーブの道路幅に
応じて設定される所定ガード値とを比較し、大きい方を
許容進入速度として選択することを特徴とするカーブ進
入制御装置。4. A curve entry control device which calculates an allowable approach speed to a curve based on at least a radius of curvature of a forward curve, and performs an alarm or deceleration control based on the allowable approach speed. And comparing a permissible approach speed set at least with a predetermined guard value set according to at least the road width of the curve, and selecting a larger one as the permissible approach speed.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP26772899A JP3167992B2 (en) | 1999-09-21 | 1999-09-21 | Curve approach control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP26772899A JP3167992B2 (en) | 1999-09-21 | 1999-09-21 | Curve approach control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2001093094A true JP2001093094A (en) | 2001-04-06 |
JP3167992B2 JP3167992B2 (en) | 2001-05-21 |
Family
ID=17448753
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP26772899A Expired - Fee Related JP3167992B2 (en) | 1999-09-21 | 1999-09-21 | Curve approach control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3167992B2 (en) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002316600A (en) * | 2001-04-20 | 2002-10-29 | Honda Motor Co Ltd | Traveling safety device of vehicle |
JP2003016593A (en) * | 2001-06-28 | 2003-01-17 | Fuji Heavy Ind Ltd | Driving support device for vehicle |
EP1559994A2 (en) | 2004-01-30 | 2005-08-03 | Aisin Aw Co., Ltd. | Apparatus for predicting road shape and method of calculating a clothoid curve |
WO2006013645A1 (en) * | 2004-08-06 | 2006-02-09 | Hitachi, Ltd. | Vehicle attitude controlling device and method |
JP2007050794A (en) * | 2005-08-18 | 2007-03-01 | Toyota Motor Corp | Deceleration control device of vehicle |
JP2009051487A (en) * | 2007-07-31 | 2009-03-12 | Nissan Motor Co Ltd | Traveling control device for vehicle and traveling control method for vehicle |
US7765048B2 (en) | 2003-10-15 | 2010-07-27 | Nissan Motor Co., Ltd. | Deceleration control apparatus and method for automotive vehicle |
JP2011096103A (en) * | 2009-10-30 | 2011-05-12 | Toyota Motor Corp | Driving support device |
JP2012064121A (en) * | 2010-09-17 | 2012-03-29 | Aisin Aw Co Ltd | Driving support device, driving support method and computer program |
CN103413460A (en) * | 2013-07-17 | 2013-11-27 | 北京航空航天大学 | Bend driving early warning method based on vehicular access synergy |
US20150134222A1 (en) * | 2013-11-08 | 2015-05-14 | Hyundai Mobis Co., Ltd. | System for controlling speed of vehicle on curved road and method thereof |
-
1999
- 1999-09-21 JP JP26772899A patent/JP3167992B2/en not_active Expired - Fee Related
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002316600A (en) * | 2001-04-20 | 2002-10-29 | Honda Motor Co Ltd | Traveling safety device of vehicle |
JP2003016593A (en) * | 2001-06-28 | 2003-01-17 | Fuji Heavy Ind Ltd | Driving support device for vehicle |
JP4563619B2 (en) * | 2001-06-28 | 2010-10-13 | 富士重工業株式会社 | Vehicle driving support device |
US7765048B2 (en) | 2003-10-15 | 2010-07-27 | Nissan Motor Co., Ltd. | Deceleration control apparatus and method for automotive vehicle |
EP1559994A3 (en) * | 2004-01-30 | 2006-10-04 | Aisin Aw Co., Ltd. | Apparatus for predicting road shape and method of calculating a clothoid curve |
US7555385B2 (en) | 2004-01-30 | 2009-06-30 | Aisin Aw Co., Ltd. | Apparatus for predicting road shape |
EP1559994A2 (en) | 2004-01-30 | 2005-08-03 | Aisin Aw Co., Ltd. | Apparatus for predicting road shape and method of calculating a clothoid curve |
WO2006013645A1 (en) * | 2004-08-06 | 2006-02-09 | Hitachi, Ltd. | Vehicle attitude controlling device and method |
JP2007050794A (en) * | 2005-08-18 | 2007-03-01 | Toyota Motor Corp | Deceleration control device of vehicle |
JP2009051487A (en) * | 2007-07-31 | 2009-03-12 | Nissan Motor Co Ltd | Traveling control device for vehicle and traveling control method for vehicle |
JP2011096103A (en) * | 2009-10-30 | 2011-05-12 | Toyota Motor Corp | Driving support device |
JP2012064121A (en) * | 2010-09-17 | 2012-03-29 | Aisin Aw Co Ltd | Driving support device, driving support method and computer program |
CN103052865A (en) * | 2010-09-17 | 2013-04-17 | 爱信艾达株式会社 | Driving support device, driving support method, and computer program |
CN103052865B (en) * | 2010-09-17 | 2015-08-12 | 爱信艾达株式会社 | Driving support device, driving support method |
CN103413460A (en) * | 2013-07-17 | 2013-11-27 | 北京航空航天大学 | Bend driving early warning method based on vehicular access synergy |
US20150134222A1 (en) * | 2013-11-08 | 2015-05-14 | Hyundai Mobis Co., Ltd. | System for controlling speed of vehicle on curved road and method thereof |
US9168832B2 (en) * | 2013-11-28 | 2015-10-27 | Hyundai Mobis Co., Ltd. | System for controlling speed of vehicle on curved road and method thereof |
Also Published As
Publication number | Publication date |
---|---|
JP3167992B2 (en) | 2001-05-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3167987B2 (en) | Curve approach control device | |
JP3391745B2 (en) | Curve approach control device | |
JP3167989B2 (en) | Curve approach control device | |
US10081358B2 (en) | Lane departure prevention apparatus | |
JP3167993B2 (en) | Road shape estimation device and curve entry control device using the same | |
JP3092803B1 (en) | Curve approach speed control device | |
US10214211B2 (en) | Drive control apparatus | |
JP3167990B2 (en) | Curve approach control device | |
JP2001084498A (en) | Controller for entrance to curve | |
US20200391747A1 (en) | Vehicle control device | |
JP3167992B2 (en) | Curve approach control device | |
US7191046B2 (en) | Motion control apparatus for vehicle | |
JP4304258B2 (en) | VEHICLE DRIVE OPERATION ASSISTANCE DEVICE AND VEHICLE HAVING VEHICLE DRIVE OPERATION ASSISTANCE DEVICE | |
CN112313131B (en) | Driver assistance system and method for autopilot with automatic longitudinal guidance | |
JP7351076B2 (en) | Electric vehicle control method and electric vehicle control device | |
JP3365117B2 (en) | Control system for road conditions ahead of automobiles | |
JP3167991B2 (en) | Curve approach control device | |
JP3161264B2 (en) | Control system for road conditions ahead of automobiles | |
JP2006044590A (en) | Deceleration control device for vehicle | |
JP3365119B2 (en) | Control system for road conditions ahead of automobiles | |
JP3293385B2 (en) | Control system for road conditions ahead of automobiles | |
JPH08194893A (en) | Controller corresponding to road state ahead of automobile | |
JP3167988B2 (en) | Curve approach control device | |
JPH08194889A (en) | Controller corresponding to road state ahead of automobile | |
US20220212669A1 (en) | Vehicle control device, operation method of vehicle control device, and storage medium |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
TRDD | Decision of grant or rejection written | ||
R150 | Certificate of patent or registration of utility model |
Ref document number: 3167992 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080309 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090309 Year of fee payment: 8 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090309 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100309 Year of fee payment: 9 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100309 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110309 Year of fee payment: 10 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110309 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120309 Year of fee payment: 11 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120309 Year of fee payment: 11 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130309 Year of fee payment: 12 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130309 Year of fee payment: 12 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140309 Year of fee payment: 13 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
S533 | Written request for registration of change of name |
Free format text: JAPANESE INTERMEDIATE CODE: R313533 |
|
R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |