JP2015067220A - Vehicular acceleration suppression device and vehicular acceleration suppression method - Google Patents
Vehicular acceleration suppression device and vehicular acceleration suppression method Download PDFInfo
- Publication number
- JP2015067220A JP2015067220A JP2013204921A JP2013204921A JP2015067220A JP 2015067220 A JP2015067220 A JP 2015067220A JP 2013204921 A JP2013204921 A JP 2013204921A JP 2013204921 A JP2013204921 A JP 2013204921A JP 2015067220 A JP2015067220 A JP 2015067220A
- Authority
- JP
- Japan
- Prior art keywords
- acceleration
- parking frame
- vehicle
- host vehicle
- 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.)
- Granted
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
Description
本発明は、車両駐車時の運転支援を行う際の駐車枠の検出技術に関する。 The present invention relates to a technique for detecting a parking frame when driving assistance is performed when a vehicle is parked.
乗物の速度を制御する装置としては、例えば特許文献1に記載の安全装置がある。この安全装置では、ナビゲーション装置の地図データと現在位置の情報から乗物が道路から外れた位置にあることを検出し、乗物の走行速度を増加させる方向のアクセル操作があり且つ乗物の走行速度が所定の値より大きいと判断されたときは、アクセルの操作に拘わらずスロットルを減速方向に制御する。
As a device for controlling the speed of a vehicle, for example, there is a safety device described in
上記特許文献1は、アクセル操作の誤操作があっても運転者の意図しない車両の加速を防止することを目的としている。このとき、アクセルの操作が誤操作であるか否かの判断が課題となる。そして、上記特許文献1では、地図情報に基づき自車両が道路から外れた位置にあり且つ所定値以上の走行速度を検出しているときのアクセル踏込み操作を、アクセル誤操作の可能性があるとし、上記条件をスロットル抑制の作動条件としている。
The above-mentioned
しかし、上述の作動条件は、地図情報に基づくものなので、地図情報が正確なものでないと誤動作をしてしまう。
本発明は、上記のような点に着目してなされたもので、自車両が駐車枠に駐車する際の運転者の意図しない車両の加速や、駐車場ではない走行路での加速抑制の作動を防止することを目的とする。
However, since the above-described operating conditions are based on map information, a malfunction occurs if the map information is not accurate.
The present invention has been made paying attention to the above points, and the acceleration of the vehicle not intended by the driver when the host vehicle is parked in the parking frame, or the acceleration suppression operation on the travel path that is not the parking lot. The purpose is to prevent.
上記課題を解決するために、本発明の一態様は、自車両に設けられたカメラによって自車両周囲の領域を撮像した撮像画像を取得し、自車両の前後方向の加減速動作の発生に係る情報である加減速情報に基づき、自車両の前後方向に加減速時の車両姿勢を推定する。加えて、推定した車両姿勢に基づき、前記撮像画像から駐車枠を検出する駐車枠検出処理に用いる情報である検出用情報の内容を、車両姿勢のピッチ方向の変化によるカメラの路面に対する位置変化に応じた撮像画像の変化を小さくする内容に設定する。そして、設定した検出用情報を用いて撮像画像から駐車枠を検出し、駐車枠を検出すると、運転者の駆動力指示操作子の操作に応じた自車両の加速を抑制する制御である加速抑制制御を実施する。 In order to solve the above-described problem, an aspect of the present invention relates to generation of an acceleration / deceleration operation in the front-rear direction of the host vehicle by acquiring a captured image obtained by capturing a region around the host vehicle with a camera provided in the host vehicle. Based on the acceleration / deceleration information, which is information, the vehicle posture during acceleration / deceleration is estimated in the front-rear direction of the host vehicle. In addition, based on the estimated vehicle posture, the content of the detection information, which is information used for parking frame detection processing for detecting a parking frame from the captured image, is changed to a position change with respect to the road surface of the camera due to a change in the pitch direction of the vehicle posture The content is set so as to reduce the change of the corresponding captured image. Then, when the parking frame is detected from the captured image using the set detection information, and the parking frame is detected, the acceleration suppression is a control that suppresses the acceleration of the host vehicle in accordance with the operation of the driving force instruction operator of the driver. Implement control.
本発明は、駐車枠の検出前に、推定した車両姿勢に基づき、駐車枠の検出時に用いる検出用情報の内容を、車両姿勢のピッチ方向の変化によるカメラの路面に対する位置変化に応じた撮像画像の変化を小さくする内容に設定するようにした。
これによって、例えば、カメラの位置変化に応じて変化する撮像画像や、この撮像画像から駐車枠を検出する際に用いる判定用閾値などの検出用情報の内容を、カメラの位置変化による撮像画像の変化を小さくする内容に設定することが可能となる。その結果、自車両にピッチ方向の姿勢変化が発生した際の駐車枠の検出精度を向上することが可能となるので、自車両にピッチ方向の姿勢変化が発生した際の運転者の意図しない車両の加速や、駐車場ではない走行路での加速抑制の作動を抑制することが可能となる。その結果、加速抑制制御の適切な作動を行うことが可能となる。
According to the present invention, based on the estimated vehicle posture before the detection of the parking frame, the content of the detection information used when detecting the parking frame is taken according to the position change of the camera posture with respect to the road surface due to the change in the pitch direction of the vehicle posture. It was set to the content which makes the change of the small.
As a result, for example, the contents of detection information such as a captured image that changes in accordance with a change in the position of the camera and a threshold value for determination used when detecting a parking frame from the captured image can be used for the captured image due to a change in the position of the camera. It is possible to set the content to reduce the change. As a result, since it becomes possible to improve the detection accuracy of the parking frame when the posture change in the pitch direction occurs in the own vehicle, the vehicle not intended by the driver when the posture change in the pitch direction occurs in the own vehicle. It is possible to suppress the acceleration of the vehicle and the acceleration suppression operation on a travel path that is not a parking lot. As a result, it is possible to perform an appropriate operation of the acceleration suppression control.
以下、本発明の実施形態について、図面を参照しつつ説明する。
[第1実施形態]
(構成)
まず、図1を用いて、本実施形態の車両用加速抑制装置を備える車両の構成を説明する。
図1は、本実施形態の車両用加速抑制装置1を備える車両Vの構成を示す概念図である。
図1中に示すように、自車両Vは、車輪W(右前輪WFR、左前輪WFL、右後輪WRR、左後輪WRL)と、ブレーキ装置2と、流体圧回路4と、ブレーキコントローラ6と、を備える。これに加え、自車両Vは、エンジン8と、エンジンコントローラ12と、を備える。
Embodiments of the present invention will be described below with reference to the drawings.
[First Embodiment]
(Constitution)
First, the configuration of a vehicle including the vehicle acceleration suppression device of the present embodiment will be described with reference to FIG.
FIG. 1 is a conceptual diagram illustrating a configuration of a vehicle V including the vehicle
As shown in FIG. 1, the host vehicle V includes wheels W (right front wheel WFR, left front wheel WFL, right rear wheel WRR, left rear wheel WRL), a
ブレーキ装置2は、例えば、ホイールシリンダを用いて形成し、各車輪Wにそれぞれ設ける。なお、ブレーキ装置2は、流体圧で制動力を付与する装置に限定するものではなく、電動ブレーキ装置等を用いて形成してもよい。
流体圧回路4は、各ブレーキ装置2に接続する配管を含む回路である。
ブレーキコントローラ6は、上位コントローラである走行制御コントローラ10から入力を受けた制動力指令値に基づき、各ブレーキ装置2で発生する制動力を、流体圧回路4を介して、制動力指令値に応じた値に制御する。すなわち、ブレーキコントローラ6は、制動力制御装置を形成する。なお、走行制御コントローラ10に関する説明は、後述する。
したがって、ブレーキ装置2、流体圧回路4およびブレーキコントローラ6は、制動力を発生する制動装置を形成する。
The
The fluid pressure circuit 4 is a circuit including piping connected to each
The brake controller 6 responds to the braking force command value generated by each
Therefore, the
エンジン8は、自車両Vの駆動源を形成する。
エンジンコントローラ12は、走行制御コントローラ10から入力を受けた目標スロットル開度信号(加速指令値)に基づき、エンジン8で発生するトルク(駆動力)を制御する。すなわち、エンジンコントローラ12は、加速制御装置を形成する。なお、目標スロットル開度信号に関する説明は、後述する。
したがって、エンジン8およびエンジンコントローラ12は、駆動力を発生する駆動装置を形成する。
なお、自車両Vの駆動源は、エンジン8に限定するものではなく、電動モータを用いて形成してもよい。また、自車両Vの駆動源は、エンジン8と電動モータを組み合わせて形成してもよい。
The engine 8 forms a drive source for the host vehicle V.
The
Therefore, the engine 8 and the
In addition, the drive source of the own vehicle V is not limited to the engine 8, You may form using an electric motor. The driving source of the host vehicle V may be formed by combining the engine 8 and the electric motor.
次に、図1を参照しつつ、図2を用いて、車両用加速抑制装置1の概略構成を説明する。
図2は、本実施形態の車両用加速抑制装置1の概略構成を示すブロック図である。
車両用加速抑制装置1は、図1および図2中に示すように、周囲環境認識センサ14と、車輪速センサ16と、操舵角センサ18と、シフトポジションセンサ20と、ブレーキ操作検出センサ22と、アクセル操作検出センサ24と、を備える。これに加え、車両用加速抑制装置1は、ナビゲーション装置26と、走行制御コントローラ10と、を備える。
Next, a schematic configuration of the vehicle
FIG. 2 is a block diagram showing a schematic configuration of the vehicle
As shown in FIGS. 1 and 2, the vehicle
周囲環境認識センサ14は、自車両Vの周囲の画像を撮像し、撮像した各画像に基づき、複数の撮像方向に対応した個別の画像を含む情報信号(以降の説明では、「個別画像信号」と記載する場合がある)を生成する。そして、生成した個別画像信号を、走行制御コントローラ10へ出力する。
なお、本実施形態では、一例として、周囲環境認識センサ14を、前方カメラ14Fと、右側方カメラ14SRと、左側方カメラ14SLと、後方カメラ14Rと、を用いて形成した場合を説明する。ここで、前方カメラ14Fは、自車両Vの車両前後方向前方を撮像するカメラであり、右側方カメラ14SRは、自車両Vの右側方を撮像するカメラである。また、左側方カメラ14SLは、自車両Vの左側方を撮像するカメラであり、後方カメラ14Rは、自車両Vの車両前後方向後方を撮像するカメラである。
The ambient
In the present embodiment, as an example, a case where the surrounding
また、本実施形態では、周囲環境認識センサ14は、例えば、自車両Vの周囲の路面が入る画角で各カメラの最大撮影範囲(例えば100[m])の距離範囲を撮像する。
車輪速センサ16は、例えば、車輪速パルスを計測するロータリエンコーダ等のパルス発生器を用いて形成する。
また、車輪速センサ16は、各車輪Wの回転速度を検出し、この検出した回転速度を含む情報信号(以降の説明では、「車輪速信号」と記載する場合がある)を、走行制御コントローラ10に出力する。
操舵角センサ18は、例えば、ステアリングホイール28を回転可能に支持するステアリングコラム(図示せず)に設ける。
Moreover, in this embodiment, the surrounding
The
Further, the
For example, the
また、操舵角センサ18は、操舵操作子であるステアリングホイール28の現在の回転角度(操舵操作量)である現在操舵角を検出し、この検出した現在操舵角を含む情報信号(以降の説明では、「現在操舵角信号」と記載する場合がある)を、走行制御コントローラ10に出力する。なお、操向輪の転舵角を含む情報信号を、操舵角を示す情報として検出してもよい。
また、操舵操作子は、運転者が回転させるステアリングホイール28に限定するものではなく、例えば、運転者が手で傾ける操作を行うレバーとしてもよい。この場合、中立位置からのレバーの傾斜角度を、現在操舵角信号に相当する情報信号として出力する。
The
Further, the steering operator is not limited to the
シフトポジションセンサ20は、シフトノブやシフトレバー等、自車両Vのシフト位置(例えば、「P」、「D」、「R」等)を変更する部材の現在位置を検出する。そして、検出した現在位置を含む情報信号(以降の説明では、「シフト位置信号」と記載する場合がある)を、走行制御コントローラ10に出力する。
ブレーキ操作検出センサ22は、制動力指示操作子であるブレーキペダル30に対し、その開度を検出する。そして、検出したブレーキペダル30の開度を含む情報信号(以降の説明では、「ブレーキ開度信号」と記載する場合がある)を、走行制御コントローラ10に出力する。
ここで、制動力指示操作子は、自車両Vの運転者が操作可能であり、且つ開度の変化により自車両Vの制動力を指示する構成である。なお、制動力指示操作子は、運転者が足で踏込み操作を行うブレーキペダル30に限定するものではなく、例えば、運転者が手で操作するレバーとしてもよい。
The
The brake
Here, the braking force instruction operator is configured to be operated by the driver of the host vehicle V and to instruct the braking force of the host vehicle V by changing the opening. Note that the braking force instruction operator is not limited to the
アクセル操作検出センサ24は、駆動力指示操作子であるアクセルペダル32に対し、その開度を検出する。そして、検出したアクセルペダル32の開度を含む情報信号(以降の説明では、「アクセル開度信号」と記載する場合がある)を、走行制御コントローラ10に出力する。
ここで、駆動力指示操作子は、自車両Vの運転者が操作可能であり、且つ開度の変化により自車両Vの駆動力を指示する構成である。なお、駆動力指示操作子は、運転者が足で踏込み操作を行うアクセルペダル32に限定するものではなく、例えば、運転者が手で操作するレバーとしてもよい。
The accelerator
Here, the driving force instruction operator is configured to be operable by the driver of the host vehicle V and to instruct the driving force of the host vehicle V by changing the opening. Note that the driving force instruction operator is not limited to the
二軸加速度センサ25は、自車両Vの前後方向(進行方向)の実加速度である実前後加速度Gaと、前後方向と直交する自車両Vの左右方向(横方向)の実加速度である実横加速度Gyとを検出する。そして、検出した実前後加速度Ga及び実横加速度Gyを含む情報信号(以降の説明では、「加速度信号」と記載する場合がある)を、走行制御コントローラ10に出力する。
なお、実前後加速度Gaは、進行方向に対して、加速時に正値となり、減速時に負値となる。また、実横加速度Gyは、進行方向に対して、右方向に加速時に正値となり、左方向に加速時に負値となる。
ナビゲーション装置26は、GPS(Global Positioning System)受信機、地図データベースと、表示モニタ等を有する情報呈示装置とを備え、経路探索および経路案内等を行う装置である。
The
The actual longitudinal acceleration Ga is a positive value during acceleration and a negative value during deceleration with respect to the traveling direction. The actual lateral acceleration Gy has a positive value when accelerating in the right direction and a negative value when accelerating in the left direction with respect to the traveling direction.
The
また、ナビゲーション装置26は、GPS受信機を用いて取得した自車両Vの現在位置と、地図データベースに格納された道路情報とに基づいて、自車両Vが走行する道路の種別や幅員等の道路情報を取得することが可能である。
また、ナビゲーション装置26は、GPS受信機を用いて取得した自車両Vの現在位置を含む情報信号(以降の説明では、「自車位置信号」と記載する場合がある)を、走行制御コントローラ10に出力する。これに加え、ナビゲーション装置26は、自車両Vが走行する道路の種別や道路幅員等を含む情報信号(以降の説明では、「走行道路情報信号」と記載する場合がある)を、走行制御コントローラ10に出力する。
Further, the
In addition, the
情報呈示装置は、走行制御コントローラ10からの制御信号に応じて、警報その他の呈示を音声や画像によって出力する。また、情報呈示装置は、例えば、ブザー音や音声により運転者への情報提供を行うスピーカと、画像やテキストの表示により情報提供を行う表示ユニットと、を備える。また、表示ユニットは、例えば、ナビゲーション装置26の表示モニタを流用してもよい。
ヨーレートセンサ27は、自車両Vのヨーレートを検出し、この検出したヨーレートを含む情報信号(以降の説明では、「ヨーレート信号」と記載する場合がある)を、走行制御コントローラ10に出力する。
走行制御コントローラ10は、CPUと、ROMおよびRAM等のCPU周辺部品とから構成される電子制御ユニットである。
The information presenting device outputs an alarm or other presenting by voice or image in accordance with a control signal from the
The
The
また、走行制御コントローラ10は、駐車のための運転支援処理を行う駐車運転支援部を備える。
走行制御コントローラ10の処理のうち駐車運転支援部は、機能構成部として、図2中に示すように、周囲環境認識情報演算部10Aと、自車両車速演算部10Bと、操舵角演算部10Cと、操舵角速度演算部10Dと、を備える。これに加え、駐車運転支援部は、機能構成部として、シフトポジション演算部10Eと、ブレーキペダル操作情報演算部10Fと、アクセル操作量演算部10Gと、アクセル操作速度演算部10Hと、加速抑制制御内容演算部10Iと、を備える。さらに、駐車運転支援部は、機能構成部として、加速抑制指令値演算部10Jと、目標スロットル開度演算部10Kと、を備える。これらの機能構成部は、一または二以上のプログラムで構成される。
The
As shown in FIG. 2, the parking driving support unit among the processes of the
周囲環境認識情報演算部10Aは、周囲環境認識センサ14から入力を受けた個別画像信号に基づき、自車両Vの上方から下方を見た自車両Vの周囲の画像(俯瞰画像)を形成する。そして、形成した俯瞰画像を含む情報信号(以降の説明では、「俯瞰画像信号」と記載する場合がある)と、この俯瞰画像信号に対応する個別画像信号とを、加速抑制制御内容演算部10Iへ出力する。
ここで、俯瞰画像は、例えば、各カメラ(前方カメラ14F、右側方カメラ14SR、左側方カメラ14SL、後方カメラ14R)で撮像した画像を俯瞰変換すると共に、俯瞰変換後の画像を合成して形成する。
The surrounding environment recognition
Here, the bird's-eye view image is formed by, for example, performing bird's-eye conversion on an image captured by each camera (
また、各カメラは、自車両Vの車体の予め設定した設置位置に固定されており、各カメラの撮影軸の方向、レンズの画角、撮影画像のサイズなどの撮像条件も予め設定されたものとなっている。
また、俯瞰画像には、例えば、路面上に表示された駐車枠の線(以降の説明では、「駐車枠線」と記載する場合がある)等の道路標示を示す画像を含む。
自車両車速演算部10Bは、車輪速センサ16から入力を受けた車輪速信号に基づき、車輪Wの回転速度から自車両Vの速度(車速)を演算する。そして、演算した速度を含む情報信号(以降の説明では、「車速演算値信号」と記載する場合がある)を、加速抑制制御内容演算部10Iへ出力する。
Each camera is fixed at a preset installation position of the body of the host vehicle V, and imaging conditions such as the direction of the shooting axis of each camera, the angle of view of the lens, and the size of the shot image are also set in advance. It has become.
The overhead image includes, for example, an image showing a road marking such as a line of a parking frame displayed on the road surface (may be described as “parking frame line” in the following description).
The own vehicle vehicle
操舵角演算部10Cは、操舵角センサ18から入力を受けた現在操舵角信号に基づき、ステアリングホイール28の現在の回転角度から、ステアリングホイール28の中立位置からの操作量(回転角)を演算する。そして、演算した中立位置からの操作量を含む情報信号(以降の説明では、「操舵角信号」と記載する場合がある)を、加速抑制制御内容演算部10Iへ出力する。
The steering angle calculation unit 10C calculates the operation amount (rotation angle) from the neutral position of the
操舵角速度演算部10Dは、操舵角センサ18から入力を受けた現在操舵角信号が含む現在操舵角を微分処理することにより、ステアリングホイール28の操舵角速度を演算する。そして、演算した操舵角速度を含む情報信号(以降の説明では、「操舵角速度信号」と記載する場合がある)を、加速抑制制御内容演算部10Iへ出力する。
シフトポジション演算部10Eは、シフトポジションセンサ20から入力を受けたシフト位置信号に基づき、現在のシフト位置を判定する。そして、演算した現在のシフト位置を含む情報信号(以降の説明では、「シフト位置信号」と記載する場合がある)を、加速抑制制御内容演算部10Iへ出力する。
The steering angular
The shift
ブレーキペダル操作情報演算部10Fは、ブレーキ操作検出センサ22から入力を受けたブレーキ開度信号に基づき、踏込み量が「0」である状態を基準とした、ブレーキペダル30の踏込み量を演算する。そして、演算したブレーキペダル30の踏込み量を含む情報信号(以降の説明では、「制動側踏込み量信号」と記載する場合がある)を、加速抑制制御内容演算部10Iへ出力する。
The brake pedal operation
アクセル操作量演算部10Gは、アクセル操作検出センサ24から入力を受けたアクセル開度信号に基づき、踏込み量が「0」である状態を基準とした、アクセルペダル32の踏込み量を演算する。そして、演算したアクセルペダル32の踏込み量を含む情報信号(以降の説明では、「駆動側踏込み量信号」と記載する場合がある)を、加速抑制制御内容演算部10Iと、加速抑制指令値演算部10Jと、目標スロットル開度演算部10Kとへ出力する。
The accelerator operation
アクセル操作速度演算部10Hは、アクセル操作検出センサ24から入力を受けたアクセル開度信号が含むアクセルペダル32の開度を微分処理することにより、アクセルペダル32の操作速度を演算する。そして、演算したアクセルペダル32の操作速度を含む情報信号(以降の説明では、「アクセル操作速度信号」と記載する場合がある)を、加速抑制指令値演算部10Jへ出力する。
The accelerator operation
加速抑制制御内容演算部10Iは、上述した各種の情報信号として、俯瞰画像信号、個別画像信号、車速演算値信号、操舵角信号、操舵角速度信号、シフト位置信号、制動側踏込み量信号、駆動側踏込み量信号、自車位置信号、走行道路情報信号の入力を受ける。加えて、各種の情報信号として、加速度信号、ヨーレート信号の入力を受ける。そして、入力を受けた各種の情報信号に基づいて、後述する加速抑制作動条件判断結果、加速抑制制御開始タイミング、加速抑制制御量を演算する。さらに、これらの演算したパラメータを含む情報信号を、加速抑制指令値演算部10Jへ出力する。
なお、加速抑制制御内容演算部10Iの詳細な構成と、加速抑制制御内容演算部10Iで行う処理については、後述する。
The acceleration suppression control content calculation unit 10I includes, as the above-described various information signals, an overhead image signal, an individual image signal, a vehicle speed calculation value signal, a steering angle signal, a steering angular velocity signal, a shift position signal, a braking side depression amount signal, a driving side Receives the input of a stepping amount signal, a vehicle position signal, and a traveling road information signal. In addition, it receives acceleration signals and yaw rate signals as various information signals. And based on the various information signals which received the input, the acceleration suppression operation condition judgment result mentioned later, acceleration suppression control start timing, and acceleration suppression control amount are calculated. Furthermore, an information signal including these calculated parameters is output to the acceleration suppression command
The detailed configuration of the acceleration suppression control content calculation unit 10I and the processing performed by the acceleration suppression control content calculation unit 10I will be described later.
加速抑制指令値演算部10Jは、上述した駆動側踏込み量信号およびアクセル操作速度信号の入力と、後述する加速抑制作動条件判断結果信号、加速抑制制御開始タイミング信号および加速抑制制御量信号の入力を受ける。そして、アクセルペダル32の踏込み量(駆動力操作量)に応じた加速指令値を抑制するための指令値である加速抑制指令値を演算する。さらに、演算した加速抑制指令値を含む情報信号(以降の説明では、「加速抑制指令値信号」と記載する場合がある)を、目標スロットル開度演算部10Kへ出力する。
The acceleration suppression command
また、加速抑制指令値演算部10Jは、入力を受けた加速抑制作動条件判断結果信号の内容に応じて、通常の駆動力制御で用いる指令値である通常加速指令値を演算する。さらに、演算した通常加速指令値を含む情報信号(以降の説明では、「通常加速指令値信号」と記載する場合がある)を、目標スロットル開度演算部10Kへ出力する。
なお、加速抑制指令値演算部10Jで行う処理については、後述する。
Further, the acceleration suppression command
The processing performed by the acceleration suppression command
目標スロットル開度演算部10Kは、駆動側踏込み量信号と、加速抑制指令値信号との入力を受ける。そして、アクセルペダル32の踏込み量と、加速抑制指令値とに基づいて、アクセルペダル32の踏込み量または加速抑制指令値に応じたスロットル開度である目標スロットル開度を演算する。さらに、演算した目標スロットル開度を含む情報信号(以降の説明では、「目標スロットル開度信号」と記載する場合がある)を、エンジンコントローラ12へ出力する。
また、目標スロットル開度演算部10Kは、加速抑制指令値が後述する加速抑制制御開始タイミング指令値を含む場合、後述する加速抑制制御開始タイミングに基づいて、目標スロットル開度信号をエンジンコントローラ12へ出力する。
なお、目標スロットル開度演算部10Kで行う処理については、後述する。
The target throttle opening
Further, when the acceleration suppression command value includes an acceleration suppression control start timing command value described later, the target throttle opening
The processing performed by the target throttle opening
(加速抑制制御内容演算部10Iの構成)
次に、図1および図2を参照しつつ、図3および図4を用いて、加速抑制制御内容演算部10Iの詳細な構成について説明する。
図3は、加速抑制制御内容演算部10Iの構成を示すブロック図である。
図3中に示すように、加速抑制制御内容演算部10Iは、加速抑制作動条件判断部34と、駐車枠確信度算出部36と、駐車枠進入確信度設定部38と、総合確信度設定部40と、を備える。これに加え、加速抑制制御内容演算部10Iは、加速抑制制御開始タイミング演算部42と、加速抑制制御量演算部44と、を備える。
(Configuration of acceleration suppression control content calculation unit 10I)
Next, a detailed configuration of the acceleration suppression control content calculation unit 10I will be described with reference to FIGS. 1 and 2 and FIGS. 3 and 4. FIG.
FIG. 3 is a block diagram illustrating a configuration of the acceleration suppression control content calculation unit 10I.
As shown in FIG. 3, the acceleration suppression control content calculation unit 10I includes an acceleration suppression operation
加速抑制作動条件判断部34は、加速抑制制御を作動させる条件が成立するか否かを判断し、その判断結果を含む情報信号(以降の説明では、「加速抑制作動条件判断結果信号」と記載する場合がある)を、加速抑制指令値演算部10Jへ出力する。ここで、加速抑制制御とは、アクセルペダル32の踏込み量に応じて自車両Vを加速させる加速指令値を、抑制する(通常よりも加速させない値に補正する)制御である。
The acceleration suppression operation
また、加速抑制作動条件判断部34が加速抑制制御を作動させる条件が成立するか否かを判断する処理については、後述する。
駐車枠確信度算出部36は、自車両Vの進行方向に駐車枠が存在する確信度である駐車枠確信度を設定する。そして、設定した駐車枠確信度を含む情報信号(以降の説明では、「駐車枠確信度信号」と記載する場合がある)を、総合確信度設定部40へ出力する。
ここで、駐車枠確信度算出部36は、俯瞰画像信号、個別画像信号、車速演算値信号、シフト位置信号、自車位置信号および走行道路情報信号が含む各種情報を参照して、駐車枠確信度を設定する。
Moreover, the process in which the acceleration suppression operation
The parking frame
Here, the parking frame
また、駐車枠確信度算出部36が確信度の設定対象とする駐車枠には、例えば、図4中に示すように、複数のパターンがある。なお、図4は、駐車枠確信度算出部36が駐車枠確信度の設定対象とする駐車枠のパターンを示す図である。
また、駐車枠確信度算出部36は、制動側踏込み量信号、駆動側踏込み量信号、シフト位置信号、加速度信号、車輪速信号、車速演算値信号、及びヨーレート信号に含まれる各種データを取得する。駐車枠確信度算出部36は、取得した各種データに基づき自車両Vの加速度を予測し、予測した加速度に基づき自車両Vの車両姿勢を推定する。そして、推定した車両姿勢に基づき、駐車枠の検出時に用いる情報である検出用情報を設定する。
なお、駐車枠確信度算出部36が駐車枠確信度を設定する処理についての詳細と、検出用情報を設定する処理についての詳細は、後述する。
Moreover, as shown in FIG. 4, for example, there are a plurality of patterns in the parking frame that the parking frame certainty
Further, the parking frame
Details of the process for setting the parking frame certainty factor by the parking frame
駐車枠進入確信度設定部38は、自車両Vが駐車枠へ進入する確信度である駐車枠進入確信度を設定する。そして、設定した駐車枠進入確信度を含む情報信号(以降の説明では、「駐車枠進入確信度信号」と記載する場合がある)を、総合確信度設定部40へ出力する。
ここで、駐車枠進入確信度設定部38は、俯瞰画像信号、車速演算値信号、シフト位置信号および操舵角信号が含む各種情報を参照して、駐車枠進入確信度を設定する。
なお、駐車枠進入確信度設定部38が駐車枠進入確信度を設定する処理については、後述する。
The parking frame approach
Here, the parking frame approach
In addition, the process which the parking frame approach
総合確信度設定部40は、駐車枠確信度信号および駐車枠進入確信度信号の入力を受け、駐車枠確信度および駐車枠進入確信度に対応する確信度である総合確信度を設定する。そして、設定した総合確信度を含む情報信号(以降の説明では、「総合確信度信号」と記載する場合がある)を、加速抑制制御開始タイミング演算部42および加速抑制制御量演算部44へ出力する。
なお、総合確信度設定部40が総合確信度を設定する処理については、後述する。
The comprehensive
In addition, the process which the comprehensive
加速抑制制御開始タイミング演算部42は、加速抑制制御を開始するタイミングである加速抑制制御開始タイミングを演算する。そして、演算した加速抑制制御開始タイミングを含む情報信号(以降の説明では、「加速抑制制御開始タイミング信号」と記載する場合がある)を、加速抑制指令値演算部10Jへ出力する。
ここで、加速抑制制御開始タイミング演算部42は、総合確信度信号、制動側踏込み量信号、車速演算値信号、シフト位置信号および操舵角信号が含む各種情報を参照して、加速抑制制御開始タイミングを演算する。
なお、加速抑制制御開始タイミング演算部42が加速抑制制御開始タイミングを演算する処理については、後述する。
The acceleration suppression control start timing
Here, the acceleration suppression control start timing
The process in which the acceleration suppression control start timing
加速抑制制御量演算部44は、アクセルペダル32の踏込み量に応じた加速指令値を抑制するための制御量である加速抑制制御量を演算する。そして、演算した加速抑制制御量を含む情報信号(以降の説明では、「加速抑制制御量信号」と記載する場合がある)を、加速抑制指令値演算部10Jへ出力する。
ここで、加速抑制制御量演算部44は、総合確信度信号、制動側踏込み量信号、車速演算値信号、シフト位置信号および操舵角信号が含む各種情報を参照して、加速抑制制御量を演算する。
なお、加速抑制制御量演算部44が加速抑制制御量を演算する処理については、後述する。
The acceleration suppression control
Here, the acceleration suppression control
The process in which the acceleration suppression control
(加速抑制制御内容演算部10Iで行う処理)
次に、図1から図4を参照しつつ、図5から図17を用いて、加速抑制制御内容演算部10Iで行う処理について説明する。
・加速抑制作動条件判断部34が行なう処理
図1から図4を参照しつつ、図5および図6を用いて、加速抑制作動条件判断部34が加速抑制制御を作動させる条件(以降の説明では、「加速抑制作動条件」と記載する場合がある)が成立するか否かを判断する処理について説明する。
(Processing performed by the acceleration suppression control content calculation unit 10I)
Next, processing performed by the acceleration suppression control content calculation unit 10I will be described with reference to FIGS. 1 to 4 and FIGS.
Processing performed by the acceleration suppression operation
図5は、加速抑制作動条件判断部34が、加速抑制作動条件が成立するか否かを判断する処理を示すフローチャートである。なお、加速抑制作動条件判断部34は、予め設定したサンプリング時間(例えば、10[msec])毎に、以下に説明する処理を繰り返し行う。
図5中に示すように、加速抑制作動条件判断部34が処理を開始(START)すると、まず、ステップS100に移行する。
FIG. 5 is a flowchart illustrating processing in which the acceleration suppression operation
As shown in FIG. 5, when the acceleration suppression operation
ステップS100では、加速抑制作動条件判断部34において、駐車枠確信度算出部36が設定した駐車枠確信度を取得する処理(図中に示す「駐車枠確信度取得処理」)を行う。その後、加速抑制作動条件判断部34が行う処理は、ステップS102に移行する。
ステップS102では、加速抑制作動条件判断部34において、ステップS100で取得した駐車枠確信度に基づいて、駐車枠の有無を判断する処理(図中に示す「駐車有無判断処理」)を行う。
In step S100, the acceleration suppression operation
In step S102, the acceleration suppression operation
本実施形態において、駐車枠の有無を判断する処理は、駐車枠確信度に基づいて行う。具体的に、駐車枠確信度が、予め設定した最低値(レベル0)であると判定すると、例えば、自車両Vを基準として予め設定した距離や領域(エリア)内に、駐車枠が無い(図中に示す「No」)と判断する。この場合、加速抑制作動条件判断部34が行う処理は、ステップS120に移行する。
In this embodiment, the process which determines the presence or absence of a parking frame is performed based on a parking frame reliability. Specifically, if it is determined that the parking frame certainty factor is a preset minimum value (level 0), for example, there is no parking frame within a distance or area (area) set in advance with the vehicle V as a reference ( "No" shown in the figure). In this case, the process performed by the acceleration suppression operation
一方、駐車枠確信度が、予め設定した最低値以外の値であると判定すると、自車両Vを基準として予め設定した距離や領域(エリア)内に、駐車枠が有る(図中に示す「Yes」)と判断する。この場合、加速抑制作動条件判断部34が行う処理は、ステップS104に移行する。
ステップS104では、加速抑制作動条件判断部34において、自車両車速演算部10Bから入力を受けた車速演算値信号を参照して、自車両Vの車速を取得する処理(図中に示す「自車両車速情報取得処理」)を行う。その後、加速抑制作動条件判断部34が行う処理は、ステップS106に移行する。
On the other hand, if it is determined that the parking frame certainty factor is a value other than the preset minimum value, there is a parking frame within a distance or area (area) set in advance with reference to the host vehicle V (see “ Yes "). In this case, the process performed by the acceleration suppression operation
In step S104, the acceleration suppression operation
ステップS106では、加速抑制作動条件判断部34において、ステップS104で取得した車速に基づいて、自車両Vの車速が、予め設定した閾値車速未満である条件が成立しているか否かを判断する処理(図中に示す「自車両車速条件判断処理」)を行う。
なお、本実施形態では、一例として、閾値車速を15[km/h]とした場合について説明する。また、閾値車速は、15[km/h]に限定するものではなく、例えば、自車両Vの制動性能等、自車両Vの諸元に応じて変更してもよい。また、例えば、自車両Vが走行する地域(国等)の交通法規等に応じて変更してもよい。
ステップS106において、自車両Vの車速が閾値車速未満である条件が成立している(図中に示す「Yes」)と判断した場合、加速抑制作動条件判断部34が行なう処理は、ステップS108に移行する。
In step S106, the acceleration suppression operation
In the present embodiment, a case where the threshold vehicle speed is set to 15 [km / h] will be described as an example. The threshold vehicle speed is not limited to 15 [km / h], and may be changed according to the specifications of the host vehicle V such as the braking performance of the host vehicle V, for example. Further, for example, the vehicle V may be changed according to the traffic regulations of the area (country etc.) where the vehicle V travels.
In step S106, when it is determined that the condition that the vehicle speed of the host vehicle V is less than the threshold vehicle speed is satisfied ("Yes" in the drawing), the processing performed by the acceleration suppression operation
一方、ステップS106において、自車両Vの車速が閾値車速未満である条件が成立していない(図中に示す「No」)と判断した場合、加速抑制作動条件判断部34が行なう処理は、ステップS120に移行する。
ステップS108では、加速抑制作動条件判断部34において、ブレーキペダル操作情報演算部10Fから入力を受けた制動側踏込み量信号を参照して、ブレーキペダル30の踏込み量(操作量)の情報を取得する処理(図中に示す「ブレーキペダル操作量情報取得処理」)を行う。その後、加速抑制作動条件判断部34が行う処理は、ステップS110に移行する。
On the other hand, if it is determined in step S106 that the condition that the vehicle speed of the host vehicle V is less than the threshold vehicle speed is not satisfied ("No" shown in the figure), the processing performed by the acceleration suppression operation
In step S108, the acceleration suppression operation
ステップS110では、加速抑制作動条件判断部34において、ステップS108で取得したブレーキペダル30の踏込み量に基づいて、ブレーキペダル30が操作されているか否かを判断する処理(図中に示す「ブレーキペダル操作判断処理」)を行う。
ステップS110において、ブレーキペダル30が操作されていない(図中に示す「No」)と判断した場合、加速抑制作動条件判断部34が行なう処理は、ステップS112に移行する。
In step S110, the acceleration suppression operation
If it is determined in step S110 that the
一方、ステップS110において、ブレーキペダル30が操作されている(図中に示す「Yes」)と判断した場合、加速抑制作動条件判断部34が行なう処理は、ステップS120に移行する。
ステップS112では、加速抑制作動条件判断部34において、アクセル操作量演算部10Gから入力を受けた駆動側踏込み量信号を参照して、アクセルペダル32の踏込み量(操作量)の情報を取得する処理(図中に示す「アクセルペダル操作量情報取得処理」)を行う。その後、加速抑制作動条件判断部34が行なう処理は、ステップS114に移行する。
On the other hand, when it is determined in step S110 that the
In step S112, the acceleration suppression operation
ステップS114では、加速抑制作動条件判断部34において、アクセルペダル32の踏込み量(操作量)が、予め設定した閾値アクセル操作量以上である条件が成立しているか否かを判断する処理(図中に示す「アクセルペダル操作判断処理」)を行う。ここで、ステップS114の処理は、ステップS112で取得したアクセルペダル32の踏込み量に基づいて行なう。
なお、本実施形態では、一例として、閾値アクセル操作量を、アクセルペダル32の開度の3[%]に相当する操作量に設定した場合について説明する。また、閾値アクセル操作量は、アクセルペダル32の開度の3[%]に相当する操作量に限定するものではなく、例えば、自車両Vの制動性能等、自車両Vの諸元に応じて変更してもよい。
ステップS114において、アクセルペダル32の踏込み量(操作量)が閾値アクセル操作量以上である条件が成立している(図中に示す「Yes」)と判断した場合、加速抑制作動条件判断部34が行なう処理は、ステップS116に移行する。
In step S114, the acceleration suppression operation
In the present embodiment, as an example, a case will be described in which the threshold accelerator operation amount is set to an operation amount corresponding to 3% of the opening of the
When it is determined in step S114 that the condition that the depression amount (operation amount) of the
一方、ステップS114において、アクセルペダル32の踏込み量(操作量)が閾値アクセル操作量以上である条件が成立していない(図中に示す「No」)と判断した場合、加速抑制作動条件判断部34が行なう処理は、ステップS120に移行する。
ステップS116では、加速抑制作動条件判断部34において、自車両Vが駐車枠へ進入するか否かを判断するための情報を取得する処理(図中に示す「駐車枠進入判断情報取得処理」)を行う。その後、加速抑制作動条件判断部34が行なう処理は、ステップS118に移行する。本実施形態では、一例として、ステアリングホイール28の操舵角と、自車両Vと駐車枠とのなす角度と、自車両Vと駐車枠との距離に基づいて、自車両Vが駐車枠へ進入するか否かを判断する場合を説明する。
On the other hand, if it is determined in step S114 that the condition that the depression amount (operation amount) of the
In step S116, the acceleration suppression operation
ここで、ステップS116で行なう処理の具体例を説明する。
ステップS116では、加速抑制作動条件判断部34において、操舵角演算部10Cから入力を受けた操舵角信号を参照して、ステアリングホイール28の回転角(操舵角)を取得する。これに加え、周囲環境認識情報演算部10Aから入力を受けた俯瞰画像信号が含む自車両Vの周囲の俯瞰画像に基づき、自車両Vと駐車枠L0とのなす角度αと、自車両Vと駐車枠L0との距離Dを取得する。
ここで、角度αは、例えば、図6中に示すように、直線Xと、枠線L1および駐車枠L0側の線との交角の絶対値とする。なお、図6は、自車両Vと、駐車枠L0と、自車両Vと駐車枠L0との距離Dを説明する図である。
Here, a specific example of the process performed in step S116 will be described.
In step S116, the acceleration suppression operation
Here, for example, as shown in FIG. 6, the angle α is an absolute value of an intersection angle between the straight line X and the line on the frame line L1 and the parking frame L0 side. FIG. 6 is a diagram for explaining the distance D between the host vehicle V, the parking frame L0, and the host vehicle V and the parking frame L0.
また、直線Xは、自車両Vの中心を通る自車両Vの前後方向の直線(進行方向に延びる直線)であり、枠線L1は、駐車枠L0に駐車が完了した際に自車両Vの前後方向と平行または略平行になる駐車枠L0部分の枠線である。また、駐車枠L0側の線とは、L1の延長線からなる駐車枠L0側の線である。
また、距離Dは、例えば、図6中に示すように、自車両Vの前端面の中心点PFと駐車枠L0の入り口L2の中心点PPとの距離とする。ただし、距離Dは、自車両Vの前端面が駐車枠L0の入り口L2を通過した後は、負の値とする。なお、距離Dは、自車両Vの前端面が駐車枠L0の入り口L2を通過した後は、ゼロに設定してもよい。
ここで、距離Dを特定するための自車両V側の位置は、中心点PFに限定するものではなく、例えば、自車両Vに予め設定した位置と、入り口L2の予め設定した位置としてもよい。この場合、距離Dは、自車両Vに予め設定した位置と、入り口L2の予め設定した位置との距離とする。
The straight line X is a straight line in the front-rear direction of the host vehicle V that passes through the center of the host vehicle V (a straight line extending in the traveling direction), and the frame line L1 is the position of the host vehicle V when the parking of the parking frame L0 is completed. It is the frame line of the parking frame L0 part which becomes parallel or substantially parallel to the front-back direction. The line on the parking frame L0 side is a line on the parking frame L0 side that is an extension of L1.
The distance D is, for example, the distance between the center point PF of the front end face of the host vehicle V and the center point PP of the entrance L2 of the parking frame L0 as shown in FIG. However, the distance D is a negative value after the front end surface of the host vehicle V passes through the entrance L2 of the parking frame L0. The distance D may be set to zero after the front end surface of the host vehicle V passes through the entrance L2 of the parking frame L0.
Here, the position on the own vehicle V side for specifying the distance D is not limited to the center point PF, and may be, for example, a position set in advance in the own vehicle V and a preset position in the entrance L2. . In this case, the distance D is a distance between a position set in advance in the host vehicle V and a position set in advance at the entrance L2.
以上説明したように、ステップS116では、自車両Vが駐車枠L0へ進入するか否かを判断するための情報として、操舵角、自車両Vと駐車枠L0の角度α、自車両Vと駐車枠L0の距離Dを取得する。
ステップS118では、加速抑制作動条件判断部34において、ステップS116で取得した情報に基づいて、自車両Vが駐車枠へ進入するか否かを判断する処理(図中に示す「駐車枠進入判断処理」)を行う。
ステップS118において、自車両Vが駐車枠へ進入しない(図中に示す「No」)と判断した場合、加速抑制作動条件判断部34が行なう処理は、ステップS120に移行する。
As described above, in step S116, as information for determining whether or not the host vehicle V enters the parking frame L0, the steering angle, the angle α between the host vehicle V and the parking frame L0, the host vehicle V and the parking The distance D of the frame L0 is acquired.
In step S118, the acceleration suppression operation
If it is determined in step S118 that the host vehicle V does not enter the parking frame ("No" shown in the figure), the processing performed by the acceleration suppression operation
一方、ステップS118において、自車両Vが駐車枠へ進入する(図中に示す「Yes」)と判断した場合、加速抑制作動条件判断部34が行なう処理は、ステップS122に移行する。
ここで、ステップS118で行なう処理の具体例を説明する。
ステップS118では、例えば、以下に示す三つの条件(A1〜A3)を全て満足した場合に、自車両Vが駐車枠へ進入すると判断する。
条件A1.ステップS116で検出した操舵角が予め設定した設定舵角値(例えば、45[deg])以上の値となってから経過した時間が、予め設定した設定時間(例えば、20[sec])以内である。
条件A2.自車両Vと駐車枠L0の角度αが、予め設定した設定角度(例えば、40[deg])以下である。
条件A3.自車両Vと駐車枠L0の距離Dが、予め設定した設定距離(例えば、3[m])以下である。
なお、自車両Vが駐車枠へ進入するか否かを判断する処理としては、駐車枠進入確信度設定部38が駐車枠進入確信度を設定する際に行なう処理を用いてもよい。
On the other hand, if it is determined in step S118 that the host vehicle V enters the parking frame (“Yes” shown in the figure), the processing performed by the acceleration suppression operation
Here, a specific example of the process performed in step S118 will be described.
In step S118, for example, when all of the following three conditions (A1 to A3) are satisfied, it is determined that the host vehicle V enters the parking frame.
Condition A1. The elapsed time after the steering angle detected in step S116 is equal to or greater than a preset steering angle value (eg, 45 [deg]) is within a preset setup time (eg, 20 [sec]). is there.
Condition A2. The angle α between the host vehicle V and the parking frame L0 is a preset angle (for example, 40 [deg]) or less.
Condition A3. The distance D between the host vehicle V and the parking frame L0 is equal to or less than a preset set distance (for example, 3 [m]).
In addition, as a process which judges whether the own vehicle V approachs a parking frame, you may use the process performed when the parking frame approach
また、自車両Vが駐車枠へ進入するか否かの判断に用いる処理は、上記のように複数の条件を用いた処理に限定するものではなく、上述した三つの条件のうち一つ以上の条件で判断する処理を用いてもよい。また、自車両Vの車速を用いて、自車両Vが駐車枠へ進入するか否かを判断する処理を用いてもよい。
ステップS120では、加速抑制作動条件判断部34において、加速抑制作動条件判断結果信号を、加速抑制制御作動条件が成立しない判断結果を含む情報信号として生成する処理(図中に示す「加速抑制作動条件非成立」)を行う。その後、加速抑制作動条件判断部34が行なう処理は、ステップS124に移行する。
In addition, the process used to determine whether or not the host vehicle V enters the parking frame is not limited to the process using a plurality of conditions as described above, but one or more of the three conditions described above. Processing based on conditions may be used. Moreover, you may use the process which judges whether the own vehicle V approachs a parking frame using the vehicle speed of the own vehicle V. FIG.
In step S120, the acceleration suppression operation
ステップS122では、加速抑制作動条件判断部34において、加速抑制作動条件判断結果信号を、加速抑制制御作動条件が成立する判断結果を含む情報信号として生成する処理(図中に示す「加速抑制作動条件成立」)を行う。その後、加速抑制作動条件判断部34が行なう処理は、ステップS124に移行する。
ステップS124では、加速抑制作動条件判断部34において、ステップS120またはステップS122で生成した加速抑制作動条件判断結果信号を、加速抑制指令値演算部10Jへ出力する処理(図中に示す「加速抑制作動条件判断結果出力」)を行う。その後、一連の処理を終了(END)する。
In step S122, the acceleration suppression operation
In step S124, the acceleration suppression operation
・駐車枠確信度算出部36が行う処理
図1から図6を参照しつつ、図7から図17を用いて、駐車枠確信度算出部36が駐車枠確信度を設定する処理について説明する。
図7は、駐車枠確信度算出部36が駐車枠確信度を設定する処理を示すフローチャートである。
図7中に示すように、駐車枠確信度算出部36が処理を開始(START)すると、まず、ステップS200に移行する。
ステップS200では、駐車枠確信度算出部36において、駐車枠確信度のレベルを最低値(レベル0)に設定する処理(図中に示す「レベル0に設定」)を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS202に移行する。
Processing Performed by Parking Frame
FIG. 7 is a flowchart illustrating a process in which the parking frame
As shown in FIG. 7, when the parking frame
In step S200, the parking frame
ステップS202では、駐車枠確信度算出部36において、周囲環境認識情報演算部10Aから入力を受けた俯瞰画像信号が含む自車両Vの周囲の俯瞰画像を取得する処理(図中に示す「周囲画像取得処理」)を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS204に移行する。
ステップS204では、ステップS202で俯瞰画像を取得したことに応じて、駐車枠の検出に用いる判定要素や、判定用の閾値等の検出用情報を補正する処理を実行するか否かを判断する処理(図中に示す「検出用情報補正実行判断」)を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS206に移行する。
In step S202, the parking frame
In step S204, a process for determining whether or not to execute a process of correcting detection information such as a determination element used for detection of a parking frame and a determination threshold value in response to the acquisition of the overhead image in step S202. ("Detection information correction execution determination" shown in the figure). Then, the process which the parking frame
ここで、図8に基づき、ステップS204で行う処理の具体例を説明する。
図8は、検出用情報補正判断処理の処理手順の一例を示すフローチャートである。
図8中に示すように、駐車枠確信度算出部36が処理を開始(START)すると、まず、ステップS2000に移行する。
ステップS2000では、駐車枠確信度算出部36において、ステップS202で俯瞰画像を取得時の各種データを読み込む。その後、駐車枠確信度算出部36が行う処理は、ステップS2010に移行する。
Here, a specific example of the process performed in step S204 will be described with reference to FIG.
FIG. 8 is a flowchart illustrating an example of a processing procedure of the detection information correction determination process.
As shown in FIG. 8, when the parking frame
In step S2000, the parking frame certainty
具体的に、本実施形態では、入力を受け付けた制動側踏込み量信号、駆動側踏込み量信号、シフト位置信号、加速度信号、車輪速信号、車速演算値信号、及びヨーレート信号に含まれる各種データを読み込む。
すなわち、駐車枠確信度算出部36は、ブレーキペダル30の踏み込み量、アクセルペダル32の踏込み量、現在のシフト位置、各車輪の車輪速、自車両Vの車速ν、実前後加速度Ga、実横加速度Gy、及びヨーレートφを読み込む。
ステップS2010では、駐車枠確信度算出部36において、ステップS2010で読み込んだ各種データに基づき、自車両Vの前後加減速度及び横加速度を予測する処理を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS2020に移行する。
Specifically, in the present embodiment, various data included in the braking-side depression amount signal, the driving-side depression amount signal, the shift position signal, the acceleration signal, the wheel speed signal, the vehicle speed calculation value signal, and the yaw rate signal that have been accepted are input. Read.
That is, the parking frame
In step S2010, the parking frame
本実施形態では、駐車枠確信度算出部36は、運転者の指示に応じた操作量のうち加速時のピッチングに影響のある操作量である、アクセルペダル32の踏み込み量、及びシフト位置に基づき自車両Vの前後方向加速度を予測する。加えて、駐車枠確信度算出部36は、運転者の指示に応じた操作量のうち減速時のピッチングに影響のある操作量である、ブレーキペダル30の踏み込み量に基づき自車両Vの前後方向減速度を予測する。
なお、アクセルペダル32の踏み込み量、及びブレーキペダル30の踏み込み量については、予め設定した設定時間だけ過去から現在に至るまでに検出したこれら踏み込み量に基づき、両者の変化量を算出する。以下の説明において、アクセルペダル32の踏み込み量の変化量を「アクセル操作変化量」と、ブレーキペダル30の踏み込み量の変化量を「ブレーキ操作変化量」と記載する場合がある。
In the present embodiment, the parking frame
In addition, about the depression amount of the
また、本実施形態において、前後方向加速度の予測値Ga*(以降の説明において、「予測前後加速度Ga*」と記載する場合がある)は、アクセル操作変化量に基づき、予め実験やシミュレーションなどによって作成されたマップを参照して算出する。なお、上記説明では2つの操作量に基づき予測前後加速度Ga*を算出しているが、上記の操作量のうちのアクセルペダル32の踏み込み量のみを使用して予測前後加速度Ga*を算出してもよい。また、他のピッチングに影響のある操作量、及びその操作量に応じて変化する量に基づき予測前後加速度Ga*を算出してもよい。
Further, in this embodiment, the longitudinal acceleration predicted value Ga * (in the following description, may be described as “predicted longitudinal acceleration Ga *”) is based on the amount of change in accelerator operation in advance through experiments or simulations. Calculate with reference to the created map. In the above description, the predicted longitudinal acceleration Ga * is calculated based on the two operation amounts. However, the predicted longitudinal acceleration Ga * is calculated using only the depression amount of the
また、本実施形態において、前後方向減速度の予測値Gb*(以降の説明において、「予測前後減速度Gb*」と記載する場合がある)は、ブレーキ操作変化量に基づき、予め実験やシミュレーションなどによって作成されたマップを参照して算出する。なお、ブレーキペダル30の踏み込み量以外にも、他のピッチングに影響のある操作量、及びその操作量に応じて変化する量に基づき予測前後減速度Gb*を算出してもよい。
Further, in the present embodiment, the predicted value Gb * of the longitudinal deceleration (which may be described as “predicted longitudinal deceleration Gb *” in the following description) is based on the amount of change in brake operation in advance through experiments and simulations. Calculate with reference to the map created by In addition to the depression amount of the
更に、本実施形態では、駐車枠確信度算出部36は、車速ν及びヨーレートφに基づき、自車両Vの旋回時の横加速度を予測する。旋回時の横加速度の予測値Gy*(以下の説明において「予測横加速度Gy*」と記載する場合がある)は、以下の式(1)を用いて算出する。
Gy*=ν・φ … (1)
なお、車速ν及びヨーレートφを用いて予測横加速度Gy*を求める構成に限らず、例えば、運転者の指示に応じた操作量のうちロールに影響のある操作量である操舵角と、その操舵角を微分演算した操舵角速度とに基づき、予め実験やシミュレーションなどによって作成されたマップを参照して、予測横加速度Gy*を算出する構成としてもよい。また、操舵角に限らず、他のロールに影響のある操作量及びその操作量に応じて変化する量に基づき予測横加速度Gy*を算出してもよい。
Furthermore, in the present embodiment, the parking frame
Gy * = ν · φ (1)
Note that the present invention is not limited to the configuration for obtaining the predicted lateral acceleration Gy * using the vehicle speed ν and the yaw rate φ. The predicted lateral acceleration Gy * may be calculated based on the steering angular velocity obtained by differentially calculating the angle with reference to a map created in advance through experiments or simulations. In addition, the predicted lateral acceleration Gy * may be calculated based not only on the steering angle but also on an operation amount that affects other rolls and an amount that changes according to the operation amount.
なお更に、本実施形態の駐車枠確信度算出部36は、実前後加速度Ga又は実前後減速度Gbに基づき路面勾配を算出し、算出した路面勾配に基づき予測前後加速度Ga*又は予測前後減速度Gb*を補正する。
ここで、路面勾配の推定に関しては様々な方法が提案されているが、本実施形態では、例えば、実前後加速度Gaと非駆動輪の加速度との差により路面勾配を推定する。この方法は、二軸加速度センサ25は路面勾配の影響を受けるのに対し、非駆動輪の加速度は実際に自車両Vに生じる加速度を表していることを利用したものである。
Still further, the parking frame
Here, various methods have been proposed for estimating the road surface gradient. In this embodiment, for example, the road surface gradient is estimated based on the difference between the actual longitudinal acceleration Ga and the acceleration of the non-driven wheels. This method utilizes the fact that the
例えば、登り勾配を一定速度で走行中の場合、二軸加速度センサ25は加速方向に出力されており、非駆動輪の加速度との差(この場合はゼロ)が路面勾配に相当する加速度Gsとなる。言い換えると、この加速度Gsに相当する駆動力を加えないと登り勾配を一定速度で走行できないことになる。本実施形態では、自車両Vの車速νを非駆動輪の車輪速の平均値から求めていることとして、読み込んだ車速νを微分して非駆動輪の加速度Gsを算出する。そして、この非駆動輪加速度Gsに基づき予測前後加速度Ga*を補正する。
For example, when the climbing gradient is traveling at a constant speed, the
加えて、本実施形態の駐車枠確信度算出部36は、各車輪の車輪速からスリップ率を演算し、スリップ率に対する実前後加速度Ga又は実前後減速度Gbの傾きを求めることにより、車輪と路面との間の摩擦係数を推定する。そして、この摩擦係数に基づき予測前後加速度Ga*又は予測前後減速度Gb*を補正する。つまり、雨で濡れた道路、凍結路、雪路など、自車両Vの走行路の路面摩擦係数が比較的小さい場合、車輪がスリップして空回転し、実際の前後加速度Gaは、アクセルペダル32の踏み込み量、及びシフト位置から予測した予測前後加速度Ga*よりも小さくなる。従って、予め設定した路面摩擦係数の大きさに応じた補正量によって、予測前後加速度Ga*を補正する。また、実際の前後減速度Gbは、ブレーキペダル30の踏み込み量から予測した予測前後減速度Gb*よりも小さくなる。従って、予め設定した路面摩擦係数の大きさに応じた補正量によって、予測前後減速度Gb*を補正する。
In addition, the parking frame
ステップS2020では、駐車枠確信度算出部36において、ステップS2010で予測しかつ補正した各予測加速度又は予測減速度と、二軸加速度センサ25で検出した各実加速度又は実減速度との差分値を算出する。その後、駐車枠確信度算出部36が行う処理は、ステップS2030に移行する。
具体的に、駐車枠確信度算出部36は、アクセルペダル32が踏み込まれた場合は、予測前後加速度Ga*と実前後加速度Gaとの差分値(以降の説明では「前後加速度差分値Gad」と記載する場合がある)を算出する。また、ブレーキペダル30が踏み込まれた場合は、予測前後減速度Gb*と実前後減速度Gbとの差分値(以降の説明では「前後減速度差分値Gbd」と記載する場合がある)を算出する。加えて、駐車枠確信度算出部36は、予測横加速度Gy*と実横加速度Gyとの差分値(以降の説明では「横加速度差分値Gyd」と記載する場合がある)を算出する。
In step S2020, in the parking frame
Specifically, when the
ステップS2030では、駐車枠確信度算出部36において、ステップS2020で算出した前後加速度差分値Gad又は前後減速度差分値Gbd、及び横加速度差分値Gydが、予め設定した差分値範囲以内であるか否かを判定する処理を行う。
ステップS2030において、前後加速度差分値Gad若しくは前後減速度差分値Gbdが前後差分値範囲以内であるとの判定、又は横加速度差分値Gydが横差分値範囲以内であるとの判定の少なくとも一方が成立したと判定した場合(図中に示す「Yes」)、駐車枠確信度算出部36が行う処理は、ステップS2040に移行する。
In step S2030, whether or not the longitudinal acceleration difference value Gad or the longitudinal deceleration difference value Gbd and the lateral acceleration difference value Gyd calculated in step S2020 are within a preset difference value range in the parking frame
In step S2030, at least one of the determination that the longitudinal acceleration difference value Gad or the longitudinal deceleration difference value Gbd is within the longitudinal difference value range or the determination that the lateral acceleration difference value Gyd is within the lateral difference value range is established. When it determines with having carried out ("Yes" shown in the figure), the process which the parking frame
一方、ステップS2030において、前後加速度差分値Gad又は前後減速度差分値Gbdが前後差分値範囲以内ではなく、かつ横加速度差分値Gydが横差分値範囲以内ではないと判定した場合(図中に示す「No」)、駐車枠確信度算出部36が行う処理は、ステップS2070に移行する。
ステップS2040では、駐車枠確信度算出部36において、差分値範囲以内であると判定した加減速度差分値に対応する予測加減速度に基づき、自車両Vの姿勢を推定する処理を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS2050に移行する。
On the other hand, when it is determined in step S2030 that the longitudinal acceleration difference value Gad or the longitudinal deceleration difference value Gbd is not within the longitudinal difference value range and the lateral acceleration difference value Gyd is not within the lateral difference value range (shown in the figure). “No”), the process performed by the parking frame
In step S2040, the parking frame
具体的に、駐車枠確信度算出部36は、前後加速度差分値Gadが前後差分値範囲以内であると判定された場合、予測前後加速度Ga*に基づき、自車両Vのピッチ角θpの推定値である推定ピッチ角θp*を算出する。また、前後減速度差分値Gbdが前後差分値範囲以内であると判定された場合、予測前後減速度Gb*に基づき、自車両Vのピッチ角θpの推定値である推定ピッチ角θp*を算出する。一方、駐車枠確信度算出部36は、前後加速度差分値Gad又は前後減速度差分値Gbdが前後差分値範囲以内ではないと判定された場合、推定ピッチ角θp*の算出は行わない(例えば、θp*=0に設定)。なお、前後差分値範囲を加速時と減速時で同じ範囲としているが、この構成に限らず、加速時と減速時とで異なる範囲を用いる構成としてもよい。
ここで、推定ピッチ角θp*は、既存の運動方程式に基づいて算出する。例えば、以下の式(2)を用いて推定ピッチ角θp*を算出する。
θp*=tan-1(G*/g) … (2)
上記式(2)において、gは重力加速度である。また、上記式(2)において、G*は、アクセルペダル32が踏み込まれた場合は、予測前後加速度Ga*となり、ブレーキペダル30が踏み込まれた場合は、予測前後減速度Gb*となる。
Specifically, when it is determined that the longitudinal acceleration difference value Gad is within the longitudinal difference value range, the parking frame
Here, the estimated pitch angle θp * is calculated based on the existing equation of motion. For example, the estimated pitch angle θp * is calculated using the following equation (2).
θp * = tan −1 (G * / g) (2)
In the above equation (2), g is a gravitational acceleration. In the above equation (2), G * is the predicted longitudinal acceleration Ga * when the
また、駐車枠確信度算出部36は、横加速度差分値Gydが横差分値範囲以内であると判定された場合、予測横加速度Gy*に基づき、自車両Vのロール角θrの推定値である推定ロール角θr*を算出する。一方、駐車枠確信度算出部36は、横加速度差分値Gydが横差分値範囲以内ではないと判定された場合、推定ロール角の算出は行わない(例えば、θr*=0に設定)。
ここで、推定ロール角θr*は、既存の運動方程式に基づいて算出する。例えば、以下の式(3)を用いて推定ロール角θr*を算出する。
θr*=(m・ha・Gy*)/(Iy・s2+s+(Ky−m・g・ha))
… (3)
上記式(3)において、mは車両のばね上質量、haは車両のロールアーム長、Iyは車両のロール慣性モーメント、Cyは車両のロール減衰係数、Kyは車両のロール剛性、gは重力加速度、sはラプラス演算子を表す。これらのうち、m,ha,Iy,Cy,Kyは、自車両Vの車両諸元に基づき予め定められた定数である。
In addition, the parking frame
Here, the estimated roll angle θr * is calculated based on the existing equation of motion. For example, the estimated roll angle θr * is calculated using the following equation (3).
θr * = (m · ha · Gy *) / (Iy · s 2 + s + (Ky−m · g · ha))
(3)
In the above formula (3), m is the sprung mass of the vehicle, ha is the roll arm length of the vehicle, Iy is the roll inertia moment of the vehicle, Cy is the roll damping coefficient of the vehicle, Ky is the roll stiffness of the vehicle, and g is the acceleration of gravity. , S represents a Laplace operator. Among these, m, ha, Iy, Cy, and Ky are constants determined in advance based on the vehicle specifications of the host vehicle V.
ステップS2050では、駐車枠確信度算出部36において、自車両Vの姿勢変化量は変化量閾値以上であるか否かを判定する処理を行う。
具体的に、駐車枠確信度算出部36は、ステップS2040で予測前後加速度Ga*又は予測前後減速度Gb*に基づき推定ピッチ角θp*の算出を行った場合は、まず、該推定ピッチ角θp*と予め設定した基準ピッチ角θprとの差分値を算出する。そして、この算出した差分値の絶対値(以下の説明において、「ピッチ角変化量θpg」と記載する場合がある)が、予め設定したピッチ角変化量閾値以上であるか否かを判定する処理を行う。
ここで、基準ピッチ角θprは、例えば、自車両Vが平坦な直進路を、予め設定した速度以下の一定速度で走行中のピッチ角、又は平坦路で停車時のピッチ角となる。例えば、路面を基準とした場合に基準ピッチ角θprは、「0[deg]」となる。
In step S2050, the parking frame
Specifically, when the parking frame
Here, the reference pitch angle θpr is, for example, a pitch angle when the host vehicle V is traveling on a flat straight road at a constant speed equal to or lower than a preset speed, or a pitch angle when the vehicle is stopped on a flat road. For example, when the road surface is used as a reference, the reference pitch angle θpr is “0 [deg]”.
また、自車両Vのピッチ角変化量θpgは、上記した前方カメラ14F及び後方カメラ14Rの位置変化量と密接な関係がある。
ここで、図9(a)〜(c)は、ピッチ角θpの変化に応じたカメラ位置の変化の一例と、カメラ位置の変化による撮像画像の変化の一例とを示す図である。図9(a)は、基準ピッチ角θprに対してピッチ角変化量θpgが「0」となる場合の例を示す図である。また、図9(b)は、自車両Vが減速時のピッチ角変化量θpgに対するカメラ位置の変化と撮像画像の変化との一例を示す図である。また、図9(c)は、自車両Vが加速時のピッチ角変化量θpgに対するカメラ位置の変化と撮像画像の変化との一例を示す図である。
Further, the pitch angle change amount θpg of the host vehicle V is closely related to the position change amounts of the
Here, FIGS. 9A to 9C are diagrams illustrating an example of a change in the camera position according to a change in the pitch angle θp and an example of a change in the captured image due to the change in the camera position. FIG. 9A is a diagram illustrating an example when the pitch angle change amount θpg is “0” with respect to the reference pitch angle θpr. FIG. 9B is a diagram illustrating an example of a change in the camera position and a change in the captured image with respect to the pitch angle change amount θpg when the host vehicle V decelerates. FIG. 9C is a diagram illustrating an example of a change in the camera position and a change in the captured image with respect to the pitch angle change amount θpg when the host vehicle V accelerates.
例えば、自車両Vが進行方向に向かって予め設定した速度以下の一定速度で走行している場合、ピッチ角変化量θpgは、基準ピッチ角θprとなり、自車両Vのピッチングによる姿勢変化が無い状態(無視できる状態)となる。この状態において、前方カメラ14F及び後方カメラ14Rで、駐車枠を構成する対向する二本の白線(直線)を含む画像を撮像したとする。この場合に、本実施形態では、この撮像画像を俯瞰変換した俯瞰画像内において、二本の白線は、図9(a)中に示すように、真っ直ぐ平行に並ぶ絵面となる。
For example, when the host vehicle V is traveling at a constant speed equal to or lower than a preset speed in the traveling direction, the pitch angle change amount θpg is the reference pitch angle θpr, and there is no posture change due to pitching of the host vehicle V. (Can be ignored). In this state, it is assumed that the
一方、自車両Vが、例えば前進走行中に、運転者がブレーキペダル30を踏み込んで自車両Vが減速した場合、図9(b)中に示すように、自車両Vの車体が前のめりとなって、ピッチ角が変化する。これは、車両が減速時には車輪に制動力が発生しているため重心点回りにピッチングモーメントが発生し、このモーメントを打ち消すため前後輪の接地点に上下力が発生するためである。この接地点に働く上下力によって前輪が縮み、後輪が伸びる方向にサスペンションや車輪の縦バネが変形し車両が前のめりにピッチングする。これにより、図9(b)中の前方カメラ14Fのレンズ中心から路面に向かって延びる矢印線(以降の説明において「撮像軸」と記載する場合がある)が、ピッチ角変化量θpgだけ路面に近づく側(下方向)に変位する。この場合、図9(b)中に示すように、俯瞰画像内の二本の白線は、白線間の幅が自車両Vの近方側(自車側)が狭まり、遠方側に向かって広がっていく逆ハの字状の形状に変化する。
On the other hand, when the host vehicle V is traveling forward, for example, when the driver depresses the
また、自車両Vが、例えば前進走行中に運転者がアクセルペダル32を踏み込んで加速した場合、図9(c)中に示すように、自車両Vの車体が後ろに仰け反って、ピッチ角が変化する。これは、減速時とは逆に、車両が加速時には車輪に駆動力が発生しているため重心点回りにピッチングモーメントが発生し、前後輪の接地点に働く上下力によって前輪が伸びて、後輪が縮む方向にサスペンションや車輪の縦バネが変形するためである。これにより、図9(c)中に示すように、前方カメラ14Fの撮像軸が、ピッチ角変化量θpgだけ路面から遠ざかる側(上方向)に変位する。この場合、図9(c)中に示すように、俯瞰画像内の二本の白線は、減速時とは逆に、白線間の幅が自車両Vの近方側(自車側)が広がり、遠方側に向かって狭まっていくハの字状の形状に変化する。
なお、自車両Vが後進走行中の場合の減速時及び加速時のピッチングによる後方カメラ14Rの俯瞰画像の変化については、前進走行時の上記前方カメラ14Fの俯瞰画像内の二本の白線の変化と同様となる。
Also, when the host vehicle V accelerates, for example, when the driver depresses the
Regarding the change in the overhead view image of the
一方、駐車枠確信度算出部36は、ステップS2040で予測横加速度Gy*に基づき推定ロール角θr*の算出を行った場合は、まず、該推定ロール角θr*と予め設定した基準ロール角θrrとの差分値を算出する。そして、この算出した差分値の絶対値(以下の説明において「ロール角変化量θrg」と記載する場合がある)が、予め設定したロール角変化量閾値以上であるか否かを判定する処理を行う。
ここで、基準ロール角θrrは、例えば、自車両Vが平坦な直進路を、予め設定した速度以下の一定速度で走行中のロール角、又は平坦路で停車時のロール角となる。例えば、路面を基準とした場合に基準ロール角θrrは、「0[deg]」となる。
On the other hand, if the parking frame
Here, the reference roll angle θrr is, for example, a roll angle when the host vehicle V is traveling on a flat straight road at a constant speed equal to or lower than a preset speed, or a roll angle when the vehicle is stopped on a flat road. For example, when the road surface is used as a reference, the reference roll angle θrr is “0 [deg]”.
また、自車両Vのロール角変化量θrgは、ピッチ角変化量θpgと同様に前方カメラ14F及び後方カメラ14Rの位置変化量と密接な関係がある。
ここで、図10(a)〜(c)は、自車両Vを後方から見た場合のロール角の変化に応じたカメラ位置の変化の一例と、カメラ位置の変化による撮像画像の変化の一例とを示す図である。図10(a)は、基準ロール角θrrに対してロール角変化量θrgが「0」となる場合の例を示す図である。また、図10(b)は、自車両Vが右旋回時のロール角変化量θrgに対するカメラ位置の変化と撮像画像の変化との一例を示す図である。
Further, the roll angle change amount θrg of the host vehicle V is closely related to the position change amounts of the
Here, FIGS. 10A to 10C are an example of a change in camera position according to a change in roll angle when the host vehicle V is viewed from behind, and an example of a change in captured image due to a change in camera position. FIG. FIG. 10A is a diagram illustrating an example in which the roll angle change amount θrg is “0” with respect to the reference roll angle θrr. FIG. 10B is a diagram illustrating an example of a change in camera position and a change in captured image with respect to the roll angle change amount θrg when the host vehicle V turns right.
例えば、自車両Vが進行方向に向かって予め設定した速度以下の一定速度で走行している場合、ロール角変化量は、基準ロール角θrrとなり、自車両Vのローリングによる姿勢変化が無い状態(無視できる状態)となる。つまり、図10(a)中の前方カメラ14Fのレンズ中心を通って路面と直交する一点鎖線(以降の説明において「横傾斜基準線」と記載する場合がある)に示すように、前方カメラ14Fのロール方向のずれ(ロール角変化量θrg)が「0」となる。この状態において、前方カメラ14F及び後方カメラ14Rで、駐車枠を構成する対向する二本の白線を含む画像を撮像したとする。この場合に、この撮像画像を俯瞰変換した俯瞰画像内の二本の白線は、図10(a)中に示すように、真っ直ぐ平行に並ぶ絵面となる。
For example, when the host vehicle V is traveling at a constant speed equal to or lower than a preset speed in the traveling direction, the roll angle change amount is the reference roll angle θrr, and there is no change in posture due to rolling of the host vehicle V ( It can be ignored. That is, as shown by a one-dot chain line that passes through the lens center of the
一方、自車両Vが、例えば前進走行中に、運転者がステアリングホイール28を操作して自車両Vが右旋回した場合、図10(b)に示すように、自車両Vの車体が左に傾いて、ロール角が変化する。これは、右旋回によって車両重心に左方向の遠心力(横加速度)が発生し、この力がロールモーメントとなって、重心をロール軸の周りに円運動させる力となる。そして、このモーメントを打ち消すため左右前後輪の接地点に上下力が発生するためである。つまり、左右前後輪の接地点に働く上下力によって旋回外側の車輪(右前後輪)が縮み、旋回内側の車輪(左前後輪)が伸びる方向にサスペンションや車輪の縦バネが変形し車両が左にローリングする。このことは、自車両Vが左旋回した場合において、左右逆となるだけで同様であり、この場合車両は右にローリングする。
なお、自車両Vが後進走行中の場合のローリングによる後方カメラ14Rの俯瞰画像の変化については、前進走行時の上記前方カメラ14Fの俯瞰画像の変化と同様となる。
On the other hand, when the host vehicle V is traveling forward, for example, when the driver operates the
The change in the overhead image of the
そして、ステップS2050において、推定ピッチ角θp*が予め設定したピッチ角変化量閾値以上であるとの判定、又は推定ロール角θr*が予め設定したロール角変化量閾値以上であるとの判定の少なくとも一方が成立したと判定したとする(図中に示す「Yes」)。この場合、駐車枠確信度算出部36が行う処理は、ステップS2060に移行する。
In step S2050, at least a determination that the estimated pitch angle θp * is greater than or equal to a preset pitch angle change amount threshold value, or a determination that the estimated roll angle θr * is greater than or equal to a preset roll angle change amount threshold value. Assume that it is determined that one has been established ("Yes" shown in the figure). In this case, the process performed by the parking frame
一方、ステップS2050において、推定ピッチ角θp*が予め設定したピッチ角変化量閾値以上ではないと判定し、かつ、推定ロール角θr*が予め設定したロール角変化量閾値以上ではないと判定したとする(図中に示す「No」)。この場合、駐車枠確信度算出部36が行う処理は、ステップS2070に移行する。
ステップS2060では、駐車枠確信度算出部36は、補正実行フラグをON(例えば、「1」)に設定する処理を行う。その後、駐車枠確信度算出部36が行う処理は、元の処理に復帰する(RETURN)。
On the other hand, in step S2050, it is determined that the estimated pitch angle θp * is not greater than or equal to the preset pitch angle change amount threshold, and it is determined that the estimated roll angle θr * is not greater than or equal to the preset roll angle change amount threshold. ("No" shown in the figure). In this case, the process performed by the parking frame
In step S2060, the parking frame
具体的に、駐車枠確信度算出部36は、ステップS2050において推定ピッチ角θp*が予め設定したピッチ角変化量閾値以上であると判定した場合、ピッチング補正実行フラグをONに設定する。加えて、ステップS2050において推定ロール角θr*が予め設定したロール角変化量閾値以上であると判定した場合、ローリング補正実行フラグをONに設定する。なお、ステップS2050において、推定ピッチ角θp*が予め設定したピッチ角変化量閾値以上ではないと判定した場合、ピッチング補正実行フラグをOFF(例えば、「0」)に設定する。また、ステップS2050において、推定ロール角θr*が予め設定したロール角変化量閾値以上ではないと判定した場合、ローリング補正実行フラグをOFFに設定する。
Specifically, the parking frame
ここで、ピッチング補正実行フラグは、自車両Vの加減速時のピッチングによる検出情報の補正処理(以下の説明において「ピッチング補正処理」と記載する場合がある)を行うか否かを示すフラグである。ピッチング補正実行フラグがON状態のときは、ピッチング補正処理を行うことを示し、ピッチング補正実行フラグがOFF状態のときは、ピッチング補正処理を行わないことを示す。 Here, the pitching correction execution flag is a flag indicating whether or not correction processing of detection information by pitching during acceleration / deceleration of the host vehicle V (may be described as “pitching correction processing” in the following description) is performed. is there. When the pitching correction execution flag is in the ON state, it indicates that the pitching correction processing is performed, and when the pitching correction execution flag is in the OFF state, it indicates that the pitching correction processing is not performed.
また、ローリング補正実行フラグは、自車両Vの加減速時のローリングによる検出情報の補正処理(以下の説明において「ローリング補正処理」と記載する場合がある)を行うか否かを示すフラグである。ローリング補正実行フラグがON状態のときは、ローリング補正処理を行うことを示し、ローリング補正実行フラグがOFF状態のときは、ローリング補正処理を行わないことを示す。
ステップS2070では、駐車枠確信度算出部36は、補正実行フラグをOFFに設定する処理を行う。その後、駐車枠確信度算出部36が行う処理は、元の処理に復帰する(RETURN)。具体的に、駐車枠確信度算出部36は、ピッチング補正実行フラグ及びローリング補正実行フラグを共にOFFに設定する。
Further, the rolling correction execution flag is a flag indicating whether or not to perform detection information correction processing by rolling during acceleration / deceleration of the host vehicle V (may be described as “rolling correction processing” in the following description). . When the rolling correction execution flag is in the ON state, it indicates that the rolling correction process is performed, and when the rolling correction execution flag is in the OFF state, it indicates that the rolling correction process is not performed.
In step S2070, the parking frame
図7に戻って、ステップS206では、ステップS202で取得した俯瞰画像から、駐車枠確信度を設定するために用いる判定要素を抽出する処理を行う。その後、駐車枠確信度設定部36が行う処理は、ステップS208に移行する。
ここで、判定要素とは、駐車枠線等、路面上に標示されている線(白線等)であり、その状態が、例えば、以下に示す三つの条件(B1〜B3)を全て満足した場合に、その線を、判定要素(以降の記載において、「駐車枠線候補」と言う場合がある)として抽出する。
条件B1.路面上に標示されている線に破断部分がある場合、その破断部分が、標示されていた線がかすれている部分(例えば、線よりも明瞭度が低く、且つ路面よりも明瞭度が高い部分)である。
条件B2.路面上に標示されている線の幅が、予め設定した設定幅(例えば、10[cm])以上である。
条件B3.路面上に標示されている線の長さが、予め設定した設定標示線長さ(例えば、2.5[m])以上である。
ここで、駐車枠線候補とは、駐車枠線等、路面上に標示されている線(白線等)である。
Returning to FIG. 7, in step S <b> 206, a process of extracting a determination element used to set the parking frame certainty factor from the overhead image acquired in step S <b> 202 is performed. Then, the process which the parking frame
Here, the determination element is a line (white line or the like) marked on the road surface, such as a parking frame line, and the state satisfies, for example, all the following three conditions (B1 to B3) In addition, the line is extracted as a determination element (in the following description, it may be referred to as “parking frame line candidate”).
Condition B1. If the marked line on the road surface has a broken part, the broken part is a part where the marked line is faint (for example, a part having a lower clarity than the line and a higher clarity than the road surface). ).
Condition B2. The width of the line marked on the road surface is not less than a preset setting width (for example, 10 [cm]).
Condition B3. The length of the line marked on the road surface is greater than or equal to a preset set line length (for example, 2.5 [m]).
Here, the parking frame line candidate is a line (white line or the like) marked on the road surface, such as a parking frame line.
以下、判定要素である駐車枠線候補の抽出方法について説明する。
図11(a)及び(b)は、エッジ検出による駐車枠線の抽出方法を模式的に説明する模式図である。図11(a)中に示すように、駐車枠線Lm,Lnを検出する際には、撮像した画像を示す領域において、横方向への走査を行う。画像の走査の際には、例えば、撮像した画像を二値化処理した白黒画像等を用いる。なお、図11(a)は、撮像した画像を示す図である。駐車枠線は、路面に比べて十分に明るい白色等で示されることから、路面に比べて輝度が高くなる。このため、図11(b)中に示すように、路面から駐車枠線に変化する境界部分では、輝度が急激に高くなるプラスエッジが検出される。なお、図11(b)は、左から右方向への走査を行った場合の画像中の画素の輝度変化を示すグラフであり、図11(c)は、図11(a)と同様、撮像した画像を示す図である。また、図11(b)中では、プラスエッジを符合「E+」で示し、図11(c)中では、プラスエッジを符合「E+」を付した太い実線で示す。また、駐車枠線から路面に変化する境界部分では、輝度が急激に低くなるマイナスエッジが検出される。なお、図11(b)中では、マイナスエッジを符合「E−」で示し、図11(c)中では、マイナスエッジを符合「E−」を付した太い点線で示す。そして、駐車枠線を認識する処理においては、走査方向に対して、プラスエッジ(E+)、マイナスエッジ(E−)の順で、隣接する一対のエッジを検出することにより、駐車枠線が存在すると判断する。
Hereinafter, a method of extracting a parking frame line candidate that is a determination element will be described.
FIGS. 11A and 11B are schematic diagrams schematically illustrating a parking frame line extraction method based on edge detection. As shown in FIG. 11A, when the parking frame lines Lm and Ln are detected, scanning in the horizontal direction is performed in the area indicating the captured image. When scanning an image, for example, a monochrome image obtained by binarizing a captured image is used. In addition, Fig.11 (a) is a figure which shows the imaged image. Since the parking frame line is displayed in white or the like sufficiently brighter than the road surface, the brightness is higher than that of the road surface. For this reason, as shown in FIG.11 (b), the plus edge where a brightness | luminance increases rapidly is detected in the boundary part which changes from a road surface to a parking frame line. FIG. 11B is a graph showing the luminance change of the pixels in the image when scanning from the left to the right, and FIG. 11C is the same as FIG. 11A. FIG. Further, in FIG. 11B, the plus edge is indicated by a sign “E +”, and in FIG. 11C, the plus edge is indicated by a thick solid line with a sign “E +”. In addition, a negative edge at which the brightness sharply decreases is detected at the boundary portion where the parking frame line changes to the road surface. In FIG. 11B, the minus edge is indicated by a sign “E−”, and in FIG. 11C, the minus edge is indicated by a thick dotted line with a sign “E−”. In the process of recognizing the parking frame line, the parking frame line exists by detecting a pair of adjacent edges in the order of plus edge (E +) and minus edge (E−) in the scanning direction. Judge that.
次に、同一の俯瞰画像(個別画像に対応する俯瞰画像)から抽出した駐車枠線候補から、該俯瞰画像内において隣り合う二本の線を一つの組として特定(以降の説明では、「ペアリング」と記載する場合がある)する。なお、同一の俯瞰画像から三本以上の線が抽出されている場合は、三本以上の線に対し、それぞれ、隣り合う二本の線により、二つ以上の組を特定する。
図7に戻って、ステップS208では、駐車枠確信度算出部36において、補正実行フラグがON状態であるか否かを判定する処理を行う。
Next, from the parking frame line candidates extracted from the same bird's-eye view image (the bird's-eye view image corresponding to the individual image), two adjacent lines in the bird's-eye view image are identified as one set (in the following description, “pair” May be described as “ring”. When three or more lines are extracted from the same bird's-eye view image, two or more sets are specified by two adjacent lines for each of the three or more lines.
Returning to FIG. 7, in step S <b> 208, the parking frame
具体的に、駐車枠確信度算出部36は、ステップS204で設定した、ピッチング補正実行フラグがON状態であるか否か、及びローリング補正実行フラグがON状態であるか否かを判定する処理を行う。
ステップS208において、ピッチング補正フラグがON状態であるとの判定、又はローリング補正フラグがON状態であるとの判定の少なくとも一方が成立していると判定(図中の「Yes」)したとする。この場合、駐車枠確信度算出部36が行う処理は、ステップS210に移行する。
Specifically, the parking frame
Assume that it is determined in step S208 that at least one of the determination that the pitching correction flag is in the ON state and the determination that the rolling correction flag is in the ON state is established (“Yes” in the drawing). In this case, the process which the parking frame
一方、ステップS208において、ピッチング補正フラグがON状態ではないと判定し、かつ、ローリング補正フラグがON状態ではないとの判定(図中の「No」)した場合、駐車枠確信度算出部36が行う処理は、ステップS212に移行する。
ステップS210では、駐車枠確信度算出部36において、駐車枠を検出するための処理(ステップS212の駐車枠条件の適合判定処理)に用いる情報である検出用情報を補正する処理(図中に示す「検出用情報補正処理」)を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS212に移行する。
On the other hand, when it is determined in step S208 that the pitching correction flag is not in the ON state and it is determined that the rolling correction flag is not in the ON state ("No" in the drawing), the parking frame
In step S210, the parking frame
以下、図12〜図13を用いて。本実施形態のステップS210で行う処理の具体例を説明する。
図12(a)〜(b)は、ピッチングによるカメラ位置の変化に応じて、俯瞰画像から抽出した判定要素を補正する一例を示す模式図である。図13(a)〜(b)は、ローリングによるカメラ位置の変化に応じて、俯瞰画像から抽出した判定要素を補正する一例を示す模式図である。
Hereinafter, with reference to FIGS. A specific example of the process performed in step S210 of the present embodiment will be described.
FIGS. 12A and 12B are schematic diagrams illustrating an example of correcting the determination element extracted from the overhead image according to the change in the camera position due to pitching. FIGS. 13A to 13B are schematic diagrams illustrating an example of correcting the determination element extracted from the overhead image according to the change in the camera position due to rolling.
本実施形態では、駐車枠確信度算出部36は、検出用情報補正処理として、検出用情報の1つであるステップS206で抽出した判定要素の位置ずれを補正する処理を行う。
具体的に、駐車枠確信度算出部36は、ピッチング補正実行フラグがON状態であると判定すると、ピッチングによるカメラ位置の位置変化に応じた俯瞰画像内の判定要素のずれを補正する。
例えば、前進走行中の減速によるピッチングの場合、図12(a)の左図中に示すように、俯瞰画像内の対向する二本の白線の逆ハの字状に変形した形状を、二本の白線の自車側(例えば、予め設定した変化の大きくなる領域部分)を矢印の方向(広げる方向)に回転移動させることで補正する。例えば、白線の自車側とは反対側(遠方側)の端部や白線の長手方向の中間点を軸に回転移動させる。これにより、二本の白線を、図12(a)の右図中に示すように、均一な線間幅で真っ直ぐに対向する形状へと補正する。
なお、自車側を広げる方向に補正する構成に限らず、遠方側を狭める方向に回転移動する等ピッチングによる変化を小さくできれば他の補正方法を用いてもよい。
In this embodiment, the parking frame
Specifically, if the parking frame
For example, in the case of pitching due to deceleration during forward travel, as shown in the left diagram of FIG. The white line of the vehicle is corrected by rotating the vehicle side (for example, a region where the change is increased in advance) in the direction of the arrow (in the direction of expansion). For example, the white line is rotated about the end of the white line opposite to the vehicle side (the far side) or the intermediate point in the longitudinal direction of the white line. As a result, the two white lines are corrected to a shape that directly faces each other with a uniform line width, as shown in the right diagram of FIG.
The correction is not limited to the direction in which the vehicle side is widened, and other correction methods may be used as long as the change due to pitching such as rotational movement in the direction to narrow the far side can be reduced.
また、例えば、前進走行中の加速によるピッチングの場合、図12(b)の左図中に示すように、俯瞰画像内の対向する二本の白線のハの字状に変形した形状を、二本の白線の自車側(例えば、予め設定した変化の大きくなる領域部分)を矢印の方向(狭める方向)に回転移動させることで補正する。例えば、白線の自車側とは反対側(遠方側)の端部や白線の長手方向の中間点を軸に回転移動させる。これにより、二本の白線を、図12(b)の右図中に示すように、均一な幅で真っ直ぐに対向するように補正する。
なお、自車側を狭める方向に補正する構成に限らず、遠方側を広げる方向に回転移動する等ピッチングによる変化を小さくできれば他の補正方法を用いてもよい。
なお、かかる補正量(回転量及び回転方向)は、ピッチ角変化量θpgに基づき、予め実験やシミュレーションなどによって作成されたマップを参照して算出する。
In addition, for example, in the case of pitching by acceleration during forward traveling, as shown in the left diagram of FIG. 12B, the shape deformed into two C-shaped two opposing white lines in the overhead view image is changed to two. Correction is performed by rotationally moving the book white line on the own vehicle side (for example, a region where the change is increased in a preset direction) in the direction of the arrow (the direction of narrowing). For example, the white line is rotated about the end of the white line opposite to the vehicle side (the far side) or the intermediate point in the longitudinal direction of the white line. Thus, the two white lines are corrected so as to face each other straight with a uniform width as shown in the right diagram of FIG.
The correction is not limited to the direction in which the own vehicle side is narrowed, but other correction methods may be used as long as the change due to pitching such as rotational movement in the direction to widen the far side can be reduced.
The correction amount (rotation amount and rotation direction) is calculated based on the pitch angle change amount θpg with reference to a map created in advance through experiments, simulations, or the like.
一方、駐車枠確信度算出部36は、ローリング補正実行フラグがON状態であると判定すると、ローリングによるカメラ位置の位置変化に応じた俯瞰画像内の判定要素のずれを補正する。
例えば、前進走行中の右旋回による左へのローリングの場合、図13(a)の左図中に示すように、俯瞰画像内の対向する二本の白線の左方向へのずれを、該二本の白線を右方向(矢印の方向)に、ずれた分だけ移動させることで補正する。これにより、二本の白線の位置を、図13(a)の右図中に示すように、ローリングの発生していない場合の位置と同じ位置となるように補正する。
On the other hand, if the parking frame
For example, in the case of rolling to the left due to a right turn while traveling forward, as shown in the left diagram of FIG. 13 (a), the two white lines facing each other in the overhead view image are shifted to the left. Correction is made by moving the two white lines to the right (in the direction of the arrow) by the amount of deviation. As a result, the positions of the two white lines are corrected so as to be the same as the position when no rolling occurs, as shown in the right diagram of FIG.
また、例えば、前進走行中の左旋回による右へのローリングの場合、図13(b)の左図中に示すように、俯瞰画像内の対向する二本の白線の右方向へのずれを、該二本の白線を左方向(矢印の方向)に、ずれた分だけ移動させることで補正する。これにより、二本の白線の位置を、図13(b)の右図中に示すように、ローリングの発生していない場合の位置と同じ位置となるように補正する。
図7に戻って、ステップS212では、駐車枠確信度算出部36において、ステップS206で抽出した駐車枠の判定要素が、駐車枠を形成する線の条件に適合しているか否かを判定する処理(図中に示す「駐車枠条件適合?」)を行う。
ステップS212において、駐車枠の判定要素が、駐車枠を形成する枠線の条件に適合していない(図中に示す「No」)と判断した場合、駐車枠確信度算出部36が行う処理は、ステップS200に移行する。
Also, for example, in the case of rolling to the right by turning left during forward travel, as shown in the left diagram of FIG. 13B, the deviation of the two white lines facing each other in the overhead view image to the right is Correction is performed by moving the two white lines to the left (in the direction of the arrow) by the amount of deviation. As a result, the positions of the two white lines are corrected so as to be the same as the position when no rolling has occurred, as shown in the right diagram of FIG. 13B.
Returning to FIG. 7, in step S212, the parking frame
In step S212, when it is determined that the determination element of the parking frame does not conform to the condition of the frame line forming the parking frame ("No" shown in the drawing), the process performed by the parking frame
一方、ステップS212において、駐車枠の判定要素が、駐車枠を形成する枠線の条件に適合している(図中に示す「Yes」)と判断した場合、駐車枠確信度算出部36が行う処理は、ステップS214に移行する。
具体的に、駐車枠確信度算出部36は、駐車枠線候補の組であるペアリングした二本の線に対し、駐車枠を形成する線の条件に適合しているか否かを判断する。
ここで、図14を用いて、駐車枠線候補のペア(以下の説明では、「駐車枠線候補ペア」と記載する場合がある)が、駐車枠を形成する線の条件に適合しているか否かを判断する処理の具体例を説明する。なお、図14は、駐車枠確信度算出部36が行う処理の内容を示す図である。また、図14中には、俯瞰画像のうち前方カメラ14Fで撮像した画像を示す領域を、符号「PE」と示す。
On the other hand, when it is determined in step S212 that the determination element of the parking frame is suitable for the condition of the frame line forming the parking frame (“Yes” shown in the drawing), the parking frame
Specifically, the parking frame
Here, referring to FIG. 14, whether a pair of parking frame line candidates (may be described as “parking frame line candidate pair” in the following description) matches the conditions of the lines forming the parking frame. A specific example of the process for determining whether or not will be described. In addition, FIG. 14 is a figure which shows the content of the process which the parking frame
駐車枠確信度算出部36は、駐車枠線候補の組であるペアリングした二本の線に対し、例えば、以下に示す四つの条件(C1〜C4)を全て満足した場合に、駐車枠線候補が、駐車枠を形成する線の条件に適合していると判断する。
ここで、ペアリングした二本の線は、自車両Vがピッチング又はローリングの少なくとも一方の姿勢変化をした場合に、上記ステップS210の処理において、該姿勢変化によるカメラの位置変化に応じたずれが補正されたものとなる。
The parking frame
Here, when the host vehicle V changes the posture of at least one of pitching and rolling, the paired two lines are displaced in accordance with the camera position change due to the posture change in the process of step S210. It will be corrected.
条件C1.図14(a)中に示すように、ペアリングした二本の線(図中では、符合「La」、符合「Lb」で示す)間の幅WLが、予め設定した設定ペアリング幅(例えば、2.5[m])以下である。
条件C2.図14(b)中に示すように、線Laと線Lbとのなす角度(平行度合い)が、予め設定した設定角度(例えば、3[°])以内である。
なお、図14(b)中には、基準線(領域PEの垂直方向に延在する線)を、符合「CLc」を付した点線で示し、線Laの中心軸線を、符合「CLa」を付した破線で示し、線Lbの中心軸線を、符合「CLb」を付した破線で示す。また、基準線CLcに対する中心軸線CLaの傾斜角を符号「θa」で示し、基準線CLcに対する中心軸線CLbの傾斜角を符号「θb」で示す。
したがって、|θa−θb|≦3[°]の条件式が成立すると、条件C2を満足することとなる。
Condition C1. As shown in FIG. 14 (a), the width WL between two paired lines (indicated by the symbols “La” and “Lb” in the drawing) is a preset pairing width (for example, 2.5 [m]) or less.
Condition C2. As shown in FIG. 14B, the angle (degree of parallelism) formed by the line La and the line Lb is within a preset set angle (for example, 3 [°]).
In FIG. 14B, a reference line (a line extending in the vertical direction of the region PE) is indicated by a dotted line with a reference “CLc”, and a central axis of the line La is indicated by a reference “CLa”. The central axis of the line Lb is indicated by a broken line with the sign “CLb”. Further, the inclination angle of the central axis line CLa with respect to the reference line CLc is indicated by a symbol “θa”, and the inclination angle of the central axis line CLb with respect to the reference line CLc is indicated by a reference symbol “θb”.
Therefore, when the conditional expression of | θa−θb | ≦ 3 [°] is satisfied, the condition C2 is satisfied.
条件C3.図14(c)中に示すように、線Laの自車両V側の端部(図中では、下方側の端部)と線Lbの自車両V側の端部を結ぶ直線と、自車両Vに近い側の線Lとのなす角度θが、予め設定した設定ずれ角度(例えば、45[°])以上である。
条件C4.図14(d)中に示すように、線Laの幅W0と線Lbの幅W1との差の絶対値(|W0−W1|)が、予め設定した設定線幅(例えば、10[cm])以下である。
なお、上述した四つの条件(D1〜D4)を満足するか否かを判定する処理では、線La,Lbのうち少なくとも一方の長さが、例えば、2[m]程度で途切れている場合、さらに、2[m]程度の仮想線を延長した4[m]程度の線として、処理を継続する。
Condition C3. As shown in FIG. 14C, a straight line connecting the end of the line La on the own vehicle V side (the end on the lower side in the drawing) and the end of the line Lb on the own vehicle V side, and the own vehicle The angle θ formed with the line L closer to V is equal to or larger than a preset setting deviation angle (for example, 45 [°]).
Condition C4. As shown in FIG. 14D, the absolute value (| W0−W1 |) of the difference between the width W0 of the line La and the width W1 of the line Lb is a preset line width (for example, 10 [cm]). )
In the process of determining whether or not the four conditions (D1 to D4) described above are satisfied, when the length of at least one of the lines La and Lb is interrupted at about 2 [m], for example, Further, the processing is continued as a line of about 4 [m] obtained by extending a virtual line of about 2 [m].
図7に戻って、ステップS214では、駐車枠確信度算出部36において、駐車枠確信度のレベルを最低値(レベル0)よりも一段階上のレベル(レベル1)に設定する処理(図中に示す「レベル1に設定」)を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS216に移行する。
ステップS214では、駐車枠確信度算出部36において、ステップS212の処理を開始してから自車両Vの移動距離が予め設定した設定移動距離となるまでに、ステップS212の処理が連続して照合するか否かを判断する処理(図中に示す「連続照合適合?」)を行う。なお、設定移動距離は、自車両Vの諸元や、前進または後退の状態に応じて、例えば、1.0〜2.5[m]の範囲内に設定する。また、ステップS216で行う処理は、例えば、周囲環境認識情報演算部10Aから入力を受けた俯瞰画像信号と、自車両車速演算部10Bから入力を受けた車速演算値信号を参照して行う。
ステップS216において、ステップS212の処理が連続して照合していない(図中に示す「No」)と判断した場合、駐車枠確信度算出部36が行う処理は、ステップS200に移行する。
Returning to FIG. 7, in step S214, the parking frame
In step S214, in the parking frame
If it is determined in step S216 that the processing in step S212 is not continuously collated ("No" shown in the drawing), the processing performed by the parking frame
一方、ステップS216において、ステップS212の処理が連続して照合している(図中に示す「Yes」)と判断した場合、駐車枠確信度算出部36が行う処理は、ステップS216に移行する。
ここで、ステップS216で行う処理では、例えば、図15中に示すように、ステップS212の処理が照合された状態と、ステップS212の処理が照合されない状態に応じて、自車両Vの移動距離を仮想的に演算する。なお、図15は、駐車枠確信度算出部36が行う処理の内容を示す図である。また、図15中には、「照合状態」と記載した領域において、ステップS212の処理が照合された状態を「ON」と示し、ステップS212の処理が照合されない状態を「OFF」と示す。また、図15中には、仮想的に演算した自車両Vの移動距離を、「仮想走行距離」と示す。
On the other hand, if it is determined in step S216 that the processing in step S212 is continuously collated (“Yes” shown in the figure), the processing performed by the parking frame
Here, in the process performed in step S216, for example, as shown in FIG. 15, the movement distance of the host vehicle V is determined according to the state in which the process in step S212 is collated and the state in which the process in step S212 is not collated. Operate virtually. In addition, FIG. 15 is a figure which shows the content of the process which the parking frame
図15中に示すように、ステップS212の処理が照合された状態が「ON」であると、仮想走行距離が増加する。一方、ステップS212の処理が照合された状態が「OFF」であると、仮想走行距離が減少する。
なお、本実施形態では、一例として、仮想走行距離が増加する際の傾き(増加ゲイン)を、仮想走行距離が減少する際の傾き(減少ゲイン)よりも大きく設定した場合について説明する。すなわち、「照合状態」が「ON」である状態の時間と「OFF」である状態の時間とが同じ時間であれば、仮想走行距離は増加することとなる。
As shown in FIG. 15, when the state in which the process of step S <b> 212 is collated is “ON”, the virtual travel distance increases. On the other hand, if the state checked in step S212 is “OFF”, the virtual travel distance decreases.
In the present embodiment, as an example, a case will be described in which the slope (increase gain) when the virtual travel distance increases is set larger than the slope (decrease gain) when the virtual travel distance decreases. In other words, if the time when the “verification state” is “ON” and the time when the “verification state” is “OFF” are the same time, the virtual travel distance increases.
そして、仮想走行距離が初期値(図中では、「0[m]」と示す)に戻ることなく、設定移動距離に達すると、ステップS212の処理が連続して照合していると判断する。
図7に戻って、ステップS218では、駐車枠確信度算出部36において、駐車枠確信度のレベルを最低値(レベル0)よりも二段階上のレベル(レベル2)に設定する処理(図中に示す「レベル2に設定」)を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS220に移行する。
Then, if the virtual travel distance reaches the set travel distance without returning to the initial value (indicated as “0 [m]” in the figure), it is determined that the processing in step S212 is continuously verified.
Returning to FIG. 7, in step S218, the parking frame
ステップS220では、駐車枠確信度算出部36において、ステップS206の処理が連続して照合している線La,Lbに対し、それぞれ、自車両Vを基準として同じ側に位置する端部(近い側の端部、または、遠い側の端部)を検出する。そして、同じ側に位置する端部同士が、幅WLの方向に沿って対向しているか否かを判断する処理(図中に示す「遠近端部対向適合?」)を行う。なお、ステップS220で行う処理は、例えば、周囲環境認識情報演算部10Aから入力を受けた俯瞰画像信号と、自車両車速演算部10Bから入力を受けた車速演算値信号を参照して行う。
ステップS220において、同じ側に位置する端部同士が、幅WLの方向に沿って対向していない(図中に示す「No」)と判断した場合、駐車枠確信度算出部36が行う処理は、ステップS228に移行する。
In step S220, in the parking frame
In step S220, when it is determined that the ends located on the same side do not face each other along the direction of the width WL ("No" shown in the drawing), the process performed by the parking frame
一方、ステップS220において、同じ側に位置する端部同士が、幅WLの方向に沿って対向している(図中に示す「Yes」)と判断した場合、駐車枠確信度算出部36が行う処理は、ステップS222に移行する。
ステップS222では、駐車枠確信度算出部36において、駐車枠確信度のレベルを最低値(レベル0)よりも三段階上のレベル(レベル3)に設定する処理(図中に示す「レベル3に設定」)を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS224に移行する。
On the other hand, in step S220, when it is determined that the ends positioned on the same side face each other along the direction of the width WL (“Yes” shown in the drawing), the parking frame
In step S222, the parking frame
ステップS224では、駐車枠確信度算出部36において、ステップS220の処理において、幅WLの方向に沿って対向していると判断した端部ペアに対し、さらに、他方の側に位置する端部ペアを検出する。すなわち、ステップS220の処理において、自車両Vに対して近い側(一方の側)の端部を検出した場合、ステップS224では、自車両Vに対して遠い側(他方の側)の端部を検出する。そして、他方の側に位置する端部同士が、幅WLの方向に沿って対向しているか否かを判断する処理(図中に示す「両端端部対向適合?」)を行う。なお、ステップS224で行う処理は、例えば、周囲環境認識情報演算部10Aから入力を受けた俯瞰画像信号と、自車両車速演算部10Bから入力を受けた車速演算値信号を参照して行う。
In step S224, in the parking frame
なお、線La,Lbの端部を検出する際には、例えば、図4(a)中に示す線の端部のような直線の端部と、図4(g)中に示す線の上端部のようなU字状の端部と、図4(o)中に示す二重線と横線との交点を、全て、一本の直線の端部として処理する。同様に、図4(h)中に示す線の上端部のような二重線の端部と、図4(m)中に示す線の上端部のようなU字状の曲線に空隙部が形成されている端部も、全て、一本の直線の端部として処理する。 When detecting the ends of the lines La and Lb, for example, a straight end such as the end of the line shown in FIG. 4A and the upper end of the line shown in FIG. All the intersections between the U-shaped end portion such as the portion and the double line and the horizontal line shown in FIG. 4 (o) are processed as one straight end portion. Similarly, there is a gap in the end of a double line such as the upper end of the line shown in FIG. 4H and a U-shaped curve such as the upper end of the line shown in FIG. All the formed end portions are processed as one straight end portion.
また、線La,Lbの端部を検出する際には、例えば、図4(n)中に示す上下方向に延在する傾斜した二重線と、左右方向に延在する一本の直線との交点は、端部として処理(認識)しない。これは、端部を検出する際には、撮像した画像を示す領域において、横方向への走査を行うことにより端部を検出するためである。また、例えば、図4(p)中に白枠の四角形で示す領域は、柱等の路上物体を示しているため、この物体の端部も検出しない。
ステップS224において、他方の側に位置する端部同士が、幅WLの方向に沿って対向していない(図中に示す「No」)と判断した場合、駐車枠確信度算出部36が行う処理は、ステップS228に移行する。
When detecting the ends of the lines La and Lb, for example, an inclined double line extending in the vertical direction shown in FIG. 4 (n) and a straight line extending in the horizontal direction Are not processed (recognized) as end portions. This is because, when detecting the edge, the edge is detected by scanning in the horizontal direction in the region indicating the captured image. Further, for example, since the area indicated by the white frame in FIG. 4P indicates a road object such as a pillar, the end of this object is not detected.
In step S224, when it is determined that the ends positioned on the other side do not face each other along the direction of the width WL ("No" shown in the drawing), the process performed by the parking frame
一方、ステップS224において、他方の側に位置する端部同士が、幅WLの方向に沿って対向している(図中に示す「Yes」)と判断した場合、駐車枠確信度算出部36が行う処理は、ステップS226に移行する。
ステップS226では、駐車枠確信度算出部36において、駐車枠確信度のレベルを最低値(レベル0)よりも四段階上のレベル(レベル4)に設定する処理(図中に示す「レベル4に設定」)を行う。ステップS226において、駐車枠確信度をレベル4に設定する処理を行うと、駐車枠確信度算出部36が行う処理は、ステップS228に移行する。
したがって、駐車枠確信度をレベル3に設定する処理では、図4中に示す駐車枠のうち、(d),(e),(j),(k)のパターンに対し、駐車枠確信度を設定することとなる。また、駐車枠確信度をレベル4に設定する処理では、図4中に示す駐車枠のうち、(d),(e),(j),(k)を除くパターンに対し、駐車枠確信度を設定することとなる。
On the other hand, when it is determined in step S224 that the ends located on the other side face each other along the direction of the width WL (“Yes” shown in the drawing), the parking frame
In step S226, the parking frame
Accordingly, in the process of setting the parking frame certainty level to level 3, among the parking frames shown in FIG. It will be set. Further, in the process of setting the parking frame certainty level to level 4, among the parking frames shown in FIG. Will be set.
ステップS228では、駐車枠確信度算出部36において、予め設定した駐車枠確信度算出部36が行う処理の終了条件が成立したか否かを判定する処理(図中に示す「終了条件成立?」)を行う。
具体的に、例えば、シフトポジションセンサ20から入力を受けたシフト位置信号に基づき、シフトポジションがパーキング(「P」)のシフト位置にあるか否か、イグニッションON→OFFの検出等に基づき終了条件を満足したか否かを判定する。他にも、自車両Vの車速が閾値車速以上となった場合に終了条件を満足したと判定する構成としてもよい。
ステップS228において、終了条件を満足したと判定した場合、駐車枠確信度算出部36が行う処理は終了(END)する。
In step S228, the parking frame
Specifically, for example, based on the shift position signal received from the
If it is determined in step S228 that the end condition is satisfied, the process performed by the parking frame certainty
一方、ステップS228において、終了条件を満足していないと判定した場合、駐車枠確信度算出部36が行う処理は、終了条件を満足するまで繰り返し実行される。
なお、駐車枠確信度算出部36が行う上記一連の処理は、開始条件が成立する毎に繰り返し実施される。例えば、イグニッションがOFFからONとなって自車両Vの車速が閾値車速未満の状態から閾値車速以上の状態となった場合に開始条件が成立したと判定する。また、例えば、自車両Vの車速が閾値車速以上の状態から閾値車速未満の状態となった場合、または閾値車速未満の状態で予め設定した設定距離以上の走行をした場合などに開始条件が成立したと判定する。他にも、例えば、ナビゲーション装置26によって、自車両Vが駐車場内に進入したことを検出した場合などに開始条件が成立したと判定する。
On the other hand, if it is determined in step S228 that the end condition is not satisfied, the process performed by the parking frame
The series of processes performed by the parking frame
・駐車枠進入確信度設定部38が行う処理
図1から図15を参照しつつ、図16および図17を用いて、駐車枠進入確信度設定部38が駐車枠進入確信度を設定する処理について説明する。
図16は、駐車枠進入確信度設定部38が駐車枠進入確信度を設定する処理を示すフローチャートである。なお、駐車枠進入確信度設定部38は、予め設定したサンプリング時間(例えば、10[msec])毎に、以下に説明する処理を行う。
図16中に示すように、駐車枠進入確信度設定部38が処理を開始(START)すると、まず、ステップS300において、自車両Vの予想軌跡と駐車枠とのずれ量を検出する処理(図中に示す「ずれ量検出」)を行う。ステップS300において、自車両Vの予想軌跡と駐車枠とのずれ量を検出する処理を行うと、駐車枠進入確信度設定部38が行う処理は、ステップS302へ移行する。なお、本実施形態では、一例として、ステップS300で検出するずれ量の単位を[cm]とした場合について説明する。また、本実施形態では、一例として、駐車枠の幅を2.5[m]とした場合について説明する。
Processing performed by the parking frame approach certainty
FIG. 16 is a flowchart illustrating a process in which the parking frame approach
As shown in FIG. 16, when the parking frame approach
ここで、ステップS300で行なう処理では、例えば、図17中に示すように、自車両Vの後輪予想軌跡TRを算出し、算出した後輪予想軌跡TRと駐車枠L0の入り口L2との交点TPを算出する。さらに、駐車枠L0の左側枠線L1lと交点TPとの距離Lflと、駐車枠L0の右側枠線L1rと交点TPとの距離Lfrを算出し、距離Lflと距離Lfrを比較する。そして、距離Lflと距離Lfrのうち長い方の距離を、自車両Vの後輪予想軌跡TRと駐車枠L0とのずれ量として検出する。なお、図17は、自車両Vの後輪予想軌跡TRと駐車枠L0とのずれ量を検出する処理の内容を示す図である。 Here, in the processing performed in step S300, for example, as shown in FIG. 17, the predicted rear wheel trajectory TR of the host vehicle V is calculated, and the intersection of the calculated predicted rear wheel trajectory TR and the entrance L2 of the parking frame L0. TP is calculated. Further, a distance Lfl between the left frame line L1l of the parking frame L0 and the intersection TP and a distance Lfr between the right frame line L1r of the parking frame L0 and the intersection TP are calculated, and the distance Lfl and the distance Lfr are compared. Then, the longer one of the distance Lfl and the distance Lfr is detected as a deviation amount between the predicted rear wheel trajectory TR of the host vehicle V and the parking frame L0. FIG. 17 is a diagram showing the contents of processing for detecting the amount of deviation between the predicted rear wheel trajectory TR of the host vehicle V and the parking frame L0.
また、自車両Vの後輪予想軌跡TRを算出する際には、自車両Vのうち、右後輪WRRと左後輪WRLとの車幅方向における中心点PRを、自車両Vの基準点として設定する。そして、俯瞰画像のうち前方カメラ14Fおよび左側方カメラ14SLで撮像した画像と、自車両Vの車速と、ステアリングホイール28の回転角(操舵角)を用いて、中心点PRの仮想移動経路を演算し、後輪予想軌跡TRを算出する。
When calculating the predicted rear wheel trajectory TR of the host vehicle V, the center point PR in the vehicle width direction of the right rear wheel WRR and the left rear wheel WRL of the host vehicle V is used as the reference point of the host vehicle V. Set as. Then, the virtual movement path of the center point PR is calculated using the images captured by the
ステップS302では、例えば、俯瞰画像のうち前方カメラ14Fで撮像した画像を用いて、直線Xと駐車枠L0の長さ方向(例えば、奥行き方向)との平行度を検出する処理(図中に示す「周囲画像取得」)を行う。ステップS302において、直線Xと駐車枠L0の長さ方向との平行度を検出する処理を行うと、駐車枠進入確信度設定部38が行なう処理は、ステップS304へ移行する。
ここで、ステップS302で検出する平行度は、図17中に示すように、駐車枠L0の中心線Yと直線Xとのなす角度θapとして検出する。
なお、ステップS302では、自車両Vが後退しながら駐車枠L0へ移動する場合、例えば、俯瞰画像のうち後方カメラ14Rで撮像した画像を用いて、直線Xと駐車枠L0の長さ方向との平行度を検出する処理を行う。ここで、自車両Vの移動方向(前進、後退)は、例えば、シフト位置信号を参照して検出する。
In step S302, for example, processing for detecting parallelism between the straight line X and the length direction (for example, the depth direction) of the parking frame L0 using an image captured by the
Here, the parallelism detected in step S302 is detected as an angle θap formed by the center line Y and the straight line X of the parking frame L0 as shown in FIG.
In step S302, when the host vehicle V moves to the parking frame L0 while moving backward, for example, using the image captured by the
ステップS304では、自車両Vの車速と、ステアリングホイール28の回転角(操舵角)を用いて、自車両Vの旋回半径を演算する処理(図中に示す「旋回半径演算」)を行う。ステップS304において、自車両Vの旋回半径を演算する処理を行うと、駐車枠進入確信度設定部38が行なう処理は、ステップS306へ移行する。
ステップS306では、ステップS302で検出した平行度(θap)が、予め設定した平行度閾値(例えば、15[°])未満であるか否かを判断する処理(図中に示す「平行度<平行度閾値?」)を行う。
ステップS306において、ステップS302で検出した平行度(θap)が平行度閾値以上である(図中に示す「No」)と判断した場合、駐車枠進入確信度設定部38が行なう処理は、ステップS308へ移行する。
In step S304, processing for calculating the turning radius of the host vehicle V ("turning radius calculation" shown in the figure) is performed using the vehicle speed of the host vehicle V and the rotation angle (steering angle) of the
In step S306, it is determined whether or not the parallelism (θap) detected in step S302 is less than a preset parallelism threshold (for example, 15 [°]) (“parallelism <parallel” shown in the figure). Degree threshold? ").
If it is determined in step S306 that the parallelism (θap) detected in step S302 is equal to or greater than the parallelism threshold (“No” in the figure), the process performed by the parking frame approach
一方、ステップS306において、ステップS302で検出した平行度(θap)が平行度閾値未満である(図中に示す「Yes」)と判断した場合、駐車枠進入確信度設定部38が行なう処理は、ステップS310へ移行する。
ステップS308では、ステップS304で検出した旋回半径が、予め設定した旋回半径閾値(例えば、100[R])以上であるか否かを判断する処理(図中に示す「旋回半径≧旋回半径閾値?」)を行う。
ステップS308において、ステップS304で検出した旋回半径が旋回半径閾値未満である(図中に示す「No」)と判断した場合、駐車枠進入確信度設定部38が行う処理は、ステップS312へ移行する。
On the other hand, if it is determined in step S306 that the parallelism (θap) detected in step S302 is less than the parallelism threshold (“Yes” shown in the figure), the process performed by the parking frame approach
In step S308, it is determined whether or not the turning radius detected in step S304 is greater than or equal to a preset turning radius threshold (for example, 100 [R]) (“turning radius ≧ turning radius threshold? ")I do.
If it is determined in step S308 that the turning radius detected in step S304 is less than the turning radius threshold value ("No" shown in the figure), the processing performed by the parking frame approach
一方、ステップS308において、ステップS304で検出した旋回半径が旋回半径閾値以上である(図中に示す「Yes」)と判断した場合、駐車枠進入確信度設定部38が行う処理は、ステップS310へ移行する。
ステップS310では、ステップS300で検出したずれ量が、予め設定した第一閾値(例えば、75[cm])以上であるか否かを判断する処理(図中に示す「ずれ量≧第一閾値?」)を行う。
ステップS310において、ステップS300で検出したずれ量が第一閾値以上である(図中に示す「Yes」)と判断した場合、駐車枠進入確信度設定部38が行う処理は、ステップS314へ移行する。
On the other hand, if it is determined in step S308 that the turning radius detected in step S304 is greater than or equal to the turning radius threshold value (“Yes” shown in the figure), the process performed by the parking frame approach
In step S310, a process for determining whether or not the amount of deviation detected in step S300 is greater than or equal to a preset first threshold (for example, 75 [cm]) (“deviation amount ≧ first threshold? ")I do.
When it is determined in step S310 that the amount of deviation detected in step S300 is greater than or equal to the first threshold ("Yes" shown in the figure), the process performed by the parking frame approach
一方、ステップS310において、ステップS300で検出したずれ量が第一閾値未満である(図中に示す「No」)と判断した場合、駐車枠進入確信度設定部38が行う処理は、ステップS316へ移行する。
ステップS312では、ステップS300で検出したずれ量が、予め設定した第二閾値(例えば、150[cm])以上であるか否かを判断する処理(図中に示す「ずれ量≧第二閾値?」)を行う。ここで、第二閾値は、上述した第一閾値よりも大きな値とする。
ステップS312において、ステップS300で検出したずれ量が第二閾値以上である(図中に示す「Yes」)と判断した場合、駐車枠進入確信度設定部38が行う処理は、ステップS318へ移行する。
On the other hand, if it is determined in step S310 that the amount of deviation detected in step S300 is less than the first threshold ("No" shown in the figure), the process performed by the parking frame approach
In step S312, a process for determining whether or not the deviation amount detected in step S300 is greater than or equal to a preset second threshold (for example, 150 [cm]) (“deviation amount ≧ second threshold? ")I do. Here, the second threshold value is larger than the first threshold value described above.
In step S312, when it is determined that the amount of deviation detected in step S300 is greater than or equal to the second threshold ("Yes" shown in the figure), the processing performed by the parking frame approach
一方、ステップS312において、ステップS300で検出したずれ量が第二閾値未満である(図中に示す「No」)と判断した場合、駐車枠進入確信度設定部38が行う処理は、ステップS314へ移行する。
ステップS314では、駐車枠進入確信度を低いレベルに設定する処理(図中に示す「進入確信度=低」)を行う。ステップS314において、駐車枠進入確信度を低いレベルに設定する処理を行うと、駐車枠進入確信度設定部38が行う処理は終了(END)する。
On the other hand, if it is determined in step S312 that the amount of deviation detected in step S300 is less than the second threshold ("No" shown in the figure), the process performed by the parking frame approach
In step S314, a process of setting the parking frame approach certainty factor to a low level ("entry certainty factor = low" shown in the figure) is performed. If the process which sets parking frame approach reliability to a low level is performed in step S314, the process which the parking frame approach
ステップS316では、駐車枠進入確信度を高いレベルに設定する処理(図中に示す「進入確信度=高」)を行う。ステップS316において、駐車枠進入確信度を高いレベルに設定する処理を行うと、駐車枠進入確信度設定部38が行う処理は終了(END)する。
ステップS318では、駐車枠進入確信度のレベルを最低値(レベル0)に設定する処理(図中に示す「進入確信度=レベル0」)を行う。ステップS318において、駐車枠進入確信度をレベル0に設定する処理を行うと、駐車枠進入確信度設定部38が行う処理は終了(END)する。
以上説明したように、駐車枠進入確信度設定部38は、駐車枠進入確信度を、最低値の「レベル0」、レベル0よりも高いレベルの「レベル低」、レベル低よりも高いレベルの「レベル高」のうち、いずれかのレベルに設定する処理を行う。
In step S316, a process of setting the parking frame approach certainty factor to a high level ("entry certainty factor = high" shown in the figure) is performed. If the process which sets parking frame approach reliability to a high level is performed in step S316, the process which the parking frame approach
In step S318, a process of setting the parking frame approach certainty level to the lowest value (level 0) (“entry certainty =
As described above, the parking frame approach
・総合確信度設定部40が行う処理
図1から図17を参照しつつ、図18を用いて、総合確信度設定部40が総合確信度を設定する処理について説明する。
総合確信度設定部40は、駐車枠確信度信号および駐車枠進入確信度信号の入力を受け、駐車枠確信度信号が含む駐車枠確信度と、駐車枠進入確信度信号が含む駐車枠進入確信度を、図18中に示す総合確信度設定マップに適合させる。そして、駐車枠確信度と駐車枠進入確信度に基づき、総合確信度を設定する。
なお、図18は、総合確信度設定マップを示す図である。また、図18中では、駐車枠確信度を「枠確信度」と示し、駐車枠進入確信度を「進入確信度」と示す。また、図18中に示す総合確信度設定マップは、自車両Vの前進走行時に用いるマップである。
Process Performed by Total
The overall
FIG. 18 is a diagram showing a comprehensive confidence setting map. Further, in FIG. 18, the parking frame certainty factor is denoted as “frame certainty factor”, and the parking frame approach certainty factor is denoted as “entry certainty factor”. 18 is a map used when the host vehicle V travels forward.
総合確信度設定部40が総合確信度を設定する処理の一例として、駐車枠確信度が「レベル3」であり、駐車枠進入確信度が「レベル高」である場合では、図18中に示すように、総合確信度を「高」に設定する。
なお、本実施形態では、一例として、総合確信度設定部40が、総合確信度を設定する処理を行うと、設定した総合確信度を、イグニッションスイッチをオフ状態としてもデータが消去されない記憶部に記憶する処理を行う場合について説明する。ここで、イグニッションスイッチをオフ状態としてもデータが消去されない記憶部とは、例えば、フラッシュメモリ等の不揮発性のメモリである。
As an example of the process in which the comprehensive
In the present embodiment, as an example, when the overall
したがって、本実施形態では、自車両Vの駐車完了後にイグニッションスイッチをオフ状態とし、自車両Vの再発進時にイグニッションスイッチをオン状態とした時点では、直前に設定した総合確信度が記憶されている。このため、自車両Vの再発進時にイグニッションスイッチをオン状態とした時点から、直前に設定した総合確信度に基づく制御を開始することが可能となる。 Therefore, in this embodiment, when the ignition switch is turned off after the parking of the host vehicle V is completed and the ignition switch is turned on when the host vehicle V restarts, the overall certainty factor set immediately before is stored. . For this reason, it becomes possible to start control based on the overall certainty factor set immediately before the ignition switch is turned on when the host vehicle V restarts.
・加速抑制制御開始タイミング演算部42が行う処理
図1から図18を参照しつつ、図19を用いて、加速抑制制御開始タイミング演算部42が加速抑制制御開始タイミングを演算する処理について説明する。
加速抑制制御開始タイミング演算部42は、総合確信度信号の入力を受け、総合確信度信号が含む総合確信度を、図19中に示す加速抑制条件演算マップに適合させる。そして、総合確信度に基づき、加速抑制制御開始タイミングを演算する。
なお、図19は、加速抑制条件演算マップを示す図である。また、図19中では、「加速抑制条件」の欄において、加速抑制制御開始タイミングを「抑制制御開始タイミング(アクセル開度)」と示す。
-Process which acceleration suppression control start timing calculating
The acceleration suppression control start timing
FIG. 19 is a diagram showing an acceleration suppression condition calculation map. Further, in FIG. 19, the acceleration suppression control start timing is indicated as “suppression control start timing (accelerator opening)” in the “acceleration suppression condition” column.
加速抑制制御開始タイミング演算部42が行う処理の一例として、総合確信度が「高」である場合では、図19中に示すように、加速抑制制御開始タイミングを、アクセルペダル32の開度が増加して「50%」に達したタイミングに設定する。なお、アクセルペダル32の開度は、アクセルペダル32を最大値まで踏み込んだ(操作した)状態を100%として設定する。
As an example of processing performed by the acceleration suppression control start timing
・加速抑制制御量演算部44が行う処理
図1から図19を参照して、加速抑制制御量演算部44が加速抑制制御量を演算する処理について説明する。
加速抑制制御量演算部44は、総合確信度信号の入力を受け、総合確信度信号が含む総合確信度を、図19中に示す加速抑制条件演算マップに適合させる。そして、総合確信度に基づき、加速抑制制御量を演算する。なお、図19中では、「加速抑制条件」の欄において、加速抑制制御量を「抑制量」と示す。
Processing Performed by Acceleration Suppression Control
The acceleration suppression control
加速抑制制御量演算部44が行う処理の一例として、総合確信度が「高」である場合では、図19中に示すように、加速抑制制御量を、実際のアクセルペダル32の開度に対して、「中」レベルのスロットル開度に抑制される制御量に設定する。なお、本実施形態では、一例として、「中」レベルのスロットル開度を、実際のアクセルペダル32の開度が25%に抑制されるスロットル開度とする。同様に、「小」レベルのスロットル開度を、実際のアクセルペダル32の開度が50%に抑制されるスロットル開度とし、「大」レベルのスロットル開度を、実際のアクセルペダル32の開度が10%に抑制されるスロットル開度とする。
また、加速抑制制御量演算部44は、総合確信度を加速抑制条件演算マップに適合させ、警告音を出力する制御の有無を設定する。なお、警告音を出力する場合、例えば、ナビゲーション装置26が備える表示モニタに、加速抑制制御を作動させている内容の文字情報や記号・発光等の視覚情報を表示してもよい。
As an example of the processing performed by the acceleration suppression control
Further, the acceleration suppression control
(加速抑制指令値演算部10Jで行う処理)
次に、図1から図19を参照しつつ、図20を用いて、加速抑制指令値演算部10Jで行う処理について説明する。
図20は、加速抑制指令値演算部10Jが行う処理を示すフローチャートである。なお、加速抑制指令値演算部10Jは、予め設定したサンプリング時間(例えば、10[msec])毎に、以下に説明する処理を行う。
図20中に示すように、加速抑制指令値演算部10Jが処理を開始(START)すると、まず、ステップS400において、加速抑制制御内容演算部10Iから入力を受けた加速抑制作動条件判断結果信号を参照する。そして、加速抑制作動条件判断結果を取得する処理(図中に示す「加速抑制作動条件判断結果取得処理」)を行う。ステップS400において、加速抑制作動条件判断結果を取得する処理を行うと、加速抑制指令値演算部10Jが行う処理は、ステップS402へ移行する。
(Processing performed by the acceleration suppression command
Next, processing performed by the acceleration suppression command
FIG. 20 is a flowchart showing processing performed by the acceleration suppression command
As shown in FIG. 20, when the acceleration suppression command
ステップS402では、ステップS400において取得した加速抑制作動条件判断結果に加え、加速抑制指令値を演算するための情報を取得する処理(図中に示す「加速抑制指令値演算情報取得処理」)を行う。ステップS402において、加速抑制指令値を演算するための情報を取得する処理を行うと、加速抑制指令値演算部10Jが行なう処理は、ステップS404へ移行する。
なお、加速抑制指令値を演算するための情報とは、例えば、上述した加速抑制制御開始タイミング信号、加速抑制制御量信号、駆動側踏込み量信号、アクセル操作速度信号が含む情報である。
In step S402, in addition to the acceleration suppression operation condition determination result acquired in step S400, processing for acquiring information for calculating the acceleration suppression command value ("acceleration suppression command value calculation information acquisition processing" shown in the figure) is performed. . If the process which acquires the information for calculating an acceleration suppression command value in step S402 is performed, the process which the acceleration suppression command
The information for calculating the acceleration suppression command value is, for example, information included in the acceleration suppression control start timing signal, the acceleration suppression control amount signal, the drive side depression amount signal, and the accelerator operation speed signal described above.
ステップS404では、ステップS400で取得した加速抑制作動条件判断結果が、加速抑制制御作動条件が成立する判断結果か否かを判断する処理(図中に示す「加速抑制制御作動条件成立?」)を行う。
ステップS404において、加速抑制制御作動条件が成立する判断結果である(図中に示す「Yes」)と判断した場合、加速抑制指令値演算部10Jが行なう処理は、ステップS406へ移行する。
In step S404, a process of determining whether or not the acceleration suppression operation condition determination result acquired in step S400 is a determination result that the acceleration suppression control operation condition is satisfied (“acceleration suppression control operation condition satisfied?” Shown in the figure). Do.
If it is determined in step S404 that the acceleration suppression control operation condition is satisfied ("Yes" shown in the drawing), the processing performed by the acceleration suppression command
一方、ステップS404において、加速抑制制御作動条件が成立しない判断結果である(図中に示す「No」)と判断した場合、加速抑制指令値演算部10Jが行なう処理は、ステップS408へ移行する。
ステップS406では、ステップS402で取得した加速抑制指令値を演算するための情報に基づき、加速抑制制御を行うための加速指令値である加速抑制指令値を演算する処理(図中に示す「加速抑制制御用指令値演算」)を行う。ステップS406において、加速抑制指令値を演算する処理を行うと、加速抑制指令値演算部10Jが行なう処理は、ステップS410に移行する。
On the other hand, if it is determined in step S404 that the acceleration suppression control operation condition is not satisfied ("No" shown in the figure), the processing performed by the acceleration suppression command
In step S406, based on the information for calculating the acceleration suppression command value acquired in step S402, a process of calculating an acceleration suppression command value that is an acceleration command value for performing acceleration suppression control ("Acceleration suppression command shown in the figure"). Control command value calculation "). If the process which calculates an acceleration suppression command value is performed in step S406, the process which the acceleration suppression command
ここで、加速抑制指令値を演算する処理では、駆動側踏込み量信号が含むアクセルペダル32の踏込み量と、加速抑制制御量信号が含む加速抑制制御量を参照する。そして、スロットル開度を、実際のアクセルペダル32の開度に対して加速抑制制御量に応じた抑制度合い(図19参照)とする加速抑制制御量指令値を演算する。
さらに、加速抑制指令値を演算する処理では、駆動側踏込み量信号が含むアクセルペダル32の踏込み量と、加速抑制制御開始タイミング信号が含む加速抑制制御開始タイミングを参照する。そして、加速抑制制御開始タイミングを、実際のアクセルペダル32の開度に応じたタイミング(図19参照)とする加速抑制制御開始タイミング指令値を演算する。
Here, in the process of calculating the acceleration suppression command value, the depression amount of the
Further, in the process of calculating the acceleration suppression command value, the depression amount of the
そして、加速抑制指令値を演算する処理では、上記のように演算した加速抑制制御量指令値及び加速抑制制御開始タイミング指令値を含む指令値を、加速抑制指令値として演算する。
ステップS408では、加速抑制制御を行なわない駆動力制御、すなわち、通常の駆動力制御で用いる加速指令値である通常加速指令値を演算する処理(図中に示す「通常駆動力制御用指令値演算」)を行う。ステップS408において、通常加速指令値を演算する処理を行うと、加速抑制指令値演算部10Jが行なう処理は、ステップS412に移行する。
ここで、通常加速指令値を演算する処理では、駆動側踏込み量信号が含むアクセルペダル32の踏込み量に基づいてスロットル開度を演算する指令値を、通常加速指令値として演算する。
In the process of calculating the acceleration suppression command value, the command value including the acceleration suppression control amount command value and the acceleration suppression control start timing command value calculated as described above is calculated as the acceleration suppression command value.
In step S408, driving force control without acceleration suppression control, that is, processing for calculating a normal acceleration command value that is an acceleration command value used in normal driving force control ("command value calculation for normal driving force control" shown in the figure). ")I do. If the process which calculates a normal acceleration command value is performed in step S408, the process which the acceleration suppression command
Here, in the process of calculating the normal acceleration command value, the command value for calculating the throttle opening based on the depression amount of the
ステップS410では、ステップS406で演算した加速抑制指令値を含む加速抑制指令値信号を、目標スロットル開度演算部10Kに出力する処理(図中に示す「加速抑制指令値出力」)を行う。ステップS410において、加速抑制指令値信号を出力する処理を行うと、加速抑制指令値演算部10Jが行なう処理は終了(END)する。
ステップS412では、ステップS408で演算した通常加速指令値を含む通常加速指令値信号を、目標スロットル開度演算部10Kに出力する処理(図中に示す「通常加速指令値出力」)を行う。ステップS412において、通常加速指令値信号を出力する処理を行うと、加速抑制指令値演算部10Jが行なう処理は終了(END)する。
In step S410, an acceleration suppression command value signal including the acceleration suppression command value calculated in step S406 is output to the target throttle opening
In step S412, a process of outputting a normal acceleration command value signal including the normal acceleration command value calculated in step S408 to the target throttle opening
(目標スロットル開度演算部10Kで行う処理)
次に、図1から図20を参照しつつ、図21を用いて、目標スロットル開度演算部10Kで行う処理について説明する。
図21は、目標スロットル開度演算部10Kが行う処理を示すフローチャートである。なお、目標スロットル開度演算部10Kは、予め設定したサンプリング時間(例えば、10[msec])毎に、以下に説明する処理を行う。
図21中に示すように、目標スロットル開度演算部10Kが処理を開始(START)すると、まず、ステップS500において、アクセル操作量演算部10から入力を受けた駆動側踏込み量信号を参照する。そして、駆動側踏込み量信号が含むアクセルペダル32の踏込み量(操作量)を取得する処理(図中に示す「アクセル操作量取得処理」)を行う。ステップS500において、アクセルペダル32の踏込み量(操作量)を取得する処理を行うと、目標スロットル開度演算部10Kが行う処理は、ステップS502へ移行する。
(Processing performed by the target throttle opening
Next, processing performed by the target throttle opening
FIG. 21 is a flowchart showing processing performed by the target throttle opening
As shown in FIG. 21, when the target throttle opening
ステップS502では、加速抑制指令値演算部10Jから入力を受けた情報信号に基づき、抑制有加速抑制指令値(ステップ408参照)、加速抑制指令値(ステップS414参照)または通常加速指令値(ステップS418参照)を取得する処理(図中に示す「指令値取得処理」)を行う。ステップS502において、加速抑制指令値または通常加速指令値を取得する処理を行うと、目標スロットル開度演算部10Kが行う処理は、ステップS504へ移行する。
In step S502, based on the information signal received from the acceleration suppression command
ステップS504では、ステップS500で取得したアクセルペダル32の踏込み量と、ステップS502で取得した指令値に基づき、目標スロットル開度の演算(図中に示す「目標スロットル開度演算」)を行う。ステップS506において、目標スロットル開度を演算すると、目標スロットル開度演算部10Kが行う処理は、ステップS506へ移行する。
ここで、ステップS504では、ステップS502で取得した指令値が通常加速指令値である場合(加速抑制作動条件が非成立である場合)は、アクセルペダル32の踏込み量に応じたスロットル開度を、目標スロットル開度として演算する。
In step S504, calculation of the target throttle opening ("target throttle opening calculation" shown in the figure) is performed based on the depression amount of the
Here, in step S504, when the command value acquired in step S502 is a normal acceleration command value (when the acceleration suppression operation condition is not established), the throttle opening corresponding to the depression amount of the
一方、ステップS502で取得した指令値が加速抑制指令値である場合(加速抑制作動条件が成立している場合)は、加速抑制制御量指令値に応じたスロットル開度を、目標スロットル開度として演算する。
目標スロットル開度は、例えば、以下の式(4)を用いて演算する。
θ*=θ1−Δθ … (4)
上式(1)中では、目標スロットル開度を「θ*」で示し、アクセルペダル32の踏込み量に応じたスロットル開度を「θ1」で示し、加速抑制制御量を「Δθ」で示す。
On the other hand, when the command value acquired in step S502 is the acceleration suppression command value (when the acceleration suppression operation condition is satisfied), the throttle opening corresponding to the acceleration suppression control amount command value is set as the target throttle opening. Calculate.
The target throttle opening is calculated using, for example, the following equation (4).
θ * = θ1−Δθ (4)
In the above equation (1), the target throttle opening is indicated by “θ *”, the throttle opening corresponding to the depression amount of the
ステップS506では、ステップS504で演算した目標スロットル開度θ*を含む目標スロットル開度信号を、エンジンコントローラ12に出力(図中に示す「目標スロットル開度出力」)する。ステップS506において、目標スロットル開度信号をエンジンコントローラ12に出力する処理を行うと、目標スロットル開度演算部10Kが行う処理は終了(END)する。
ここで、ステップS506では、ステップS502で取得した指令値が抑制有加速抑制指令値または加速抑制指令値である場合は、アクセルペダル32の開度(踏み込み量)が加速抑制制御開始タイミングに応じた開度に達したタイミングで、目標スロットル開度信号を出力する。
In step S506, a target throttle opening signal including the target throttle opening θ * calculated in step S504 is output to the engine controller 12 (“target throttle opening output” shown in the figure). In step S506, when the process of outputting the target throttle opening signal to the
Here, in step S506, when the command value acquired in step S502 is the suppression-accelerated suppression command value or the acceleration suppression command value, the opening degree (depression amount) of the
(動作)
次に、図1から図21を参照しつつ、本実施形態の車両用加速抑制装置1を用いて行う動作の一例を説明する。
まず、駐車場内を走行する自車両Vが、運転者の選択した駐車枠に進入する例を説明する。
自車両Vの車速が、閾値車速である15[km/h]以上の状態では、加速抑制制御作動条件が成立しないため、駐車場内であっても自車両Vには加速抑制制御が作動することなく、運転者の加速意図を反映した通常の駆動力制御を行う。
(Operation)
Next, an example of an operation performed using the vehicle
First, an example in which the host vehicle V traveling in the parking lot enters the parking frame selected by the driver will be described.
When the vehicle speed of the host vehicle V is 15 [km / h] or more, which is the threshold vehicle speed, the acceleration suppression control operation condition is not satisfied, and therefore the acceleration suppression control operates on the host vehicle V even in the parking lot. Instead, normal driving force control that reflects the driver's acceleration intention is performed.
一方、自車両Vの車速が、15[km/h]以上でかつ駐車枠確信度の設定処理の開始条件に係る閾値車速である30[km/h]以下の状態では、加速抑制制御の作動準備のために、駐車枠確信度の設定処理が実行される。
駐車枠確信度の設定処理が実行されると、駐車枠確信度算出部36において、駐車枠確信度が「0」に設定され(ステップS200)、引き続き、周囲画像取得処理が行われて自車両Vの周囲の画像情報が取得される(ステップS202)。
On the other hand, in a state where the vehicle speed of the host vehicle V is 15 [km / h] or more and 30 [km / h] or less which is a threshold vehicle speed related to the start condition of the parking frame certainty setting process, the acceleration suppression control is activated. For preparation, parking frame certainty factor setting processing is executed.
When the parking frame certainty factor setting process is executed, the parking frame certainty
次に、駐車枠確信度算出部36において、検出用情報補正判断処理が行われる(ステップS204)。
検出用情報補正判断処理が開始されると、駐車枠確信度算出部36において、まず、自車両Vの周囲の画像情報を含む各種データが取得される(ステップS2000)。
ここで、現在、自車両Vは、例えば駐車場内の平坦な乾いた道路を真っ直ぐに前進走行中であるとし、運転者がアクセルペダル32を急に深く踏み込んだとする。
Next, in the parking frame
When the detection information correction determination process is started, the parking frame
Here, it is assumed that the host vehicle V is currently traveling straight forward on a flat dry road in a parking lot, for example, and the driver suddenly depresses the
これにより、駐車枠確信度算出部36において、予め設定した設定時間分の過去から現在までのアクセルペダル32の操作量の変化量と現在のシフト位置とに基づき、予め設定したマップから予測前後加速度Ga*が算出される。加えて、ヨーレートセンサ27からのヨーレートφと車速νとから予測横加速度Gy*が算出される(ステップS2010)。
なお、自車両Vが平坦な乾いた道路を走行中であるため、算出された予測前後加速度Ga*及び予測横加速度Gy*の、路面勾配と路面摩擦係数とによる補正量はほぼ「0」となる。
Thereby, in the parking frame
Since the vehicle V is traveling on a flat dry road, the correction amount of the calculated predicted longitudinal acceleration Ga * and predicted lateral acceleration Gy * based on the road surface gradient and the road surface friction coefficient is substantially “0”. Become.
次に、駐車枠確信度算出部36において、二軸加速度センサ25からの前後加速度Gaと予測前後加速度Ga*との差分値である前後加速度差分値Gadが算出される。加えて、予測横加速度Gy*と、二軸加速度センサ25からの実横加速度Gyとの差分値である横加速度差分値Gydが算出される(ステップS2020)。
次に、駐車枠確信度算出部36において、前後加速度差分値Gad及び横加速度差分値Gydが予め設定した差分範囲以内か否かが判定される(ステップS2030)。ここでは、両方とも差分範囲以内であると判定されたとする(ステップS2030のYes)。
Next, in the parking frame
Next, the parking frame
これにより、駐車枠確信度算出部36は、次に、自車両Vの車両姿勢を推定する(ステップS2040)。ここでは、自車両Vがアクセルペダル32の急な踏み込みによって急加速するため、予測前後加速度Ga*及び実前後加速度Gaが大きな値となり、その結果、推定ピッチ角θp*も大きな値となる。一方、自車両Vは旋回等を行っていないため予測横加速度Gy*及び実横加速度Gyはほぼ「0」となる。そのため、推定ロール角θr*は、ほぼ「0」又はオフセット値となる。
Thereby, the parking frame
続いて、駐車枠確信度算出部36において、自車両Vの姿勢変化量が予め設定した変化量閾値以上であるか否かを判定する(ステップS2050)。ここでは、推定ピッチ角θp*が大きな値となっているので、ピッチ角変化量θpgはピッチ角変化量閾値以上となる。一方、推定ロール角θr*は小さな値となっているので、ロール角変化量θrgはロール角変化量閾値未満となる(ステップS2050のYes)。
これにより、駐車枠確信度算出部36において、ピッチング補正実行フラグがONに設定され、ローリング補正実行フラグがOFFに設定される(ステップS2060)。
続いて、駐車枠確信度算出部36において、取得した俯瞰画像から駐車枠の判定要素を抽出する処理が行われる(ステップS206)。ここでは、俯瞰画像内から、二本の線La,Lbを抽出したとする。
Subsequently, the parking frame
Thereby, in the parking frame
Subsequently, the parking frame
次に、駐車枠確信度算出部36において、ピッチング補正実行フラグがONに設定されているので(ステップS208のYes)、検出用情報補正処理が行われる(ステップS210)。
ここでは、自車両Vの急加速によってピッチングが発生しているため、このピッチングに応じた前方カメラ14Fの位置変化による俯瞰画像内の判定要素のずれを補正する処理が行われる。つまり、自車両Vが急加速した場合は、図9(c)に示すように、自車両Vが仰け反って、自車両Vに固定された前方カメラ14Fは上方向にピッチングする。従って、本来は真っ直ぐな俯瞰画像内の二本の線La,Lbがハの字状に変形する。従って、この変形を、例えば、図12(b)に示すように、二本の線La,Lbを、ずれた分だけ矢印の方向に回転移動させることによって、図12(b)の右図に示すように正常な形状へと補正する。
Next, in the parking frame
Here, since the pitching has occurred due to the rapid acceleration of the host vehicle V, a process of correcting the shift of the determination element in the overhead view image due to the position change of the
引き続き、駐車枠確信度算出部36において、抽出された二本の線La,Lbが駐車枠を形成する枠線の条件に適合しているか否かが判定される(ステップS212)。
ここでは、二本の線La,Lbが駐車枠を形成する枠線の条件に適合しているとして(ステップS2012のYes)、駐車枠確信度算出部36は、駐車枠確信度を初期値のレベル0からレベル1に設定する(ステップS214)。
このようにして駐車枠が検出され、さらに、ブレーキペダル30が操作されておらず、アクセルペダル32の踏込み量が閾値アクセル操作量以上であると、自車両Vが駐車枠へ進入するか否かの判断を行う。
Subsequently, the parking frame
Here, assuming that the two lines La and Lb meet the conditions of the frame line forming the parking frame (Yes in step S2012), the parking frame
In this way, if the parking frame is detected, the
また、自車両Vの走行中には、駐車枠確信度算出部36の駐車枠確信度の設定に加えて、駐車枠進入確信度設定部38が駐車枠進入確信度を設定する。そして、総合確信度設定部40が、駐車枠確信度および駐車枠進入確信度に基づく総合確信度を設定する。
さらに、自車両Vの走行中には、総合確信度設定部40が設定した総合確信度に基づき、加速抑制制御開始タイミング演算部42が加速抑制制御開始タイミングを演算し、加速抑制制御量演算部44が加速抑制制御量を演算する。
During traveling of the host vehicle V, in addition to setting the parking frame certainty factor of the parking frame certainty
Further, while the host vehicle V is traveling, the acceleration suppression control start timing
そして、自車両Vの車速が、閾値車速である15[km/h]未満の状態となり、かつ、自車両Vが駐車枠へ進入すると判断したとする。これにより、加速抑制制御作動条件が成立する。加速抑制制御作動条件が成立すると判断すると、加速抑制指令値演算部10Jが、加速抑制指令値信号を目標スロットル開度演算部10Kへ出力する。さらに、目標スロットル開度演算部10Kが、目標スロットル開度信号をエンジンコントローラ12へ出力する。
Then, it is assumed that the vehicle speed of the host vehicle V is less than 15 [km / h], which is a threshold vehicle speed, and it is determined that the host vehicle V enters the parking frame. Thereby, the acceleration suppression control operation condition is established. If it is determined that the acceleration suppression control operation condition is satisfied, the acceleration suppression command
この時点では、駐車枠確信度がレベル1であるため、図18に示すように、総合確信度は「極低」となる。従って、図19に示すように、抑制制御開始タイミングは「80[%]」、抑制量は「小」および警告音は「無」となる。
即ち、加速抑制制御開始タイミングを、アクセルペダル32の開度が増加して「80[%]」に達したタイミングに設定し、スロットル開度を、実際のアクセルペダル32の開度が50[%]に抑制されるスロットル開度に設定し、警告音を出力しない設定とする。
このため、加速抑制制御作動条件が成立した状態で、運転者がアクセルペダル32を操作すると、アクセルペダル32の踏み込み量に応じたスロットル開度を、加速抑制制御量指令値に応じた開度(実際のスロットル開度の50[%]の開度)に抑制する。これに加え、アクセルペダル32の踏み込み量に応じたスロットル開度を抑制する開始タイミングを、加速抑制制御開始タイミング指令値に応じたタイミング(スロットル開度が80[%]に達したタイミング)とする。
At this time, since the parking frame certainty is
That is, the acceleration suppression control start timing is set to a timing at which the opening degree of the
Therefore, when the driver operates the
引き続き、二本の線La,Lbが駐車枠を形成する枠線の条件に適合していると判定されることによって、駐車枠確信度がレベル1に維持(連続照合)される(ステップS214)。
更に、連続照合された状態で、自車両Vの走行距離が設定移動距離に達すると、駐車枠確信度算出部36は、駐車枠確信度をレベル1からレベル2に設定する(ステップS216の「Yes」,S218)。
駐車枠確信度がレベル2に設定されると、次に、線La,Lbに対し、それぞれ、自車両Vを基準として同じ側に位置する端部を検出する。ここでは、近い側の端部が検出されたとして(ステップS220のYes)、駐車枠確信度算出部36は、駐車枠確信度をレベル2からレベル3に設定する(ステップS222)。
Subsequently, when it is determined that the two lines La and Lb meet the conditions of the frame line forming the parking frame, the parking frame reliability is maintained at level 1 (continuous verification) (step S214). .
Further, when the travel distance of the host vehicle V reaches the set travel distance in the state of continuous verification, the parking frame
When the parking frame certainty is set to
引き続き、線La,Lbに対し、それぞれ、自車両Vを基準として近い側の端部と対向する側に位置する遠い側の端部を検出する(ステップS224)。
そして、遠い側の端部が検出されると(ステップS224のYes)、駐車枠確信度算出部36は、駐車枠確信度をレベル3からレベル4に設定する(ステップS226)。
これにより、例えば、進入確信度がレベル「高」である場合、図18に示すように、総合確信度は「極高」と設定される。これにより、加速抑制制御作動条件が成立し、図19に示すように、抑制制御開始タイミングは「50[%]」、抑制量は「大」および警告音は「有」となる。
Subsequently, for the lines La and Lb, the far end located on the side facing the near end with respect to the own vehicle V is detected (step S224).
When the far end is detected (Yes in step S224), the parking frame
Thereby, for example, when the approach certainty factor is “high”, the total certainty factor is set to “extremely high” as shown in FIG. As a result, the acceleration suppression control operation condition is established, and as shown in FIG. 19, the suppression control start timing is “50 [%]”, the suppression amount is “large”, and the warning sound is “present”.
即ち、加速抑制制御開始タイミングを、アクセルペダル32の開度が増加して「50[%]」に達したタイミングに設定し、スロットル開度を、実際のアクセルペダル32の開度が10[%]に抑制されるスロットル開度に設定し、警告音を出力する設定とする。
このため、加速抑制制御作動条件が成立した状態で、運転者がアクセルペダル32を操作すると、アクセルペダル32の踏み込み量に応じたスロットル開度を、加速抑制制御量指令値に応じた開度(実際のスロットル開度の10[%]の開度)に抑制する。これに加え、アクセルペダル32の踏み込み量に応じたスロットル開度を抑制する開始タイミングを、加速抑制制御開始タイミング指令値に応じたタイミング(スロットル開度が50[%]に達したタイミング)とする。さらに、情報呈示装置のスピーカからブザー音や警告メッセージ等の警告音を出力する。
That is, the acceleration suppression control start timing is set to a timing when the opening of the
Therefore, when the driver operates the
次に、自車両Vが道路を前進走行中に、道路の左側に面した例えばコンビニエンスストアの駐車場内に、ブレーキペダル30を踏み込んで減速しつつ左折で進入し、かつ、そのまま駐車枠内へと駐車する場合の動作を説明する。
この場合は、駐車枠確信度算出部36において、予め設定した設定時間分の過去から現在までのブレーキペダル30の操作量の変化量に基づき、予め設定したマップから予測前後減速度Gb*が算出される。加えて、ヨーレートセンサ27からのヨーレートφと車速νとから予測横加速度Gy*が算出される(ステップS2010)。
Next, while the host vehicle V is traveling forward on the road, enter the parking lot of the convenience store facing the left side of the road, for example, depressing the
In this case, the parking frame
次に、駐車枠確信度算出部36において、二軸加速度センサ25からの実前後減速度Gbと予測前後減速度Gb*との差分値である前後減速度差分値Gbdが算出される。加えて、予測横加速度Gy*と、二軸加速度センサ25からの実横加速度Gyとの差分値である横加速度差分値Gydが算出される(ステップS2020)。
次に、駐車枠確信度算出部36において、前後減速度差分値Gbd及び横加速度差分値Gydが予め設定した差分範囲以内か否かが判定される(ステップS2030)。ここでは、両方とも差分範囲以内であると判定されたとする(ステップS2030のYes)。
Next, the parking frame
Next, the parking frame
これにより、駐車枠確信度算出部36は、次に、自車両Vの車両姿勢を推定する(ステップS2040)。ここでは、運転者が駐車のためにブレーキペダル30を比較的強く踏み込んでおり、予測前後減速度Gb*及び実前後減速度Gbが比較的大きな値となる。そのため、推定ピッチ角θp*も比較的大きな値となる。加えて、自車両Vは急な左旋回を行っており予測横加速度Gy*及び実横加速度Gyも比較的大きな値となる。そのため、推定ロール角θr*も、比較的大きな値となる。
Thereby, the parking frame
続いて、駐車枠確信度算出部36において、自車両Vの姿勢変化量が予め設定した変化量閾値以上であるか否かを判定する(ステップS2050)。ここでは、推定ピッチ角θp*が比較的大きな値となっているので、ピッチ角変化量θpgはピッチ角変化量閾値以上となる。更に、推定ロール角θr*も比較的大きな値となっているので、ロール角変化量θrgもロール角変化量閾値以上となる(ステップS2050のYes)。
これにより、駐車枠確信度算出部36において、ピッチング補正実行フラグ及びローリング補正実行フラグが共にONに設定される(ステップS2060)。
続いて、駐車枠確信度算出部36において、取得した俯瞰画像から駐車枠の判定要素を抽出する処理が行われる(ステップS206)。ここでは、俯瞰画像内から、二本の線La,Lbを抽出したとする。
Subsequently, the parking frame
Thereby, in the parking frame
Subsequently, the parking frame
次に、駐車枠確信度算出部36において、ピッチング補正実行フラグ及びローリング補正実行フラグが共にONに設定されているので(ステップS208のYes)、検出用情報補正処理が行われる(ステップS210)。
ここでは、自車両Vの減速によるピッチング及び左旋回によるローリングが発生しているため、これらピッチング及びローリングに応じた前方カメラ14Fの位置変化による俯瞰画像内の判定要素のずれを補正する処理が行われる。つまり、自車両Vが減速した場合は、図9(b)に示すように、自車両Vが前のめりとなって、自車両Vに固定された前方カメラ14Fは下方向にピッチングする。従って、本来は真っ直ぐな俯瞰画像内の二本の線La,Lbが逆ハの字状に変形する。従って、この変形を、例えば、図12(a)の左図に示すように、二本の線La,Lbを、ずれた分だけ矢印の方向に回転移動させることによって、図12(b)の右図に示すように正常な形状へと補正する。加えて、自車両Vが左旋回した場合は、右方向にローリングするため、例えば、図13(b)の左図に示すように、俯瞰画像内の二本の線La,Lbが右方向にずれる。従って、このずれを、例えば、図13(b)の左図に示すように、二本の線La,Lbを、ずれた分だけ矢印の方向に移動させることによって、図13(b)の右図に示すように正常な位置へと補正する。
以降の動作は、上記加速した場合の動作と同様となるので説明を省略する。
Next, since both the pitching correction execution flag and the rolling correction execution flag are set to ON in the parking frame certainty calculation unit 36 (Yes in step S208), a detection information correction process is performed (step S210).
Here, since the pitching due to the deceleration of the host vehicle V and the rolling due to the left turn have occurred, the process of correcting the shift of the determination element in the overhead view image due to the position change of the
Subsequent operations are the same as those in the case of acceleration described above, and a description thereof will be omitted.
また、本実施形態の駐車枠確信度算出部36は、例えば、自車両Vが坂道(傾斜路)を登っているような場合、予測した前後加減速度及び横加速度に対して、傾斜(勾配)に応じた補正を行う。
また、本実施形態の駐車枠確信度算出部36は、自車両Vが雨に濡れた道路、雪路、凍結路等の路面摩擦係数の比較的小さくなる路面状態の道路を走行中は、予測した前後加減速度及び横加速度に対して、路面摩擦係数に応じた補正を行う。
Further, the parking frame
In addition, the parking frame
また、本実施形態の駐車枠確信度算出部36は、例えば、予測加減速度又は予測横加速度が実加速度に対して大きく外れていたり、二軸加速度センサ25が故障するなどして検出値が大きく誤っていたりした場合に、これらの差分値の大きさを判定する。すなわち、これらの差分値が予め設定した差分値範囲を超えていると判定すると、ピッチング補正実行フラグ及びローリング補正実行フラグを共にOFFに設定する。つまり、本実施形態の駐車枠確信度算出部36は、予測値と実測値との差が大きい場合、検出用情報の補正処理を行わない。
In addition, the parking frame
以上説明したように、本実施形態では、自車両Vの姿勢変化によってカメラの位置が変化した場合に、この位置変化による俯瞰画像内の判定要素のずれを補正することが可能となる。これにより、自車両Vの姿勢変化時の駐車枠の検出精度を向上することが可能となる。加えて、姿勢変化時の検出精度の向上によって、自車両Vの姿勢変化時の加速抑制制御の作動精度を向上することが可能となる。 As described above, in the present embodiment, when the position of the camera changes due to a change in the posture of the host vehicle V, it is possible to correct the shift of the determination element in the overhead image due to the change in position. Thereby, it becomes possible to improve the detection accuracy of the parking frame when the posture of the host vehicle V changes. In addition, by improving the detection accuracy when the posture changes, it is possible to improve the operation accuracy of the acceleration suppression control when the vehicle V changes its posture.
また、このようにして補正された判定要素に基づき検出した駐車枠に基づき、自車両Vが駐車枠内で駐車に適した位置に近づいた状態等、制動操作が適切な運転操作である状況で、誤操作等によりアクセルペダル32が操作された場合であっても、総合確信度に応じてスロットル開度を抑制することが可能となる。すなわち、総合確信度が低い状態では、加速抑制量(スロットル開度の抑制度合い)が小さいため、運転性の低下を少なくすることが可能となり、総合確信度が高い状態では、加速抑制量が大きいため、自車両Vの加速抑制効果を高くすることが可能となる。
In a situation where the braking operation is an appropriate driving operation, such as a state in which the host vehicle V is approaching a position suitable for parking in the parking frame based on the parking frame detected based on the determination element corrected in this way. Even when the
つまり、本実施形態では、駐車時において、駐車枠への進入を行う前には駐車場内における運転性低下を抑制することが可能であるとともに、アクセルペダル32の誤操作時における自車両Vの加速を抑制することが可能である。
また、本実施形態では、総合確信度が高いほど、加速抑制制御量を大きくすることにより、自車両Vの加速を抑制して、安全性を向上させる。また、総合確信度が低いほど、加速抑制制御開始タイミングを遅くして、運転性の低下を抑制する。これにより、以下に示す状況下において、安全性の向上と運転性低下の抑制が可能となる。
例えば、路上において、走行路の脇に縦列駐車用の駐車枠が標示されている付近に待機している自車両Vを発進させる状況では、ある程度の加速を許容する必要がある。
In other words, in the present embodiment, it is possible to suppress the drivability deterioration in the parking lot before entering the parking frame during parking, and to accelerate the own vehicle V when the
Moreover, in this embodiment, the acceleration of the host vehicle V is suppressed and the safety is improved by increasing the acceleration suppression control amount as the total certainty factor is higher. Further, the lower the overall certainty, the later the acceleration suppression control start timing is delayed, and the drivability is suppressed from decreasing. This makes it possible to improve safety and suppress deterioration of drivability under the following conditions.
For example, in a situation where the host vehicle V standing by in the vicinity of a parking frame for tandem parking on the side of the traveling road is started, it is necessary to allow some acceleration.
また、以下に示す状況下においても、ある程度の加速を許容する必要がある。これは、自車両Vを駐車させる駐車枠の両脇(左右の駐車枠)に他車両が存在し、その向かい側(各駐車枠から離れた側)に多少のスペースに自車両Vを前側から進入させる。その後、自車両Vを駐車させる駐車枠に自車両Vを後側から進入させて駐車を行う状況である。
これらの状況に対し、総合確信度に基づいて加速抑制制御開始タイミングと加速抑制制御量を制御することにより、自車両Vの加速を抑制して、安全性を向上させることが可能となる。これに加え、自車両Vの加速を許容して、運転性低下を抑制することが可能となる。
Even under the following conditions, it is necessary to allow a certain amount of acceleration. This is because there are other vehicles on both sides (left and right parking frames) of the parking frame where the host vehicle V is parked, and the host vehicle V enters from a front side into a small space on the opposite side (side away from each parking frame). Let Thereafter, the host vehicle V enters the parking frame in which the host vehicle V is parked from the rear side and is parked.
By controlling the acceleration suppression control start timing and the acceleration suppression control amount based on the total certainty for these situations, it is possible to suppress the acceleration of the host vehicle V and improve safety. In addition, it is possible to allow acceleration of the host vehicle V and suppress drivability deterioration.
なお、加速抑制制御として、自車両Vを加速させる加速指令値を抑制する制御を例に挙げて説明したが、この構成に限らない。例えば、加速抑制制御は、自車両Vを予め設定した車速以下の低車速で走行させる制御や、駆動力制御のみに限らず制動装置による自車両Vを減速(停止も含む)させる制御なども含む。さらに、加速抑制制御は、クラッチの接続制御による動力の伝達制御(例えば、抑制時はクラッチをギアから切り離して動力を伝達させない)なども含む。 In addition, although control which suppresses the acceleration command value which accelerates the own vehicle V was mentioned as an example as acceleration suppression control, it was not restricted to this structure. For example, the acceleration suppression control includes control for causing the host vehicle V to travel at a low vehicle speed equal to or lower than a preset vehicle speed, and control for decelerating (including stopping) the host vehicle V using a braking device as well as driving force control. . Further, the acceleration suppression control includes power transmission control based on clutch connection control (for example, when suppression is performed, the clutch is disconnected from the gear and power is not transmitted).
ここで、上述した周囲環境認識センサ14は、撮像部に対応する。
また、上述した駐車枠確信度算出部36が行う判定要素が駐車枠を形成する要素の条件に適合するか否かを判定する処理(ステップS212)は、駐車枠検出部に対応する。
また、上述した加速抑制制御開始タイミング演算部42と、加速抑制制御量演算部44と、加速抑制指令値演算部10Jと、目標スロットル開度演算部10Kは、加速抑制制御部に対応する。
Here, the ambient
Moreover, the process (step S212) which determines whether the determination element which the parking frame
Moreover, the acceleration suppression control start timing
また、アクセル操作検出センサ24およびアクセル操作量演算部10と、ブレーキ操作検出センサ22およびブレーキペダル操作情報演算部10Fと、シフトポジションセンサ20およびシフトポジション演算部10Eと、ヨーレートセンサ27と、車輪速センサ16および自車両車速演算部10Bとは、走行状態情報検出部に対応する。
また、上述した二軸加速度センサ25は、実加速度検出部および実減速度検出部に対応する。
また、上述した駐車枠確信度算出部36が行う加減速度を予測する処理から車両姿勢を推定するまでの処理(ステップS2010〜S2040)は、車両姿勢推定部に対応する。
また、上述した駐車枠確信度算出部36が行う路面の傾斜を検出する処理(ステップS2010)は、
また、上述した駐車枠確信度算出部36が行う検出用情報補正処理(ステップS210)は、検出用情報設定部に対応する。
また、アクセルペダル32の踏み込み量及びシフト位置は、加速情報に対応し、ブレーキペダル30の踏み込み量は、減速情報に対応する。
Further, the accelerator
The
Moreover, the process (step S2010-S2040) from the process which estimates the acceleration / deceleration which the parking frame
Moreover, the process (step S2010) which detects the inclination of the road surface which the parking frame
Further, the detection information correction process (step S210) performed by the parking frame certainty
Further, the depression amount and shift position of the
(実施形態の効果)
本実施形態であれば、以下に記載する効果を奏することが可能となる。
(1)周囲環境認識センサ14(前方カメラ14F、右側方カメラ14SR、左側方カメラ14SLおよび後方カメラ14R)が、自車両周囲の領域を撮像した撮像画像を取得する。アクセル操作検出センサ24およびアクセル操作量演算部10Gと、シフトポジションセンサ20及びシフトポジション演算部10Eとが、自車両Vの前後方向の加速動作の発生に係る情報であるアクセルペダル32の踏み込み量と、シフト位置とを検出する。駐車枠確信度算出部36が、検出したアクセルペダル32の踏み込み量とシフト位置とに基づき、自車両Vの前後方向に加速時の車両姿勢(ピッチ角θp)を推定する。一方、ブレーキ操作検出センサ22およびブレーキ操作情報演算部10Fが、自車両Vの減速動作の発生に係る情報であるブレーキペダル30の踏み込み量を検出する。駐車枠確信度算出部36が、検出したブレーキペダル30の踏み込み量に基づき、自車両Vの前後方向に減速時の車両姿勢を推定する。駐車枠確信度算出部36が、推定した車両姿勢に基づき、撮像画像から駐車枠の検出する駐車枠検出処理に用いる検出用情報の内容を、車両姿勢のピッチ方向の変化によるカメラ(前方カメラ14F又は後方カメラ14R)の路面に対する位置変化に応じた撮像画像の変化を小さくする内容に設定する。駐車枠確信度算出部36が、設定した検出用情報を用いて撮像画像から駐車枠を検出する。加速抑制制御開始タイミング演算部42、加速抑制制御量演算部44、加速抑制指令値演算部10Jおよび目標スロットル開度演算部10Kが、駐車枠確信度算出部36が駐車枠を検出すると、アクセル操作検出センサ24およびアクセル操作量演算部10Gが検出した駆動力操作量に応じた加速指令値(スロットル開度)を抑制する加速抑制制御を実施する。
(Effect of embodiment)
If it is this embodiment, it will become possible to show the effect described below.
(1) The surrounding environment recognition sensor 14 (the
つまり、自車両Vが、例えば、前後方向の加減速によって姿勢変化(ピッチング)した場合に、駐車枠の検出に用いる画像情報や判定用の閾値等の検出用情報の内容を、姿勢変化によるカメラの路面に対する位置変化に応じた撮像画像の変化を小さくする内容に設定するようにした。
これによって、自車両Vのピッチ方向への姿勢変化時の駐車枠の検出精度を向上することが可能となり、該姿勢変化時に検出される駐車枠に自車両Vが駐車する際の運転者の意図しない車両の加速や駐車場ではない走行路での加速抑制の作動を抑制することが可能となる。その結果、加速抑制制御の適切な作動を行うことが可能となる。
(2)駐車枠確信度算出部36が、検出用情報の内容を、車両姿勢の自車側の変化を小さくするように補正する。
In other words, when the host vehicle V changes its posture (pitching) due to acceleration / deceleration in the front-rear direction, for example, the image information used for detection of the parking frame and the contents of detection information such as a threshold value for determination are used as a camera based on the posture change. The content is set so as to reduce the change in the captured image in accordance with the position change with respect to the road surface.
As a result, it is possible to improve the detection accuracy of the parking frame when the posture of the host vehicle V changes in the pitch direction, and the driver's intention when the host vehicle V parks in the parking frame detected when the posture changes. It is possible to suppress the acceleration of the vehicle that does not perform and the acceleration suppression operation on the travel path that is not a parking lot. As a result, it is possible to perform an appropriate operation of the acceleration suppression control.
(2) The parking frame
ここで、ピッチ方向の変化によって、撮像画像の内容は自車側が大きく変化する。
このことに基づき、カメラの路面に対する位置変化によって、撮像画像(俯瞰画像)の内容が変化した際に、その自車側の変化を小さくするように、例えば、撮像画像の内容、駐車枠の検出に用いる判定用閾値などの検出用情報の内容を補正するようにした。そのため、変化量の大きい自車側に着目することで適切な量での補正がしやすく、自車両Vの姿勢変化時の駐車枠の検出精度を向上することが可能となる。これにより、該姿勢変化時に検出される駐車枠に自車両Vが駐車する際の運転者の意図しない車両の加速や駐車場ではない走行路での加速抑制の作動を抑制することが可能となる。その結果、加速抑制制御の適切な作動を行うことが可能となる。
Here, due to a change in the pitch direction, the content of the captured image greatly changes on the own vehicle side.
Based on this, when the content of the captured image (overhead image) changes due to a change in the position of the camera with respect to the road surface, for example, the content of the captured image and the detection of the parking frame are reduced so as to reduce the change on the own vehicle side. The contents of the detection information such as the determination threshold used for the correction are corrected. Therefore, it is easy to perform correction with an appropriate amount by paying attention to the own vehicle side having a large amount of change, and it becomes possible to improve the detection accuracy of the parking frame when the posture of the own vehicle V changes. As a result, it is possible to suppress the acceleration of the vehicle not intended by the driver when the host vehicle V is parked in the parking frame detected when the posture is changed, and the acceleration suppression operation on the travel path that is not the parking lot. . As a result, it is possible to perform an appropriate operation of the acceleration suppression control.
(3)駐車枠確信度算出部36が、自車両Vの前部が後部に対して上方に上がるピッチ方向の変化の場合に、撮像画像の自車側を狭める方向に該撮像画像を補正し、自車両Vの前部が後部に対して下方に下がるピッチ方向の変化の場合に、撮像画像の自車側を広げる方向に該撮像画像を補正する。
ここで、自車両Vが後ろに仰け反るピッチングが発生するとカメラの撮像軸が上方に上がり、撮像画像の自車側が通常姿勢時よりも広がるように変化する。一方、自車両Vが前のめりになるピッチングが発生するとカメラの撮像軸が下方に下がり、撮像画像の自車側が通常姿勢時よりも狭まるように変化する。
(3) The parking frame
Here, when pitching occurs in which the host vehicle V is turned back, the imaging axis of the camera rises upward, and the host vehicle side of the captured image changes so as to be wider than in the normal posture. On the other hand, when pitching occurs such that the host vehicle V is turned forward, the imaging axis of the camera is lowered downward, and the host vehicle side of the captured image changes so as to be narrower than that in the normal posture.
このことに基づき、自車両Vが仰け反るピッチングが生じた場合、撮像画像の自車側を狭める方向に補正し、自車両Vが前のめりとなるピッチングが生じた場合、撮像画像の自車側を広げる方向に補正するようにした。これにより、自車両Vのピッチ方向への姿勢変化時の駐車枠の検出精度を向上することが可能となり、該姿勢変化時に検出される駐車枠に自車両Vが駐車する際の運転者の意図しない車両の加速や駐車場ではない走行路での加速抑制の作動を抑制することが可能となる。その結果、加速抑制制御の適切な作動を行うことが可能となる。 Based on this, when pitching occurs in which the host vehicle V is turned up, the captured image is corrected in the direction of narrowing the host vehicle side, and when pitching occurs such that the host vehicle V is turned forward, the host vehicle side of the captured image is widened. The direction was corrected. Thereby, it becomes possible to improve the detection accuracy of the parking frame when the posture of the host vehicle V changes in the pitch direction, and the driver's intention when the host vehicle V parks in the parking frame detected when the posture changes. It is possible to suppress the acceleration of the vehicle that does not perform and the acceleration suppression operation on the travel path that is not a parking lot. As a result, it is possible to perform an appropriate operation of the acceleration suppression control.
(4)二軸加速度センサ25が、自車両Vの実前後加速度Gaを検出する。駐車枠確信度算出部36が、アクセルペダル32の踏み込み量及びシフト位置に基づき自車両Vの予測加速度Ga*を算出し、算出した予測加速度Ga*に基づき自車両Vの加速動作に応じた車両姿勢(推定ピッチ角θp*)を算出する。駐車枠確信度算出部36が、算出した予測前後加速度Ga*と二軸加速度センサ25が検出した実前後加速度Gaとの差分(前後加速度差分値Gad)が、予め設定した差分範囲を超えていると判定すると、検出用情報の内容を、撮像画像の変化を小さくする内容に設定する処理を実施しない。
(4) The
一方、二軸加速度センサ25が、自車両Vの実前後減速度Gbを検出する。駐車枠確信度算出部36が、ブレーキ操作検出センサ22およびブレーキペダル操作情報演算部10Fが検出したブレーキペダル30の踏み込み量に基づき自車両Vの予測前後減速度Gb*を算出する。駐車枠確信度算出部36が、算出した予測前後減速度Gb*と二軸加速度センサ25が検出した実前後減速度Gbとの差分(前後減速度差分値Gbd)が、予め設定した差分範囲を超えていると判定すると、検出用情報の内容を、撮像画像の変化による駐車枠検出処理への影響を打ち消す内容に設定する処理を実施しない。
つまり、前後加速度差分値Gadが、予め設定した差分範囲を超えている場合に、検出用情報の内容を、上記変化を小さくする内容に設定する処理を実施しないようにした。加えて、前後減速度差分値Gbdが、予め設定した差分範囲を超えている場合に、検出用情報の内容を、上記変化を小さくする内容に設定する処理を実施しないようにした。
On the other hand, the
That is, when the longitudinal acceleration difference value Gad exceeds the preset difference range, the process of setting the content of the detection information to the content that reduces the change is not performed. In addition, when the longitudinal deceleration difference value Gbd exceeds a preset difference range, the process of setting the content of the detection information to the content that reduces the change is not performed.
これによって、予測前後加速度Ga*が実前後加速度Gaに対して大きな誤差を有していたり、予測前後減速度Gb*が実前後減速度Gbに対して大きな誤差を有していたりした場合に、検出用情報の内容を誤差のより大きくなる内容に設定することを防ぐことが可能となる。また、二軸加速度センサ25の故障等によって、実前後加速度Gaが誤った値となっている場合なども、検出用情報の内容を誤差のより大きくなる内容に設定することを防ぐことが可能となる。
Accordingly, when the predicted longitudinal acceleration Ga * has a large error with respect to the actual longitudinal acceleration Ga, or when the predicted longitudinal deceleration Gb * has a large error with respect to the actual longitudinal acceleration Gb, It is possible to prevent the content of the detection information from being set to a content with a larger error. In addition, even when the actual longitudinal acceleration Ga has an incorrect value due to a failure of the
(5)駐車枠確信度算出部36が、自車両の走行路の路面状態を示す情報として、走行路の勾配を示す勾配情報(路面勾配)を検出する。また、駐車枠確信度算出部36が、自車両の走行路の路面状態を示す情報として、走行路の路面摩擦係数を検出する。そして、駐車枠確信度算出部36が、検出した路面情報に基づき、予測前後加速度Ga*又は予測前後減速度Gb*を補正する。
(5) The parking frame
つまり、自車両Vの走行路(例えば坂道や雪路等)の勾配や路面摩擦係数などの路面状態によって、アクセルペダルの踏み込み量から予測される予測前後加速度Ga*と、二軸加速度センサ25が検出する実前後加速度Gaとには誤差が発生する場合がある。同様に、自車両Vの走行路の路面状態によって、ブレーキペダルの踏み込み量から予測される予測前後減速度Gb*と、二軸加速度センサ25が検出する実前後減速度Gbとには誤差が発生する場合がある。そのため、このような誤差を予め補正するようにした。
That is, the predicted longitudinal acceleration Ga * predicted from the depression amount of the accelerator pedal and the
これによって、例えば、自車両Vが駐車場内の傾斜の比較的きつい走行路や路面摩擦係数の比較的小さい走行路などを走行中に姿勢変化が発生した場合の駐車枠の検出精度を向上することが可能となる。そのため、このような走行路を走行中に姿勢変化が発生した時に検出される駐車枠に自車両Vを駐車する際の運転者の意図しない車両の加速や駐車場ではない走行路での加速抑制の作動を抑制することが可能となる。その結果、加速抑制制御の適切な作動を行うことが可能となる。 As a result, for example, the accuracy of detecting the parking frame when the vehicle V changes its posture while traveling on a relatively hard traveling road with a relatively small slope or a relatively small road surface friction coefficient in the parking lot is improved. Is possible. Therefore, acceleration of the vehicle not intended by the driver when the vehicle V is parked in the parking frame detected when a change in posture occurs while traveling on such a traveling road, or acceleration on a traveling road that is not a parking lot. Can be suppressed. As a result, it is possible to perform an appropriate operation of the acceleration suppression control.
(6)駐車枠確信度算出部36が、駐車枠の検出に用いる路面上の線を、補正した線に設定する。
つまり、駐車枠の検出前に、撮像画像中に含まれる駐車枠線の候補となる路面上の線を、カメラの路面に対する位置変化によって生じた変化が小さくなるように補正する。
これによって、自車両Vの姿勢変化時の駐車枠の検出精度を向上することが可能となる。
(6) The parking frame
That is, before detecting the parking frame, the line on the road surface that is a candidate for the parking frame line included in the captured image is corrected so that the change caused by the position change with respect to the road surface of the camera is reduced.
Thereby, it becomes possible to improve the detection accuracy of the parking frame when the posture of the host vehicle V changes.
(7)自車両車速演算部10Bおよびヨーレートセンサ27が、自車両Vの横方向の加速動作の発生に係る情報である横加速情報として、車速νおよびヨーレートφを検出する。駐車枠確信度算出部36が、自車両車速演算部10Bおよびヨーレートセンサ27が検出した車速νおよびヨーレートφに基づき自車両Vが横方向に加速時の車両姿勢(ロール角θr)を推定する。駐車枠確信度算出部36が、推定した横方向に加速時の車両姿勢に基づき、検出用情報の内容を、車両姿勢のロール方向の変化を打ち消す内容に設定する
つまり、自車両Vの旋回動作等によって発生するローリングによるカメラ位置のロール方向への変化に応じて、駐車枠の検出前に、検出用情報の内容を、ローリングによる撮像画像の変化分を打ち消す内容に設定することが可能となる。
これによって、自車両Vの旋回動作等によるローリング時の駐車枠の検出精度を向上することが可能となる。
(7) The vehicle
Thereby, it becomes possible to improve the detection accuracy of the parking frame during rolling by the turning operation of the host vehicle V or the like.
(8)本実施形態の車両用加速抑制方法では、自車両Vに設けられた周囲環境認識センサ14(前方カメラ14F、右側方カメラ14SR、左側方カメラ14SLおよび後方カメラ14R)によって自車両周囲の領域を撮像した撮像画像(俯瞰画像)を取得し、自車両Vの前後方向の加減速動作の発生に係る情報である加減速情報に基づき、自車両Vの前後方向に加減速時の車両姿勢を推定し、推定した車両姿勢に基づき、撮像画像から駐車枠を検出する駐車枠検出処理に用いる情報である検出用情報の内容を、車両姿勢のピッチ方向の変化によるカメラ(前方カメラ14F又は後方カメラ14R)の路面に対する位置変化に応じた撮像画像の変化を小さくする内容に設定し、設定した検出用情報を用いて撮像画像から駐車枠を検出し、駐車枠を検出したと判定すると、運転者の駆動力指示操作子の操作に応じた自車両Vの加速を抑制する加速抑制制御を実施する。
(8) In the vehicle acceleration suppression method of the present embodiment, the surrounding environment recognition sensor 14 (
このため、自車両Vが、例えば、前後方向の加減速によって姿勢変化(ピッチング)した場合に、駐車枠の検出に用いる画像情報や判定用の閾値等の検出用情報の内容を、ピッチ方向への姿勢変化によるカメラの路面に対する位置変化に応じた撮像画像の変化を小さくする内容に設定することが可能となる。
その結果、自車両Vの姿勢変化時の駐車枠の検出精度を向上することが可能となると共に、姿勢変化時に検出される駐車枠に自車両Vを駐車する際の運転者の意図しない車両の加速や駐車場ではない走行路での加速抑制の作動を抑制することが可能となる。その結果、加速抑制制御の適切な作動を行うことが可能となる。
For this reason, for example, when the host vehicle V changes its attitude (pitching) by acceleration / deceleration in the front-rear direction, the contents of the detection information such as the image information used for detecting the parking frame and the threshold value for determination are displayed in the pitch direction. It is possible to set the content to reduce the change in the captured image according to the change in the position of the camera with respect to the road surface due to the change in the posture.
As a result, it is possible to improve the detection accuracy of the parking frame when the posture of the host vehicle V is changed, and the vehicle not intended by the driver when the host vehicle V is parked in the parking frame detected when the posture is changed. It is possible to suppress acceleration and operation of acceleration suppression on a travel path that is not a parking lot. As a result, it is possible to perform an appropriate operation of the acceleration suppression control.
[第2実施形態]
次に、第2実施形態について図面を参照しつつ説明する。なお上記第1実施形態と同様な構成については同一の符号を付して説明する。
(構成)
本実施形態の基本的構成は、上記第1実施形態と同様である。
本実施形態の駐車枠確信度算出部36の処理は、基本的に上記第1実施形態の処理(図7)と同様である。但し、ステップS210、S212の処理が異なる。
[Second Embodiment]
Next, a second embodiment will be described with reference to the drawings. In addition, the same code | symbol is attached | subjected and demonstrated about the structure similar to the said 1st Embodiment.
(Constitution)
The basic configuration of the present embodiment is the same as that of the first embodiment.
The process of the parking frame
次に、本実施形態における、ステップS210,S212の処理について説明する。
ステップS210では、駐車枠確信度算出部36において、検出用情報補正処理を行う。その後、駐車枠確信度算出部36が行う処理は、ステップS212に移行する。
以下、図9〜図10を参照しつつ、本実施形態のステップS210で行う処理の具体例を説明する。
具体的に、本実施形態では、自車両Vのピッチングに対する検出用情報の補正処理として、駐車枠を形成する線の条件に適合しているか否かを判定する際の、上記四つの条件(C1〜C4)のうち、条件C1及びC2の判定に用いる判定用閾値を補正する処理を行う。
すなわち、上記条件C1を満たすか否かを判定するための、予め設定した設定ペアリング幅(例えば、2.5[m])を補正する。
例えば、自車両Vが減速時のピッチングではペアリングした二本の線が逆ハの字状に自車側が狭まるので、設定ペアリング幅を、ピッチ角変化量θpgの大きさに応じた幅(例えば、2.3[m]など)に補正する。
Next, processing in steps S210 and S212 in the present embodiment will be described.
In step S210, the parking frame
Hereinafter, a specific example of the process performed in step S <b> 210 of the present embodiment will be described with reference to FIGS. 9 to 10.
Specifically, in the present embodiment, as the correction processing of the detection information for the pitching of the host vehicle V, the above four conditions (C1) when determining whether or not the conditions of the line forming the parking frame are met. To C4), a process of correcting the determination threshold value used for determination of the conditions C1 and C2 is performed.
That is, a preset pairing width (for example, 2.5 [m]) for determining whether or not the condition C1 is satisfied is corrected.
For example, in pitching when the host vehicle V is decelerating, the paired two lines are reversed in the shape of an inverted letter C, and the host vehicle side narrows. Therefore, the set pairing width is set to a width corresponding to the magnitude of the pitch angle change amount θpg ( For example, it is corrected to 2.3 [m].
一方、自車両Vが加速時のピッチングではペアリングした二本の線がハの字状に自車側が広がるので、設定ペアリング幅を、ピッチ角変化量θpgの大きさに応じた幅(例えば、2.7[m]など)に補正する。
なお、設定ペアリング幅の補正量は、予め実験やシミュレーションなどで作成されたマップに基づき算出する。
また、設定ペアリング幅の補正量は、ピッチ角変化量θpgの大きさに応じて可変させる構成に限らず、固定値としてもよい。
On the other hand, in the pitching when the host vehicle V is accelerating, the paired two lines are expanded in the shape of a letter C so that the set pairing width is set to a width corresponding to the pitch angle change amount θpg (for example, 2.7 [m] etc.).
Note that the correction amount of the set pairing width is calculated based on a map created in advance through experiments or simulations.
Further, the correction amount of the set pairing width is not limited to the configuration in which the correction amount is changed according to the magnitude of the pitch angle change amount θpg, but may be a fixed value.
加えて、上記条件C2を満たすか否かを判定するための、予め設定した設定角度(例えば、3[°])を補正する。例えば、自車両Vが加減速時のピッチングではペアリングした二本の線がハの字状や逆ハの字状となって線Laと線Lbとのなす角度(平行度合い)が変化する。従って、設定角度を、ピッチ角変化量θpgの大きさに応じた角度(例えば、5[°]など)に補正する。
なお、設定角度の補正量は、予め実験やシミュレーションなどで作成されたマップに基づき算出する。
In addition, a preset set angle (for example, 3 [°]) for determining whether or not the condition C2 is satisfied is corrected. For example, in pitching when the host vehicle V is accelerating / decelerating, two paired lines become a C shape or an inverted C shape, and an angle (degree of parallelism) between the line La and the line Lb changes. Accordingly, the set angle is corrected to an angle (for example, 5 [°] or the like) according to the magnitude of the pitch angle change amount θpg.
Note that the correction amount of the set angle is calculated based on a map created in advance through experiments or simulations.
また、設定角度の補正量は、ピッチ角変化量θpgの大きさに応じて可変させる構成に限らず、固定値としてもよい。
本実施形態のステップS212では、駐車枠線候補の組であるペアリングした二本の線に対し、上記条件C1及びC2を満足しているか否かを判定する際に、ステップS210で補正後の設定ペアリング幅及び設定角度を用いる。それ以外は、上記第1実施形態と同様の処理となる。
Further, the correction amount of the set angle is not limited to a configuration that can be varied according to the magnitude of the pitch angle change amount θpg, and may be a fixed value.
In step S212 of the present embodiment, when it is determined whether or not the above-described conditions C1 and C2 are satisfied for the paired two lines that are pairs of parking frame line candidates, The set pairing width and set angle are used. Other than that, the processing is the same as in the first embodiment.
(動作)
次に、図1から図21を参照しつつ、本実施形態の車両用加速抑制装置1を用いて行う動作の一例を説明する。
以下、検出用情報補正処理及び駐車枠条件の適合判定処理の動作以外は上記第1実施形態と同様となるので、検出用情報補正処理及び駐車枠条件の適合判定処理の動作についてのみ説明する。
まず、自車両Vが、例えば駐車場内の平坦な乾いた道路を真っ直ぐに前進走行中であるとし、運転者がアクセルペダル32を急に深く踏み込んだ場合の動作を説明する。
この場合、自車両Vの急加速によってピッチングが発生するため、このピッチングに応じた前方カメラ14Fの位置変化によって影響を受ける判定用閾値の補正処理が行われる(ステップS210)。つまり、自車両Vが急加速した場合は、図9(c)に示すように、自車両Vが仰け反って、自車両Vに固定された前方カメラ14Fは上方向にピッチングする。従って、本来は真っ直ぐな俯瞰画像内の二本の線La,Lbがハの字状に変形する。そのため、本実施形態では、二本の線La,Lbの線間幅や、平行度合いが、駐車枠を形成する枠線の条件(条件C1,C2)に適合しているか否かを判定するための判定用閾値をピッチ角変化量θpgの大きさに応じて補正する。
(Operation)
Next, an example of an operation performed using the vehicle
Hereinafter, operations other than the detection information correction process and the parking frame condition conformity determination process are the same as those in the first embodiment, and only the detection information correction process and the parking frame condition conformity determination process will be described.
First, assuming that the host vehicle V is traveling forward straight on a flat dry road in a parking lot, for example, an operation when the driver suddenly depresses the
In this case, since pitching occurs due to sudden acceleration of the host vehicle V, correction processing for a threshold value for determination that is affected by a change in the position of the
ここで、ピッチングによる姿勢変化が発生していない場合の、上記設定ペアリング幅を、例えば「2.5[m]」とし、上記設定角度を、例えば「3[°]」とする。
現在、加速によるピッチングによって、二本の線La,Lbの線間幅はハの字状に近方側(自車側)が広がる。そのため、駐車枠確信度算出部36は、自車側を基準として、設定ペアリング幅を、通常よりも広めの例えば「2.7[m]」に補正する。また、駐車枠確信度算出部36は、線Laと線Lbとのなす角度が大きくなるので、設定角度を、例えば「5[°]」に補正する。
Here, when the posture change due to pitching does not occur, the set pairing width is, for example, “2.5 [m]”, and the set angle is, for example, “3 [°]”.
At present, due to pitching by acceleration, the distance between the two lines La and Lb is widened in the shape of a letter C on the near side (the vehicle side). Therefore, the parking frame
次に、駐車枠確信度算出部36は、抽出された二本の線La,Lbが駐車枠を形成する枠線の条件に適合しているか否かを判定する(ステップS212)。このとき、駐車枠確信度算出部36は、上記条件C1及びC2の判定を行う際に、補正後の設定ペアリング幅及び設定角度を用いる。
次に、自車両Vが道路を前進走行中に、道路の左側に面した例えばコンビニエンスストアの駐車場内に、ブレーキペダル30を踏み込んで減速しつつ左折で進入し、かつ、そのまま駐車枠内へと駐車する場合の動作を説明する。
Next, the parking frame
Next, while the host vehicle V is traveling forward on the road, enter the parking lot of the convenience store facing the left side of the road, for example, depressing the
この場合、自車両Vの急減速によるピッチング及び急な左旋回によるローリングが発生するため、これらピッチング及びローリングに応じた前方カメラ14Fの位置変化によって影響を受ける判定用閾値の補正処理が行われる(ステップS210)。つまり、自車両Vが急減速した場合は、図9(b)に示すように、自車両Vが前のめりとなって、自車両Vに固定された前方カメラ14Fは下方向にピッチングする。従って、本来は真っ直ぐな俯瞰画像内の二本の線La,Lbが逆ハの字状に変形する。そのため、本実施形態では、上記加速時と同様に、上記条件C1及びC2の判定に用いる、設定ペアリング幅及び設定角度をピッチ角変化量θpgの大きさに応じて補正する。
In this case, pitching due to sudden deceleration of the host vehicle V and rolling due to a sudden left turn occur, and therefore a determination threshold value correction process that is affected by the position change of the
具体的に、自車両Vの減速によるピッチングによって、二本の線La,Lbの線間幅は逆ハの字状に近方側(自車側)が狭まる。そのため、駐車枠確信度算出部36は、自車側を基準として、設定ペアリング幅を、通常よりも狭めの例えば「2.3[m]」に補正する。また、駐車枠確信度算出部36は、線Laと線Lbとのなす角度が大きくなるので、設定角度を、例えば「5[°]」に補正する。
Specifically, due to pitching due to deceleration of the host vehicle V, the distance between the two lines La and Lb becomes narrower on the near side (the host vehicle side) in an inverted C shape. Therefore, the parking frame
一方、自車両Vの左旋回による右方向へのローリングによる判定要素のずれについては、上記第1実施形態と同様の補正処理を行う。
次に、駐車枠確信度算出部36は、抽出された二本の線La,Lbが駐車枠を形成する枠線の条件に適合しているか否かを判定する(ステップS212)。このとき、駐車枠確信度算出部36は、上記条件C1及びC2の判定を行う際に、補正後の設定ペアリング幅及び設定角度を用いる。
On the other hand, correction processing similar to that in the first embodiment is performed for the deviation of the determination element due to rolling in the right direction due to the left turn of the host vehicle V.
Next, the parking frame
(本実施形態の効果)
本実施形態は、第1実施形態での効果の他、次の効果を奏する。
(1)駐車枠確信度算出部36が、駐車枠の検出に用いる、駐車枠線の候補となる路面上の線(例えば、線La,Lb)が駐車枠を形成する線に適合するか否かを判定する際に用いる判定用閾値(例えば、設定ペアリング幅,設定角度)を、補正した値に設定する。
つまり、自車両Vに姿勢変化があったときに、駐車枠の検出前に、判定用閾値を、例えば、カメラの路面に対する位置変化に応じた撮像画像の変化分を許容できるように補正した値に設定することが可能となる。
(Effect of this embodiment)
This embodiment has the following effects in addition to the effects of the first embodiment.
(1) Whether or not the lines (for example, lines La and Lb) on the road surface, which are candidates for the parking frame line, used by the parking frame
That is, a value obtained by correcting the threshold for determination before the parking frame is detected when the host vehicle V has changed in posture so that, for example, the change in the captured image corresponding to the change in the position of the camera with respect to the road surface can be allowed. It becomes possible to set to.
これによって、駐車枠の検出時において、カメラの位置変化量に応じた撮像画像の変化を許容する値に設定された判定用閾値を用いて検出処理を行うことが可能となる。そのため、自車両Vの姿勢変化時の駐車枠の検出精度を向上することが可能となる。従って、姿勢変化時に検出される駐車枠に自車両Vを駐車する際の運転者の意図しない車両の加速や駐車場ではない走行路での加速抑制の作動を抑制することが可能となる。その結果、加速抑制制御の適切な作動を行うことが可能となる。 Thereby, at the time of detecting the parking frame, it is possible to perform the detection process using the determination threshold value set to a value allowing the change of the captured image according to the amount of change in the position of the camera. Therefore, it becomes possible to improve the detection accuracy of the parking frame when the posture of the host vehicle V is changed. Accordingly, it is possible to suppress the acceleration of the vehicle not intended by the driver when the host vehicle V is parked in the parking frame detected when the posture is changed, and the acceleration suppression operation on the travel path that is not the parking lot. As a result, it is possible to perform an appropriate operation of the acceleration suppression control.
(変形例)
(1)上記各実施形態では、自車両Vの加減速時の姿勢変化に対して検出用情報の設定処理を実施する構成としたが、この構成に限らない。例えば、加速時のみ、または減速時のみに実施する構成としてもよい。
(2)上記第1実施形態では、俯瞰画像から駐車枠の判定要素を抽出した後に、該判定要素を補正する構成としたが、この構成に限らない。例えば、判定要素を抽出前の俯瞰画像全体に対して補正を行う構成としてもよい。
(3)上記各実施形態では、自車両Vの姿勢変化に応じて、判定要素や判定用閾値等の検出用情報を補正する構成としたが、この構成に限らない。例えば、姿勢変化量又はカメラの位置変化量に対して予め設定された異なる内容の検出用情報群のなかから、姿勢変化量又はカメラの位置変化量に対応する情報を読み出す。そして、読み出した検出用情報を、駐車枠の検出処理に用いる検出用情報として設定する構成としてもよい。
(Modification)
(1) In each of the above-described embodiments, the detection information setting process is performed with respect to the posture change during acceleration / deceleration of the host vehicle V. However, the present invention is not limited to this configuration. For example, it is good also as a structure implemented only at the time of acceleration or deceleration.
(2) In the first embodiment, after the determination element of the parking frame is extracted from the overhead image, the determination element is corrected. However, the present invention is not limited to this configuration. For example, it is good also as a structure which correct | amends with respect to the whole bird's-eye view image before extracting a determination element.
(3) In each of the above embodiments, the detection information such as the determination element and the determination threshold is corrected according to the change in the posture of the host vehicle V. However, the present invention is not limited to this configuration. For example, information corresponding to the posture change amount or the camera position change amount is read out from the detection information groups having different contents set in advance with respect to the posture change amount or the camera position change amount. And it is good also as a structure which sets the read information for a detection as the information for a detection used for the detection process of a parking frame.
(4)上記各実施形態では、自車両Vの車両姿勢(ピッチ角及びロール角)を、前後加速度及び横加速度に基づき推定する構成としたが、この構成に限らない。例えば、ジャイロセンサ、ハイトセンサ等のセンサを用いて車両姿勢を推定する構成としてもよい。
(5)上記各実施形態では、総合確信度設定部40が設定した総合確信度に基づいて、加速抑制制御開始タイミングと加速抑制制御量を演算したが、これに限定するものではない。すなわち、駐車枠確信度算出部36が設定した駐車枠確信度のみに基づいて、加速抑制制御開始タイミングと加速抑制制御量を演算してもよい。この場合、加速抑制制御開始タイミングと加速抑制制御量は、駐車枠確信度を、例えば、図22中に示す加速抑制条件演算マップに適合させて演算する。なお、図22は、本実施形態の変形例を示す図である。
(4) In the above embodiments, the vehicle posture (pitch angle and roll angle) of the host vehicle V is estimated based on the longitudinal acceleration and the lateral acceleration. However, the present invention is not limited to this configuration. For example, it is good also as a structure which estimates a vehicle attitude | position using sensors, such as a gyro sensor and a height sensor.
(5) In the above embodiments, the acceleration suppression control start timing and the acceleration suppression control amount are calculated based on the total reliability set by the total
(6)上記各実施形態では、駐車枠確信度算出部36の構成を、自車両Vの周囲の俯瞰画像(環境)と自車両Vの車速(走行状態)に基づいて、駐車枠確信度を設定する構成としたが、駐車枠確信度算出部36の構成は、これに限定するものではない。すなわち、駐車枠確信度算出部36の構成を、自車両Vの周囲の俯瞰画像と車速に加え、さらに、自車位置信号が含む自車両Vの現在位置と、走行道路情報信号が含む自車両Vが走行する道路の種別(道路種別)を用いて、駐車枠確信度を設定する構成としてもよい。
この場合、例えば、自車位置信号および走行道路情報信号が含む情報に基づき、自車両Vの現在位置が公道上であることを検出すると、自車両Vの周囲に駐車枠L0が存在しないと判断し、駐車枠確信度を「レベル0」に設定する。
これにより、例えば、公道上で道路端に配置された駐車枠等、加速抑制制御の作動が好ましくない駐車枠へ自車両Vが進入する際に、自車両Vの運転性低下を抑制することが可能となる。
(6) In each of the above-described embodiments, the parking frame certainty
In this case, for example, when it is detected that the current position of the host vehicle V is on a public road based on information included in the host vehicle position signal and the travel road information signal, it is determined that there is no parking frame L0 around the host vehicle V. The parking frame certainty is set to “
Thereby, for example, when the host vehicle V enters a parking frame where the operation of the acceleration suppression control is not preferable, such as a parking frame disposed on the road edge on a public road, the drivability reduction of the host vehicle V is suppressed. It becomes possible.
(7)上記各実施形態では、駐車枠確信度算出部36が、線La,Lbに対し、それぞれ、端部同士が幅WLの方向に沿って対向していると判断すると、駐車枠確信度をレベル3またはレベル4に設定する処理を行う(ステップS230参照)。しかしながら、駐車枠確信度をレベル3またはレベル4に設定する処理は、これに限定するものではない。すなわち、線Lの端部形状が、例えば、U字状(図4(g)〜(k)、(m)、(n)を参照)である場合等、公道上に標示されていない形状であることを認識すると、駐車枠確信度をレベル3またはレベル4に設定してもよい。
(7) In the above embodiments, if the parking frame
(8)上記各実施形態では、駐車枠確信度算出部36の構成を、自車両Vの周囲の俯瞰画像(環境)と自車両Vの車速(走行状態)に基づいて、駐車枠確信度を設定する構成としたが、駐車枠確信度算出部36の構成は、これに限定するものではない。すなわち、自車両Vの構成が、例えば、運転者に対して駐車枠L0への操舵操作を支援する装置(駐車支援装置)を備える構成である場合、駐車支援装置がON状態であれば、駐車枠確信度のレベルが上がりやすくなる構成としてもよい。ここで、駐車枠確信度のレベルが上がりやすくなる構成とは、例えば、上述した設定移動距離を通常よりも短い距離に設定する等の構成である。
(8) In each of the above embodiments, the parking frame certainty
(9)上記各実施形態では、総合確信度に基づいて、加速抑制制御量および加速抑制制御開始タイミングを変化させ、加速指令値の抑制度合いを変化させるが、これに限定するものではない。すなわち、総合確信度に応じて、加速抑制制御開始タイミングのみ、または、加速抑制制御量のみを変化させ、加速指令値の抑制度合いを変化させてもよい。この場合、例えば、総合確信度が高いほど、加速抑制制御量の大きく設定し、加速抑制制御開始タイミングは変化させずに、加速指令値の抑制度合いを高くしてもよい。 (9) In the above embodiments, the acceleration suppression control amount and the acceleration suppression control start timing are changed based on the total certainty factor, and the suppression degree of the acceleration command value is changed. However, the present invention is not limited to this. That is, according to the total certainty factor, only the acceleration suppression control start timing or only the acceleration suppression control amount may be changed to change the suppression degree of the acceleration command value. In this case, for example, the higher the total certainty factor, the larger the acceleration suppression control amount may be set, and the acceleration suppression control value may be increased without changing the acceleration suppression control start timing.
(10)上記各実施形態では、加速指令値を制御して、アクセルペダル32の踏込み量(駆動力操作量)に応じた自車両Vの加速を抑制したが、これに限定するものではない。すなわち、例えば、アクセルペダル32の踏込み量(駆動力操作量)に応じたスロットル開度を目標スロットル開度とし、さらに、上述した制動装置により制動力を発生させて、駆動力操作量に応じた自車両Vの加速を抑制してもよい。
(10) In the above embodiments, the acceleration command value is controlled to suppress the acceleration of the host vehicle V according to the depression amount (driving force operation amount) of the
また、上記各実施形態は、本発明の好適な具体例であり、技術的に好ましい種々の限定が付されているが、本発明の範囲は、上記の説明において特に本発明を限定する旨の記載がない限り、これらの形態に限られるものではない。また、上記の説明で用いる図面は、図示の便宜上、部材ないし部分の縦横の縮尺は実際のものとは異なる模式図である。また、本発明は上記各実施形態に限定されるものではなく、本発明の目的を達成できる範囲での変形、改良、均等物等は本発明に含まれるものである。 Each of the above embodiments is a preferable specific example of the present invention, and various technically preferable limitations are given. However, the scope of the present invention is particularly limited in the above description. As long as there is no description, it is not restricted to these forms. In the drawings used in the above description, for convenience of illustration, the vertical and horizontal scales of members or parts are schematic views different from actual ones. Further, the present invention is not limited to the above-described embodiments, and modifications, improvements, equivalents, and the like within the scope that can achieve the object of the present invention are included in the present invention.
1 車両用加速抑制装置
2 ブレーキ装置
4 流体圧回路
6 ブレーキコントローラ
8 エンジン
10 走行制御コントローラ
10A 周囲環境認識情報演算部
10B 自車両車速演算部
10C 操舵角演算部
10D 操舵角速度演算部
10E シフトポジション演算部
10F ブレーキペダル操作情報演算部
10G アクセル操作量演算部
10H アクセル操作速度演算部
10I 加速抑制制御内容演算部
10J 加速抑制指令値演算部
10K 目標スロットル開度演算部
12 エンジンコントローラ
14 周囲環境認識センサ(前方カメラ14F、右側方カメラ14SR、左側方カメラ14SL、後方カメラ14R)
16 車輪速センサ
18 操舵角センサ
20 シフトポジションセンサ
22 ブレーキ操作検出センサ
24 アクセル操作検出センサ
25 二軸加速度センサ
26 ナビゲーション装置
27 ヨーレートセンサ
28 ステアリングホイール
30 ブレーキペダル
32 アクセルペダル
34 加速抑制作動条件判断部
36 駐車枠確信度算出部
38 駐車枠進入確信度設定部
40 総合確信度設定部
42 加速抑制制御開始タイミング演算部
44 加速抑制制御量演算部
V 自車両
W 車輪(右前輪WFR、左前輪WFL、右後輪WRR、左後輪WRL)
DESCRIPTION OF
DESCRIPTION OF
Claims (9)
自車両の前後方向の加減速動作の発生に係る情報である加減速情報を検出する加減速情報検出部と、
前記加減速情報検出部が検出した前記加減速情報に基づき、自車両の前後方向に加減速時の車両姿勢を推定する車両姿勢推定部と、
前記車両姿勢推定部が推定した前記車両姿勢に基づき、前記撮像画像から駐車枠を検出する駐車枠検出処理に用いる情報である検出用情報の内容を、前記車両姿勢のピッチ方向の変化による前記カメラの路面に対する位置変化に応じた前記撮像画像の変化を小さくする内容に設定する検出用情報設定部と、
前記検出用情報設定部が設定した前記検出用情報を用いて前記駐車枠検出処理を行う駐車枠検出部と、
前記駐車枠検出部が前記駐車枠を検出すると、運転者の駆動力指示操作子の操作に応じた自車両の加速を抑制する制御である加速抑制制御を実施する加速抑制制御部と、を備えることを特徴とする車両用加速抑制装置。 An imaging unit that acquires a captured image obtained by capturing an area around the host vehicle with a camera provided in the host vehicle;
An acceleration / deceleration information detector that detects acceleration / deceleration information, which is information related to the occurrence of acceleration / deceleration operations in the longitudinal direction of the host vehicle;
Based on the acceleration / deceleration information detected by the acceleration / deceleration information detection unit, a vehicle attitude estimation unit that estimates a vehicle attitude during acceleration / deceleration in the front-rear direction of the host vehicle;
Based on the vehicle posture estimated by the vehicle posture estimation unit, the content of detection information, which is information used for parking frame detection processing for detecting a parking frame from the captured image, is obtained by changing the pitch direction of the vehicle posture. An information setting unit for detection that sets the content to reduce the change in the captured image according to the position change with respect to the road surface;
A parking frame detection unit that performs the parking frame detection process using the detection information set by the detection information setting unit;
When the parking frame detection unit detects the parking frame, an acceleration suppression control unit that performs acceleration suppression control, which is control for suppressing acceleration of the host vehicle according to the operation of the driving force instruction operator of the driver. An acceleration suppression device for a vehicle characterized by the above.
前記車両姿勢推定部は、自車両の運転者が制駆動力を指示するために操作する操作子の操作量の情報に基づき、自車両の前後方向の加減速度を予測するようになっており、
前記検出用情報設定部は、前記車両姿勢推定部が予測した加減速度と前記実加速度検出部が検出した前記実加速度との差分値が、予め設定した加減速度差分閾値以上であると判定すると、前記検出用情報の内容を前記小さくする内容に設定する処理を実施しないことを特徴とする請求項3に記載の車両用加速抑制装置。 An actual acceleration detector for detecting the actual acceleration in the longitudinal direction of the host vehicle,
The vehicle posture estimation unit is configured to predict acceleration / deceleration in the front-rear direction of the host vehicle based on information on an operation amount of a manipulator operated by the driver of the host vehicle to instruct braking / driving force.
When the detection information setting unit determines that the difference value between the acceleration / deceleration predicted by the vehicle posture estimation unit and the actual acceleration detected by the actual acceleration detection unit is greater than or equal to a preset acceleration / deceleration difference threshold value, The vehicle acceleration suppression device according to claim 3, wherein the process of setting the content of the detection information to the content to be reduced is not performed.
前記車両姿勢推定部は、前記路面状態検出部が検出した前記路面状態に基づき、前記予測した加減速度を補正することを特徴とする請求項4に記載の車両用加速抑制装置。 A road surface state detection unit that detects the road surface state of the traveling road of the host vehicle,
5. The vehicle acceleration suppression device according to claim 4, wherein the vehicle posture estimation unit corrects the predicted acceleration / deceleration based on the road surface state detected by the road surface state detection unit.
前記検出用情報設定部は、前記駐車枠検出処理に用いる前記路面上の線を、補正した線に設定することを特徴とする請求項1乃至5のいずれか1項に記載の車両用加速抑制装置。 The information for detection is a line on the road surface that is a candidate for a parking frame line in the captured image,
The vehicle acceleration suppression according to any one of claims 1 to 5, wherein the detection information setting unit sets a line on the road surface used for the parking frame detection process to a corrected line. apparatus.
前記検出用情報設定部は、前記駐車枠検出処理に用いる前記判定用閾値を、補正した値に設定することを特徴とする請求項1乃至5のいずれか1項に記載の車両用加速抑制装置。 The detection information is a determination threshold value used when determining whether a line on the road surface that is a candidate for a parking frame line included in the captured image is a line that forms a parking frame,
The vehicular acceleration suppression device according to any one of claims 1 to 5, wherein the detection information setting unit sets the determination threshold used in the parking frame detection process to a corrected value. .
前記車両姿勢推定部は、前記横加速情報検出部が検出した前記横加速情報に基づき自車両の横方向に加速時の車両姿勢を推定し、
前記検出用情報設定部は、前記車両姿勢推定部が推定した前記横方向に加速時の車両姿勢に基づき、前記検出用情報の内容を、前記車両姿勢のロール方向の変化を打ち消す内容に設定することを特徴とする請求項1乃至7のいずれか1項に記載の車両用加速抑制装置。 A lateral acceleration information detection unit that detects lateral acceleration information that is information related to the occurrence of the acceleration operation in the lateral direction of the host vehicle;
The vehicle posture estimation unit estimates a vehicle posture at the time of acceleration in the lateral direction of the host vehicle based on the lateral acceleration information detected by the lateral acceleration information detection unit,
The detection information setting unit sets the content of the detection information to cancel the change in the roll direction of the vehicle posture based on the vehicle posture during acceleration in the lateral direction estimated by the vehicle posture estimation unit. The vehicle acceleration suppression device according to any one of claims 1 to 7.
自車両の前後方向の加減速動作の発生に係る情報である加減速情報に基づき、自車両の前後方向に加減速時の車両姿勢を推定し、
推定した前記車両姿勢に基づき、前記撮像画像から駐車枠を検出する駐車枠検出処理に用いる情報である検出用情報の内容を、前記車両姿勢のピッチ方向の変化による前記カメラの路面に対する位置変化に応じた前記撮像画像の変化を小さくする内容に設定し、
設定した前記検出用情報を用いて前記撮像画像から駐車枠を検出し、
前記駐車枠を検出すると、運転者の駆動力指示操作子の操作に応じた自車両の加速を抑制する制御である加速抑制制御を実施することを特徴とする車両用加速抑制方法。 Obtain a captured image obtained by capturing an area around the vehicle with a camera provided in the vehicle,
Based on acceleration / deceleration information, which is information related to the occurrence of acceleration / deceleration operations in the front-rear direction of the host vehicle, estimates the vehicle attitude at the time of acceleration / deceleration in the front-rear direction of the host vehicle,
Based on the estimated vehicle posture, the content of the detection information, which is information used for parking frame detection processing for detecting a parking frame from the captured image, is changed to a position change of the camera relative to the road surface due to a change in the pitch direction of the vehicle posture. In response, set the content to reduce the change in the captured image,
A parking frame is detected from the captured image using the set information for detection,
When the parking frame is detected, an acceleration suppression method for a vehicle is implemented, which is an acceleration suppression control that is a control for suppressing the acceleration of the host vehicle in accordance with the operation of the driving force indicating operator of the driver.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013204921A JP6119537B2 (en) | 2013-09-30 | 2013-09-30 | Vehicle acceleration suppression device and vehicle acceleration suppression method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013204921A JP6119537B2 (en) | 2013-09-30 | 2013-09-30 | Vehicle acceleration suppression device and vehicle acceleration suppression method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2015067220A true JP2015067220A (en) | 2015-04-13 |
JP6119537B2 JP6119537B2 (en) | 2017-04-26 |
Family
ID=52834349
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2013204921A Active JP6119537B2 (en) | 2013-09-30 | 2013-09-30 | Vehicle acceleration suppression device and vehicle acceleration suppression method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6119537B2 (en) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002140696A (en) * | 2000-11-06 | 2002-05-17 | Toyota Central Res & Dev Lab Inc | Image pickup and image conversion device |
JP2003137001A (en) * | 2001-11-06 | 2003-05-14 | Denso Corp | Computer program for realizing safety device of vehicle and safe operating method for vehicle by computer |
JP2010070012A (en) * | 2008-09-17 | 2010-04-02 | Toyota Motor Corp | Lane recognition device |
JP2010143378A (en) * | 2008-12-18 | 2010-07-01 | Toyota Central R&D Labs Inc | Vehicle attitude angle estimation device and program |
WO2011039989A1 (en) * | 2009-09-30 | 2011-04-07 | パナソニック株式会社 | Vehicle-surroundings monitoring device |
JP2011254128A (en) * | 2010-05-31 | 2011-12-15 | Panasonic Corp | Plane view generating device and plane view generating method |
JP2012250673A (en) * | 2011-06-06 | 2012-12-20 | Nissan Motor Co Ltd | Device and method for suppressing acceleration for vehicle |
-
2013
- 2013-09-30 JP JP2013204921A patent/JP6119537B2/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002140696A (en) * | 2000-11-06 | 2002-05-17 | Toyota Central Res & Dev Lab Inc | Image pickup and image conversion device |
JP2003137001A (en) * | 2001-11-06 | 2003-05-14 | Denso Corp | Computer program for realizing safety device of vehicle and safe operating method for vehicle by computer |
JP2010070012A (en) * | 2008-09-17 | 2010-04-02 | Toyota Motor Corp | Lane recognition device |
JP2010143378A (en) * | 2008-12-18 | 2010-07-01 | Toyota Central R&D Labs Inc | Vehicle attitude angle estimation device and program |
WO2011039989A1 (en) * | 2009-09-30 | 2011-04-07 | パナソニック株式会社 | Vehicle-surroundings monitoring device |
JP2011254128A (en) * | 2010-05-31 | 2011-12-15 | Panasonic Corp | Plane view generating device and plane view generating method |
JP2012250673A (en) * | 2011-06-06 | 2012-12-20 | Nissan Motor Co Ltd | Device and method for suppressing acceleration for vehicle |
Also Published As
Publication number | Publication date |
---|---|
JP6119537B2 (en) | 2017-04-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5994865B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP5846317B2 (en) | Vehicle acceleration suppression device | |
JP5915771B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP5991382B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP5999195B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP5915769B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP5915770B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP6136724B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP6155944B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP6007991B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP6031973B2 (en) | Vehicle acceleration suppression device | |
JP6119537B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP6299179B2 (en) | Vehicle acceleration suppression device | |
JP5892259B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP5900648B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP5900647B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP5900650B2 (en) | Vehicle acceleration suppression device and vehicle acceleration suppression method | |
JP6197604B2 (en) | Acceleration suppression device for vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20160328 |
|
TRDD | Decision of grant or rejection written | ||
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20170223 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20170228 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170313 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6119537 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |