JP3189711B2 - Vehicle front recognition device - Google Patents

Vehicle front recognition device

Info

Publication number
JP3189711B2
JP3189711B2 JP29203896A JP29203896A JP3189711B2 JP 3189711 B2 JP3189711 B2 JP 3189711B2 JP 29203896 A JP29203896 A JP 29203896A JP 29203896 A JP29203896 A JP 29203896A JP 3189711 B2 JP3189711 B2 JP 3189711B2
Authority
JP
Japan
Prior art keywords
vehicle
shift amount
relative position
unit
information
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
JP29203896A
Other languages
Japanese (ja)
Other versions
JPH10132939A (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.)
Mitsubishi Motors Corp
Original Assignee
Mitsubishi Motors Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Motors Corp filed Critical Mitsubishi Motors Corp
Priority to JP29203896A priority Critical patent/JP3189711B2/en
Publication of JPH10132939A publication Critical patent/JPH10132939A/en
Application granted granted Critical
Publication of JP3189711B2 publication Critical patent/JP3189711B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/48Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
    • G01S7/497Means for monitoring or calibrating
    • G01S7/4972Alignment of sensor
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/40Means for monitoring or calibrating
    • G01S7/4004Means for monitoring or calibrating of parts of a radar system
    • G01S7/4026Antenna boresight
    • G01S7/403Antenna boresight in azimuth, i.e. in the horizontal plane
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/40Means for monitoring or calibrating
    • G01S7/4052Means for monitoring or calibrating by simulation of echoes
    • G01S7/4082Means for monitoring or calibrating by simulation of echoes using externally generated reference signals, e.g. via remote reflector or transponder
    • G01S7/4091Means for monitoring or calibrating by simulation of echoes using externally generated reference signals, e.g. via remote reflector or transponder during normal radar operation

Description

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

【0001】[0001]

【発明の属する技術分野】本発明は、車両の前方認識装
置に係り、詳しくは、車両前方の物体の位置を正確に把
握可能な前方認識装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a forward recognition device for a vehicle, and more particularly, to a forward recognition device capable of accurately grasping the position of an object ahead of a vehicle.

【0002】[0002]

【関連する背景技術】近年、車両の前方を走行する車両
等を人間の眼に代わって認識する前方認識装置が開発さ
れ、車両に搭載されつつある。このような前方認識装置
の前方認識手段としては、CCDカメラ等の撮像カメラ
の他、夜間走行等においても車両前方の物体を確実に認
識可能である等の理由から、レーザレーダ方式のレーダ
装置も採用される傾向にある。
2. Related Background Art In recent years, a forward recognition device that recognizes a vehicle or the like traveling ahead of a vehicle in place of human eyes has been developed and is being mounted on vehicles. In addition to an imaging camera such as a CCD camera, a radar apparatus of a laser radar system is also used as a front recognition means of such a front recognition apparatus because an object in front of the vehicle can be reliably recognized even at night or the like. Tend to be adopted.

【0003】そして、これら撮像カメラやレーダ装置か
らの情報に基づいて、車間距離を適正に保持する車間距
離制御や車両が走行車線から逸脱しないようにする逸脱
防止制御等の各種走行制御が行われている。ところで、
このような前方認識装置では、レーダ装置等の組み付け
時の取付け状態により、必ずしもそのレーダ装置等の向
く方向が車両の前方方向となっていない場合がある。つ
まり、レーダ装置等の光軸方向が正確に車両の前後軸線
方向に一致していない場合がある。
Based on information from the imaging camera and the radar device, various traveling controls such as an inter-vehicle distance control for properly maintaining the inter-vehicle distance and a departure prevention control for preventing the vehicle from deviating from the traveling lane are performed. ing. by the way,
In such a front recognition device, the direction in which the radar device or the like faces may not always be the front direction of the vehicle depending on the mounting state when the radar device or the like is assembled. That is, the direction of the optical axis of the radar device or the like may not exactly match the direction of the longitudinal axis of the vehicle.

【0004】このように、レーダ装置等の光軸方向が車
両の前後軸線方向からずれていると、車両の前方の物体
の位置を正しく認識できないことになり好ましいことで
はない。つまり、レーダ装置等の光軸方向が、例えば車
両の前後軸線から右側にずれていると、前方認識装置は
車両の右前方に位置している物体を車両の前方にあると
誤認識してしまう虞があるのである。
If the direction of the optical axis of the radar device or the like deviates from the longitudinal axis of the vehicle, the position of an object ahead of the vehicle cannot be correctly recognized, which is not preferable. That is, if the optical axis direction of the radar device or the like is shifted to the right from the longitudinal axis of the vehicle, for example, the forward recognition device erroneously recognizes an object located on the right front of the vehicle as being in front of the vehicle. There is a fear.

【0005】このようなことから、レーダ装置等の取付
け精度を高くするとともに、車両の走行時の振動等によ
る光軸方向のずれをなくすべくレーダ装置等の取付け精
度を定期的或いは適宜修正することが考えられる。しか
しながら、その修正は容易なものではなく、また信頼性
を高めるには頻繁に修正を行う必要があり手間がかかる
という問題がある。
[0005] For this reason, it is necessary to improve the mounting accuracy of the radar device and the like periodically and to correct the mounting accuracy of the radar device and the like periodically or appropriately so as to eliminate the displacement in the optical axis direction due to vibrations during running of the vehicle. Can be considered. However, there is a problem that the correction is not easy, and it is necessary to make frequent corrections in order to increase reliability, which is troublesome.

【0006】そこで、レーダ装置等の光軸がずれている
ような場合であっても、直線走行状態時における車両の
前後方向を光軸データとみなすことで車両の前方の物体
の位置を適正に認識可能に図る装置が特開平7−120
555号公報等に開示されている。
Therefore, even when the optical axis of a radar device or the like is deviated, the position of an object ahead of the vehicle can be properly determined by regarding the longitudinal direction of the vehicle in a straight running state as optical axis data. Japanese Patent Application Laid-Open No. 7-120 discloses a device for enabling recognition.
No. 555, for example.

【0007】[0007]

【発明が解決しようとする課題】しかしながら、上記公
報に開示された装置では、車両が直線走行状態にならな
い限り光軸データの更新は行われることがない。つま
り、上記公報に開示された装置では、道路が少しでもカ
ーブしているような場合には、光軸データは更新される
ことはなく、例えば、車両がカーブの連続する道路のみ
を走行し続けるような場合には、車両の振動等によって
光軸がずれていても、長期間に亘り光軸データが更新さ
れることがないことになる。故に、このような装置で
は、レーダ装置等からの認識情報を用いて車両の走行制
御を行おうとした場合において、正確な制御ができない
ことがあり得、好ましいことではない。
However, in the apparatus disclosed in the above publication, the optical axis data is not updated unless the vehicle is in a straight running state. In other words, in the device disclosed in the above publication, when the road is slightly curved, the optical axis data is not updated, and, for example, the vehicle keeps traveling only on the road with continuous curves. In such a case, even if the optical axis is deviated due to vibration of the vehicle or the like, the optical axis data will not be updated for a long period of time. Therefore, such a device is not preferable because accurate control may not be performed when running control of the vehicle is performed using recognition information from a radar device or the like.

【0008】本発明は、上述した事情に基づきなされた
もので、その目的とするところは、車両前方の物体位置
を常に正確に認識可能な車両の前方認識装置を提供する
ことにある。
The present invention has been made in view of the above-mentioned circumstances, and an object of the present invention is to provide a vehicle forward recognition device capable of always accurately recognizing an object position ahead of the vehicle.

【0009】[0009]

【課題を解決するための手段】上述の目的を達成するた
め、請求項1の発明では、車両の走行状況から車両の挙
動を検出する車両挙動検出手段と、前記車両挙動検出手
段からの情報に基づき、所定期間における車両の走行方
向の情報を演算する車両移動量演算手段と、車両前方の
物体を認識する前方物体認識手段と、前記前方物体認識
手段からの情報に基づき前記物体との相対位置を認知す
る前方物体相対位置認知手段と、前記車両移動量演算手
段による演算結果と前記前方物体相対位置認知手段から
の相対位置情報とに基づき車両前方の停止物体を判定す
る停止物判定手段と、前記停止物判定手段からの情報に
基づき、前記車両前方の停止物体の前記所定期間におけ
る相対位置移動軌跡を演算する移動軌跡演算手段と、前
記移動軌跡演算手段による前記停止物体の相対位置移動
軌跡の演算結果と前記車両移動量演算手段による前記車
両の移動量の演算結果とに基づき、前記前方物体認識手
段の認識方向軸線と車両の前後軸線との方向ずれ量を演
算する方向ずれ量演算手段と、前記方向ずれ量演算手段
による前記方向ずれ量の演算結果に基づき、前記前方物
体相対位置認知手段により認知される前記相対位置情報
を補正する位置情報補正手段とを備えたことを特徴とし
ている。
In order to achieve the above object, according to the first aspect of the present invention, a vehicle behavior detecting means for detecting a behavior of a vehicle from a running state of the vehicle, and information from the vehicle behavior detecting means is provided. Based on how the vehicle travels during the predetermined period
Vehicle movement amount calculating means for calculating direction information , forward object recognizing means for recognizing an object in front of the vehicle, and forward object relative position recognition for recognizing a relative position to the object based on information from the forward object recognizing means. Means, a stationary object determining means for determining a stationary object ahead of the vehicle based on a calculation result by the vehicle moving amount calculating means and relative position information from the forward object relative position recognizing means, and information from the stationary object determining means. A movement trajectory calculating means for calculating a relative position movement trajectory of the stationary object ahead of the vehicle in the predetermined time period, a calculation result of the relative position movement trajectory of the stationary object by the movement trajectory calculation means, and the vehicle movement amount calculation Means for calculating the direction shift between the recognition direction axis of the front object recognition means and the front-rear axis of the vehicle based on the calculation result of the movement of the vehicle by the means. Calculation means; and position information correction means for correcting the relative position information recognized by the front object relative position recognition means based on the calculation result of the direction deviation amount by the direction deviation amount calculation means. And

【0010】従って、前方物体認識手段の認識方向軸線
と車両の前後軸線とに方向ずれがあるような場合には、
ずれた認識方向軸線が車両の前後軸線とみなされること
から、そのままでは前方物体相対位置認知手段によって
認知される前方物体の車両との相対位置が正確に把握さ
れないことになってしまうのであるが、このような場合
であっても、方向ずれ量演算手段により、前方物体認識
手段の認識方向軸線と車両の前後軸線との方向ずれ量
が、直線路或いはカーブ路に拘わらず、移動軌跡演算手
段による停止物体の相対位置移動軌跡と車両移動量演算
手段による車両の走行方向の情報とに基づいて容易に演
算により求められ、前方物体相対位置認知手段によって
認知される車両前方の物体の相対位置情報が常に適正な
ものに補正される。
Therefore, when there is a direction shift between the recognition direction axis of the front object recognition means and the front-rear axis of the vehicle,
Since the shifted recognition direction axis is regarded as the front-back axis of the vehicle, the relative position of the front object and the vehicle recognized by the front object relative position recognition means cannot be accurately grasped as it is, Even in such a case, the direction shift amount between the recognition direction axis of the front object recognizing unit and the front-rear axis of the vehicle is determined by the direction shift amount calculating unit regardless of the straight road or the curved road. The relative position information of the object in front of the vehicle, which is easily obtained by calculation based on the relative position movement trajectory of the stationary object and the information on the traveling direction of the vehicle by the vehicle movement amount calculation means, is recognized by the front object relative position recognition means. It is always corrected to an appropriate one.

【0011】また、請求項2の発明では、前記方向ずれ
量演算手段は、前記方向ずれ量の分布を統計処理する統
計処理手段を含み、前記分布の重心値を最適方向ずれ量
として出力することを特徴としている。従って、方向ず
れ量演算手段により前方物体認識手段の認識方向軸線と
車両の前後軸線との方向ずれ量が容易に演算により求め
られるとともに、統計処理手段によって方向ずれ量の分
布の重心値が最適方向ずれ量として決定されるので、方
向ずれ量が外部ノイズ信号等の影響によってばらつくよ
うなことがあっても、方向ずれ量が常に適正なものとさ
れ、前方物体相対位置認知手段によって認知される車両
前方の物体の位置情報が極めて好適に補正される。
Further, in the invention according to claim 2, the direction shift amount calculating means includes statistical processing means for statistically processing the distribution of the direction shift amount, and outputs a center of gravity value of the distribution as an optimum direction shift amount. It is characterized by. Therefore, the direction shift amount between the recognition direction axis of the front object recognizing means and the front-rear axis of the vehicle can be easily calculated by the direction shift amount calculating means, and the center of gravity of the distribution of the direction shift amount is determined by the statistical processing means in the optimum direction. Since the deviation amount is determined, even if the direction deviation amount varies due to the influence of an external noise signal or the like, the direction deviation amount is always appropriate, and the vehicle recognized by the forward object relative position recognition means is recognized. The position information of the object ahead is corrected very suitably.

【0012】[0012]

【発明の実施の形態】以下、図面を参照して、本発明の
実施の形態としての実施例を詳細に説明する。図1に
は、本発明に係る前方認識装置の搭載された車両1を示
してある。同図に示すように、車両1の前部(例えば、
バンパ部等)にはスキャン式レーザレーダ(前方物体認
識手段)2が締結具等により取付けられている。
Embodiments of the present invention will be described below in detail with reference to the drawings. FIG. 1 shows a vehicle 1 on which a forward recognition device according to the present invention is mounted. As shown in the figure, a front portion of the vehicle 1 (for example,
A scanning laser radar (front object recognizing means) 2 is attached to a bumper section or the like with a fastener or the like.

【0013】このスキャン式レーザレーダ2は、レーザ
ビームを照射することで物体を認識し、当該レーザレー
ダ2に対する物体の相対位置を認識可能な高精度のレー
ダ装置であり、ここでは、例えば、所定の照射範囲(例
えば、水平方向で12°〜24°、上下方向で4°)内
で細いレーザビーム照射して等間隔に数百方向の距離を
測定する方式のレーダ装置が用いられる。なお、このよ
うなスキャン式レーザレーダは公知であるため、ここで
は、その構成の詳細な説明は省略する。
The scanning laser radar 2 is a high-precision radar device capable of recognizing an object by irradiating a laser beam and recognizing a relative position of the object with respect to the laser radar 2. (E.g., 12 ° to 24 ° in the horizontal direction, 4 ° in the vertical direction) and irradiates a thin laser beam to measure distances in several hundred directions at equal intervals. Since such a scanning laser radar is known, a detailed description of its configuration is omitted here.

【0014】また、車両1の車室内に設けられ、車両1
の一対の前車輪4,4の操舵を行うステアリングホイー
ル10のステアリングコラム12には、ステアリング角
度、つまりハンドル角θHを検出するハンドル角センサ
14が設けられている。さらに一対の後車輪6,6の近
傍には、それぞれ後車輪6,6の車輪速を検出する一対
の車輪速センサ20,20が設けられている。これら一
対の車輪速センサ20,20は車速センサとして機能し
ており、つまり、これら一対の車輪速センサ20,20
からの情報に基づき車速Vが検出可能とされている(車
速検出手段)。なお、トランスミッション(図示せず)
の出力軸に軸回転センサを設け、この軸回転センサから
の情報に基づき車速Vを求めるようにしてもよい。
The vehicle 1 is provided in the cabin of the vehicle 1.
The steering column 12 of the steering wheel 10 for steering the pair of front wheels 4, 4 is provided with a steering wheel angle sensor 14 for detecting a steering angle, that is, a steering wheel angle θH. Further, a pair of wheel speed sensors 20, 20 for detecting the wheel speeds of the rear wheels 6, 6 are provided near the pair of rear wheels 6, 6, respectively. The pair of wheel speed sensors 20, 20 function as a vehicle speed sensor, that is, the pair of wheel speed sensors 20, 20,
The vehicle speed V can be detected based on the information from the vehicle (vehicle speed detecting means). Transmission (not shown)
May be provided with a shaft rotation sensor, and the vehicle speed V may be obtained based on information from the shaft rotation sensor.

【0015】そして、上記スキャン式レーザレーダ2、
ハンドル角センサ14、車輪速センサ20,20は、C
PU、ROM、RAM等からなる電子制御ユニット(E
CU)30の入力側に電気的に接続されている。一方、
ECU30の出力側には、車間距離制御システム等の各
種走行制御部40が接続されている。なお、ECU30
は、車両1の運転に関わる各種制御を司る主制御ユニッ
トであり、故にECU30の入力側には上記以外にも各
種センサ類が接続され、また出力側にも種々の駆動装
置、制御装置等が接続されている。
Then, the scanning laser radar 2,
The steering wheel angle sensor 14 and the wheel speed sensors 20, 20 are C
Electronic control unit (E) consisting of PU, ROM, RAM, etc.
CU) 30 is electrically connected to the input side. on the other hand,
Various running control units 40 such as an inter-vehicle distance control system are connected to the output side of the ECU 30. The ECU 30
Is a main control unit that controls various controls related to the operation of the vehicle 1. Therefore, various sensors are connected to the input side of the ECU 30 in addition to the above, and various drive devices and control devices are also provided on the output side. It is connected.

