JP3432881B2 - Vehicle control device - Google Patents

Vehicle control device

Info

Publication number
JP3432881B2
JP3432881B2 JP02529594A JP2529594A JP3432881B2 JP 3432881 B2 JP3432881 B2 JP 3432881B2 JP 02529594 A JP02529594 A JP 02529594A JP 2529594 A JP2529594 A JP 2529594A JP 3432881 B2 JP3432881 B2 JP 3432881B2
Authority
JP
Japan
Prior art keywords
vehicle
road shape
vehicle speed
road
control means
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
JP02529594A
Other languages
Japanese (ja)
Other versions
JPH07234991A (en
Inventor
浩 関根
和也 田村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to JP02529594A priority Critical patent/JP3432881B2/en
Priority to US08/394,648 priority patent/US5661650A/en
Priority to GB9503676A priority patent/GB2286905B/en
Priority to DE19506364A priority patent/DE19506364C2/en
Publication of JPH07234991A publication Critical patent/JPH07234991A/en
Application granted granted Critical
Publication of JP3432881B2 publication Critical patent/JP3432881B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Traffic Control Systems (AREA)
  • Navigation (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、複数の座標点の集合よ
りなる地図情報に基づいて道路形状を判定し、判定した
道路形状に基づいて車両の走行を制御する車両制御装置
に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a vehicle control device for determining a road shape based on map information composed of a set of a plurality of coordinate points and controlling the traveling of a vehicle based on the determined road shape.

【0002】[0002]

【従来の技術】カーブの入口手前に設けた送信機から該
カーブをスムーズに通過するために必要な進入速度や操
舵角の情報を送信し、この情報に基づいて自動車の走行
状態を制御するもの(特開平3−149700号公報参
照)、或いはCD−ROMに記憶した道路の勾配、路面
状態、カーブ半径の情報に基づいて自動車のオートクル
ーズ装置等を制御するもの(特開平4−15799号公
報参照)が知られている。
2. Description of the Related Art A transmitter provided in front of an entrance of a curve transmits information on an approach speed and a steering angle necessary for smoothly passing through the curve, and controls a running state of an automobile based on the information. (See Japanese Patent Application Laid-Open No. 3-149700), or one that controls an auto-cruise device of a vehicle based on information of road gradient, road surface state, and curve radius stored in a CD-ROM (Japanese Patent Application Laid-Open No. 4-15799). (See) is known.

【0003】[0003]

【発明が解決しようとする課題】ところで、前者のもの
は設備費や維持費が嵩むために全ての道路に設置するこ
とが困難であり、また後者のものはデータ量が膨大にな
るために実現性が乏しいという問題がある。
By the way, the former one is difficult to install on all roads because of the high equipment cost and maintenance cost, and the latter one is feasible because the amount of data is huge. There is a problem that is scarce.

【0004】本発明は前述の事情に鑑みてなされたもの
で、複数の座標点の集合よりなる地図情報から判定した
道路形状に基づいて車両の走行状態を的確に制御するこ
とを目的とする。
The present invention has been made in view of the above circumstances, and it is an object of the present invention to accurately control the running state of a vehicle based on a road shape determined from map information composed of a set of a plurality of coordinate points.

【0005】[0005]

【課題を解決するための手段】前記目的を達成するため
に、請求項1に記載された発明は、道路を構成する複数
の座標点の集合としての地図情報を出力する地図情報出
力手段と、自車の車速を検出する車速検出手段と、道路
上の自車位置を出力する自車位置出力手段と、自車位置
よりも前方の道路上において略等間隔に離間す少なく
とも3個の基準座標点を抽出する基準座標点抽出手段
と、抽出した基準座標点に基づいて道路形状を判定する
道路形状判定手段と、判定した道路形状に基づいて車両
の走行を制御する車両制御手段とを備え、基準座標点抽
出手段は、これが抽出する基準座標点の相互間隔を、車
速が大きい場合には小さい場合よりもその相互間隔が粗
く設定されるように車速検出手段の検出車速に基づいて
調整することを特徴とする。
In order to achieve the above object, the invention described in claim 1 is a map information output means for outputting map information as a set of a plurality of coordinate points forming a road, vehicle speed detecting means for detecting a vehicle speed of the vehicle, and the vehicle position output means for outputting the vehicle position on the road, less you spaced at approximately equal intervals on the road ahead than the vehicle position <br/> A reference coordinate point extraction unit that extracts three reference coordinate points, a road shape determination unit that determines a road shape based on the extracted reference coordinate points, and a vehicle that controls the traveling of the vehicle based on the determined road shape. e Bei and control means, reference coordinate point extraction
The output means determines the mutual interval of the reference coordinate points extracted by the vehicle.
Larger velocities have less coarse spacing than smaller ones.
Based on the vehicle speed detected by the vehicle speed detection means
It is characterized by adjusting .

【0006】また請求項2に記載された発明は、請求項
1の構成に加えて、車両制御手段は操舵角或いは操舵ト
ルクを制御する操舵制御手段を有し、道路形状判定手段
により判定した道路形状に基づいて操舵制御手段が操舵
角或いは操舵トルクを制御することを特徴とする。
According to a second aspect of the invention, in addition to the structure of the first aspect, the vehicle control means has a steering control means for controlling a steering angle or a steering torque, and the road shape determination means determines the road. The steering control means controls the steering angle or the steering torque based on the shape.

【0007】また請求項3に記載された発明は、請求項
1の構成に加えて、車両制御手段はブレーキ装置或いは
オートクルーズ装置等からなる車速制御手段を有し、道
路形状判定手段により判定した道路形状に基づいて車速
制御手段が車速を制御することを特徴とする。
According to a third aspect of the present invention, in addition to the structure of the first aspect, the vehicle control means has a vehicle speed control means such as a brake device or an auto cruise device, and the road shape determination means determines the vehicle speed. The vehicle speed control means controls the vehicle speed based on the road shape.

【0008】また請求項4に記載された発明は、請求項
1の構成に加えて、車両制御手段は視覚表示手段或いは
聴覚表示手段を有し、道路形状判定手段により判定した
道路形状に基づいて視覚表示手段或いは聴覚表示手段が
乗員に警報することを特徴とする。
According to the invention described in claim 4, in addition to the structure of claim 1, the vehicle control means has visual display means or auditory display means, and based on the road shape determined by the road shape determination means. The visual display means or the auditory display means warns the occupant.

【0009】[0009]

【実施例】以下、図面に基づいて本発明の実施例を説明
する。
Embodiments of the present invention will be described below with reference to the drawings.

【0010】図1〜図4は本発明の第1実施例を示すも
ので、図1は本発明装置の全体構成を示すブロック図、
図2は制御系のブロック図、図3は操舵角の求め方を示
す説明図、図4は通過可能車速の求め方を示す説明図で
ある。
1 to 4 show a first embodiment of the present invention, and FIG. 1 is a block diagram showing the overall configuration of the device of the present invention,
2 is a block diagram of a control system, FIG. 3 is an explanatory diagram showing how to obtain a steering angle, and FIG. 4 is an explanatory diagram showing how to obtain a passable vehicle speed.

【0011】図1において、NVは自動車用ナビゲーシ
ョンシステムであって、その内部に周知の航法装置1、
ICカードやCD−ROMを用いた地図情報出力手段2
及び後述の種々の演算を行う制御部3を備える。
In FIG. 1, NV is a navigation system for automobiles, in which a well-known navigation device 1,
Map information output means 2 using an IC card or CD-ROM
And a control unit 3 for performing various calculations to be described later.

【0012】航法装置1は、衛星通信装置4或いは近接
通信装置5からの自車位置情報、道路情報、交通情報等
に加えて車速検出手段6からの信号を受け、これと前記
地図情報出力手段2からの地図情報とに基づいて、自車
の現在位置や目的地までの経路を演算し、これをマンマ
シンインターフェイス8を介してCRT9に表示する。
The navigation device 1 receives a signal from the vehicle speed detecting means 6 in addition to the vehicle position information, road information, traffic information, etc. from the satellite communication device 4 or the near field communication device 5, and the map information output means. Based on the map information from 2, the current position of the vehicle and the route to the destination are calculated and displayed on the CRT 9 via the man-machine interface 8.

【0013】地図情報出力手段2が出力する地図情報
は、道路上に配設された仮想的なノードNの集合から構
成されており、各ノードNはそれぞれ座標N(X,Y)
によって規定されている。
The map information output by the map information output means 2 is composed of a set of virtual nodes N arranged on the road, and each node N has a coordinate N (X, Y).
Stipulated by

【0014】制御部3は、航法装置1、地図情報出力手
段2及び車速検出手段6の出力に基づいて後述する種々
の演算を行い、その結果を表示するとともに警報、操舵
角制御及び車速制御を行う。
The control unit 3 performs various calculations which will be described later based on the outputs of the navigation device 1, the map information output means 2 and the vehicle speed detection means 6, displays the results, and performs warning, steering angle control and vehicle speed control. To do.

【0015】Cは車両制御装置であって、その内部に視
覚表示手段11、聴覚表示手段12、車速制御手段13
及び操舵制御手段14を備える。視覚制御手段11は例
えばヘッドアップディスプレイよりなり、前方のカーブ
の曲率半径や通過可能車速等を表示することにより乗員
に警報を発する。聴覚制御手段12はブザーやチャイム
よりなり、前記視覚表示手段11と共に乗員に種々の警
報を発する。車速制御手段13はブレーキ装置、オート
クルーズ装置、シフト制御装置、スロットル制御装置等
からなり、カーブを通過し得るように車速を自動的に調
整する。操舵制御手段14は操舵角や操舵トルクを制御
するステアリング装置からなり、カーブを通過し得るよ
うにステアリングを自動的に調整する。
Reference numeral C denotes a vehicle control device, which has a visual display means 11, an auditory display means 12, and a vehicle speed control means 13 therein.
And steering control means 14. The visual control means 11 is composed of, for example, a head-up display, and issues an alarm to an occupant by displaying a curvature radius of a curve in front and a vehicle speed at which the vehicle can pass. The hearing control means 12 comprises a buzzer and a chime, and together with the visual display means 11, issues various warnings to the occupant. The vehicle speed control means 13 is composed of a brake device, an auto cruise device, a shift control device, a throttle control device, etc., and automatically adjusts the vehicle speed so that it can pass through a curve. The steering control means 14 comprises a steering device that controls the steering angle and steering torque, and automatically adjusts the steering so that it can pass through a curve.

【0016】図2は本発明の制御系を示すブロック図で
あって、前記車速検出手段6に対応する車速検出手段M
1と、前記地図情報出力手段2に対応する地図情報出力
手段M2と、前記航法装置1に対応する自車位置出力手
段M3と、前記制御部3に対応する基準座標点抽出手段
M4及び道路形状判定手段M5と、前記車両制御装置C
に対応する車両制御手段M6とを備える。また、車両制
御手段M6は、前記操舵制御手段14に対応する操舵制
御手段M7と、前記車速制御手段13に対応する車速制
御手段M8と、前記視覚表示手段11に対応する視覚表
示手段M9と、前記聴覚表示手段12に対応する聴覚表
示手段M10とを備える。
FIG. 2 is a block diagram showing a control system of the present invention, which is a vehicle speed detecting means M corresponding to the vehicle speed detecting means 6.
1, map information output means M2 corresponding to the map information output means 2, own vehicle position output means M3 corresponding to the navigation device 1, reference coordinate point extraction means M4 corresponding to the control unit 3, and road shape. Determination means M5 and the vehicle control device C
And vehicle control means M6 corresponding to. Further, the vehicle control means M6 includes a steering control means M7 corresponding to the steering control means 14, a vehicle speed control means M8 corresponding to the vehicle speed control means 13, and a visual display means M9 corresponding to the visual display means 11. The auditory display means M10 corresponding to the auditory display means 12 is provided.

【0017】基準座標点抽出手段M4は、道路上に設定
された多数のノードNから道路形状を判定するための4
個のノードN1 ,N2 ,N3 ,N4 (以下、基準ノード
という)を抽出する。
The reference coordinate point extracting means M4 is used to determine the road shape from a large number of nodes N set on the road.
The nodes N 1 , N 2 , N 3 , and N 4 (hereinafter referred to as reference nodes) are extracted.

【0018】道路形状判定手段M5は、前記4個の基準
ノードN1 ,N2 ,N3 ,N4 の配列状態に基づいて道
路形状を判定する。
The road shape judging means M5 judges the road shape based on the arrangement state of the four reference nodes N 1 , N 2 , N 3 and N 4 .

【0019】次に、道路形状を判定して操舵制御を行う
場合の作用を説明する。
Next, the operation when the road shape is determined and the steering control is performed will be described.

【0020】先ず、車速検出手段M1から車速V0 を読
み込むとともに、地図情報出力手段M2から地図情報
(即ち、ノードNの座標(X,Y))を読み込み、更に
自車位置出力手段M3から自車位置を読み込む。
First, the vehicle speed V 0 is read from the vehicle speed detection means M1, the map information (that is, the coordinates (X, Y) of the node N) is read from the map information output means M2, and the own vehicle position output means M3 reads the map information. Read the car position.

【0021】次に、基準座標点抽出手段M4により、道
路形状を判定するための4個の基準ノードN1 〜N4
抽出する。図3に示すように、第2基準ノードN2 は自
車位置に設定され、第1基準ノードN1 は第2基準ノー
ドN2 の距離aだけ手前位置に、第3基準ノードN3
第2基準ノードN2 の距離aだけ前方位置に、第4基準
ノードN4 は第3基準ノードN3 の距離aだけ前方位置
にそれぞれ設定される。ここで、aは車速V0 と所定時
間t1 との積(a=V0 ×t1 )として設定される。
Next, the reference coordinate point extraction means M4, extracts four reference nodes N 1 to N 4 for determining the road shape. As shown in FIG. 3, the second reference node N 2 is set at the own vehicle position, the first reference node N 1 is at a position a distance a from the second reference node N 2 , and the third reference node N 3 is at the first position. The second reference node N 2 is set to the front position by the distance a, and the fourth reference node N 4 is set to the front position by the distance a of the third reference node N 3 . Here, a is set as the product of the vehicle speed V 0 and the predetermined time t 1 (a = V 0 × t 1 ).

【0022】このように、基準ノードN1 〜N4 間の距
離aを車速V0 に応じて設定することにより、車速V0
が大きい場合には基準ノードN1 〜N4 の間隔を粗く設
定し、道路形状を判定するための充分な演算時間を確保
することができる。
[0022] Thus, the distance a between the reference node N 1 to N 4 by setting in accordance with the vehicle speed V 0, the vehicle speed V 0
When is large, the intervals between the reference nodes N 1 to N 4 can be set roughly, and a sufficient calculation time for determining the road shape can be secured.

【0023】尚、仮自車位置を基準にして距離aの倍数
により設定される位置にノードNが存在しない場合に
は、その位置に最も近接したノードNが基準ノードN1
〜N4として抽出される。また、ノードNのデータが疎
であって距離aの範囲にノードNが存在しない場合に
は、連続する4個のノードNが基準ノードN1 〜N4
して抽出される。
If there is no node N at a position set by a multiple of the distance a with reference to the temporary vehicle position, the node N closest to the position is the reference node N 1
~ N 4 is extracted. When the data of the node N is sparse and the node N does not exist in the range of the distance a, four consecutive nodes N are extracted as the reference nodes N 1 to N 4 .

【0024】道路形状がカーブであって4個の基準ノー
ドN1 〜N4 が実質的に円弧上に存在していると仮定す
ると、道路形状判定手段M5により自車位置である第2
基準ノードN2 から次の第3基準ノードN3 への旋回角
度θが以下のようにして求められる。
Assuming that the road shape is a curve and that the four reference nodes N 1 to N 4 are substantially on a circular arc, the road shape determining means M 5 indicates the second position of the vehicle.
The turning angle θ from the reference node N 2 to the next third reference node N 3 is obtained as follows.

【0025】先ず、第1基準ノードN1 (X1 ,Y1
と第2基準ノードN2 (X2 ,Y2)とを結ぶベクトル
12(X12,Y12)と、第2基準ノードN2 (X2 ,Y
2 )と第3基準ノードN3 (X3 ,Y3 )とを結ぶベク
トルV23(X23,Y23)と、第3基準ノードN
3 (X3 ,Y3 )と第4基準ノードN4 (X4 ,Y4
とを結ぶベクトルV34(X34,Y34)とを演算する。
First, the first reference node N 1 (X 1 , Y 1 )
When the second reference node N 2 (X 2, Y 2 ) and the vector V 12 connecting (X 12, Y 12), the second reference node N 2 (X 2, Y
2 ) and the third reference node N 3 (X 3 , Y 3 ) connecting the vector V 23 (X 23 , Y 23 ), and the third reference node N 3.
3 (X 3 , Y 3 ) and the fourth reference node N 4 (X 4 , Y 4 ).
A vector V 34 (X 34 , Y 34 ) connecting with and is calculated.

【0026】このとき、ベクトルV12とベクトルV23
の成す角度をθ1 とすると、ベクトルV12及びベクトル
23の内積から、 X12・X23+Y12・Y23 =(X12 2 +Y12 2 1/2 ・(X23 2 +Y23 2 1/2 ・ cosθ1 …(1) が成立し、これから角度θ1 が求められる。
[0026] At this time, when the angle formed by the vector V 12 and the vector V 23 and theta 1, from the inner product of the vector V 12 and the vector V 23, X 12 · X 23 + Y 12 · Y 23 = (X 12 2 + Y 12 2 ) 1/2 · (X 23 2 + Y 23 2 ) 1/2 · cos θ 1 (1) holds, and the angle θ 1 is obtained from this.

【0027】また、ベクトルV23とベクトルV34との成
す角度をθ2 とすると、ベクトルV23及びベクトルV34
の内積から、 X23・X34+Y23・Y34 =(X23 2 +Y23 2 1/2 ・(X34 2 +Y34 2 1/2 ・ cosθ2 …(2) が成立し、これから角度θ2 が求められる。
Further, when the angle formed by the vector V 23 and the vector V 34 and theta 2, the vector V 23 and the vector V 34
From the inner product of, X 23 · X 34 + Y 23 · Y 34 = (X 23 2 + Y 23 2 ) 1/2 · (X 34 2 + Y 34 2 ) 1/2 · cos θ 2 … (2) The angle θ 2 is obtained.

【0028】これにより、第2基準ノードN2 から第3
基準ノードN3 への旋回角度θが、 θ=(θ1 +θ2 )/2 …(3) により求められ、また円弧の曲率半径Rが、 R=2a/(θ1 +θ2 ) …(4) により求められる。
As a result, the second reference node N 2 to the third reference node
The turning angle θ to the reference node N 3 is obtained by θ = (θ 1 + θ 2 ) / 2 (3), and the radius of curvature R of the arc is R = 2a / (θ 1 + θ 2 ) (4) ) Is required.

【0029】而して、第2基準ノードN2 から第3基準
ノードN3 へ旋回する際の操舵角θSTRGは、 θSTRG=(1+A・V0 2 )・b・N/R =(θ1 +θ2 )・(1+A・V0 2 )・b・N/2a …(5) A;スタビリティファクタ b;ホイールベース N;ステアリングギヤレシオ で与えられる。
Thus, the steering angle θ STRG when turning from the second reference node N 2 to the third reference node N 3 is θ STRG = (1 + A · V 0 2 ) · b · N / R = (θ 1 + θ 2 ) · (1 + A · V 0 2 ) · b · N / 2a (5) A; Stability factor b; Wheel base N; Steering gear ratio.

【0030】上述のようにして前方の道路にカーブの存
在が判定されると、視覚表示手段M9や聴覚表示手段M
10によりカーブの曲率半径Rや操舵角θSTRGが乗員に
報知されるとともに、カーブを確実に通過し得るように
操舵制御手段M7による自動操舵が行われる。
When it is determined that there is a curve on the road ahead as described above, the visual display means M9 and the auditory display means M are displayed.
The radius of curvature R of the curve and the steering angle θ STRG are notified to the occupant by means of 10, and automatic steering is performed by the steering control means M7 so that the vehicle can reliably pass through the curve.

【0031】このように複数のノードNの座標N(X,
Y)の集合よりなる地図情報に基づいて道路形状を判定
し、判定した道路形状に基づいて操舵角を制御している
ので、設備費や維持費が嵩むインフラストラクチャーの
整備を必要とせず、CD−ROMやICカードに記憶可
能な最小限のデータ量で車両の走行制御を行うことがで
きる。
Thus, the coordinates N (X, X,
Since the road shape is determined based on the map information composed of the set of Y) and the steering angle is controlled based on the determined road shape, it is not necessary to maintain an infrastructure that requires high equipment costs and maintenance costs. -Vehicle running control can be performed with a minimum amount of data that can be stored in a ROM or an IC card.

【0032】次に、道路形状を判定して車速制御を行う
場合の作用を説明する。
Next, the operation of determining the road shape and controlling the vehicle speed will be described.

【0033】車速制御を行う場合には4個の基準ノード
1 〜N4 の抽出のしかたが前記舵角制御を行う場合と
異なっている。即ち、図4に示すように、自車位置より
も先読距離Sだけ前方に仮自車位置が設定され、この仮
自車位置に第2基準ノードN2 が設定される。そして第
1基準ノードN1 は第2基準ノードN2 の距離aだけ手
前位置に、第3基準ノードN3 は第2基準ノードN2
距離aだけ前方位置に、第4基準ノードN4 は第3基準
ノードN3 の距離aだけ前方位置にそれぞれ設定され
る。前記先読距離Sは、車両が車速V0 から所定の減速
度βで減速した場合に所定時間t2 内に停止できる距離
として与えられる。
When the vehicle speed control is performed, the method of extracting the four reference nodes N 1 to N 4 is different from that when the steering angle control is performed. That is, as shown in FIG. 4, the temporary vehicle position is set ahead of the vehicle position by the read-ahead distance S, and the second reference node N 2 is set at this temporary vehicle position. The first reference node N 1 is in the front position by the distance a of the second reference node N 2 , the third reference node N 3 is in the front position by the distance a of the second reference node N 2 , and the fourth reference node N 4 is The distances a of the third reference node N 3 are set to the front positions. The read-ahead distance S is given as a distance that can be stopped within a predetermined time t 2 when the vehicle decelerates from the vehicle speed V 0 at a predetermined deceleration β.

【0034】 S=V0 ・t2 −(β・t2 2 /2) …(6) 上述した先読距離Sを設定することにより、判定した道
路形状に応じて減速を行う必要がある場合に、その時間
的余裕を与えることができる。
[0034] S = V 0 · t 2 - By setting the (β · t 2 2/2 ) ... (6) look-ahead distance S described above, if it is necessary to perform deceleration in accordance with the determined road shape Can afford that time.

【0035】さて、第2基準ノードN2 及び第3基準ノ
ードN3 間を基準横加速度α以下で通過するための通過
可能車速Vsは、道路の曲率半径をRとすると、 Vs=(R・α)1/2 …(7) で与えられ、これに前記式(4) を適用して、 Vs={2a・α/(θ1 +θ2 )}1/2 …(8) が得られる。即ち、車速V0 が前記通過可能車速Vs以
下であれば、車両は減速を行うことなく第2基準ノード
2 及び第3基準ノードN3 間のカーブを通過でき、車
速V0 が前記通過可能車速Vs以上であれば、通過可能
車速Vsまで減速しないと第2基準ノードN2 及び第3
基準ノードN3 間のカーブを通過でないことになる。
Now, the passable vehicle speed Vs for passing between the second reference node N 2 and the third reference node N 3 at a reference lateral acceleration α or less is Vs = (R · α) 1/2 (7), and by applying the above equation (4), Vs = {2a · α / (θ 1 + θ 2 )} 1/2 (8) is obtained. That is, if the vehicle speed V 0 is equal to or lower than the passable vehicle speed Vs, the vehicle can pass through the curve between the second reference node N 2 and the third reference node N 3 without decelerating, and the vehicle speed V 0 can pass through the curve. If the vehicle speed is Vs or higher, the second reference node N 2 and the third reference node N 2 must be decelerated to the passable vehicle speed Vs.
It does not pass through the curve between the reference nodes N 3 .

【0036】而して、前方の道路にカーブの存在が判定
されると、視覚表示手段M9や聴覚表示手段M10によ
りカーブの曲率半径Rや通過可能車速Vsが乗員に報知
され、車速V0 が通過可能車速Vsを上回っている場合
には、カーブを確実に通過し得るように車速制御手段M
8による自動減速が行われる。
When it is determined that there is a curve on the road ahead, the visual display means M9 and the auditory display means M10 inform the occupant of the radius of curvature R of the curve and the vehicle speed Vs at which the vehicle can pass, and the vehicle speed V 0 becomes When the vehicle speed Vs that can be passed is exceeded, the vehicle speed control means M is arranged so that the vehicle can surely pass the curve.
Automatic deceleration by 8 is performed.

【0037】上述したように、複数のノードNの座標N
(X,Y)の集合よりなる地図情報に基づいて道路形状
を判定し、判定した道路形状に基づいて車速を制御して
いるので、設備費や維持費が嵩むインフラストラクチャ
ーの整備を必要とせず、CD−ROMやICカードに記
憶可能な最小限のデータ量で車両の走行制御を行うこと
ができる。
As described above, the coordinates N of the plurality of nodes N
Since the road shape is determined based on the map information composed of a set of (X, Y) and the vehicle speed is controlled based on the determined road shape, there is no need to maintain an infrastructure that requires high equipment costs and maintenance costs. , The traveling control of the vehicle can be performed with the minimum amount of data that can be stored in the CD-ROM or the IC card.

【0038】ところで、上述した自動操舵や自動減速を
行う場合には自車が設定された経路上を走行しているこ
とが必要であり、乗員の意思により或いは誤りにより設
定経路を逸脱した場合にはシステムをOFFさせること
が望ましい。車両が設定経路を逸脱する可能性の有無は
次のようにして判定することができる。
By the way, in the case of performing the above-mentioned automatic steering or automatic deceleration, it is necessary that the own vehicle is traveling on the set route, and when the vehicle deviates from the set route by the intention of the occupant or by an error. It is desirable to turn off the system. Whether or not the vehicle may deviate from the set route can be determined as follows.

【0039】図3において、車両が第2基準ノードN2
から第3基準ノードN3 まで正しい経路上を旋回したと
き、車両の目標旋回角θはθ=(θ1 +θ2 )/2によ
り与えられる(式(3) 参照)。一方、車載のヨーレート
センサで検出した実ヨーレートdγ/dtを車両が第2
基準ノードN2 を通過してから第3基準ノードN3 に達
するまでの時間t1 (t1 =a/V0 )に亘って積分す
ることにより、車両の実旋回角γを求める。そして、目
標旋回角θ及び実旋回角γの偏差を|θ−γ|により演
算し、この偏差|θ−γ|が所定値以下であれば車両が
設定経路を逸脱する可能性がないと判定する。また、偏
差|θ−γ|が所定値を越えれば車両が設定経路を逸脱
する可能性があると判定し、乗員に警報を発することが
できる。
In FIG. 3, the vehicle is the second reference node N 2
The target turning angle θ of the vehicle is given by θ = (θ 1 + θ 2 ) / 2 when the vehicle makes a turn on the correct route from to the third reference node N 3 (see formula (3)). On the other hand, the vehicle determines the actual yaw rate dγ / dt detected by the vehicle-mounted yaw rate sensor as the second
The actual turning angle γ of the vehicle is obtained by integrating over the time t 1 (t 1 = a / V 0 ) from when the vehicle passes through the reference node N 2 until it reaches the third reference node N 3 . Then, the deviation between the target turning angle θ and the actual turning angle γ is calculated by | θ−γ |, and if this deviation | θ−γ | is less than or equal to a predetermined value, it is determined that the vehicle does not deviate from the set route. To do. Further, if the deviation | θ-γ | exceeds a predetermined value, it is determined that the vehicle may deviate from the set route, and an occupant can be alerted.

【0040】前記偏差|θ−γ|の限界は、例えば車両
が第2基準ノードN2 から第3基準ノードN3 までの距
離aを走行する間に、車両が道幅Wの道路から外れない
値として次式に基づいて設定することができる。
The limit of the deviation | θ-γ | is, for example, a value at which the vehicle does not deviate from the road having the road width W while the vehicle travels the distance a from the second reference node N 2 to the third reference node N 3. Can be set based on the following equation.

【0041】 a・|θ−γ|≦W/2 …(9) ところで、前記実施例では4個の基準ノードN1 〜N4
に基づいて道路形状を判定して車両制御を行っている
が、第1実施例の4個の基準ノードN1 〜N4 に代え
て、第2実施例では第4基準ノードN4 を除いた3個の
基準ノードN1 〜N3 が用いられる。
A · | θ−γ | ≦ W / 2 (9) In the above embodiment, four reference nodes N 1 to N 4 are used.
The vehicle shape is determined based on the road shape, and the vehicle control is performed. However, in place of the four reference nodes N 1 to N 4 of the first embodiment, the fourth reference node N 4 is removed in the second embodiment. three reference nodes N 1 to N 3 is used.

【0042】図5に示すように、ベクトルV12(X12
12)とベクトルV23(X23,Y23)との成す角度θ
は、次式に基づいて求められる。
As shown in FIG. 5, the vector V 12 (X 12 ,
The angle θ formed between Y 12 ) and the vector V 23 (X 23 , Y 23 ).
Is calculated based on the following equation.

【0043】 X12・X23+Y12・Y23 =(X12 2 +Y12 2 1/2 ・(X23 2 +Y23 2 1/2 ・ cosθ …(10) このようにして求めた角度θは、第1、第2基準ノード
1 ,N2 の中点から第2、第3基準ノードN2 ,N3
の中点への旋回角度に代わる近似値となる。従って、3
個の基準ノードN1 〜N3 を用いた場合には、前記式
(4) に代えて曲率半径R=a/θを用いることができ、
前記式(5) に代えて操舵角θSTRG=θ・(1+A・V0
2 )・b・N/aを用いることができ、前記式(8) に代
えて通過可能車速Vs=(a・α/θ)1/2 を用いるこ
とができる。
X 12 · X 23 + Y 12 · Y 23 = (X 12 2 + Y 12 2 ) 1/2 · (X 23 2 + Y 23 2 ) 1/2 · cos θ (10) The angle thus obtained θ is from the midpoint of the first and second reference nodes N 1 and N 2 to the second and third reference nodes N 2 and N 3.
It becomes an approximate value instead of the turning angle to the midpoint. Therefore, 3
When the number of reference nodes N 1 to N 3 is used, the above equation is used.
A radius of curvature R = a / θ can be used instead of (4),
Instead of the above equation (5), the steering angle θ STRG = θ · (1 + A · V 0
2 ) .b.N / a can be used, and instead of the above equation (8), the passable vehicle speed Vs = (a.α / θ) 1/2 can be used.

【0044】以上、本発明の実施例を詳述したが、本発
明は前記実施例に限定されるものでなく、種々の設計変
更を行うことが可能である。
Although the embodiments of the present invention have been described in detail above, the present invention is not limited to the above-mentioned embodiments, and various design changes can be made.

【0045】例えば、操舵制御を行う場合にも先読み区
間Sを設定することができる。この先読距離Sは車速V
0 と所定時間t2 とによりS=V0 ・t2 により設定さ
れ、その先読距離Sを車両が走行する間に目標舵角まで
操舵を行うことによりカーブを一層スムーズに通過する
ことができる。また、操舵制御を行う場合に操舵角に代
えて操舵トルクを制御しても良い。
For example, the look-ahead section S can be set even when steering control is performed. This look-ahead distance S is the vehicle speed V
It is set by S = V 0 · t 2 by 0 and the predetermined time t 2, and the vehicle can pass through the curve more smoothly by steering to the target steering angle while the vehicle travels the prefetch distance S. . Further, when performing the steering control, the steering torque may be controlled instead of the steering angle.

【0046】[0046]

【発明の効果】以上のように、請求項1に記載された発
明によれば、少なくとも3個の基準座標点に基づいて道
路形状を判定し、判定した道路形状に基づいて車両の走
行を制御しているので、設備費や維持費が嵩むインフラ
ストラクチャーの整備を必要とせず、しかもCD−RO
MやICカードに記憶可能な最小限のデータ量に基づい
て車両制御を行うことができる。また特に基準座標点抽
出手段は、これが抽出する基準座標点の相互間隔を、車
速が大きい場合には小さい場合よりもその相互間隔が粗
く設定されるように車速検出手段の検出車速に基づいて
調整しているので、車速が大きい場合には小さい場合よ
りも基準座標点の間隔を粗く設定することができ、従っ
て、車速が大きくても、道路形状を判定するための充分
な演算時間を確保することができる。
As described above, according to the invention described in claim 1, the road shape is determined based on at least three reference coordinate points, and the traveling of the vehicle is controlled based on the determined road shape. CD-RO because it does not require the maintenance of the infrastructure, which requires high equipment costs and maintenance costs.
The vehicle can be controlled based on the minimum amount of data that can be stored in the M or the IC card. Also, especially the reference coordinate point extraction
The output means determines the mutual interval of the reference coordinate points extracted by the vehicle.
Larger velocities have less coarse spacing than smaller ones.
Since the <br/> adjusted based on the detected vehicle speed in the vehicle speed detection means as Ku is set, if when the vehicle speed is large is small
It can be set roughly the distance of remote reference coordinate point, followed
Therefore , even if the vehicle speed is high, it is possible to secure a sufficient calculation time for determining the road shape.

【0047】また請求項2に記載された発明によれば、
道路形状判定手段により判定した道路形状に基づいて操
舵角或いは操舵トルクを制御しているので、カーブを通
過するための操舵を自動的に行うことができる。
According to the invention described in claim 2,
Since the steering angle or the steering torque is controlled based on the road shape determined by the road shape determination means, it is possible to automatically perform steering for passing a curve.

【0048】また請求項3に記載された発明によれば、
道路形状判定手段により判定した道路形状に基づいて車
速を制御しているので、カーブを適切な車速で確実に通
過することができる。
According to the invention described in claim 3,
Since the vehicle speed is controlled based on the road shape determined by the road shape determination means, it is possible to reliably pass through the curve at an appropriate vehicle speed.

【0049】また請求項4に記載された発明によれば、
道路形状判定手段により判定した道路形状に基づいて視
覚表示手段或いは聴覚表示手段が乗員に警報するので、
乗員にカーブ等の存在を予告して注意を促すことができ
る。
According to the invention described in claim 4,
Since the visual display means or the auditory display means warns the occupant based on the road shape determined by the road shape determination means,
It is possible to alert the occupant of the existence of a curve or the like and call attention.

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

【図1】本発明装置の全体構成を示すブロック図FIG. 1 is a block diagram showing the overall configuration of a device of the present invention.

【図2】制御系のブロック図FIG. 2 is a block diagram of a control system

【図3】操舵角の求め方を示す説明図FIG. 3 is an explanatory diagram showing how to determine a steering angle.

【図4】通過可能車速の求め方を示す説明図FIG. 4 is an explanatory diagram showing how to obtain a passable vehicle speed.

【図5】3個の基準ノードを用いた第2実施例の説明図FIG. 5 is an explanatory diagram of a second embodiment using three reference nodes.

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

M1 車速検出手段 M2 地図情報出力手段 M3 自車位置出力手段 M4 基準座標点抽出手段 M5 道路形状判定手段 M6 車両制御手段 M7 操舵制御手段 M8 車速制御手段 M9 視覚表示手段 M10 聴覚表示手段 N1 〜N4 基準ノード(基準座標点)M1 vehicle speed detection means M2 map information output means M3 own vehicle position output means M4 reference coordinate point extraction means M5 road shape determination means M6 vehicle control means M7 steering control means M8 vehicle speed control means M9 visual display means M10 auditory display means N 1 to N 4 reference node (reference coordinate point)

───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.7 識別記号 FI // B62D 101:00 B62D 137:00 137:00 G06F 15/40 310Z (56)参考文献 特開 平4−184215(JP,A) 特開 平5−141979(JP,A) 特開 平6−36187(JP,A) 特開 平5−80697(JP,A) 特開 平7−192194(JP,A) (58)調査した分野(Int.Cl.7,DB名) G08G 1/16 B60R 21/00 B60K 31/00 ─────────────────────────────────────────────────── ─── Continuation of front page (51) Int.Cl. 7 Identification code FI // B62D 101: 00 B62D 137: 00 137: 00 G06F 15/40 310Z (56) Reference JP-A-4-184215 (JP, A) JP-A-5-141979 (JP, A) JP-A-6-36187 (JP, A) JP-A-5-80697 (JP, A) JP-A-7-192194 (JP, A) (58) Survey Areas (Int.Cl. 7 , DB name) G08G 1/16 B60R 21/00 B60K 31/00

Claims (4)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】 道路を構成する複数の座標点の集合とし
ての地図情報を出力する地図情報出力手段(M2)と、 自車の車速を検出する車速検出手段(M1)と、 道路上の自車位置を出力する自車位置出力手段(M3)
と、 自車位置よりも前方の道路上において略等間隔に離間す
少なくとも3個の基準座標点(N1 〜N4 )を抽出す
る基準座標点抽出手段(M4)と、 抽出した基準座標点(N1 〜N4 )に基づいて道路形状
を判定する道路形状判定手段(M5)と、 判定した道路形状に基づいて車両の走行を制御する車両
制御手段(M6)とを備え、 基準座標点抽出手段(M4)は、これが抽出する基準座
標点(N 1 〜N 4 )の相互間隔(a)を、車速が大きい
場合には小さい場合よりもその相互間隔(a)が粗く設
定されるように車速検出手段(M1)の検出車速に基づ
いて調整する ことを特徴とする、車両制御装置。
1. A map information output means (M2) for outputting map information as a set of a plurality of coordinate points forming a road, a vehicle speed detection means (M1) for detecting a vehicle speed of a vehicle, and a vehicle on the road. Vehicle position output means (M3) for outputting the vehicle position
And at a substantially equal interval on the road ahead of the vehicle position.
Road shape determining at least three reference coordinate point with a reference coordinate point extraction means for extracting the (N 1 ~N 4) (M4 ), extracted reference coordinate point a road shape based on the (N 1 ~N 4) that and determination means (M5), e Bei and vehicle control means for controlling the travel of the vehicle based on the determined road shape (M6), the reference coordinate point extraction means (M4), the reference locus which extracts
The mutual speed (a) between the gauge points (N 1 to N 4 ) is set to a high vehicle speed.
In some cases, the mutual spacing (a) is set coarser than in the case of small
Based on the vehicle speed detected by the vehicle speed detection means (M1)
The vehicle control device is characterized in that it is adjusted .
【請求項2】 車両制御手段(M6)は操舵角或いは操
舵トルクを制御する操舵制御手段(M7)を有し、道路
形状判定手段(M5)により判定した道路形状に基づい
て操舵制御手段(M7)が操舵角或いは操舵トルクを制
御することを特徴とする、請求項1記載の車両制御装
置。
2. The vehicle control means (M6) has steering control means (M7) for controlling the steering angle or steering torque, and the steering control means (M7) is based on the road shape determined by the road shape determination means (M5). 2. The vehicle control device according to claim 1, wherein the control unit controls a steering angle or a steering torque.
【請求項3】 車両制御手段(M6)はブレーキ装置或
いはオートクルーズ装置等からなる車速制御手段(M
8)を有し、道路形状判定手段(M5)により判定した
道路形状に基づいて車速制御手段(M8)が車速を制御
することを特徴とする、請求項1記載の車両制御装置。
3. The vehicle control means (M6) is a vehicle speed control means (M) including a brake device or an auto cruise device.
8. The vehicle control device according to claim 1, further comprising 8), wherein the vehicle speed control means (M8) controls the vehicle speed based on the road shape determined by the road shape determination means (M5).
【請求項4】 車両制御手段(M6)は視覚表示手段
(M9)或いは聴覚表示手段(M10)を有し、道路形
状判定手段(M5)により判定した道路形状に基づいて
視覚表示手段(M9)或いは聴覚表示手段(M10)が
乗員に警報することを特徴とする、請求項1記載の車両
制御装置。
4. The vehicle control means (M6) has a visual display means (M9) or an auditory display means (M10), and the visual display means (M9) is based on the road shape determined by the road shape determination means (M5). Alternatively, the vehicle control device according to claim 1, wherein the audible display means (M10) warns an occupant.
JP02529594A 1994-02-23 1994-02-23 Vehicle control device Expired - Fee Related JP3432881B2 (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP02529594A JP3432881B2 (en) 1994-02-23 1994-02-23 Vehicle control device
US08/394,648 US5661650A (en) 1994-02-23 1995-02-22 System for controlling a vehicle relative to a judged shape of a travel road
GB9503676A GB2286905B (en) 1994-02-23 1995-02-23 Vehicle control system
DE19506364A DE19506364C2 (en) 1994-02-23 1995-02-23 Vehicle control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP02529594A JP3432881B2 (en) 1994-02-23 1994-02-23 Vehicle control device

Publications (2)

Publication Number Publication Date
JPH07234991A JPH07234991A (en) 1995-09-05
JP3432881B2 true JP3432881B2 (en) 2003-08-04

Family

ID=12162036

Family Applications (1)

Application Number Title Priority Date Filing Date
JP02529594A Expired - Fee Related JP3432881B2 (en) 1994-02-23 1994-02-23 Vehicle control device

Country Status (1)

Country Link
JP (1) JP3432881B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102009042915A1 (en) 2008-09-30 2010-04-01 Denso Corporation, Kariya-City Steering control device for a vehicle
CN101020453B (en) * 2006-02-13 2010-05-19 株式会社电装 Vehicle control system

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE69736216T2 (en) 1996-04-12 2007-05-16 Equos Research Co. Ltd. VEHICLE CONTROL
JP3247622B2 (en) * 1996-11-07 2002-01-21 本田技研工業株式会社 Vehicle control device
JPH10141102A (en) * 1996-11-12 1998-05-26 Honda Motor Co Ltd Vehicle control device
JP3850530B2 (en) * 1997-10-21 2006-11-29 富士重工業株式会社 Vehicle motion control device
JP4052279B2 (en) * 2004-04-23 2008-02-27 日産自動車株式会社 Deceleration control device
JP2006119028A (en) * 2004-10-22 2006-05-11 Denso Corp Road information transmission system
US9475588B2 (en) * 2010-12-14 2016-10-25 The Boeing Company Steering method for taxiing aircraft
JP5824994B2 (en) * 2011-09-13 2015-12-02 富士通株式会社 Traveling direction determination device, traveling direction determination method, and traveling direction determination program
JP5673597B2 (en) 2011-11-18 2015-02-18 株式会社デンソー Vehicle behavior control device
JP6058603B2 (en) * 2014-09-12 2017-01-11 アイシン精機株式会社 Vehicle control device
JP2018008550A (en) * 2016-07-11 2018-01-18 株式会社デンソー Steering control device
JP6662227B2 (en) * 2016-07-19 2020-03-11 株式会社デンソー Control device
CN108297876B (en) * 2017-08-22 2019-09-17 腾讯科技(深圳)有限公司 Travel speed control method, device, computer equipment and storage medium

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101020453B (en) * 2006-02-13 2010-05-19 株式会社电装 Vehicle control system
DE102009042915A1 (en) 2008-09-30 2010-04-01 Denso Corporation, Kariya-City Steering control device for a vehicle
DE102009042915B4 (en) 2008-09-30 2019-05-23 Denso Corporation Steering control device for a vehicle

Also Published As

Publication number Publication date
JPH07234991A (en) 1995-09-05

Similar Documents

Publication Publication Date Title
JP3223220B2 (en) Vehicle intercommunication device
US5661650A (en) System for controlling a vehicle relative to a judged shape of a travel road
JP3366096B2 (en) Vehicle travel control device
JP3432881B2 (en) Vehicle control device
JP4877773B2 (en) Vehicle travel control system
EP1136792B1 (en) Dangerous area alarm system
US5465089A (en) Method and apparatus for guidance of road condition
JP4193266B2 (en) Peripheral vehicle notification device
EP0745965B1 (en) A safe driving support system
CN102903254B (en) School regional safety device of advanced safety vehicle, and method thereof
JP3400584B2 (en) In-vehicle display device
US20100023232A1 (en) Vehicle travel speed control method
EP1637385A2 (en) A curve approach control apparatus
JP3062777B2 (en) Vehicle speed control device
JP3235522B2 (en) Travel lane departure warning device
JPH08147598A (en) Vehicle controller
EP0487280B1 (en) Method and apparatus for displaying road conditions
JP2006343904A (en) Driving support device
JPH04290200A (en) Collision alarming device for vehicle
JP3024478B2 (en) Constant speed cruise control device including navigation device
JP3366043B2 (en) Vehicle passing speed setting device
CN111210661A (en) Intersection vehicle anti-collision method and device
JP2003081038A (en) Alarm device for vehicle
JP3464794B2 (en) Vehicle curve warning device
JPH05126591A (en) Alarming apparatus for driving

Legal Events

Date Code Title Description
FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080523

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20090523

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20090523

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20100523

Year of fee payment: 7

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

Free format text: PAYMENT UNTIL: 20110523

Year of fee payment: 8

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

Free format text: PAYMENT UNTIL: 20110523

Year of fee payment: 8

LAPS Cancellation because of no payment of annual fees