JPH10111136A - Vehicle attitude detector - Google Patents
Vehicle attitude detectorInfo
- Publication number
- JPH10111136A JPH10111136A JP8264398A JP26439896A JPH10111136A JP H10111136 A JPH10111136 A JP H10111136A JP 8264398 A JP8264398 A JP 8264398A JP 26439896 A JP26439896 A JP 26439896A JP H10111136 A JPH10111136 A JP H10111136A
- Authority
- JP
- Japan
- Prior art keywords
- image
- yaw rate
- vehicle
- yaw angle
- yaw
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000006073 displacement reaction Methods 0.000 claims abstract description 52
- 238000012937 correction Methods 0.000 claims abstract description 18
- 238000001514 detection method Methods 0.000 claims abstract description 10
- 238000000034 method Methods 0.000 description 26
- 238000010586 diagram Methods 0.000 description 13
- 239000010720 hydraulic oil Substances 0.000 description 8
- 239000003921 oil Substances 0.000 description 8
- 238000001914 filtration Methods 0.000 description 7
- 230000035939 shock Effects 0.000 description 3
- 239000006096 absorbing agent Substances 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 238000013016 damping Methods 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000012447 hatching Effects 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
Landscapes
- Steering-Linkage Mechanisms And Four-Wheel Steering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
Description
【0001】[0001]
【発明の属する技術分野】本発明は車両位置検出装置に
関し、車両前方の撮像画像から走行路に対する車両の相
対関係を検出する車両姿勢検出装置に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a vehicle position detecting device, and more particularly, to a vehicle attitude detecting device for detecting a relative relationship of a vehicle to a traveling path from an image captured in front of the vehicle.
【0002】[0002]
【従来の技術】従来から、車両前方の道路を撮像した画
像から走行すべき走行路に対する車両位置を検出するこ
とが行われている。例えば、特開平7−105498号
公報には、車両前方の道路を撮像した画像から白線等を
検出して自車の走行路の側縁を検出すると共に、車速及
び操舵角から自車の進行方向を推定し、この推定進行路
と走行路の側縁とが交わる角度及び交点までの距離を求
め、走行路からの逸脱を予測して逸脱を防止すべく修正
操舵を行う。2. Description of the Related Art Conventionally, a vehicle position with respect to a traveling road to be traveled has been detected from an image of a road ahead of the vehicle. For example, Japanese Unexamined Patent Publication No. 7-105498 discloses a method in which a white line or the like is detected from an image of a road ahead of a vehicle to detect a side edge of a traveling road of the vehicle, and a traveling direction of the vehicle is determined based on a vehicle speed and a steering angle. Is estimated, the angle between the estimated traveling path and the side edge of the traveling path and the distance to the intersection are obtained, the deviation from the traveling path is predicted, and corrective steering is performed to prevent the deviation.
【0003】[0003]
【発明が解決しようとする課題】車両前方を撮像した画
像から自車の走行すべき走行路を認識する場合、路面の
凹凸などにより撮像した画像に揺れ等のばらつきが生
じ、自車の走行路の検出に誤差が生じ、この誤差を持つ
検出走行路に基づいて修正操舵制御を行うと、車両に不
要な動きが発生し、ドライバビリティーが悪化するとい
う問題があった。When recognizing a traveling road on which the vehicle should travel from an image captured in front of the vehicle, the captured image varies due to unevenness of the road surface and the like. If correction steering control is performed based on a detected traveling path having this error, unnecessary movement occurs in the vehicle, and the drivability deteriorates.
【0004】本発明は上記の点に鑑みなされたもので、
撮像画像から検出したヨー角又は横変位にばらつきが生
じたとき、ヨーレート又は車速の横方向成分の積分値を
用いて補正することにより、路面の凹凸による画像の揺
れからヨー角又は横変位に生じたばらつきを補正し誤り
のないヨー角又は横変位を検出できる車両姿勢検出装置
を提供することを目的とする。[0004] The present invention has been made in view of the above points,
When variations occur in the yaw angle or lateral displacement detected from the captured image, correction is performed using the integral value of the lateral component of the yaw rate or vehicle speed. It is an object of the present invention to provide a vehicle attitude detecting device which can correct the variation and detect the yaw angle or the lateral displacement without error.
【0005】[0005]
【課題を解決するための手段】請求項1に記載の発明
は、図1(A)に示すように、車両前方を撮像した画像
から走行路に対する車両の相対関係としてヨー角を検出
するヨー角検出手段M1を有する車両姿勢検出装置にお
いて、車両のヨーレートを検出するヨーレート検出手段
M2と、上記ヨー角のばらつきが発生したとき、上記ヨ
ー角を上記ヨーレート検出手段で得たヨーレートの積分
値を用いて補正するヨーレート補正手段M3とを有す
る。According to the first aspect of the present invention, as shown in FIG. 1A, a yaw angle for detecting a yaw angle as a relative relation of a vehicle to a traveling road from an image taken in front of the vehicle. In a vehicle attitude detecting device having a detecting means M1, a yaw rate detecting means M2 for detecting a yaw rate of a vehicle and an integrated value of the yaw rate obtained by the yaw rate detecting means when the variation of the yaw angle occurs are used. And a yaw rate correction means M3 for performing correction.
【0006】このため、画像の揺れにより画像から検出
したヨー角にばらつきが生じたとき、画像の揺れの影響
を受けないヨーレート検出手段で得たヨーレートの積分
値を用いて上記ヨー角を補正するため、ばらつきを除去
した誤りのないヨー角を得ることができる。For this reason, when the yaw angle detected from the image fluctuates due to the fluctuation of the image, the yaw angle is corrected using the integrated value of the yaw rate obtained by the yaw rate detecting means which is not affected by the fluctuation of the image. Therefore, it is possible to obtain an error-free yaw angle from which variations have been removed.
【0007】請求項2に記載の発明は、図1(B)に示
すように、車両前方を撮像した画像から走行路に対する
車両の相対関係として車両の横方向の変位量である横変
位を検出する横変位検出手段M4を有する車両姿勢検出
装置において、車両の速度を検出する車速検出手段M5
と、上記横変位のばらつきが発生したとき、上記横変位
を上記車速検出手段で得た車速の横方向成分の積分値を
用いて補正する横変位補正手段M6とを有する。According to a second aspect of the present invention, as shown in FIG. 1B, a lateral displacement, which is a lateral displacement of the vehicle, is detected from an image taken in front of the vehicle as a relative relationship of the vehicle to a traveling road. In a vehicle attitude detecting device having a lateral displacement detecting means M4, a vehicle speed detecting means M5 for detecting a speed of a vehicle.
And a lateral displacement correcting means M6 for correcting the lateral displacement using the integral value of the lateral component of the vehicle speed obtained by the vehicle speed detecting means when the variation of the lateral displacement occurs.
【0008】このため、画像の揺れにより画像から検出
した横変位にばらつきが生じたとき、画像の揺れの影響
を受けない車速検出手段で得た車速の横方向成分の積分
値を用いて上記横変位を補正するため、ばらつきを除去
した誤りのない横変位を得ることができる。For this reason, when the lateral displacement detected from the image varies due to the image swing, the lateral displacement is calculated using the integral value of the lateral component of the vehicle speed obtained by the vehicle speed detecting means which is not affected by the image shake. In order to correct the displacement, it is possible to obtain an error-free lateral displacement from which variations have been removed.
【0009】[0009]
【発明の実施の形態】図2は本発明装置の一実施例の構
成図を示す。同図中、前輪操舵機構Aは操舵ハンドル1
1を有しており、この操舵ハンドル11は操舵軸12を
介してピニオンギヤ13に接続されている。このピニオ
ンギヤ13はラックバー14と噛合し、操舵ハンドル1
1の回転運動をラックバー14の往復運動に変換して伝
達するものである。ラックバー14の両端には左右タイ
ロッド15a,15b及び左右ナックルアーム16a,
16bを介して左右前輪FW1,FW2が操舵可能に連
結されている。FIG. 2 is a block diagram showing an embodiment of the apparatus according to the present invention. In the figure, the front wheel steering mechanism A is a steering wheel 1
The steering wheel 11 is connected to a pinion gear 13 via a steering shaft 12. The pinion gear 13 meshes with a rack bar 14 to control the steering wheel 1.
1 is converted into a reciprocating motion of the rack bar 14 and transmitted. Left and right tie rods 15a, 15b and left and right knuckle arms 16a,
Left and right front wheels FW1 and FW2 are steerably connected via 16b.
【0010】又、ラックバー14は操舵ハンドル11の
回動による軸方向の変位に応じて左右前輪FW1,FW
2を操舵する。操舵軸12の中間には四方弁からなる制
御バルブ17が組み付けられている。制御バルブ17
は、操舵軸12に作用する操舵トルクに応じて、エンジ
ン18により駆動される油圧ポンプ21からの作動油を
パワーシリンダ22の一方の油室へ供給するとともに、
パワーシリンダ22の他方の油室内の作動油をリザーバ
23へ排出するように機能する。パワーシリンダ22
は、作動油の吸排に応じてラックバー14を軸方向に駆
動することにより、左右前輪FW1,FW2の操舵を助
勢する。[0010] The rack bar 14 is driven by the left and right front wheels FW1 and FW in accordance with the axial displacement caused by the rotation of the steering handle 11.
Steer 2 A control valve 17 composed of a four-way valve is mounted in the middle of the steering shaft 12. Control valve 17
Supplies hydraulic oil from a hydraulic pump 21 driven by an engine 18 to one oil chamber of a power cylinder 22 in accordance with a steering torque acting on a steering shaft 12.
It functions to discharge the hydraulic oil in the other oil chamber of the power cylinder 22 to the reservoir 23. Power cylinder 22
Assists the steering of the left and right front wheels FW1 and FW2 by driving the rack bar 14 in the axial direction according to the intake and discharge of the hydraulic oil.
【0011】操舵トルク可変装置25は路面から直接伝
達される衝撃やステアリング系の振動を減衰させるため
のショックアブソーバ(ステアリングダンパ)であり、
ショックアブソーバのオリフィス径を可変することによ
り減衰係数を可変して操舵トルクを可変する。The steering torque varying device 25 is a shock absorber (steering damper) for attenuating a shock transmitted directly from a road surface and a vibration of a steering system.
The steering torque is varied by varying the damping coefficient by varying the orifice diameter of the shock absorber.
【0012】後輪操舵機構Bは、ラックバー14と同様
に軸方向に変位して左右後輪RW1,RW2を操舵する
リレーロッド31を有する。リレーロッド31の両端に
は、前記前輪操舵機構Aの場合と同様に、左右タイロッ
ド32a,32b及び左右ナックルアーム33a,33
bを介して左右後輪RW1,RW2が操舵可能に連結さ
れている。The rear wheel steering mechanism B has a relay rod 31 that is displaced in the axial direction and steers the left and right rear wheels RW1, RW2 similarly to the rack bar 14. The left and right tie rods 32a, 32b and the left and right knuckle arms 33a, 33 are provided at both ends of the relay rod 31, as in the case of the front wheel steering mechanism A.
The left and right rear wheels RW1 and RW2 are steerably connected via b.
【0013】リレーロッド31は車体に支持されたハウ
ジング34により軸方向に変位可能に支持され、ハウジ
ング34内にはパワーシリンダ35が形成されている。
パワーシリンダ35は作動油の吸排に応じてリレーロッ
ド31を軸方向へ駆動するものであり、リレーロッド3
1に固定されたピストン35aにより左右油室35b,
35cに区画されている。これらの左右油室35b,3
5c内にはスプリング36a,36bがプレロードを付
与された状態でリレーロッド31を貫通させるようにし
て組み込まれており、スプリング36a,36bはそれ
らの弾発力によりリレーロッド31を中立位置に附勢し
ている。The relay rod 31 is axially displaceably supported by a housing 34 supported by the vehicle body. A power cylinder 35 is formed in the housing 34.
The power cylinder 35 drives the relay rod 31 in the axial direction in accordance with the suction and discharge of hydraulic oil.
The left and right oil chambers 35b,
35c. These left and right oil chambers 35b, 3
5c has springs 36a and 36b incorporated therein so as to penetrate the relay rod 31 in a preloaded state, and the springs 36a and 36b urge the relay rod 31 to a neutral position by their elastic force. doing.
【0014】また、ハウジング34内には、パワーシリ
ンダ35とともに油圧倣い機構を構成するスプールバル
ブ37が組み込まれている。このスプールバルブ37は
ハウジング34内に軸方向に液密的且つ摺動可能に収容
されたバルブスリーブ37aと、ハウジング34に固定
されたバルブスリーブ37bと、からなり、バルブスリ
ーブ37aの左方向への変位に応じて、エンジン18に
より駆動される油圧ポンプ38からの作動油をパワーシ
リンダ35の左油室35bへ供給するとともに、パワー
シリンダ35の右油室35c内の作動油をリザーバ23
へ排出する。又、バルブスリーブ37aが右方向へ変位
すると、スプールバルブ37は油圧ポンプ38からの作
動油をパワーシリンダ35の右油室35cへ供給すると
ともに、パワーシリンダ35の左油室35b内の作動油
をリザーバ23へ排出する。In the housing 34, a spool valve 37 constituting a hydraulic copying mechanism together with the power cylinder 35 is incorporated. The spool valve 37 includes a valve sleeve 37a accommodated in the housing 34 in a liquid-tight and slidable manner in the axial direction, and a valve sleeve 37b fixed to the housing 34. In accordance with the displacement, hydraulic oil from a hydraulic pump 38 driven by the engine 18 is supplied to the left oil chamber 35b of the power cylinder 35, and hydraulic oil in the right oil chamber 35c of the power cylinder 35 is supplied to the reservoir 23.
Discharge to When the valve sleeve 37a is displaced rightward, the spool valve 37 supplies the hydraulic oil from the hydraulic pump 38 to the right oil chamber 35c of the power cylinder 35, and supplies the hydraulic oil in the left oil chamber 35b of the power cylinder 35. Discharge to reservoir 23.
【0015】バルブスリーブ37aの右端部には、貫通
孔37a1 が設けられており、貫通孔37a1 にはレバ
ー41が貫通されている。レバー41の中間部分には球
型の節状***部41aが設けられ、レバー41は節状隆
起部41aの外周面にて貫通孔37a1 の内周面に傾動
且つ摺動可能に係合している。又、レバー41の下端部
はピストン35aの外周上に設けた環状溝35a1 内に
回動可能且つ上下方向に摺動可能に嵌合され、レバー4
1の上端部はピン42に回動可能に接続されている。[0015] the right end portion of the valve sleeve 37a has a through hole 37a 1 is provided, the lever 41 is in the through-holes 37a 1 are through. The intermediate portion of the lever 41 is provided nodose ridges 41a of the spherical, lever 41 is tilted and slidably engaged with the inner peripheral surface of the through hole 37a 1 at the outer peripheral surface of the nodular elevations 41a ing. Further, the lower end portion of the lever 41 is slidably fitted in the annular groove 35a 1 provided on the outer periphery of the piston 35a to be rotatable and vertically, the lever 4
The upper end of 1 is rotatably connected to a pin 42.
【0016】ピン42の両端部は、ハウジング34に設
けた支持孔34a,34b内に進退可能且つ回転不能に
侵入している。又、ピン42の外周上にはラック歯42
aが形成され、ラック歯42aにはステップモータ43
の回転軸に固定されたウォーム44が噛合している。こ
の場合、ステップモータ43が右回転又は左回転すると
ピン42は右方向又は左方向に変位するようになってい
る。Both ends of the pin 42 enter the support holes 34a and 34b formed in the housing 34 so as to be able to advance and retreat and not to rotate. In addition, rack teeth 42
a is formed, and the stepping motor 43 is provided on the rack teeth 42a.
The worm 44 fixed to the rotation shaft of the gear is engaged. In this case, when the step motor 43 rotates clockwise or counterclockwise, the pin 42 is displaced rightward or leftward.
【0017】電子制御回路(ECU)50には操舵トル
クセンサ51、後輪操舵角センサ54、ヨー角検出手段
M1及び横変位検出手段M4としてのガイドライン認識
手段62、車速検出手段M5としての車速センサ65及
びヨーレートを検出するヨーレート検出手段M2として
のヨーレートセンサ66及び前輪の操舵角を検出する操
舵角センサ67が接続されている。The electronic control circuit (ECU) 50 includes a steering torque sensor 51, a rear wheel steering angle sensor 54, a guide line recognition means 62 as a yaw angle detection means M1 and a lateral displacement detection means M4, and a vehicle speed sensor as a vehicle speed detection means M5. A yaw rate sensor 66 as a yaw rate detecting means M2 for detecting a yaw rate 65 and a steering angle sensor 67 for detecting a steering angle of a front wheel are connected.
【0018】操舵トルクセンサ51は操舵軸12に加わ
るトルクを検出して操舵トルクMTを表わす信号をEC
U50に供給する。後輪操舵角センサ54はステップモ
ータ43の回転角を測定して後輪操舵角θrを表わす信
号をECU50に供給する。ガイドライン認識手段62
は車両の進行方向前方の道路を撮像した道路画像をカメ
ラ64から供給され、この道路画像を処理して道路の中
央又は路側の白線や黄色の追越し禁止線等のガイドライ
ンを認識し、このガイドラインに基づいて走行車線を認
識し、図4に示す横変位X及びヨー角(画像ヨー角)θ
を検出する。また、これと共に道路のカーブの曲率半径
R等の走行環境情報を検出する。この横変位X,画像ヨ
ー角θ及びカーブの曲率半径Rは走行環境情報ECUで
ある電子制御装置50に供給される。The steering torque sensor 51 detects a torque applied to the steering shaft 12 and outputs a signal representing the steering torque MT to the EC.
Supply to U50. The rear wheel steering angle sensor 54 measures the rotation angle of the step motor 43 and supplies a signal representing the rear wheel steering angle θr to the ECU 50. Guideline recognition means 62
Is supplied from the camera 64 with a road image obtained by imaging a road ahead in the traveling direction of the vehicle. The road image is processed to recognize a guideline such as a white line or a yellow overtaking prohibition line at the center or the roadside of the road. The travel lane is recognized based on the lateral displacement X and the yaw angle (image yaw angle) θ shown in FIG.
Is detected. At the same time, traveling environment information such as the radius of curvature R of the curve of the road is detected. The lateral displacement X, the image yaw angle θ, and the curvature radius R of the curve are supplied to an electronic control unit 50 which is a traveling environment information ECU.
【0019】電子制御装置50は図3に示す如く、マイ
クロコンピュータで構成され、中央処理ユニット(CP
U)70と、リードオンリメモリ(ROM)72と、ラ
ンダムアクセスメモリ(RAM)74と、入力ポート回
路76と、出力ポート回路78と、通信回路80とを有
し、これは双方向性のコモンバス82により互いに接続
されている。The electronic control unit 50 comprises a microcomputer as shown in FIG.
U) 70, a read only memory (ROM) 72, a random access memory (RAM) 74, an input port circuit 76, an output port circuit 78, and a communication circuit 80. They are connected to each other by 82.
【0020】入力ポート回路76には上記の後輪操舵角
センサ54,車速センサ65,ヨーレートセンサ66,
操舵角センサ67夫々の出力する検出信号が供給され
る。また、通信回路80にはガイドライン認識手段62
の出力する車両オフセット量E(n)が供給される。R
OM72には制御プログラムが記憶されている。CPU
70は制御プログラムに基づき、後述する種々の演算を
行い、その際にRAM74が作業領域として使用され
る。The input port circuit 76 includes a rear wheel steering angle sensor 54, a vehicle speed sensor 65, a yaw rate sensor 66,
A detection signal output from each of the steering angle sensors 67 is supplied. The communication circuit 80 includes the guideline recognition means 62.
Is output as the vehicle offset amount E (n). R
The OM 72 stores a control program. CPU
70 performs various operations to be described later based on the control program, and at that time, the RAM 74 is used as a work area.
【0021】本発明の原理について説明するに、走行路
が直線の場合にはガイドライン認識手段62で得た画像
ヨー角θと、ヨーレートセンサ67で検出したヨーレー
トγの積分値∫γdtとは同一のはずであるが、ヨーレ
ートγにはオフセットがあるため、画像ヨー角θが図5
に実線で示すように時間変化する場合、ヨーレートγの
積分値は例えば図5に破線で示すように変化する。To explain the principle of the present invention, when the traveling path is straight, the image yaw angle θ obtained by the guideline recognition means 62 and the integral value ∫γdt of the yaw rate γ detected by the yaw rate sensor 67 are the same. However, since the yaw rate γ has an offset, the image yaw angle θ is
5, the integrated value of the yaw rate γ changes as shown by a broken line in FIG. 5, for example.
【0022】一方、カーブにおいては目標ヨー角Δθは
ヨーレートγの積分値∫γdtから、カーブの曲率半径
Rと車速Vとの比の積分値∫(V/R)dtを減算した
値となる。図7はCPU70が実行する補正処理の第1
実施例のフローチャートを示す。この処理は所定時間間
隔で繰り返し実行される。同図中、ステップS10では
カイドライン認識手段62から供給されるカーブ曲率半
径R、横変位X、画像ヨー角θ夫々を読み込むと共に、
車速センサ65からの車速V及びヨーレートセンサ66
からのヨーレートγ及び操舵角センサ67からの操舵角
θs夫々を読み込む。そしてカーブ曲率半径Rのフィル
タリングを行う。On the other hand, in the curve, the target yaw angle Δθ is a value obtained by subtracting the integral value ∫ (V / R) dt of the ratio between the curvature radius R of the curve and the vehicle speed V from the integral value ∫γdt of the yaw rate γ. FIG. 7 shows a first correction process performed by the CPU 70.
4 shows a flowchart of an embodiment. This process is repeatedly executed at predetermined time intervals. In FIG. 10, in step S10, the curvature radius R, the lateral displacement X, and the image yaw angle θ supplied from the guide line recognizing means 62 are read, respectively.
Vehicle speed V from vehicle speed sensor 65 and yaw rate sensor 66
, And the steering angle θs from the steering angle sensor 67 are read. Then, filtering of the curvature radius R is performed.
【0023】ここでは、今回得られた曲率半径をR
(n),前回得られた曲率半径をR(n−1)として R(n)<R(n−1)−ΔRの場合、R(n)=R(n)−ΔR …(1) R(n−1)−ΔR≦R(n)≦R(n−1)+ΔRの場合、R(n)=R( n)…(2) R(n)>R(n−1)+ΔRの場合、R(n)=R(n)+ΔR …(3) とする。但し、ΔRは図8に示すように曲率半径R
(n)の逆数が小なる程、大きな値としている。これに
よって、曲率半径Rの逆数が図9に実線で示すように時
間変化し、ばらつきを有する場合にもフィルタリング後
の曲率半径Rの逆数は破線で示すようにばらつきを除去
できる。勿論、フィルタリングはローパスフィルタを用
いて行っても良く、更にはナビゲーションシステムから
道路の曲率半径Rを得るようにしても良い。Here, the radius of curvature obtained this time is R
(N), when the radius of curvature obtained last time is R (n-1), and R (n) <R (n-1)-. DELTA.R, R (n) = R (n)-. DELTA.R (1) R When (n-1)-[Delta] R≤R (n) ≤R (n-1) + [Delta] R, R (n) = R (n) ... (2) When R (n)> R (n-1) + [Delta] R , R (n) = R (n) + ΔR (3) Here, ΔR is the radius of curvature R as shown in FIG.
The smaller the reciprocal of (n), the larger the value. As a result, the reciprocal of the radius of curvature R changes over time as shown by the solid line in FIG. 9, and even when there is variation, the reciprocal of the radius of curvature R after filtering can remove the variation as shown by the broken line. Of course, the filtering may be performed using a low-pass filter, and the curvature radius R of the road may be obtained from the navigation system.
【0024】カーブの曲率半径Rをフィルタリングする
のは、画像ヨー角θ又は横変位Xの補正に曲率半径Rが
必要であり、曲率半径Rの値がフィルタリングにより遅
延しても操舵制御が不安定になることはないからであ
る。一方、画像ヨー角θ又は横変位は、車両運動量であ
るため、これらの車両運動量の遅延は操舵制御の不安定
につながるので充分なフィルタリングを行うことはでき
ない。Filtering of the curvature radius R of the curve requires the curvature radius R to correct the image yaw angle θ or the lateral displacement X, and the steering control is unstable even if the value of the curvature radius R is delayed by the filtering. Because it will not be. On the other hand, since the image yaw angle θ or the lateral displacement is the vehicle momentum, the delay of the vehicle momentum leads to instability of the steering control, so that sufficient filtering cannot be performed.
【0025】ステップS10の実行後、ステップS12
に進んで、画像ヨー角θのばらつき判定を行う。ここで
は後述するように、画像ヨー角θにばらつきがなければ
フラグfに0をセットし、ばらつきがあればフラグfに
1をセットする。次にステップS14でフラグfが0か
否か、つまりθにばらつきがないかどうかを判別する。
ここで、f=0でθにばらつきがなければステップS1
6に進み、ステップS10で読み込んだ画像ヨー角θを
今回の画像ヨー角θ(n)にセットして処理を終了す
る。After execution of step S10, step S12
To determine the variation of the image yaw angle θ. Here, as described later, the flag f is set to 0 if the image yaw angle θ does not vary, and 1 is set to the flag f if the image yaw angle θ varies. Next, in step S14, it is determined whether or not the flag f is 0, that is, whether or not there is a variation in θ.
Here, if f = 0 and there is no variation in θ, step S1
In step 6, the image yaw angle θ read in step S10 is set to the current image yaw angle θ (n), and the process ends.
【0026】一方、f=1でθにばらつきがある場合は
ステップS18に進み、曲率半径Rの逆数の絶対値が所
定値1/R0 未満で、走行路が略直線か否かを判別す
る。|1/R|<1/R0 で直線の場合にはステップS
20に進み、今回の画像ヨー角θ(n)を(4)式で補
正する。On the other hand, if f = 1 and there is a variation in θ, the process proceeds to step S18, where it is determined whether or not the absolute value of the reciprocal of the radius of curvature R is less than a predetermined value 1 / R0 and the traveling path is substantially straight. . If | 1 / R | <1 / R 0 and a straight line, step S
Proceeding to step 20, the present image yaw angle θ (n) is corrected by equation (4).
【0027】 θ(n)=θ(n−1)+γ(n−1)・Δt …(4) つまり前回の画像ヨー角に前回のヨーレートγと前回と
今回の時間間隔Δtとの積を加算して補正を行う。そし
てカウンタcountを1だけインクリメントする。Θ (n) = θ (n−1) + γ (n−1) · Δt (4) That is, the product of the previous yaw rate γ and the previous and current time interval Δt is added to the previous image yaw angle. And make corrections. Then, the counter count is incremented by one.
【0028】また、ステップS18で|1/R|≧1/
R0 で走行路がカーブの場合にはステップS22に進
み、今回の画像ヨー角θ(n)を(5)式で補正する。In step S18, | 1 / R | ≧ 1 /
If the traveling road is a curve at R 0 , the process proceeds to step S22, and the present image yaw angle θ (n) is corrected by the equation (5).
【0029】[0029]
【数1】 (Equation 1)
【0030】つまり前回の画像ヨー角に、前回のヨーレ
ートからカーブに起因するヨーレートV/Rを減じた値
と前回と今回の時間間隔Δtとの積を加算して補正を行
う。そしてカウンタcountを1だけインクリメント
する。上記のステップS20又はS22を実行するとス
テップS24に進んでカウンタcountの値が所定値
Nを越えるかどうかを判別し、count>Nの場合に
のみステップS26でカウンタcountを0にリセッ
トし、フラグfを0にリセットして処理を終了する。上
記のステップS20,S22がヨー角補正手段M3に対
応する。That is, the correction is performed by adding the product of the value obtained by subtracting the yaw rate V / R due to the curve from the previous yaw rate and the previous time interval Δt to the previous image yaw angle. Then, the counter count is incremented by one. When the above step S20 or S22 is executed, the process proceeds to step S24 to determine whether the value of the counter exceeds a predetermined value N. Only when count> N, the counter count is reset to 0 in step S26, and the flag f Is reset to 0, and the process ends. The above steps S20 and S22 correspond to the yaw angle correction means M3.
【0031】図10はばらつき判定の第1実施例のフロ
ーチャートを示す。同図中、ステップS30で今回と前
回の画像ヨー角の増分からヨーレートΔθを(6)式に
より求める。FIG. 10 shows a flowchart of a first embodiment of the variation judgment. In the figure, in step S30, the yaw rate Δθ is obtained from the present and previous image yaw angle increments by the equation (6).
【0032】[0032]
【数2】 (Equation 2)
【0033】次にステップS32で曲率半径Rの逆数の
絶対値が所定値1/R0 未満で、走行路が略直線か否か
を判別する。ここで、|1/R|<1/R0 で直線の場
合にはステップS34で今回読み込んだヨーレートγ
(n)と画像ヨー角の増分から求めたヨーレートΔθ1
との差の絶対値が所定値γ0 未満か否かを判別し、|γ
(n)−Δθ1 |<γ0 の場合はそのまま処理を終了
し、|γ(n)−Δθ1 |≧γ0 の場合は画像ヨー角の
ばらつきが発生したとしてステップS36でフラグfに
1をセットして処理を終了する。Next, in step S32, it is determined whether or not the absolute value of the reciprocal of the radius of curvature R is less than a predetermined value 1 / R0 , and whether or not the traveling road is substantially straight. Here, in the case of | 1 / R | <1 / R 0 and a straight line, the yaw rate γ read this time in step S34
(N) and the yaw rate Δθ 1 obtained from the increment of the image yaw angle
The absolute value of the difference between, it is determined whether or not less than the predetermined value γ 0, | γ
If (n) −Δθ 1 | <γ 0 , the process is terminated as it is. If | γ (n) −Δθ 1 | ≧ γ 0 , it is determined that a variation in the image yaw angle has occurred and the flag f is set to 1 in step S36. Is set and the process ends.
【0034】一方、|1/R|≧1/R0 の場合は、ス
テップS38に進み、(7)式で画像ヨー角の増分から
求めたヨーレートΔθ1 にカーブで生じるヨーレートV
/Rを加算してヨーレートΔθ2 を求める。 Δθ2 =Δθ1 +V/R …(7) 次に、ステップS34で今回読み込んだヨーレートγ
(n)と画像ヨー角の増分から求めたカーブの補正を行
ったヨーレートΔθ2 との差の絶対値が所定値γ0未満
か否かを判別し、|γ(n)−Δθ1 |<γ0 の場合は
そのまま処理を終了し、|γ(n)−Δθ1 |≧γ0の
場合は画像ヨー角のばらつきが発生したとしてステップ
S42でフラグfに1をセットして処理を終了する。On the other hand, if | 1 / R | ≧ 1 / R 0 , the process proceeds to step S38, and the yaw rate V generated by the curve at the yaw rate Δθ 1 obtained from the increment of the image yaw angle by equation (7).
/ R is added to determine the yaw rate Δθ 2 . Δθ 2 = Δθ 1 + V / R (7) Next, the yaw rate γ read this time in step S34
It is determined whether the absolute value of the difference between (n) and the yaw rate Δθ 2 obtained by correcting the curve obtained from the increment of the image yaw angle is less than a predetermined value γ 0 , and | γ (n) −Δθ 1 | < and the process ends if the γ 0, | γ (n) -Δθ 1 | for ≧ [gamma] 0 and the processing is ended set to 1 in step S42 the flag f as variations in image yaw angle occurs.
【0035】このようにして、画像ヨー角θにばらつき
が発生したときはステップS20又はS22で画像ヨー
角θがヨーレートγに基づいて補正される。ここでは図
11(A),(B)に示すように画像ヨー角θ,ヨーレ
ートγのばらつきが発生した場合は、ヨーレートγのば
らつきが収束した後も画像ヨー角θのばらつきが持続す
るために、その後の所定値Nに相当する所定期間はステ
ップS20又はS22による補正を持続するためにカウ
ンタcountを用いている。As described above, when the image yaw angle θ varies, the image yaw angle θ is corrected based on the yaw rate γ in step S20 or S22. Here, as shown in FIGS. 11A and 11B, when the variation of the image yaw angle θ and the yaw rate γ occurs, the variation of the image yaw angle θ continues even after the variation of the yaw rate γ converges. The counter count is used to maintain the correction in step S20 or S22 for a predetermined period corresponding to the predetermined value N thereafter.
【0036】図12はばらつき判定の第2実施例のフロ
ーチャートを示す。同図中、ステップS50で操舵角θ
sが0であり、かつ、ヨーレートγの絶対値が所定値γ
0 未満か否かによって直線走行中か否かを判別する。こ
の条件を満足する直線走行中はステップS52に進みカ
ウンタmを1だけインクリメントする。この後、ステッ
プS54でカウンタmの値が所定値m0 を越えたか否か
を判別し、m>m0 の場合はステップS56でカウンタ
mに1をセットしてステップS58に進む。M≦m0 の
場合は直接ステップS58に進む。FIG. 12 shows a flowchart of a second embodiment of the variation judgment. In the figure, at step S50, the steering angle θ
s is 0, and the absolute value of the yaw rate γ is a predetermined value γ
It is determined whether or not the vehicle is running straight based on whether or not the value is less than 0 . If the vehicle is traveling straight, the process proceeds to step S52, and the counter m is incremented by one. Thereafter, the value of the counter m is determined whether or not exceeds a predetermined value m 0 in step S54, in the case of m> m 0 proceeds to step S58 to set a counter m in step S56. If M ≦ m 0 , the process proceeds directly to step S58.
【0037】ステップS58では今回読み込んだヨーレ
ートγをγ(m)に格納し、(8)式によりヨーレート
の移動平均γave つまりオフセットを求め、ステップS
60に進む。In step S58, the currently read yaw rate γ is stored in γ (m), and the moving average γave of the yaw rate, that is, the offset is obtained by the equation (8).
Proceed to 60.
【0038】[0038]
【数3】 (Equation 3)
【0039】一方、ステップS50の条件を満足しない
場合はそのままステップS60に進む。ステップS60
では(9)式により前回の画像ヨー角θ(n−1)に前
回のヨーレートγ(n−1)をオフセットγave で補正
した値と前回と今回の時間間隔Δtとの積を加算して今
回のヨー角θ(n)とする。On the other hand, if the condition of step S50 is not satisfied, the process proceeds directly to step S60. Step S60
Then, the product of the value obtained by correcting the previous yaw rate γ (n−1) by the offset γave and the previous time interval Δt is added to the previous image yaw angle θ (n−1) according to equation (9). The yaw angle θ (n).
【0040】 θ(n)=θ(n−1)+{γ(n−1)−γave }・Δt …(9) 次にステップS62では補正した今回のヨー角θ(n)
と画像ヨー角θとの差の絶対値が所定値θ0 を越えるか
否かを判別し、|θ(n)−θ|>θ0 ならば画像ヨー
角θにばらつきがありとしてステップS64でフラグf
に1をセットして処理を終了する。また、|θ(n)−
θ|≦θ0 ならば画像ヨー角θにばらつきなしとして、
そのまま処理を終了する。これにより、図13に実線で
示す画像ヨー角θが破線で示す補正した今回のヨー角θ
(n)と所定値θ0 以上の差があるとき、画像ヨー角θ
にばらつきが発生したとしてフラグfに1がセットされ
る。Θ (n) = θ (n−1) + {γ (n−1) −γave} · Δt (9) Next, in step S62, the corrected yaw angle θ (n)
It is determined whether or not the absolute value of the difference between the image yaw angle θ and the image yaw angle θ exceeds a predetermined value θ 0, and if | θ (n) −θ |> θ 0 , it is determined that there is a variation in the image yaw angle θ and in step S 64 Flag f
Is set to 1 and the process is terminated. Also, | θ (n) −
If θ | ≦ θ 0 , there is no variation in the image yaw angle θ, and
The process ends as it is. As a result, the image yaw angle θ shown by the solid line in FIG.
(N) and a predetermined value θ 0 or more, the image yaw angle θ
Is set to 1 as the flag f.
【0041】このように、画像の揺れにより画像から検
出したヨー角にばらつきが生じたとき、画像の揺れの影
響を受けないヨーレート検出手段で得たヨーレートの積
分値を用いて上記ヨー角を補正するため、ばらつきを除
去した誤りのないヨー角を得ることができる。As described above, when the yaw angle detected from the image fluctuates due to the fluctuation of the image, the yaw angle is corrected using the integrated value of the yaw rate obtained by the yaw rate detecting means which is not affected by the fluctuation of the image. Therefore, it is possible to obtain an error-free yaw angle from which variations have been removed.
【0042】図14はCPU70が実行する補正処理の
第2実施例のフローチャートを示す。この処理は所定時
間間隔で繰り返し実行される。同図中、ステップS10
0ではカーブ曲率半径R、横変位X、画像ヨー角θ、車
速V、ヨーレートγ、夫々を読み込む。そしてカーブ曲
率半径Rのフィルタリングを行う。次に、ステップS1
02に進みカウンタmを1だけインクリメントする。こ
の後、ステップS104でカウンタmの値が所定値m0
を越えたか否かを判別し、m>m0 の場合はステップS
106でカウンタmに1をセットしてステップS108
に進む。m≦m 0 の場合は直接ステップS108に進
む。FIG. 14 shows a correction process executed by the CPU 70.
9 shows a flowchart of a second embodiment. This process is performed when
It is executed repeatedly at intervals. In the figure, step S10
At 0, the curvature radius R, the lateral displacement X, the image yaw angle θ, and the car
The speed V and the yaw rate γ are read. And curve song
Filtering of the rate radius R is performed. Next, step S1
In step 02, the counter m is incremented by one. This
After that, in step S104, the value of the counter m is equal to the predetermined value m.0
Is determined, m> m0If step S
At step 106, 1 is set to the counter m and step S108
Proceed to. m ≦ m 0In the case of, go directly to step S108.
No.
【0043】ステップS108ではカーブの曲率半径R
の逆数の絶対値が所定値1/R0 未満で、走行路が略直
線か否かを判別する。|1/R|<1/R0 で直線の場
合にはステップS110に進み、今回の画像ヨー角θ
(m)を(10)式で補正する。 θ(m)=θ(m−1)+γ(m−1)・Δt …(10) つまり前回のヨー角に前回のヨーレートγと前回と今回
の時間間隔Δtとの積を加算してヨーレートγの積分を
行う。また、ステップS108で|1/R|≧1/R0
で走行路がカーブの場合にはステップS112に進み、
今回の画像ヨー角θ(m)を(11) 式で補正する。In step S108, the curvature radius R of the curve
It is determined whether or not the absolute value of the reciprocal of is less than the predetermined value 1 / R 0 and the traveling path is substantially straight. If | 1 / R | <1 / R 0 and the line is a straight line, the process proceeds to step S110, where the current image yaw angle θ
(M) is corrected by equation (10). θ (m) = θ (m−1) + γ (m−1) · Δt (10) That is, the yaw rate γ is obtained by adding the product of the previous yaw rate γ and the previous time interval Δt to the previous yaw angle. Is integrated. Also, in step S108, | 1 / R | ≧ 1 / R 0
If the traveling path is a curve, the process proceeds to step S112,
The image yaw angle θ (m) this time is corrected by equation (11).
【0044】[0044]
【数4】 (Equation 4)
【0045】つまり前回のヨー角に、前回のヨーレート
からカーブに起因するヨーレートV/Rを減じた値と前
回と今回の時間間隔Δtとの積を加算して補正したヨー
レートの積分を行う。上記のステップS110又はS1
12を実行後、ステップS114に進み、ヨーレートの
積分値θ(m)と画像ヨー角θとの差D(m)を求め、
(12) 式から差D(m)の移動平均Dave を求める。That is, the yaw rate corrected by adding the product of the value obtained by subtracting the yaw rate V / R caused by the curve from the previous yaw rate to the previous yaw angle and the current time interval Δt is integrated. Step S110 or S1 above
After execution of step S12, the process proceeds to step S114, in which a difference D (m) between the integral value θ (m) of the yaw rate and the image yaw angle θ is obtained.
A moving average Dave of the difference D (m) is obtained from the equation (12).
【0046】[0046]
【数5】 (Equation 5)
【0047】この後、ステップS116でヨーレートの
積分値θ(m)から差D(m)の移動平均、つまりオフ
セットDave を減算して、これを今回のヨー角θ(n)
として処理を終了する。これによって、図15(A)に
実線で示す画像ヨー角θにばらつきが発生し、またヨー
レートの積分値θ(m)が破線に示すような場合、ハッ
チングで示す期間の移動平均からオフセットDave を求
められ、図15(B)に一点鎖線で示すようなばらつき
を除去したヨー角θ(n)を得ることができる。Thereafter, in step S116, the moving average of the difference D (m), that is, the offset Dave is subtracted from the integrated value θ (m) of the yaw rate, and this is subtracted from the current yaw angle θ (n).
And the process ends. As a result, a variation occurs in the image yaw angle θ indicated by the solid line in FIG. 15A, and when the integrated value θ (m) of the yaw rate is indicated by the broken line, the offset Dave is subtracted from the moving average during the period indicated by hatching. Thus, the yaw angle θ (n) from which the variation as shown by the one-dot chain line in FIG. 15B has been removed can be obtained.
【0048】ところで、上記実施例では画像ヨー角θの
補正について説明したが、横変位Xについても同様にし
て補正できる。図16(A)に示すように走行路が直線
であれば、横変位X(n)は車速VのX成分V・sin θ
(n)を積分することにより求められる。このため、図
7の補正処理において、ステップS16において読み込
んだ横変位Xを今回の横変位X(n)にセットする場
合、ステップS20では(13) 式により今回の横変位X
(n)を補正する。In the above embodiment, the correction of the image yaw angle θ has been described, but the lateral displacement X can be similarly corrected. If the traveling road is straight as shown in FIG. 16A, the lateral displacement X (n) is the X component V · sin θ of the vehicle speed V.
It is determined by integrating (n). Therefore, in the correction process of FIG. 7, when the lateral displacement X read in step S16 is set to the current lateral displacement X (n), in step S20, the current lateral displacement X is calculated according to equation (13).
Correct (n).
【0049】 X(n)=X(n−1)+V・sin θ(n−1)・Δt …(13) また、走行路が図16(B)に示すようにカーブの場合
には、横変位X(n)は車速VのX成分V・sin θ
(n)の積分値からカーブによるみかけの変位量ΔXを
減算することにより求められる。このため、図7のステ
ップS22において(14)式により今回の横変位X
(n)を補正する。X (n) = X (n−1) + V · sin θ (n−1) · Δt (13) When the traveling road is a curve as shown in FIG. The displacement X (n) is the X component V · sin θ of the vehicle speed V
It is obtained by subtracting the apparent displacement ΔX due to the curve from the integrated value of (n). For this reason, in step S22 of FIG.
Correct (n).
【0050】[0050]
【数6】 (Equation 6)
【0051】上記の(13) 式,(14)式を用いた図7の
フローチャートのステップS20,S22が横変位補正
手段M6に対応する。このように、画像の揺れにより画
像から検出した横変位にばらつきが生じたとき、画像の
揺れの影響を受けない車速検出手段で得た車速の横方向
成分の積分値を用いて上記横変位を補正するため、ばら
つきを除去した誤りのない横変位を得ることができる。Steps S20 and S22 in the flowchart of FIG. 7 using the above equations (13) and (14) correspond to the lateral displacement correcting means M6. As described above, when the lateral displacement detected from the image varies due to the image swing, the lateral displacement is calculated by using the integral value of the lateral component of the vehicle speed obtained by the vehicle speed detecting means which is not affected by the image shake. Because of the correction, it is possible to obtain an error-free lateral displacement from which variations have been removed.
【0052】[0052]
【発明の効果】上述の如く、請求項1に記載の発明は、
車両前方を撮像した画像から走行路に対する車両の相対
関係としてヨー角を検出する車両姿勢検出装置におい
て、車両のヨーレートを検出するヨーレート検出手段
と、上記ヨー角のばらつきが発生したとき、上記ヨー角
を上記ヨーレート検出手段で得たヨーレートの積分値を
用いて補正するヨーレート補正手段とを有する。As described above, the first aspect of the present invention provides
A vehicle attitude detection device that detects a yaw angle as a relative relationship of the vehicle to a traveling road from an image captured in front of the vehicle, a yaw rate detection unit that detects a yaw rate of the vehicle, and a yaw angle when a variation in the yaw angle occurs. Is corrected using the integrated value of the yaw rate obtained by the yaw rate detecting means.
【0053】このため、画像の揺れにより画像から検出
したヨー角にばらつきが生じたとき、画像の揺れの影響
を受けないヨーレート検出手段で得たヨーレートの積分
値を用いて上記ヨー角を補正するため、ばらつきを除去
した誤りのないヨー角を得ることができる。For this reason, when the yaw angle detected from the image fluctuates due to the fluctuation of the image, the yaw angle is corrected using the integrated value of the yaw rate obtained by the yaw rate detecting means which is not affected by the fluctuation of the image. Therefore, it is possible to obtain an error-free yaw angle from which variations have been removed.
【0054】また、請求項2に記載の発明は、車両前方
を撮像した画像から走行路に対する車両の相対関係とし
て車両の横方向の変位量である横変位を検出する車両姿
勢検出装置において、車両の速度を検出する車速検出手
段と、上記横変位のばらつきが発生したとき、上記横変
位を上記車速検出手段で得た車速の横方向成分の積分値
を用いて補正する横変位補正手段とを有する。According to a second aspect of the present invention, there is provided a vehicle attitude detecting apparatus for detecting a lateral displacement, which is a lateral displacement amount of a vehicle, as a relative relationship of the vehicle with respect to a traveling path from an image captured in front of the vehicle. Vehicle speed detecting means for detecting the speed of the vehicle, and a lateral displacement correcting means for correcting the lateral displacement using an integral value of a lateral component of the vehicle speed obtained by the vehicle speed detecting means when the lateral displacement varies. Have.
【0055】このため、画像の揺れにより画像から検出
した横変位にばらつきが生じたとき、画像の揺れの影響
を受けない車速検出手段で得た車速の横方向成分の積分
値を用いて上記横変位を補正するため、ばらつきを除去
した誤りのない横変位を得ることができる。For this reason, when the lateral displacement detected from the image varies due to the image swing, the lateral displacement is calculated using the integral value of the lateral component of the vehicle speed obtained by the vehicle speed detecting means which is not affected by the image shake. In order to correct the displacement, it is possible to obtain an error-free lateral displacement from which variations have been removed.
【図1】本発明の原理図である。FIG. 1 is a principle diagram of the present invention.
【図2】本発明装置の構成図である。FIG. 2 is a configuration diagram of the device of the present invention.
【図3】ECUのブロック図である。FIG. 3 is a block diagram of an ECU.
【図4】ヨー角,横変位を説明するための図である。FIG. 4 is a diagram for explaining a yaw angle and a lateral displacement.
【図5】本発明を説明するための図である。FIG. 5 is a diagram for explaining the present invention.
【図6】本発明を説明するための図である。FIG. 6 is a diagram for explaining the present invention.
【図7】補正処理のフローチャートである。FIG. 7 is a flowchart of a correction process.
【図8】本発明を説明するための図である。FIG. 8 is a diagram for explaining the present invention.
【図9】本発明を説明するための図である。FIG. 9 is a diagram for explaining the present invention.
【図10】ばらつき判定のフローチャートである。FIG. 10 is a flowchart of a variation determination.
【図11】本発明を説明するための図である。FIG. 11 is a diagram for explaining the present invention.
【図12】ばらつき判定のフローチャートである。FIG. 12 is a flowchart of a variation determination.
【図13】本発明を説明するための図である。FIG. 13 is a diagram for explaining the present invention.
【図14】補正処理のフローチャートである。FIG. 14 is a flowchart of a correction process.
【図15】本発明を説明するための図である。FIG. 15 is a diagram for explaining the present invention.
【図16】本発明を説明するための図である。FIG. 16 is a diagram for explaining the present invention.
11 操舵ハンドル 21 油圧ポンプ 22 パワーシリンダ 23 リザーバ 31 リレーロッド 32a,32b 左右タイロッド 35 パワーシリンダ 37 スプールバルブ 38 油圧ポンプ 41 レバー 50 ECU 51 操舵トルクセンサ 54 後輪操舵角センサ 56,57 駆動回路 60 ウインカスイッチ 65 車速センサ 67 操舵角センサ M1 ヨー角検出手段 M2 ヨーレート検出手段 M3 ヨー角補正手段 M4 横変位検出手段 M5 車速検出手段 M6 横変位補正手段 Reference Signs List 11 steering handle 21 hydraulic pump 22 power cylinder 23 reservoir 31 relay rod 32a, 32b left and right tie rod 35 power cylinder 37 spool valve 38 hydraulic pump 41 lever 50 ECU 51 steering torque sensor 54 rear wheel steering angle sensor 56, 57 drive circuit 60 turn signal switch 65 vehicle speed sensor 67 steering angle sensor M1 yaw angle detecting means M2 yaw rate detecting means M3 yaw angle correcting means M4 lateral displacement detecting means M5 vehicle speed detecting means M6 lateral displacement correcting means
───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.6 識別記号 FI B62D 137:00 ──────────────────────────────────────────────────の Continued on the front page (51) Int.Cl. 6 Identification code FI B62D 13:00
Claims (2)
する車両の相対関係としてヨー角を検出する車両姿勢検
出装置において、 車両のヨーレートを検出するヨーレート検出手段と、 上記ヨー角のばらつきが発生したとき、上記ヨー角を上
記ヨーレート検出手段で得たヨーレートの積分値を用い
て補正するヨーレート補正手段とを有することを特徴と
する車両姿勢検出装置。1. A vehicle attitude detecting device for detecting a yaw angle as a relative relationship of a vehicle to a traveling road from an image captured in front of the vehicle, wherein a yaw rate detecting means for detecting a yaw rate of the vehicle; And a yaw rate correction means for correcting the yaw angle using an integrated value of the yaw rate obtained by the yaw rate detection means.
する車両の相対関係として車両の横方向の変位量である
横変位を検出する車両姿勢検出装置において、 車両の速度を検出する車速検出手段と、 上記横変位のばらつきが発生したとき、上記横変位を上
記車速検出手段で得た車速の横方向成分の積分値を用い
て補正する横変位補正手段とを有することを特徴とする
車両姿勢検出装置。2. A vehicle attitude detecting device for detecting a lateral displacement, which is an amount of lateral displacement of a vehicle, as a relative relationship of the vehicle to a traveling path from an image obtained by capturing an image of the front of the vehicle. And a lateral displacement correcting means for correcting the lateral displacement by using an integral value of a lateral component of the vehicle speed obtained by the vehicle speed detecting means when the variation of the lateral displacement occurs. apparatus.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP8264398A JPH10111136A (en) | 1996-10-04 | 1996-10-04 | Vehicle attitude detector |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP8264398A JPH10111136A (en) | 1996-10-04 | 1996-10-04 | Vehicle attitude detector |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH10111136A true JPH10111136A (en) | 1998-04-28 |
Family
ID=17402614
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP8264398A Pending JPH10111136A (en) | 1996-10-04 | 1996-10-04 | Vehicle attitude detector |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH10111136A (en) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000059764A (en) * | 1998-08-07 | 2000-02-25 | Mazda Motor Corp | Vehicle position detecting device |
JP2005247231A (en) * | 2004-03-08 | 2005-09-15 | Hitachi Ltd | Steering control system |
JP2007296919A (en) * | 2006-04-28 | 2007-11-15 | Nissan Motor Co Ltd | Lane departure prevention system |
JP2008032632A (en) * | 2006-07-31 | 2008-02-14 | Denso Corp | Calibration device of angular velocity sensor, and angular velocity value identifying device |
JP2009298264A (en) * | 2008-06-12 | 2009-12-24 | Nissan Motor Co Ltd | Vehicle deceleration controller and method thereof |
JP2013248941A (en) * | 2012-05-31 | 2013-12-12 | Isuzu Motors Ltd | Power steering system, vehicle mounting the same, and method of controlling the same |
KR20180058417A (en) * | 2016-11-24 | 2018-06-01 | 현대자동차주식회사 | Car and controlling method thereof |
JP2022127413A (en) * | 2021-02-19 | 2022-08-31 | 本田技研工業株式会社 | Determination device, vehicle control device, determination method and program |
-
1996
- 1996-10-04 JP JP8264398A patent/JPH10111136A/en active Pending
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000059764A (en) * | 1998-08-07 | 2000-02-25 | Mazda Motor Corp | Vehicle position detecting device |
JP2005247231A (en) * | 2004-03-08 | 2005-09-15 | Hitachi Ltd | Steering control system |
JP2007296919A (en) * | 2006-04-28 | 2007-11-15 | Nissan Motor Co Ltd | Lane departure prevention system |
JP2008032632A (en) * | 2006-07-31 | 2008-02-14 | Denso Corp | Calibration device of angular velocity sensor, and angular velocity value identifying device |
JP2009298264A (en) * | 2008-06-12 | 2009-12-24 | Nissan Motor Co Ltd | Vehicle deceleration controller and method thereof |
JP2013248941A (en) * | 2012-05-31 | 2013-12-12 | Isuzu Motors Ltd | Power steering system, vehicle mounting the same, and method of controlling the same |
KR20180058417A (en) * | 2016-11-24 | 2018-06-01 | 현대자동차주식회사 | Car and controlling method thereof |
US10220844B2 (en) | 2016-11-24 | 2019-03-05 | Huyndai Motor Company | Vehicle and control method thereof |
JP2022127413A (en) * | 2021-02-19 | 2022-08-31 | 本田技研工業株式会社 | Determination device, vehicle control device, determination method and program |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1954546B1 (en) | Driving assistance system and driving assistance method | |
US7447578B2 (en) | Steering control apparatus and method for automotive vehicle | |
US8805604B2 (en) | Method for adjusting a steering system in a vehicle | |
JP7070376B2 (en) | Disturbance detector for vehicles | |
US10427712B2 (en) | Automatic driving system | |
US6134509A (en) | Road curvature estimating apparatus | |
US20100108432A1 (en) | Steering control device | |
JP3367355B2 (en) | Vehicle steering control device | |
JP4696671B2 (en) | Vehicle control device | |
EP3144204A1 (en) | Steering system | |
JPH10111136A (en) | Vehicle attitude detector | |
JP3882318B2 (en) | Vehicle steering control device | |
JP3183164B2 (en) | Vehicle steering control device | |
JP3255052B2 (en) | Vehicle steering control device | |
EP0563885B1 (en) | Rear-wheel steering apparatus for vehicles with a yaw rate sensor and calibration means therefore, and method for calibrating a yaw rate sensor | |
JP7032967B2 (en) | Vehicle steering support device | |
JP3163990B2 (en) | Vehicle steering control device | |
JP2020082751A (en) | Vehicular automatic steering control apparatus | |
KR102621533B1 (en) | Apparatus and method for controlling steering system of vehicle | |
JPH10273062A (en) | Steering controller of vehicle | |
JP3024413B2 (en) | Rear wheel control device for four-wheel steering vehicles | |
JP4923564B2 (en) | Steering device | |
JP3577864B2 (en) | Vehicle steering control device | |
JP3214360B2 (en) | Vehicle steering control device | |
JPH09301208A (en) | Steering control device for vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20040629 |
|
A131 | Notification of reasons for refusal |
Effective date: 20040720 Free format text: JAPANESE INTERMEDIATE CODE: A131 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20040917 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20050308 |