【0016】以下、上記のように構成された前方車両認
識装置の作用について説明する。当該前方車両認識装置
では、通常、走行中においてレーザレーダ2により車両
1の前方に例えば先行車両が認識され、認識情報がEC
U30に供給されると、ECU30によって認識情報が
処理されて先行車両の位置が認知され、この位置情報が
各種走行制御部40に供給される。そして、各種走行制
御部40において、例えば車間距離制御等の走行制御が
実行される。車間距離制御にあっては、例えば車速Vの
増減速制御が実施され、これにより車両1の走行安全性
が維持されることになる。
In the following, the operation of the preceding vehicle recognition device configured as described above will be described. In the preceding vehicle recognition device, normally, for example, a preceding vehicle is recognized in front of the vehicle 1 by the laser radar 2 during traveling, and the recognition information is set to EC.
When supplied to the U30, the recognition information is processed by the ECU 30, the position of the preceding vehicle is recognized, and this position information is supplied to various traveling control units 40. Then, in the various traveling control units 40, traveling control such as inter-vehicle distance control is performed. In the inter-vehicle distance control, for example, acceleration / deceleration control of the vehicle speed V is performed, whereby the traveling safety of the vehicle 1 is maintained.

【0017】ところが、前述したように、レーザレーダ
2は、その光軸方向(認識方向軸線)が車両1の前後軸
線方向からずれていると、車両1の前方の物体(以下、
前方物体という)の位置を正しく認識できない。つま
り、レーザレーダ2は、通常、その光軸方向が車両1の
前後軸線から許容誤差範囲内(例えば、±0.5deg)
で精度よく車両1に取り付けられてはいるが、光軸が例
えば車両振動等に伴う経時変化によって車両1の前後軸
線から上記許容誤差範囲を超えて左右にずれてしまって
いると、前方認識装置は、車両1の前後軸線とレーザレ
ーダ2の光軸とが一致しているものとみなして前方物体
の位置を認識するため、実際には、前方物体が車両1の
前後軸線よりも右側或いは左側にあるにも拘わらず、そ
の前方物体を車両1の前方にあると誤認識してしまう場
合がある。即ち、レーザレーダ2の光軸方向が車両の前
後軸線方向からずれていると、道路上で前方認識装置を
用いて上記車間距離制御を行いたいような場合におい
て、隣接車線を走行している斜め前方の車両を先行車両
と誤判断する等し、正確な車間距離制御が実施されない
ことがあり得るのである。
However, as described above, when the optical axis direction (recognition direction axis) of the laser radar 2 is deviated from the front-rear axis direction of the vehicle 1, an object in front of the vehicle 1 (hereinafter, referred to as the vehicle).
Position (referred to as the front object) cannot be correctly recognized. That is, the laser radar 2 normally has its optical axis direction within an allowable error range (for example, ± 0.5 deg) from the longitudinal axis of the vehicle 1.
Although it is attached to the vehicle 1 with high accuracy, if the optical axis is shifted left and right from the longitudinal axis of the vehicle 1 beyond the permissible error range due to a temporal change due to, for example, vehicle vibration, the forward recognition device Is assumed that the front-rear axis of the vehicle 1 coincides with the optical axis of the laser radar 2 and recognizes the position of the front object. Therefore, the front object is actually located on the right or left side of the front-rear axis of the vehicle 1. May be erroneously recognized as being in front of the vehicle 1. That is, if the direction of the optical axis of the laser radar 2 is deviated from the front-rear axis direction of the vehicle, the above-mentioned inter-vehicle distance control is desired to be performed on the road using the front recognition device. It is possible that the vehicle is incorrectly determined to be the preceding vehicle, and that accurate inter-vehicle distance control may not be performed.

【0018】そこで、本発明の前方認識装置では、レー
ザレーダ2の光軸の車両1の前後軸線からのずれ量ψを
正確に求め、この光軸ずれ量ψをレーザレーダ2からの
情報に加味することで、車両1の前方にある物体の位置
を常に正確に把握するようにしている。図2を参照する
と、前方認識装置における上記光軸ずれ量ψの検出機能
がブロック図で示されており、また、図3を参照する
と、ECU30が例えば150msecの周期で実行する上
記光軸ずれ量ψの演算ルーチンのフローチャートが示さ
れている。以下、これら図2、図3に基づき、本発明に
係る前方認識装置の光軸ずれ量ψの検出手順について説
明する。
Therefore, in the forward recognition device of the present invention, the deviation ψ of the optical axis of the laser radar 2 from the longitudinal axis of the vehicle 1 is accurately obtained, and this optical axis deviation ψ is added to the information from the laser radar 2. By doing so, the position of the object in front of the vehicle 1 is always accurately grasped. FIG. 2 is a block diagram showing a function of detecting the optical axis shift amount に お け る in the forward recognition device, and FIG. 3 is a block diagram showing the optical axis shift amount executed by the ECU 30 at a cycle of, for example, 150 msec. The flowchart of the calculation routine of ψ is shown. Hereinafter, a procedure for detecting the optical axis shift amount の of the forward recognition device according to the present invention will be described with reference to FIGS.

【0019】図3のステップS10において、ECU3
0は、先ず、車輪速センサ20,20からの車速情報V
及びハンドル角センサ14からのハンドル角情報θHと
を読込む。そして、さらに、ステップS12において、
レーザレーダ2からの認識情報を読込む。ステップS1
4では、図2中の車両挙動演算部(車両挙動検出手段)
50において、上記車速情報Vとハンドル角情報θHと
に基づいて車両挙動のファクタであるヨーレイトγ及び
車両重心スリップ角βを演算する。ここに、ヨーレイト
γとは、車両1がハンドル操作等によってヨー運動する
ときのヨー角速度のことであり、車両重心スリップ角β
とは、車両1の前後軸線方向と車両1の進行方向とのな
す角度である。なお、これらヨーレイトγ及び車両重心
スリップ角βの演算方法等は公知であるため、ここでは
説明を省略する。
In step S10 of FIG.
0 is the vehicle speed information V from the wheel speed sensors 20 and 20 first.
And the handle angle information θH from the handle angle sensor 14 is read. And further, in step S12,
The recognition information from the laser radar 2 is read. Step S1
4, the vehicle behavior calculation unit (vehicle behavior detection means) in FIG.
At 50, the yaw rate γ and the vehicle center-of-gravity slip angle β, which are factors of the vehicle behavior, are calculated based on the vehicle speed information V and the steering wheel angle information θH. Here, the yaw rate γ is a yaw angular velocity when the vehicle 1 performs a yaw motion by operating a steering wheel or the like, and the vehicle center-of-gravity slip angle β
Is the angle between the longitudinal axis direction of the vehicle 1 and the traveling direction of the vehicle 1. Since the method of calculating the yaw rate γ and the vehicle center-of-gravity slip angle β is known, the description thereof is omitted here.

【0020】次のステップS16では、図2中の車両移
動量演算部(車両移動量演算手段)52において、上記
車速V、ヨーレイトγ及び車両重心スリップ角βとに基
づき、車両1の単位時間あたりの移動量、即ち、地上の
座標系(x−y)で見た当該ルーチンの実行周期(例え
ば、150msec)毎の車両1の微少移動量Δx,Δy,
Δφを算出する。ここに、Δxは車両1の横方向、Δy
は前後方向の微少移動量であり、Δφは車両1の微少回
転角度を示している。なお、これら微少移動量Δx,Δ
y,Δφの演算方法等についても公知であるため、ここ
では説明を省略する。
In the next step S16, the vehicle movement amount calculating unit (vehicle movement amount calculating means) 52 in FIG. 2 calculates the per unit time of the vehicle 1 based on the vehicle speed V, the yaw rate γ and the vehicle center of gravity slip angle β. , That is, the minute movement amounts Δx, Δy, of the vehicle 1 in each execution cycle (for example, 150 msec) of the routine viewed in the coordinate system (xy) on the ground.
Calculate Δφ. Here, Δx is the lateral direction of the vehicle 1, Δy
Is a minute movement amount in the front-rear direction, and Δφ is a minute rotation angle of the vehicle 1. Note that these small movement amounts Δx, Δ
The method of calculating y and Δφ is also known, and a description thereof will be omitted.

【0021】次のステップS18では、一方、レーザレ
ーダ2からの情報に基づき、車両1の前方の停止物、具
体的には、車両1の前方の路側に付設されているポール
状の反射板(以下、デリニエータDという)の位置を車
両の座標系(x'−y')において求める。なお、ここに
いう車両の座標系(x'−y')とは、レーザレーダ2の
光軸を車両1の前後方向、つまりy'軸として見た場合
の系であり、実際の車両座標系とは区別される。
In the next step S18, on the other hand, on the basis of information from the laser radar 2, a stationary object in front of the vehicle 1, specifically, a pole-shaped reflector attached to a roadside in front of the vehicle 1 ( Hereinafter, the position of the delineator D) is obtained in the vehicle coordinate system (x′−y ′). Note that the vehicle coordinate system (x'-y ') is a system in which the optical axis of the laser radar 2 is viewed in the front-rear direction of the vehicle 1, that is, the y' axis. Is distinguished.

【0022】詳しくは、このステップS18では、先ず
図2中の前方物体認識部(前方物体相対位置認知手段)
60においてレーザレーダ2が認識する全ての前方物体
の位置(相対位置)を車両の座標系(x'−y')におい
て認知する。そして、これら前方物体の位置情報が、次
に停止物判定処理部(停止物判定手段)62に送られ
る。
More specifically, in step S18, first, the front object recognition unit (front object relative position recognition means) in FIG.
At 60, the positions (relative positions) of all forward objects recognized by the laser radar 2 are recognized in the vehicle coordinate system (x'-y '). Then, the position information of these forward objects is sent to a stationary object determination processing unit (stationary object determining means) 62 next.

【0023】停止物判定処理部62では、前方物体認識
部60において認識した前方物体の中からデリニエータ
Dの位置情報を判定する。具体的には、ここでは、レー
ザレーダ2による当該ルーチンの前回実行時における前
方物体の位置情報と今回の位置情報とを比較し、このと
きの車両の座標系(x'−y')での差Δx',Δy'が上
記地上の座標系(x−y)で見た車両1の微少移動量Δ
x,Δyと略一致しているか否かで判定する。つまり、
停止物であればΔx',Δy'とΔx,Δyとがそれぞれ
略一致するはずであり、故にΔx',Δy'とΔx,Δy
とがそれぞれ略一致するようなポール状の物体について
はデリニエータDと判定するのである。そして、当該デ
リニエータDと判定された位置情報のみが次の停止物移
動軌跡演算部64に送られる。
The stationary object determination processing section 62 determines the position information of the delineator D from the front objects recognized by the front object recognition section 60. Specifically, here, the position information of the forward object at the time of the previous execution of the routine by the laser radar 2 is compared with the current position information, and the position information of the vehicle in the coordinate system (x′−y ′) at this time is compared. The differences Δx ′ and Δy ′ are the minute movement amounts Δ of the vehicle 1 as viewed in the coordinate system (xy) on the ground.
Judgment is made based on whether they substantially match x and Δy. That is,
In the case of a stationary object, Δx ′, Δy ′ and Δx, Δy should substantially coincide with each other, and therefore Δx ′, Δy ′ and Δx, Δy
Is determined as a delineator D for a pole-shaped object having substantially the same values as. Then, only the position information determined to be the delineator D is sent to the next stationary object movement trajectory calculation unit 64.

【0024】なお、このとき停止物判定処理部62にお
いて判定されるデリニエータDの情報は一つとは限られ
ない。従って、認識される全てのデリニエータDの情報
が停止物移動軌跡演算部64に送られ処理されることに
なる。但し、ここでは、説明を簡単にするため、認識さ
れるデリニエータDが一つであるものとして以下説明す
る。
At this time, the information of the delineator D determined by the stationary object determination processing unit 62 is not limited to one. Therefore, the information of all recognized delineators D is sent to the stationary object movement trajectory calculation unit 64 and processed. However, here, for the sake of simplicity, the description will be made assuming that there is one recognized delineator D.

【0025】停止物移動軌跡演算部(移動軌跡演算手
段)64では、今回のデリニエータDの位置情報K1
(x'1,y'1)と、例えば当該ルーチンの5回前の実行
時(所定期間)の同一デリニエータDの位置情報K0
(x'0,y'0)との差に基づいてデリニエータDの移動
軌跡(相対位置移動軌跡)を求める。なお、デリニエー
タDの同一性の判定は、上記Δx',Δy'とΔx,Δy
とが略一致しているか否かの判別に基づいて行われる。
即ち、Δx',Δy'の上記当該ルーチンの5回実行分の
加算値とΔx,Δyの5回実行分の加算値とが略一致す
るデリニエータDは同一のものとみなされる。
The stationary object movement trajectory calculation unit (movement trajectory calculation means) 64 calculates the position information K1 of the current delineator D.
(X'1, y'1) and, for example, the position information K0 of the same delineator D at the time of execution (predetermined period) five times before this routine.
The movement trajectory (relative position movement trajectory) of the delineator D is obtained based on the difference from (x'0, y'0). Note that the determination of the identity of the delineator D is based on Δx ′, Δy ′ and Δx, Δy.
Is determined based on whether or not approximately matches.
That is, the delineators D in which the added values of Δx ′ and Δy ′ for the five executions of the routine and the added values of Δx and Δy for the five executions substantially match are regarded as the same.

【0026】このようにしてデリニエータDのK0(x'
0,y'0)からK1(x'1,y'1)までの移動軌跡が演算
されたら、次のステップS20では、光軸ずれ量演算部
(方向ずれ量演算手段)70において、レーザレーダ2
の光軸と車両1の前後軸線とのずれ量、即ち光軸ずれ量
ψを演算する。図4の模式図を参照すると、レーザレー
ダ2の光軸Oが実際に角度ψだけずれている場合のレー
ザレーダ2の実際の認識範囲及び光軸Oが実線で示され
ており、また、車両1の前方の路側に付設されているデ
リニエータDが、実際の車両座標系で見たものとして示
されている。そして、さらに、このデリニエータDの当
該光軸ずれ量演算ルーチンの5回の実行周期期間におけ
る実際の車両座標系での移動軌跡が実線矢印で示されて
いる。
Thus, K0 (x 'of the delineator D)
After the movement trajectory from (0, y'0) to K1 (x'1, y'1) is calculated, in the next step S20, an optical axis shift amount calculating unit (direction shift amount calculating means) 70 uses a laser radar. 2
Of the optical axis of the vehicle 1 and the longitudinal axis of the vehicle 1, that is, the optical axis deviation ず れ. Referring to the schematic diagram of FIG. 4, the actual recognition range of the laser radar 2 and the optical axis O when the optical axis O of the laser radar 2 is actually shifted by the angle ψ are shown by solid lines. The delineator D attached to the roadside in front of the vehicle 1 is shown as viewed in the actual vehicle coordinate system. Further, the actual movement trajectory in the vehicle coordinate system during five execution cycle periods of the optical axis deviation amount calculation routine of the delineator D is indicated by solid arrows.

【0027】また、同図には、車両の座標系(x'−
y')において前方認識装置が認識範囲と擬制する範囲
が二点鎖線で示されており、車両の座標系(x'−y')
における上記デリニエータDの位置K0(x'0,y'
0)、K1(x'1,y'1)が破線で、また、上記デリニエ
ータDのK0(x'0,y'0)からK1(x'1,y'1)まで
の移動軌跡が破線矢印で示されている。
FIG. 2 also shows a coordinate system (x'-
In y ′), the range assumed by the forward recognition device as the recognition range is indicated by a two-dot chain line, and the coordinate system (x′−y ′) of the vehicle is used.
Of the delineator D in the position K0 (x'0, y '
0) and K1 (x'1, y'1) are indicated by broken lines, and the trajectory of the delineator D from K0 (x'0, y'0) to K1 (x'1, y'1) is indicated by broken lines. Indicated by arrows.

【0028】さらに、同図を参照すると、上記位置K0
(x'0,y'0)を基点として、上記車両挙動のファクタ
に基づき、つまり車両1の移動量に基づき推定したデリ
ニエータDの推定移動軌跡も一点鎖線で併せて示されて
いる。本来、レーザレーダ2の光軸Oが車両の座標系
(x'−y')のy'軸に一致するようにレーザレーダ2
が正しく設置されていれば、デリニエータDの推定移動
軌跡(一点鎖線)とレーザレーダ2で認識した車両の座
標系(x'−y')でのデリニエータDの移動軌跡(破
線)とは完全に一致するはずである。しかしながら、光
軸Oがy'軸から角度ψだけずれているような場合に
は、各移動軌跡(一点鎖線及び破線)は、同図に示すよ
うに角度ψに応じた分だけずれたものとなる。
Still referring to FIG.
With (x'0, y'0) as a base point, the estimated movement trajectory of the delineator D estimated based on the above-described vehicle behavior factor, that is, based on the movement amount of the vehicle 1, is also shown by a dashed line. Originally, the laser radar 2 is set so that the optical axis O of the laser radar 2 coincides with the y 'axis of the vehicle coordinate system (x'-y').
Is correctly installed, the estimated movement trajectory of the delineator D (dot-dash line) and the movement trajectory of the delineator D in the vehicle coordinate system (x'-y ') recognized by the laser radar 2 (dashed line) are completely Should match. However, when the optical axis O is shifted from the y ′ axis by an angle ψ, each movement trajectory (dashed line and broken line) is shifted by an amount corresponding to the angle よ う as shown in FIG. Become.

【0029】そこで、本発明の前方車両認識装置では、
これら各移動軌跡(一点鎖線及び破線)のずれに着目す
ることでレーザレーダ2の光軸Oのずれ量ψを検出する
ようにしている。以下、光軸ずれ量ψの演算方法につい
て述べる。上記各移動軌跡(一点鎖線及び破線)の関係
を数学的に解析すると、車両の座標系(x'−y')にお
けるデリニエータDの位置情報K0(x'0,y'0)、K1
(x'1,y'1)と地上の座標系(x−y)における上記
Δx,Δy,Δφの当該ルーチン5回実行分の各加算値
(以下、ΔX,ΔY,ΔΦとする)と光軸ずれ量ψとの
間には座標変換の式に基づき次式(1)の関係が成り立っ
ている。
Therefore, in the forward vehicle recognition device of the present invention,
The shift amount の of the optical axis O of the laser radar 2 is detected by paying attention to the shift of each of these movement trajectories (dashed line and broken line). Hereinafter, a method of calculating the optical axis shift amount ψ will be described. When mathematically analyzing the relationship between the above-mentioned respective movement trajectories (dashed line and broken line), position information K0 (x'0, y'0) and K1 of the delineator D in the vehicle coordinate system (x'-y ') are obtained.
(X′1, y′1) and the sum (hereinafter referred to as ΔX, ΔY, ΔΦ) of each of the above five executions of the routine of Δx, Δy, Δφ in the coordinate system (xy) on the ground, and light The relationship of the following equation (1) is established between the axis shift amount ψ and the axis shift amount ψ based on the coordinate conversion equation.

【0030】そこで、ここでは、この式(1)をψについ
て解くことで光軸ずれ量ψを求める。
Therefore, here, the optical axis shift amount 求 め る is obtained by solving the equation (1) for ψ.

【0031】[0031]

【数1】 (Equation 1)

【0032】ここに、R(−ψ)、R(ΔΦ)は、それ
ぞれ回転行列を示している。そして、以上のようにして
求められた光軸ずれ量ψは、次に図2中の統計処理部
(統計処理手段)72に送られてECU30の例えばR
AM内にデータとして一定期間に亘り蓄積される。詳し
くは、このように一定期間に亘り蓄積された光軸ずれ量
ψのデータは、横軸を光軸ずれ量ψとする図5に示すよ
うな度数分布のグラフ、即ちヒストグラムとして処理さ
れる。
Here, R (-ψ) and R (ΔΦ) each represent a rotation matrix. Then, the optical axis shift amount ψ obtained as described above is sent to the statistical processing unit (statistical processing means) 72 in FIG.
It is stored as data in the AM for a certain period. More specifically, the data of the optical axis shift amount 蓄積 accumulated over a certain period as described above is processed as a graph of a frequency distribution as shown in FIG.

【0033】本来ならば、デリニエータDの位置情報に
基づいて算出される光軸ずれ量ψは上記式(1)から常に
特定の値として一義に求まるはずである。しかしなが
ら、実際には、同図に示すように、光軸ずれ量ψにはば
らつきが認められる。これは、位置情報に外部ノイズ信
号が影響することがあり、この外部ノイズ信号に応じて
光軸ずれ量ψが変動するためである。
Originally, the optical axis shift amount 算出 calculated based on the position information of the delineator D should always be unambiguously determined as a specific value from the above equation (1). However, in practice, as shown in the figure, there is a variation in the optical axis shift amount ψ. This is because the position information may be affected by an external noise signal, and the optical axis shift amount 変 動 varies according to the external noise signal.

【0034】そこで、当該統計処理部72では、ステッ
プS22に示すように、光軸ずれ量ψを図5に示すヒス
トグラムとして統計処理し、このヒストグラムから光軸
ずれ量ψの重心値ψcを求めるようにし、この重心値、
つまり最適光軸ずれ量(最適方向ずれ量)ψcを最終的
に光軸ずれ量ψとして出力するようにしている。故に、
光軸ずれ量ψは信頼性の高いものとされている。
Therefore, as shown in step S22, the statistical processing section 72 statistically processes the optical axis shift amount と し て as a histogram shown in FIG. 5, and obtains the barycenter value ψc of the optical axis shift amount か ら from this histogram. And this center of gravity value,
That is, the optimal optical axis deviation amount (optimal direction deviation amount) {c} is finally output as the optical axis deviation amount ψ. Therefore,
The optical axis shift amount ψ is considered to be highly reliable.

【0035】このようにして最適光軸ずれ量ψcが求ま
ると、この最適光軸ずれ量情報ψcは、次に図2中の位
置情報補正部(位置情報補正手段)80に送られる。こ
の位置情報補正部80には上述の前方物体認識部60か
ら先行車両等の前方物体位置情報が入力するのである
が、当該位置情報補正部80では、この前方物体位置情
報を上記最適光軸ずれ量ψcに応じて補正する。これに
より、レーザレーダ2の光軸が車両1の前後軸線からず
れているような場合であっても、前方物体位置が常に正
確に把握されることになる。
When the optimum optical axis deviation amount Δc is obtained in this manner, the optimum optical axis deviation amount information Δc is sent to the position information correction unit (position information correction means) 80 in FIG. The position information correction unit 80 receives the front object position information of the preceding vehicle or the like from the front object recognition unit 60, and the position information correction unit 80 converts the front object position information into the optimal optical axis deviation. Correct according to the amount ψc. Thus, even if the optical axis of the laser radar 2 is deviated from the longitudinal axis of the vehicle 1, the position of the front object can always be accurately grasped.

【0036】従って、図2中には車間距離制御システム
等の各種走行制御部40が示されているが、当該各種走
行制御部40に先行車両の位置情報等が供給された場合
において、常に適正な走行制御が実施可能とされる。例
えば、車間距離制御システムに関していえば、隣接車線
の車両を先行車両と誤認識することなく、同一車線上で
車両1の前方を走行している車両を正確に先行車両とし
て把握することができ、レーザレーダ2の光軸のずれ如
何に拘わらず車間距離制御を正確に実施可能となる。
Accordingly, FIG. 2 shows various traveling control units 40 such as an inter-vehicle distance control system. However, when the various traveling control units 40 are supplied with the position information of the preceding vehicle, etc. Cruise control can be performed. For example, regarding the inter-vehicle distance control system, a vehicle traveling ahead of the vehicle 1 on the same lane can be accurately grasped as a preceding vehicle without erroneously recognizing a vehicle in an adjacent lane as a preceding vehicle, Inter-vehicle distance control can be performed accurately regardless of the displacement of the optical axis of the laser radar 2.

【0037】以上、詳細に説明したように、本発明の前
方車両認識装置では、レーザレーダ2の光軸が車両1の
前後軸線からずれた場合であっても、光軸ずれ量ψを演
算により容易に求めることができる。従って、レーザレ
ーダ2自体の取付け状態を一々修正することなく、前方
車両の位置を正確に把握することが可能となる。特に、
本発明の前方車両認識装置では、車両挙動のファクタか
ら車両1の移動量を求め、この移動量、即ち走行方向の
情報(ΔX,ΔY,ΔΦ)に基づいて光軸ずれ量ψを求
めることが可能であるので(式(1)参照)、車両1が直
線路を走行している場合のみならず、カーブ路を走行し
ている場合であっても、常に良好に光軸ずれ量ψを求め
ることが可能とされる。
As described above in detail, in the forward vehicle recognizing device of the present invention, even when the optical axis of the laser radar 2 is deviated from the longitudinal axis of the vehicle 1, the optical axis deviation ψ is calculated. It can be easily obtained. Therefore, it is possible to accurately grasp the position of the vehicle ahead without correcting the mounting state of the laser radar 2 itself. In particular,
In the forward vehicle recognition device of the present invention, the moving amount of the vehicle 1 is obtained from the factor of the vehicle behavior, and the optical axis deviation amount 軸 is obtained based on the moving amount, that is, the information (ΔX, ΔY, ΔΦ) of the traveling direction. Since it is possible (see Equation (1)), the optical axis deviation amount 常 に is always favorably obtained not only when the vehicle 1 is traveling on a straight road but also when traveling on a curved road. It is made possible.

【0038】また、ここでは、演算処理によって求めら
れる光軸ずれ量ψをそのまま用いて前方車両の位置情報
の補正を行うのではなく、過去一定期間蓄積された光軸
ずれ量ψの度数分布(ヒストグラム)上の重心値、即ち
最適光軸ずれ量ψcを光軸ずれ量ψとして採用するよう
にしているので、外部ノイズ信号の影響等により光軸ず
れ量ψの演算値がばらつくことがあっても、光軸ずれ量
ψを信頼性の高いものにでき、レーザレーダ2からの情
報に基づき制御の実施される車間距離制御等の各種走行
制御がより正確なものとされる。
Here, instead of using the optical axis deviation ψ obtained by the arithmetic processing as it is to correct the positional information of the preceding vehicle, the frequency distribution of the optical axis deviation ψ accumulated in the past fixed period ( Since the center of gravity value on the histogram), that is, the optimum optical axis shift amount {c} is adopted as the optical axis shift amount ψ, the calculated value of the optical axis shift amount に よ り may vary due to the influence of an external noise signal or the like. In addition, the optical axis deviation amount ψ can be made highly reliable, and various traveling controls such as inter-vehicle distance control, which are controlled based on information from the laser radar 2, are made more accurate.

【0039】なお、上記実施形態では、前方認識手段と
してスキャン式レーザレーダ2を用いるようにしたが、
これに限らず、前方認識手段にCCDカメラ等の撮像装
置を用いるようにしても同様の効果が得られる。
In the above embodiment, the scanning laser radar 2 is used as the forward recognition means.
However, the same effect can be obtained by using an imaging device such as a CCD camera for the forward recognition means.

【0040】[0040]

【発明の効果】以上、詳細に説明したように、本発明の
請求項1の車両の前方認識装置によれば、前方物体認識
手段の認識方向軸線と車両の前後軸線とに方向ずれがあ
るような場合において、方向ずれ量演算手段により、直
線路或いはカーブ路に拘わらず、前方物体認識手段の認
識方向軸線と車両の前後軸線との方向ずれ量を移動軌跡
演算手段による停止物体の相対位置移動軌跡と車両移動
量演算手段による車両の走行方向の情報とに基づいて容
易に演算により求めることができ、前方物体相対位置認
知手段によって認知される車両前方の物体の相対位置情
報を常に適正なものに補正することができる。従って、
例えば、先行車両の位置情報を用いて車間距離制御等の
走行制御を行う場合であっても、先行車両の位置を常に
正確に把握でき、適正な走行制御を実現することができ
る。
As described in detail above, according to the vehicle front recognition apparatus of the first aspect of the present invention, the direction of the recognition direction of the front object recognition means and the front and rear axis of the vehicle are deviated. In such a case, the direction shift amount calculating means calculates the direction shift amount between the recognition direction axis of the front object recognizing means and the front-rear axis of the vehicle, regardless of a straight road or a curved road, by moving the relative position of the stationary object by the moving path calculating means. The relative position information of the object ahead of the vehicle, which can be easily obtained by calculation based on the trajectory and the information of the traveling direction of the vehicle by the vehicle movement amount calculating means, is always correct. Can be corrected. Therefore,
For example, even when running control such as inter-vehicle distance control is performed using the position information of the preceding vehicle, the position of the preceding vehicle can always be accurately grasped, and appropriate running control can be realized.

【0041】また、請求項2の車両の前方認識装置によ
れば、方向ずれ量演算手段により前方物体認識手段の認
識方向軸線と車両の前後軸線との方向ずれ量を容易に演
算により求めることができるとともに、統計処理手段に
よって方向ずれ量の分布の重心値を最適方向ずれ量とし
て決定するので、方向ずれ量が外部ノイズ信号等の影響
によってばらつくようなことがあっても、方向ずれ量を
常に適正なものにでき、前方物体相対位置認知手段によ
って認知される車両前方の物体の位置情報を極めて好適
に補正することができる。
According to the vehicle front recognition apparatus of the second aspect, the direction deviation amount between the recognition direction axis of the front object recognition means and the front-rear axis of the vehicle can be easily obtained by the direction deviation calculation means. In addition, since the center of gravity value of the distribution of the direction shift amount is determined as the optimum direction shift amount by the statistical processing means, even if the direction shift amount varies due to the influence of an external noise signal or the like, the direction shift amount is always determined. The position information of the object ahead of the vehicle recognized by the forward object relative position recognition means can be corrected very suitably.

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

【図1】車両に搭載された前方認識装置の概略構成図で
ある。
FIG. 1 is a schematic configuration diagram of a forward recognition device mounted on a vehicle.

【図2】本発明に係る前方認識装置の光軸ずれ量の検出
機能を示すブロック図である。
FIG. 2 is a block diagram showing a function of detecting an optical axis shift amount of the forward recognition device according to the present invention.

【図3】光軸ずれ量演算処理ルーチンを示すフローチャ
ートである。
FIG. 3 is a flowchart illustrating an optical axis shift amount calculation processing routine;

【図4】光軸ずれ量の演算方法を説明するための模式図
である。
FIG. 4 is a schematic diagram for explaining a method of calculating an optical axis shift amount.

【図5】光軸ずれ量のヒストグラムを示す図である。FIG. 5 is a diagram illustrating a histogram of an optical axis shift amount.

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

1 車両 2 スキャン式レーザレーダ(前方物体認識手段) 14 ハンドル角センサ 20 車輪速センサ 30 電子制御ユニット(ECU) 40 各種走行制御部 50 車両挙動演算部(車両挙動検出手段) 52 車両移動量演算部(車両移動量演算手段) 60 前方物体認識部(前方物体相対位置認知手段) 62 停止物判定処理部(停止物判定手段) 64 停止物移動軌跡演算部(移動軌跡演算手段) 70 光軸ずれ量演算部(方向ずれ量演算手段) 72 統計処理部(統計処理手段) 80 位置情報補正部(位置情報補正手段) D デリニエータ(停止物体) DESCRIPTION OF SYMBOLS 1 Vehicle 2 Scanning laser radar (forward object recognition means) 14 Handle angle sensor 20 Wheel speed sensor 30 Electronic control unit (ECU) 40 Various traveling control units 50 Vehicle behavior calculation unit (Vehicle behavior detection means) 52 Vehicle travel distance calculation unit (Vehicle movement amount calculation means) 60 Forward object recognition unit (Front object relative position recognition means) 62 Stop object determination processing unit (Stop object determination means) 64 Stop object movement trajectory calculation unit (Motion trajectory calculation means) 70 Optical axis deviation amount Calculation unit (direction shift amount calculation means) 72 Statistical processing unit (statistical processing means) 80 Position information correction unit (position information correction means) D Delineator (stop object)

───────────────────────────────────────────────────── フロントページの続き (56)参考文献 特開 平9−281239(JP,A) 特開 平7−209414(JP,A) 特開 平6−160510(JP,A) 特開 平7−120555(JP,A) (58)調査した分野(Int.Cl.7,DB名) G01S 7/00 - 7/51 G01S 17/00 - 17/95 G01S 13/00 - 13/95 ────────────────────────────────────────────────── ─── Continuation of the front page (56) References JP-A-9-281239 (JP, A) JP-A-7-209414 (JP, A) JP-A-6-160510 (JP, A) JP-A-7-281 120555 (JP, A) (58) Fields investigated (Int. Cl. 7 , DB name) G01S 7 /00-7/51 G01S 17/00-17/95 G01S 13/00-13/95

Claims (2)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】 車両の走行状況から車両の挙動を検出す
る車両挙動検出手段と、 前記車両挙動検出手段からの情報に基づき、所定期間に
おける車両の走行方向の情報を演算する車両移動量演算
手段と、 車両前方の物体を認識する前方物体認識手段と、 前記前方物体認識手段からの情報に基づき前記物体との
相対位置を認知する前方物体相対位置認知手段と、 前記車両移動量演算手段による演算結果と前記前方物体
相対位置認知手段からの相対位置情報とに基づき車両前
方の停止物体を判定する停止物判定手段と、 前記停止物判定手段からの情報に基づき、前記車両前方
の停止物体の前記所定期間における相対位置移動軌跡を
演算する移動軌跡演算手段と、 前記移動軌跡演算手段による前記停止物体の相対位置移
動軌跡の演算結果と前記車両移動量演算手段による前記
車両の移動量の演算結果とに基づき、前記前方物体認識
手段の認識方向軸線と車両の前後軸線との方向ずれ量を
演算する方向ずれ量演算手段と、 前記方向ずれ量演算手段による前記方向ずれ量の演算結
果に基づき、前記前方物体相対位置認知手段により認知
される前記相対位置情報を補正する位置情報補正手段
と、 を備えたことを特徴とする車両の前方認識装置。
1. A vehicle behavior detecting means for detecting a behavior of a vehicle from a traveling state of the vehicle, and a vehicle moving amount calculating means for calculating information on a traveling direction of the vehicle during a predetermined period based on information from the vehicle behavior detecting means. Forward object recognizing means for recognizing an object in front of the vehicle; forward object relative position recognizing means for recognizing a relative position to the object based on information from the front object recognizing means; A stationary object determining unit that determines a stationary object ahead of the vehicle based on the result and the relative position information from the forward object relative position recognizing unit. Based on the information from the stationary object determining unit, the stationary object ahead of the vehicle is A moving path calculating means for calculating a relative position moving path in a predetermined period; a calculation result of a relative position moving path of the stationary object by the moving path calculating means; A direction shift amount calculating unit that calculates a direction shift amount between the recognition direction axis of the front object recognizing unit and the front-rear axis of the vehicle based on a calculation result of the moving amount of the vehicle by the moving amount calculating unit; A position information correcting unit for correcting the relative position information recognized by the forward object relative position recognition unit based on a calculation result of the direction shift amount by the calculation unit; .
【請求項2】 前記方向ずれ量演算手段は、前記方向ず
れ量の分布を統計処理する統計処理手段を含み、前記分
布の重心値を最適方向ずれ量として出力することを特徴
とする、請求項1記載の車両の前方認識装置。
2. The method according to claim 1, wherein the direction shift amount calculating unit includes a statistical processing unit that statistically processes the distribution of the direction shift amount, and outputs a centroid value of the distribution as an optimum direction shift amount. 2. The forward recognition device for a vehicle according to claim 1.
JP29203896A 1996-11-01 1996-11-01 Vehicle front recognition device Expired - Fee Related JP3189711B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP29203896A JP3189711B2 (en) 1996-11-01 1996-11-01 Vehicle front recognition device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP29203896A JP3189711B2 (en) 1996-11-01 1996-11-01 Vehicle front recognition device

Publications (2)

Publication Number Publication Date
JPH10132939A JPH10132939A (en) 1998-05-22
JP3189711B2 true JP3189711B2 (en) 2001-07-16

Family

ID=17776735

Family Applications (1)

Application Number Title Priority Date Filing Date
JP29203896A Expired - Fee Related JP3189711B2 (en) 1996-11-01 1996-11-01 Vehicle front recognition device

Country Status (1)

Country Link
JP (1) JP3189711B2 (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3279683A1 (en) * 2016-07-22 2018-02-07 Delphi Technologies, Inc. Automated vehicle radar system with auto-alignment for azimuth, elevation, and vehicle speed-scaling-error
US10641878B2 (en) 2016-08-10 2020-05-05 Aptiv Technologies Limited Positional feedback sensing useful for automated vehicle LIDAR
US11548504B2 (en) 2019-12-20 2023-01-10 Hl Klemove Corp. Driver assistance system and control method thereof

Families Citing this family (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19858297A1 (en) 1998-12-17 2000-06-29 Daimler Chrysler Ag Method for correcting a signal of at least one sensor, on the basis of which a path curve can be determined on which the vehicle is moving
JP2001166051A (en) * 1999-12-10 2001-06-22 Fujitsu Ten Ltd Axis deviation detection device for vehicular radar device
DE19964020A1 (en) * 1999-12-30 2001-07-05 Bosch Gmbh Robert Method and device for misalignment detection in a motor vehicle radar system
JP3897956B2 (en) * 2000-06-27 2007-03-28 本田技研工業株式会社 Position detection device
JP3808287B2 (en) * 2000-06-27 2006-08-09 本田技研工業株式会社 Position detection device
JP3733863B2 (en) * 2001-02-02 2006-01-11 株式会社日立製作所 Radar equipment
JP3729132B2 (en) * 2002-01-16 2005-12-21 日産自動車株式会社 Axial misalignment detection device for vehicular radar device
DE10246066B4 (en) * 2002-10-02 2007-11-22 Robert Bosch Gmbh Method and device for calibrating an image sensor system in a motor vehicle
JP2004198159A (en) * 2002-12-17 2004-07-15 Nissan Motor Co Ltd Measuring device for axis misalignment of on-vehicle sensor
JP4013825B2 (en) 2003-05-22 2007-11-28 日産自動車株式会社 Vehicle travel control device
JP4895484B2 (en) 2004-06-28 2012-03-14 富士通テン株式会社 Axis deviation calculation method for on-vehicle radar device and on-vehicle radar axis deviation determination method
US7545313B2 (en) 2004-11-12 2009-06-09 Mitsubishi Electric Corporation Off-axis angle estimation method and apparatus using the same
JP2008026997A (en) * 2006-07-18 2008-02-07 Denso Corp Pedestrian recognition device and pedestrian recognition method
JP4345783B2 (en) * 2006-08-10 2009-10-14 オムロン株式会社 Object detection apparatus and method
DE112010003022T5 (en) 2009-07-22 2012-08-02 Ntn Corp. Vehicle control unit and speed detection device used therein
JP5566060B2 (en) * 2009-07-29 2014-08-06 Ntn株式会社 Vehicle control device
JP6442193B2 (en) * 2014-08-26 2018-12-19 株式会社トプコン Point cloud position data processing device, point cloud position data processing system, point cloud position data processing method and program
JP6527369B2 (en) 2015-03-31 2019-06-05 株式会社デンソー Vehicle control device and vehicle control method
JP6363549B2 (en) * 2015-03-31 2018-07-25 株式会社デンソー Vehicle control apparatus and vehicle control method
JP6475543B2 (en) * 2015-03-31 2019-02-27 株式会社デンソー Vehicle control apparatus and vehicle control method
JP6493196B2 (en) 2015-12-17 2019-04-03 株式会社デンソー Control device and control method
US10657654B2 (en) 2017-12-28 2020-05-19 Denso Ten Limited Abnormality detection device and abnormality detection method
JP7028722B2 (en) * 2018-06-05 2022-03-02 株式会社Soken Axial deviation angle detector
DE112020003009T5 (en) * 2019-08-02 2022-03-31 Hitachi Astemo, Ltd. TARGET DEVICE, DRIVING CONTROL SYSTEM AND METHOD FOR CALCULATING A CORRECTION FOR SENSOR DATA

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3279683A1 (en) * 2016-07-22 2018-02-07 Delphi Technologies, Inc. Automated vehicle radar system with auto-alignment for azimuth, elevation, and vehicle speed-scaling-error
US10114106B2 (en) 2016-07-22 2018-10-30 Delphi Technologies, Inc. Automated vehicle radar system with auto-alignment for azimuth, elevation, and vehicle speed-scaling-error
US10641878B2 (en) 2016-08-10 2020-05-05 Aptiv Technologies Limited Positional feedback sensing useful for automated vehicle LIDAR
US11548504B2 (en) 2019-12-20 2023-01-10 Hl Klemove Corp. Driver assistance system and control method thereof

Also Published As

Publication number Publication date
JPH10132939A (en) 1998-05-22

Similar Documents

Publication Publication Date Title
JP3189711B2 (en) Vehicle front recognition device
US6889161B2 (en) Method for recognizing a change in lane of a vehicle
US5479173A (en) Obstacle sensing apparatus for vehicles
KR0183383B1 (en) Vehicle surrounding monitoring device
JP2004345518A (en) Travel control device for vehicle
US20220355820A1 (en) Method for Determining an Avoidance Path of a Motor Vehicle
CN111806426A (en) Vehicle control device
JP3913911B2 (en) Vehicle obstacle detection device
JPH04248489A (en) Preceding car detector for vehicle
JP2002175599A (en) Lane position estimating device for precedent vehicle or target
JP2005182186A (en) Vehicular travel track setting system
CN110678778B (en) Vehicle system for detecting an oncoming vehicle
JP3058058B2 (en) Vehicle front object detection device
JP3189712B2 (en) Vehicle lane recognition device
JP4563619B2 (en) Vehicle driving support device
EP4015331B1 (en) Method and system for target detection of vehicle
JPH1068777A (en) On-vehicle preceding car detecting device
JPH11120497A (en) Course-out preventing device of vehicle
JP7216695B2 (en) Surrounding vehicle monitoring device and surrounding vehicle monitoring method
KR100469773B1 (en) Method and apparatus for correcting a curve radius
JP3979931B2 (en) Target speed calculation device and vehicle control device using the same
JP2000198402A (en) Object detector
JP3209671B2 (en) Curved road judgment device
JPH06144076A (en) Traveling controller of vehicle
KR20020097360A (en) Method for recognizing target of intelligent cruise control system in vehicle

Legal Events

Date Code Title Description
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20010417

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

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

Free format text: PAYMENT UNTIL: 20080518

Year of fee payment: 7

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

Free format text: PAYMENT UNTIL: 20090518

Year of fee payment: 8

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

Free format text: PAYMENT UNTIL: 20100518

Year of fee payment: 9

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

Free format text: PAYMENT UNTIL: 20100518

Year of fee payment: 9

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

Free format text: PAYMENT UNTIL: 20110518

Year of fee payment: 10

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

Free format text: PAYMENT UNTIL: 20110518

Year of fee payment: 10

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

Free format text: PAYMENT UNTIL: 20120518

Year of fee payment: 11

LAPS Cancellation because of no payment of annual fees