JP2014071569A - Parking space detection device - Google Patents

Parking space detection device Download PDF

Info

Publication number
JP2014071569A
JP2014071569A JP2012215809A JP2012215809A JP2014071569A JP 2014071569 A JP2014071569 A JP 2014071569A JP 2012215809 A JP2012215809 A JP 2012215809A JP 2012215809 A JP2012215809 A JP 2012215809A JP 2014071569 A JP2014071569 A JP 2014071569A
Authority
JP
Japan
Prior art keywords
parking
vehicle
space
distance
detection
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
Application number
JP2012215809A
Other languages
Japanese (ja)
Other versions
JP5860788B2 (en
Inventor
Keiko Akiyama
啓子 秋山
Motonori Tominaga
元規 富永
Masumi Fukuman
真澄 福万
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Denso Corp
Soken Inc
Original Assignee
Denso Corp
Nippon Soken Inc
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Denso Corp, Nippon Soken Inc filed Critical Denso Corp
Priority to JP2012215809A priority Critical patent/JP5860788B2/en
Publication of JP2014071569A publication Critical patent/JP2014071569A/en
Application granted granted Critical
Publication of JP5860788B2 publication Critical patent/JP5860788B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Abstract

PROBLEM TO BE SOLVED: To eliminate an error generated between a loading position of a range-finding sensor grasped by a parking space detection device and an actual loading position in the parking space detection device for detecting the parking space using the range-finding sensor.SOLUTION: When a vehicle 5 passes the lateral sides of parked vehicles 61 and 62, corners 311 and 321 of the parked vehicles 61 and 62 are detected using a lateral side range-finding sensor loaded on the lateral side of the vehicle 5. When the vehicles 61 and 62 are parked in a parallel parking thereafter, corners 312 and 322 of the parked vehicles 61 and 62 are detected using range-finding sensors 22 and 23 loaded on the front and the rear side of the vehicle 5. An off-set amount of the parking space (the primary detection space) detected when the vehicles pass the lateral side and the parking space (the secondary detection space) detected when the vehicles perform a parking operation is calculated from the corners 311 and 321 detected when passing the lateral side and the corners 312 and 322 detected when performing the parking operation. The loading position of the lateral range-finding sensor is corrected by the off-set amount or a warning against the loading state is generated.

Description

本発明は、駐車車両に隣接した駐車空間を検知する駐車空間検知装置に関する。   The present invention relates to a parking space detection device that detects a parking space adjacent to a parked vehicle.

従来より、超音波センサ等の測距センサを利用して、駐車車両に隣接した駐車空間を検知する駐車空間検知装置が知られている(例えば特許文献1参照)。この種の駐車空間検知装置では、車両が駐車車両の側方通過時に、測距センサで駐車車両までの距離(検知距離)を逐次検知する。また、車両の移動状態(車速、操舵角)や車両における測距センサの搭載位置(車両のどこに搭載されているかの情報)を用いて、距離検知を行うときの測距センサの位置(センサ位置)を算出する。そして、それら検知距離、センサ位置を利用して駐車車両の輪郭点を求め、求めた輪郭点から駐車空間を検知している。   2. Description of the Related Art Conventionally, a parking space detection device that detects a parking space adjacent to a parked vehicle using a distance measuring sensor such as an ultrasonic sensor is known (see, for example, Patent Document 1). In this type of parking space detection device, when the vehicle passes by the side of the parked vehicle, the distance to the parked vehicle (detection distance) is sequentially detected by the distance measuring sensor. Also, the position of the distance measuring sensor (sensor position) when performing distance detection using the moving state of the vehicle (vehicle speed, steering angle) and the mounting position of the distance measuring sensor (information on where the vehicle is mounted) ) Is calculated. And the contour point of a parked vehicle is calculated | required using those detection distances and sensor positions, and the parking space is detected from the calculated | required contour point.

特開2008−21039号公報JP 2008-21039 A

ところで、測距センサは車両出荷後に(後付けで)車両に搭載される場合がある。後付けの測距センサを用いる場合、もともと車両に搭載されている測距センサ(純正の測距センサ)に比べて、精密に車両に取り付けられているわけではないので、駐車空間検知装置が把握している測距センサの搭載位置と、実際の搭載位置とに誤差が生じることがある。この場合、誤差を有した搭載位置を利用して検知された駐車空間の検知精度が低下する。   By the way, the distance measuring sensor may be mounted on the vehicle after the vehicle is shipped (afterwards). When using a retrofit distance sensor, it is not precisely attached to the vehicle compared to the distance sensor (genuine distance sensor) originally installed in the vehicle. An error may occur between the mounting position of the distance measuring sensor and the actual mounting position. In this case, the detection accuracy of the parking space detected using the mounting position having an error is lowered.

また、純正の測距センサを用いる場合であっても、駐車動作を繰り返し行ううちに、測距センサの搭載位置がずれていくことがある。この場合も、駐車空間検知装置が把握する搭載位置と、実際の搭載位置とに誤差が生じることになるので、駐車空間の検知精度が低下する。   Even when a genuine distance measuring sensor is used, the mounting position of the distance measuring sensor may shift as the parking operation is repeated. Also in this case, since an error occurs between the mounting position grasped by the parking space detection device and the actual mounting position, the detection accuracy of the parking space is lowered.

本発明は上記事情に鑑みてなされたものであり、駐車空間検知装置が把握する測距センサの搭載位置と実際の搭載位置とに誤差が生じた場合に、その誤差を解消することができる駐車空間検知装置を提供することを課題とする。   The present invention has been made in view of the above circumstances, and when an error occurs between the mounting position of the distance measuring sensor grasped by the parking space detection device and the actual mounting position, the parking that can eliminate the error. It is an object to provide a space detection device.

上記課題を解決するために、本発明は、車両の周囲に存在する駐車車両までの距離を逐次検知する距離検知手段と、
前記距離検知手段の前記車両における搭載位置を記憶する記憶手段と、
前記車両の移動状態を検知する移動状態検知手段と、
前記搭載位置と前記車両の移動状態とに基づいて前記駐車車両の距離検知を行うときの前記距離検知手段の位置であるセンサ位置を算出する位置算出手段と、
前記距離検知手段が検知した距離である検知距離と前記センサ位置とに基づいて、前記駐車車両の側方通過時に前記駐車車両に隣接した駐車空間を検知する第1の空間検知手段と、
前記駐車空間に対する駐車動作時に前記駐車空間を検知する第2の空間検知手段と、
前記第1の空間検知手段が検知した駐車空間である1次検知空間と、前記第2の空間検知手段が検知した駐車空間である2次検知空間の差異を算出する差異算出手段と、
前記差異に相当する前記搭載位置の誤差に対する対策処理を実行する対策実行手段と、
を備えることを特徴とする。
In order to solve the above problems, the present invention provides a distance detection means for sequentially detecting a distance to a parked vehicle existing around the vehicle,
Storage means for storing the mounting position of the distance detection means in the vehicle;
A moving state detecting means for detecting a moving state of the vehicle;
Position calculating means for calculating a sensor position which is a position of the distance detecting means when detecting the distance of the parked vehicle based on the mounting position and the moving state of the vehicle;
A first space detecting means for detecting a parking space adjacent to the parked vehicle when the parked vehicle is laterally passed based on a sensed distance detected by the distance detecting means and the sensor position;
Second space detection means for detecting the parking space during a parking operation with respect to the parking space;
A difference calculation means for calculating a difference between a primary detection space that is a parking space detected by the first space detection means and a secondary detection space that is a parking space detected by the second space detection means;
Countermeasure executing means for executing countermeasure processing for an error in the mounting position corresponding to the difference;
It is characterized by providing.

本発明によれば、駐車車両の側方通過時に駐車空間(1次検知空間)を検知する第1の空間検知手段の他に、駐車動作時に駐車空間(2次検知空間)を検知する第2の空間検知手段を備えている。記憶手段に記憶された搭載位置(駐車空間検知装置が把握している搭載位置)と実際の搭載位置とに誤差が生じている場合には、1次検知空間はその誤差に相当する分だけ実際の駐車空間からずれた位置に検知される。一方、2次検知空間は、実際に駐車空間に駐車するときに検知された駐車空間であるため、1次検知空間に比べて正確な位置に検知される。差異算出手段が算出する1次検知空間と2次検知空間の差異は、搭載位置の誤差に相当するので、その差異を見ることで搭載位置に誤差が生じているか否かを判断できる。そして、対策実行手段は、搭載位置の誤差に対する対策処理を実行するので、搭載位置の誤差を解消することができる。   According to the present invention, in addition to the first space detection means that detects the parking space (primary detection space) when the parked vehicle passes by the side, the second detection that detects the parking space (secondary detection space) during the parking operation. The space detection means is provided. If there is an error between the mounting position (the mounting position known by the parking space detection device) stored in the storage means and the actual mounting position, the primary detection space is actually equivalent to the error. It is detected at a position shifted from the parking space. On the other hand, since the secondary detection space is a parking space that is detected when the vehicle is actually parked in the parking space, the secondary detection space is detected at a more accurate position than the primary detection space. Since the difference between the primary detection space and the secondary detection space calculated by the difference calculation means corresponds to an error in the mounting position, it can be determined whether there is an error in the mounting position by looking at the difference. The countermeasure execution means executes the countermeasure process for the mounting position error, so that the mounting position error can be eliminated.

対策処理の第1の具体的態様として、本発明における対策実行手段は、前記対策処理として前記差異の分だけ前記搭載位置を補正する補正手段である。これによれば、搭載位置が差異の分だけ補正されるので、搭載位置の誤差を解消できる。   As a first specific mode of the countermeasure process, the countermeasure execution means in the present invention is a correcting means for correcting the mounting position by the difference as the countermeasure process. According to this, since the mounting position is corrected by the difference, the mounting position error can be eliminated.

また、対策処理の第2の具体的態様として、本発明の対策実行手段は、前記距離検知手段の搭載状態に対して警告を発する警告手段である。つまり、第2の具体的態様は、距離検知手段の搭載状態の異常を検知して警告する、いわゆるダイアグ検出機能である。これによって、距離検知手段の搭載状態が異常であることを(搭載位置に誤差が生じていることを)車両のユーザに認識させることができる。よって、ディーラー等で距離検知手段の搭載状態を点検修理することで、搭載位置の誤差を解消できる。   As a second specific mode of the countermeasure processing, the countermeasure execution means of the present invention is a warning means for issuing a warning with respect to the mounted state of the distance detection means. That is, the second specific mode is a so-called diagnostic detection function that detects and warns of an abnormality in the mounting state of the distance detection means. Thereby, the user of the vehicle can recognize that the mounting state of the distance detecting means is abnormal (that an error has occurred in the mounting position). Therefore, an error in the mounting position can be eliminated by inspecting and repairing the mounting state of the distance detecting means at a dealer or the like.

駐車支援装置1の概略構成を示したブロック図である。1 is a block diagram showing a schematic configuration of a parking assistance device 1. FIG. 駐車空間の検知場面の一例を示した図である。It is the figure which showed an example of the detection scene of a parking space. 駐車空間検知処理のフローチャートである。It is a flowchart of a parking space detection process. 反射波の到来方向及び反射点の算出方法を説明する図である。It is a figure explaining the calculation method of the arrival direction of a reflected wave, and a reflective point. 図4の三角形7だけを抜き出した図である。It is the figure which extracted only the triangle 7 of FIG. 縦列駐車した駐車車両61、62の側方通過時に駐車空間を検知する場面を示した図である。It is the figure which showed the scene which detects a parking space at the time of the side passage of the parked vehicles 61 and 62 parked in parallel. 図6の検知場面後の場面であり、縦列駐車用の駐車空間への駐車動作時にその駐車空間を検知する場面を示した図である。It is the scene after the detection scene of FIG. 6, and the figure which showed the scene which detects the parking space at the time of the parking operation to the parking space for parallel parking. 並列駐車した駐車車両61、62の側方通過時に駐車空間を検知する場面を示した図である。It is the figure which showed the scene which detects a parking space at the time of the side passage of the parked vehicles 61 and 62 parked in parallel. 図8の検知場面後の場面であり、並列駐車用の駐車空間への駐車動作時にその駐車空間を検知する場面を示した図である。It is the scene after the detection scene of FIG. 8, and the figure which showed the scene which detects the parking space at the time of the parking operation to the parking space for parallel parking. 駐車動作時の検知場面では測距センサの搭載位置の誤差の影響が小さいことを説明するための図である。It is a figure for demonstrating that the influence of the error of the mounting position of a ranging sensor is small in the detection scene at the time of parking operation. 図10のA部の拡大図である。It is an enlarged view of the A section of FIG. 図3のS25及びS26の詳細のフローチャートである。4 is a detailed flowchart of S25 and S26 in FIG. 3.

以下、本発明に係る駐車空間検知装置の実施形態を図面を参照しながら説明する。図1は、本発明の駐車空間検知装置が実現された駐車支援装置1の概略構成を示したブロック図である。駐車支援装置1は、車両5(図2参照)に搭載されて、車両5の周囲に存在する駐車空間を検知するなど、駐車を支援する装置である。その駐車支援装置1は、図1に示すように、測距センサ2と車速センサ12と操舵角センサ13と駐車態様選択スイッチ14と警告部15とそれらと接続したECU11とを備えている。   Hereinafter, an embodiment of a parking space detection device according to the present invention will be described with reference to the drawings. FIG. 1 is a block diagram showing a schematic configuration of a parking assistance device 1 in which the parking space detection device of the present invention is realized. The parking assistance device 1 is a device that is mounted on the vehicle 5 (see FIG. 2) and assists parking, for example, by detecting a parking space that exists around the vehicle 5. As shown in FIG. 1, the parking assist device 1 includes a distance measuring sensor 2, a vehicle speed sensor 12, a steering angle sensor 13, a parking mode selection switch 14, a warning unit 15, and an ECU 11 connected thereto.

測距センサ2は、その周囲に存在する駐車車両等の障害物までの距離を検知するセンサである。具体的には、測距センサ2は、ECU11からの指示に基づき、測距センサ2の正面方向に所定間隔おきに(例えば100ミリ秒おきに)超音波等の探査波を送信する。測距センサ2は、送信した探査波が障害物に当たって反射した反射波を受信する。測距センサ2は、探査波の送信タイミングと反射波の受信タイミングとに基づき、障害物までの距離を算出する。測距センサ2で検知された検知情報(検知距離)はECU11に入力される。なお、検知距離の算出はECU11が行っても良い。測距センサ2は、探査波を送信しその探査波の反射波を受信するセンサであれば良く、音波を用いるものであっても、光波を用いるものであっても、電波を用いるものであっても良い。測距センサ2としては、例えば超音波センサ、レーザレーダ、ミリ波レーダ等のセンサを用いることができる。   The distance measuring sensor 2 is a sensor that detects a distance to an obstacle such as a parked vehicle existing around the distance measuring sensor 2. Specifically, the distance measurement sensor 2 transmits an exploration wave such as an ultrasonic wave at predetermined intervals (for example, every 100 milliseconds) in the front direction of the distance measurement sensor 2 based on an instruction from the ECU 11. The distance measuring sensor 2 receives the reflected wave reflected by the transmitted exploration wave hitting an obstacle. The distance measuring sensor 2 calculates the distance to the obstacle based on the transmission timing of the exploration wave and the reception timing of the reflected wave. Detection information (detection distance) detected by the distance measuring sensor 2 is input to the ECU 11. Note that the ECU 11 may calculate the detection distance. The distance measuring sensor 2 may be any sensor that transmits an exploration wave and receives a reflected wave of the exploration wave, and uses a radio wave regardless of whether it uses a sound wave or a light wave. May be. As the distance measuring sensor 2, for example, a sensor such as an ultrasonic sensor, a laser radar, or a millimeter wave radar can be used.

図2は、駐車空間の検知場面の一例を示した図であり、具体的には、縦列駐車した2台の駐車車両61、62の側方経路100を車両5が通過しているときに駐車車両61、62に挟まれた駐車空間9を検知する場面を上から見た図である。なお、以下では、駐車車両61、62を区別しないときには符号6を使用する。図2に示すように、測距センサ2は車両5の外周面の複数箇所に搭載されている。具体的には、測距センサ2は、車両5の左側面51に搭載された左側方測距センサ21Lと、右側面52に搭載された右側方測距センサ21Rと、前面53に搭載された前部測距センサ22と、後面54に搭載された後部測距センサ23とを含む。左側方測距センサ21Lの障害物検知範囲41(探査波の送信範囲)は車両5の左側方に設定されている。右側方測距センサ21Rの障害物検知範囲42は車両5の右側方に設定されている。前部測距センサ22の障害物検知範囲43は車両5の前方に設定されている。後部測距センサ23の障害物検知範囲44は車両5の後方に設定されている。各測距センサ2の指向性φは例えば70°〜120°程度となっている。また、各測距センサ2が検知可能な最大検知距離(左側方測距センサ21Lの例で言うと、障害物検知範囲41の先端と左側方測距センサ21Lの間の距離)は例えば4m〜10m程度となっている。なお、以下では、左側方測距センサ21Lと右側方測距センサ21Rを区別しないときには、側方測距センサ21と言う。   FIG. 2 is a diagram showing an example of a parking space detection scene. Specifically, the parking space is parked when the vehicle 5 passes through the side path 100 of the two parked vehicles 61 and 62 that are parked in parallel. It is the figure which looked at the scene which detects the parking space 9 pinched | interposed between the vehicles 61 and 62 from the top. In the following, reference numeral 6 is used when the parked vehicles 61 and 62 are not distinguished. As shown in FIG. 2, the distance measuring sensors 2 are mounted at a plurality of locations on the outer peripheral surface of the vehicle 5. Specifically, the distance measuring sensor 2 is mounted on the left side distance measuring sensor 21L mounted on the left side surface 51 of the vehicle 5, the right side distance measuring sensor 21R mounted on the right side surface 52, and the front surface 53. A front distance measuring sensor 22 and a rear distance measuring sensor 23 mounted on the rear surface 54 are included. The obstacle detection range 41 (search wave transmission range) of the left-side distance measuring sensor 21L is set on the left side of the vehicle 5. The obstacle detection range 42 of the right side distance measuring sensor 21 </ b> R is set on the right side of the vehicle 5. The obstacle detection range 43 of the front distance measuring sensor 22 is set in front of the vehicle 5. The obstacle detection range 44 of the rear distance measuring sensor 23 is set behind the vehicle 5. The directivity φ of each distance measuring sensor 2 is, for example, about 70 ° to 120 °. Further, the maximum detection distance that each distance measurement sensor 2 can detect (in the example of the left-side distance measurement sensor 21L, the distance between the tip of the obstacle detection range 41 and the left-side distance measurement sensor 21L) is, for example, 4 m to It is about 10m. Hereinafter, when the left side distance measuring sensor 21L and the right side distance measuring sensor 21R are not distinguished, they are referred to as the side distance measuring sensor 21.

なお、測距センサ2は、車両5の出荷時からもともと車両5に搭載されている純正の測距センサであっても、出荷後に車両5に搭載された後付けの測距センサであっても良い。本実施形態では、純正の測距センサ2を用いる場合には、測距センサ2の搭載位置のズレを検出するダイアグ検出が行われる一方、後付けの測距センサ2を用いる場合には、駐車支援装置1(ECU11)が把握する測距センサ2の搭載位置の補正が行われる。   The distance measuring sensor 2 may be a genuine distance measuring sensor originally mounted on the vehicle 5 from the time of shipment of the vehicle 5 or a retrofit distance measuring sensor mounted on the vehicle 5 after shipping. . In the present embodiment, when a genuine distance measuring sensor 2 is used, diagnostic detection is performed to detect a displacement of the mounting position of the distance measuring sensor 2, while when a rear distance measuring sensor 2 is used, parking assistance is performed. The mounting position of the distance measuring sensor 2 grasped by the device 1 (ECU 11) is corrected.

車速センサ12は車両5の車速を検知するセンサである。車速センサ12で検知された検知情報(車速)はECU11に入力される。操舵角センサ13は車両5のステアリングの操舵角を検知するセンサである。操舵角センサ13で検知された検知情報(操舵角)はECU11に入力される。   The vehicle speed sensor 12 is a sensor that detects the vehicle speed of the vehicle 5. Detection information (vehicle speed) detected by the vehicle speed sensor 12 is input to the ECU 11. The steering angle sensor 13 is a sensor that detects the steering angle of the vehicle 5. Detection information (steering angle) detected by the steering angle sensor 13 is input to the ECU 11.

駐車態様選択スイッチ14は、例えば車両5の運転席周辺に設けられ、車両5のドライバーに、縦列駐車に対する支援を行うのか、並列駐車に対する支援を行うのかを選択させるスイッチである。その駐車態様選択スイッチ14は、メカ式のスイッチであったり、液晶ディスプレイにスイッチ画像として表示されたタッチスイッチであったりする。駐車態様選択スイッチ14で選択された駐車態様はECU11に入力される。   The parking mode selection switch 14 is a switch that is provided, for example, in the vicinity of the driver's seat of the vehicle 5 and allows the driver of the vehicle 5 to select whether to support parallel parking or to support parallel parking. The parking mode selection switch 14 may be a mechanical switch or a touch switch displayed as a switch image on a liquid crystal display. The parking mode selected by the parking mode selection switch 14 is input to the ECU 11.

警告部15は、測距センサ2の搭載位置が初期位置からズレが生じている場合に、そのことを車両5のドライバーに警告する部分であり、例えば、スピーカーであったり、表示装置であったりする。   The warning unit 15 is a part that warns the driver of the vehicle 5 when the mounting position of the distance measuring sensor 2 is deviated from the initial position, for example, a speaker or a display device. To do.

ECU11は、CPU、ROM、RAM等から構成されたマイコンを主体として構成され、測距センサ2、車速センサ12、操舵角センサ13から入力された各検知情報に基づき、車両5の駐車を支援する各種処理を実行する。具体的には、ECU11は、車両5が駐車車両の側方経路を通過するときや、駐車動作を行っているときに、車両5の周囲に存在する駐車車両を検知し、その検知結果に基づき車両5の周囲に存在する駐車空間を検知する駐車空間検知処理を実行する。また、ECU11は、駐車空間検知処理で検知した駐車空間に車両5を自動で駐車させる自動駐車処理を実行する。   The ECU 11 is composed mainly of a microcomputer composed of a CPU, a ROM, a RAM, and the like, and supports parking of the vehicle 5 based on each detection information input from the distance measuring sensor 2, the vehicle speed sensor 12, and the steering angle sensor 13. Perform various processes. Specifically, the ECU 11 detects a parked vehicle existing around the vehicle 5 when the vehicle 5 passes a side path of the parked vehicle or performs a parking operation, and based on the detection result. A parking space detection process for detecting a parking space existing around the vehicle 5 is executed. Moreover, ECU11 performs the automatic parking process which parks the vehicle 5 automatically in the parking space detected by the parking space detection process.

また、ECU11は、車両5における測距センサ2の搭載位置及び測距センサ2の向き(正面方向)が記憶されるメモリ111を備えている。具体的には、メモリ111には、測距センサ2の搭載位置として、例えば車両5の後輪軸101の中心102(図2参照)を基準とした座標が記憶される。測距センサ2が純正の場合には、車両5の製造時に搭載位置がメモリ111に記憶される一方で、測距センサ2が後付けの場合には、後付け後にECU11が仮設定した搭載位置がメモリ111に記憶される。   In addition, the ECU 11 includes a memory 111 that stores the mounting position of the distance measuring sensor 2 in the vehicle 5 and the direction (front direction) of the distance measuring sensor 2. Specifically, the memory 111 stores, for example, coordinates based on the center 102 (see FIG. 2) of the rear wheel shaft 101 of the vehicle 5 as the mounting position of the distance measuring sensor 2. When the distance measuring sensor 2 is genuine, the mounting position is stored in the memory 111 when the vehicle 5 is manufactured. On the other hand, when the distance measuring sensor 2 is retrofitted, the mounting position temporarily set by the ECU 11 after the retrofitting is stored in the memory 111. 111 is stored.

以下、ECU11が実行する駐車空間検知処理の詳細を説明する。図3は、駐車空間検知処理のフローチャートを示している。図3の処理は、例えば駐車支援の開始を指示するスイッチ(図示外)が車両5のドライバーに操作されたときに開始される。なお、図3の処理を実行する間、ECU11は、測距センサ2に指示をして、車両5の周囲に存在する障害物(駐車車両6)までの距離を逐次検知させている。図3の処理を開始すると、先ず、以降の処理で使用する各種パラメータを初期化する(S11)。具体的には、測距センサ2が距離検知を行うときの時間t(n)をゼロに設定する(S11)。また、測距センサ2が距離検知を試みた回数(計測カウント)nを1に設定する(S11)。また、現在、車両5が駐車車両6の側方経路100を通過中か、検知した駐車空間にバック駐車の動作を行っている最中かを示した後退フラグFlagを、側方通過中であることを示した値「0」に設定する(S11)。また、測距センサ2が純正の場合に、測距センサ2の搭載状態に対する警告を行うか否かを示した警告フラグFlagCheckを、警告を行わないことを示した値「0」に設定する(S11)。なお、ECU11は、各計測カウントnでの時間t(n)(t(1)を基準とした時間)を計測している。   Hereinafter, details of the parking space detection process executed by the ECU 11 will be described. FIG. 3 shows a flowchart of the parking space detection process. The process of FIG. 3 is started when a switch (not shown) for instructing the start of parking assistance is operated by the driver of the vehicle 5, for example. During execution of the processing of FIG. 3, the ECU 11 instructs the distance measuring sensor 2 to sequentially detect the distance to the obstacle (parked vehicle 6) existing around the vehicle 5. When the processing of FIG. 3 is started, first, various parameters used in the subsequent processing are initialized (S11). Specifically, the time t (n) when the distance measuring sensor 2 performs distance detection is set to zero (S11). In addition, the number of times the distance measurement sensor 2 tries to detect the distance (measurement count) n is set to 1 (S11). Further, the vehicle 5 is currently passing the reverse flag Flag indicating whether the vehicle 5 is passing the side route 100 of the parked vehicle 6 or performing the back parking operation in the detected parking space. This value is set to “0” (S11). Further, when the distance measuring sensor 2 is genuine, a warning flag FlagCheck indicating whether or not to warn the mounted state of the distance measuring sensor 2 is set to a value “0” indicating that no warning is performed ( S11). The ECU 11 measures time t (n) (time based on t (1)) at each measurement count n.

次に、側方測距センサ21が純正か後付けかを示したパラメータModeの値が、後付けであることを示した値「1」であるか否かを判断する(S12)。Modeの値は、側方測距センサ21が純正か後付けかに応じてROM等に予め設定されている。なお、S12の判断では、前部測距センサ22、後部測距センサ23は、純正であっても後付けであっても良い。Mode=1の場合、つまり側方測距センサ21が後付けの場合には(S12:Yes)、S13に進む。   Next, it is determined whether or not the value of the parameter Mode indicating whether the side ranging sensor 21 is genuine or retrofitted is a value “1” indicating that it is retrofitted (S12). The value of Mode is set in advance in the ROM or the like depending on whether the lateral distance measuring sensor 21 is genuine or retrofitted. In the determination of S12, the front distance measuring sensor 22 and the rear distance measuring sensor 23 may be genuine or retrofitted. When Mode = 1, that is, when the side distance measuring sensor 21 is retrofitted (S12: Yes), the process proceeds to S13.

S13では、車両5における側方測距センサ21の搭載位置SenPosIni及び角度(向き)SenAngIniを仮設定する(S13)。具体的には、図2に示すように、例えば図3の処理を開始した時点における後輪軸101の中心102の位置を原点O、その時点の車両5の進行方向をX軸、そのX軸に垂直な方向をY軸とした座標系を設定する。その座標系の原点O(後輪軸101の中心102)を基準とした座標値(SenPosIniX、SenPosIniY)を、搭載位置SenPosIniとして設定する。具体的にどの座標値(SenPosIniX、SenPosIniY)に設定するかは、例えば処理プログラムで予め決めておけばよい。具体的には、例えば左側方測距センサ21Lの搭載位置SenPosIniとして車両5の左側前輪付近の座標値を仮設定し、右側方測距センサ21Rの搭載位置SenPosIniとして車両5の右側前輪付近の座標値を仮設定する。なお。前回の駐車時に、後述するS25で搭載位置SenPosIniの補正が行われた場合には、今回のS13では、その補正後の搭載位置SenPosIniを仮設定の搭載位置として用いる。   In S13, the mounting position SenPosIni and the angle (orientation) SenAngIni of the side ranging sensor 21 in the vehicle 5 are temporarily set (S13). Specifically, as shown in FIG. 2, for example, the position of the center 102 of the rear wheel shaft 101 at the time of starting the processing of FIG. 3 is the origin O, and the traveling direction of the vehicle 5 at that time is the X axis and the X axis. A coordinate system with the vertical direction as the Y axis is set. A coordinate value (SenPosIniX, SenPosIniY) with reference to the origin O (center 102 of the rear wheel shaft 101) of the coordinate system is set as the mounting position SenPosIni. Specifically, the coordinate value (SenPosIniX, SenPosIniY) to be set may be determined in advance by a processing program, for example. Specifically, for example, a coordinate value near the left front wheel of the vehicle 5 is temporarily set as the mounting position SenPosIni of the left side ranging sensor 21L, and a coordinate near the right front wheel of the vehicle 5 is set as the mounting position SenPosIni of the right side ranging sensor 21R. Temporarily set a value. Note that. If the mounting position SenPosIni is corrected in S25, which will be described later, during the previous parking, the corrected mounting position SenPosIni is used as a temporarily set mounting position in S13.

S13では、側方測距センサ21の角度SenAngIniも、処理プログラムで予め決めておけばよい。例えば角度SenAngIniとして、後輪軸101と平行な方向を仮設定する。なお、前部測距センサ22、後部測距センサ23が後付けの場合にも、S13では、それらセンサ22、23の搭載位置SenPosIni及び角度SenAngIniを仮設定する。S13で仮設定した搭載位置SenPosIni及び角度SenAngIniはメモリ111に記憶される。S13の処理の後、S14に進む。   In S13, the angle SenAngIni of the side ranging sensor 21 may be determined in advance by the processing program. For example, a direction parallel to the rear wheel shaft 101 is temporarily set as the angle SenAngIni. Even when the front ranging sensor 22 and the rear ranging sensor 23 are retrofitted, in S13, the mounting position SenPosIni and the angle SenAngIni of the sensors 22 and 23 are temporarily set. The mounting position SenPosIni and the angle SenAngIni temporarily set in S13 are stored in the memory 111. It progresses to S14 after the process of S13.

一方、S12において、Mode≠1の場合、つまり側方測距センサ21が純正の場合には(S12:No)、メモリ111には既に側方測距センサ21の搭載状態(搭載位置SenPosIni、角度SenAngIni)が記憶されているので、S13の処理は行わずにS14に進む。   On the other hand, if Mode ≠ 1 in S12, that is, if the lateral distance measuring sensor 21 is genuine (S12: No), the memory 111 has already been loaded with the lateral distance measuring sensor 21 (mounting position SenPosIni, angle). Since (SenAngIni) is stored, the process proceeds to S14 without performing the process in S13.

S14では、計測カウントnでの検知距離L(n)を各測距センサ2から取得する(S14)。なお、ECU11自身が検知距離Lを算出する構成の場合には、S14では、測距センサ2から反射波の受信タイミングを取得して、送信タイミングと受信タイミングとに基づき検知距離L(n)を算出する。なお、測距センサ2の障害物検知範囲41〜44(図2参照)に障害物が存在しない場合、つまり非検知の場合には検知距離L(n)=0とする。   In S14, the detection distance L (n) at the measurement count n is acquired from each distance measuring sensor 2 (S14). When the ECU 11 itself is configured to calculate the detection distance L, in S14, the reception timing of the reflected wave is acquired from the distance measurement sensor 2, and the detection distance L (n) is calculated based on the transmission timing and the reception timing. calculate. When no obstacle exists in the obstacle detection ranges 41 to 44 (see FIG. 2) of the distance measuring sensor 2, that is, in the case of non-detection, the detection distance L (n) = 0.

次に、計測カウントnでの各測距センサ2の位置(センサ位置)SenPosを算出する(S15)。具体的には、S13で設定した座標系での座標(SenPosX(n)、SenPosY(n))としてセンサ位置SenPosを算出する。より具体的には、メモリ111に記憶された搭載位置SenPosIniと、車速センサ12、操舵角センサ13の検出情報とに基づき、センサ位置SenPosを算出する。このとき、車速センサ12から入力された車速と時間t(n)とから、搭載位置SenPosIniからの測距センサ2の移動距離を算出できる。また、操舵角センサ13から入力された操舵角から、搭載位置SenPosIniからの測距センサ2の移動方向を算出できる。つまり、それら移動距離、移動方向から、搭載位置SenPosIniがどの方向にどれだけ移動したか(移動変化分)が分かるので、搭載位置SenPosIniにその移動変化分を追加することで、センサ位置SenPosを算出できる。なお、S14で取得した検知距離L(n)はセンサ位置SenPosに対応付けてRAM等のワークメモリに記憶しておく。   Next, the position (sensor position) SenPos of each distance measuring sensor 2 at the measurement count n is calculated (S15). Specifically, the sensor position SenPos is calculated as the coordinates (SenPosX (n), SenPosY (n)) in the coordinate system set in S13. More specifically, the sensor position SenPos is calculated based on the mounting position SenPosIni stored in the memory 111 and the detection information of the vehicle speed sensor 12 and the steering angle sensor 13. At this time, the moving distance of the distance measuring sensor 2 from the mounting position SenPosIni can be calculated from the vehicle speed input from the vehicle speed sensor 12 and the time t (n). Further, the moving direction of the distance measuring sensor 2 from the mounting position SenPosIni can be calculated from the steering angle input from the steering angle sensor 13. In other words, it is possible to know how much the mounting position SenPosIni has moved in which direction (moving change) from the moving distance and moving direction, and by adding the moving change to the mounting position SenPosIni, the sensor position SenPos is calculated. it can. The detection distance L (n) acquired in S14 is stored in a work memory such as a RAM in association with the sensor position SenPos.

次に、後退フラグFlagPark=0か否かを確認することで、車両5が駐車車両の側方通過中か否かを判断する。後退フラグFlagPark=0の場合(S16:Yes)、側方通過中であるとしてS17に進む。S17では、駐車空間側の側方測距センサ21が検知した検知距離L(n)及びセンサ位置SenPosを用いて、駐車空間を検知する(S17)。図2を参照して駐車空間の検知方法を説明する。図2の例では、左側方測距センサ21Lにより検知された検知距離の履歴を符号8(×の点)で図示している。各検知距離8は、各計測カウントnでのセンサ位置SenPosから、左側方測距センサ21Lの正面方向に検知距離だけ離された点(以下、測距点という)である。なお、左側方測距センサ21Lの正面方向は、メモリ111に記憶された角度SenAngIniから特定できる。障害物検知範囲41はある程度の広がりを持っているため、車両5が駐車車両6に対峙する位置に到達する前から左側方測距センサ21Lによる距離検知が開始され、車両5が駐車車両6を通過した後もしばらくの間は左側方測距センサ21Lによる距離検知が続く。つまり、測距点8の履歴範囲は駐車車両6の幅よりも広くなる。この測距点8の履歴から直接駐車空間を検知しようとすると、実際の駐車空間9よりも狭い駐車空間が検知されてしまう。   Next, it is determined whether or not the vehicle 5 is passing the side of the parked vehicle by checking whether or not the reverse flag FlagPark = 0. When the reverse flag FlagPark = 0 (S16: Yes), it is determined that the vehicle is passing sideways and the process proceeds to S17. In S17, the parking space is detected using the detection distance L (n) detected by the side ranging sensor 21 on the parking space side and the sensor position SenPos (S17). The parking space detection method will be described with reference to FIG. In the example of FIG. 2, the history of the detection distance detected by the left-side distance measuring sensor 21 </ b> L is illustrated by reference numeral 8 (dots). Each detection distance 8 is a point separated from the sensor position SenPos at each measurement count n by the detection distance in the front direction of the left side distance measurement sensor 21L (hereinafter referred to as a distance measurement point). Note that the front direction of the left side distance measuring sensor 21L can be specified from the angle SenAngIni stored in the memory 111. Since the obstacle detection range 41 has a certain extent, the distance detection by the left-side distance measuring sensor 21L is started before the vehicle 5 reaches the position facing the parked vehicle 6, and the vehicle 5 The distance detection by the left-side distance measuring sensor 21L continues for a while after passing. That is, the history range of the distance measuring point 8 is wider than the width of the parked vehicle 6. If it is attempted to detect the parking space directly from the history of the distance measuring points 8, a parking space narrower than the actual parking space 9 is detected.

そこで、S17では、測距点8(検知距離、センサ位置)の履歴を用いて三角測量の原理により、反射波の到来方向を推定し、センサ位置SenPosから反射波の到来方向に検知距離L(n)だけ離れた点Rflt(以下、反射点という)を算出する。なお、三角測量の原理に基づく反射点の推定では、隣接するセンサ位置間で、測距センサ2からの探査波が駐車車両6の同一点で反射するとの仮定に基づいている。この反射点Rfltは、図2の座標系の座標(RfltX(n)、RfltY(n))として算出する。ここで、図4は、反射波の到来方向及び反射点Rfltの算出方法を説明する図である。具体的には、図4は、計測カウントnにおける車両5の位置5b(実線で図示)と、1つ前の計測カウントn−1における車両5の位置5a(破線で図示)と、駐車車両6とを上から見た図を示している。図4に示すように、計測カウントnにおけるセンサ位置SenPos(n)及び検知距離L(n)と、計測カウントn−1におけるセンサ位置SenPos(n−1)と検知距離L(n−1)とで構成される三角形7を考える。   Therefore, in S17, the arrival direction of the reflected wave is estimated based on the principle of triangulation using the history of the distance measurement point 8 (detection distance, sensor position), and the detection distance L (from the sensor position SenPos to the arrival direction of the reflected wave is estimated. n) A point Rflt (hereinafter referred to as a reflection point) separated by a distance is calculated. The estimation of the reflection point based on the principle of triangulation is based on the assumption that the exploration wave from the distance measuring sensor 2 is reflected at the same point of the parked vehicle 6 between adjacent sensor positions. This reflection point Rflt is calculated as coordinates (RfltX (n), RfltY (n)) in the coordinate system of FIG. Here, FIG. 4 is a diagram for explaining a method of calculating the arrival direction of the reflected wave and the reflection point Rflt. Specifically, FIG. 4 shows a position 5b (illustrated by a solid line) of the vehicle 5 in the measurement count n, a position 5a (illustrated by a broken line) of the vehicle 5 in the immediately preceding measurement count n−1, and the parked vehicle 6. The figure which looked at from the top is shown. As shown in FIG. 4, the sensor position SenPos (n) and the detection distance L (n) at the measurement count n, and the sensor position SenPos (n-1) and the detection distance L (n-1) at the measurement count n-1. Consider a triangle 7 consisting of

図5はその三角形7だけを抜き出した図を示している。センサ位置SenPos(n)、SenPos(n−1)の座標成分に基づいて、それら位置間の辺71のベクトル成分(SenPosBktX、SenPosBktX)とそのベクトルの絶対値SenPosBktとを算出する。また、辺71と検知距離L(n)の辺72との成す角度をθ(n)とすると、角度θ(n)を次の式1で算出する。この角度θ(n)が反射波の到来方向に相当する。

Figure 2014071569
FIG. 5 shows a diagram in which only the triangle 7 is extracted. Based on the coordinate components of the sensor positions SenPos (n) and SenPos (n−1), the vector components (SenPosBktX, SenPosBktX) of the side 71 between the positions and the absolute value SenPosBkt of the vector are calculated. Further, assuming that the angle formed between the side 71 and the side 72 of the detection distance L (n) is θ (n), the angle θ (n) is calculated by the following equation 1. This angle θ (n) corresponds to the arrival direction of the reflected wave.
Figure 2014071569

そして、角度θ(n)、上記のベクトル成分(SenPosBktX、SenPosBktY)、絶対値SenPosBktを以下の式2〜式6に代入して、三角形7の頂点3の座標(RfltX(n)、RfltY(n))を反射点Rfltとして算出する。   Then, the angle θ (n), the above vector components (SenPosBktX, SenPosBktY), and the absolute value SenPosBkt are substituted into the following equations 2 to 6, and the coordinates of the vertex 3 of the triangle 7 (RfltX (n), RfltY (n) )) Is calculated as the reflection point Rflt.

Figure 2014071569
Figure 2014071569
Figure 2014071569
Figure 2014071569
Figure 2014071569
Figure 2014071569
Figure 2014071569
Figure 2014071569
Figure 2014071569
Figure 2014071569

これによって、車両5が移動するにしたがって駐車車両6の面に略一致した位置に反射点3の履歴をプロットすることができる。そして、S17では、車両5が最初に通過する駐車車両61(1台目の駐車車両)に対する反射点3の履歴から、1台目の駐車車両61のコーナー611の位置Side1(以下、通過時1台目コーナーという)を決定する。この通過時1台目コーナーSide1は、S13で設定した座標系の座標(Side1X、Side1Y)として決定する。具体的には、例えば1台目の駐車車両61に対する反射点3の履歴のうち、X座標が最大となっている反射点3(最も駐車空間寄りの反射点)のX座標を通過時1台目コーナーSide1のX座標Side1Xとし、Y座標が最小となっている反射点3(最も側方経路寄りの反射点)のY座標を通過時1台目コーナーSide1のY座標Side1Yとする。   As a result, the history of the reflection point 3 can be plotted at a position substantially coinciding with the surface of the parked vehicle 6 as the vehicle 5 moves. In S17, from the history of the reflection point 3 with respect to the parked vehicle 61 (the first parked vehicle) through which the vehicle 5 first passes, the position Side1 of the corner 611 of the first parked vehicle 61 (hereinafter referred to as 1 when passing). Determine the corner). The first corner Side1 at the time of passage is determined as the coordinates (Side1X, Side1Y) of the coordinate system set in S13. Specifically, for example, in the history of the reflection point 3 with respect to the first parked vehicle 61, one vehicle passes the X coordinate of the reflection point 3 (the reflection point closest to the parking space) having the maximum X coordinate. The X coordinate Side1X of the eye corner Side1 is set, and the Y coordinate of the reflection point 3 (reflection point closest to the side path) having the minimum Y coordinate is set as the Y coordinate Side1Y of the first corner Side1 when passing.

同様に、車両5が次に通過する駐車車両62(2台目の駐車車両)に対する反射点3の履歴から、2台目の駐車車両62のコーナー621の位置Side2(以下、通過時2台目コーナーという)を決定する。この通過時2台目コーナーもS13で設定した座標系の座標(Side2X、Side2Y)として決定する。具体的には例えば2台目の駐車車両62に対する反射点3の履歴のうち、X座標が最小となっている反射点3(最も駐車空間寄りの反射点)のX座標を通過時2台目コーナーSide2のX座標Side2Xとし、Y座標が最小となっている反射点3(最も側方経路寄りの反射点)のY座標を通過時2台目コーナーSide2のY座標Side2Yとする。図2には、S17で検知された通過時1台目コーナーSide1の点を符号31で図示し、通過時2台目コーナーSide2の点を符号32で図示している。そして、S17では、それらコーナーSide1、Side2間(図2の例では、コーナー31、32間)を駐車空間として検知する。   Similarly, from the history of the reflection point 3 with respect to the parked vehicle 62 (second parked vehicle) through which the vehicle 5 passes next, the position Side2 of the corner 621 of the second parked vehicle 62 (hereinafter referred to as the second parked vehicle). Corner). The second corner at the time of passing is also determined as the coordinates (Side2X, Side2Y) of the coordinate system set in S13. Specifically, for example, in the history of the reflection point 3 with respect to the second parked vehicle 62, the second vehicle when passing the X coordinate of the reflection point 3 (the reflection point closest to the parking space) having the smallest X coordinate. The X coordinate Side2X of the corner Side2 is set, and the Y coordinate of the reflection point 3 (the reflection point closest to the side path) having the minimum Y coordinate is set as the Y coordinate Side2Y of the second corner Side2 when passing. In FIG. 2, the point of the first corner Side1 at the time of passage detected in S17 is illustrated by reference numeral 31, and the point of the second corner Side2 at the time of passage is illustrated by reference numeral 32. And in S17, between these corners Side1 and Side2 (in the example of FIG. 2, between corners 31 and 32) is detected as a parking space.

次に、S17で検知した駐車空間Side1、Side2に対して駐車可能か否か、つまり後退フラグFlagParkを1にして良いか否かを判断する(S18)。具体的には例えば、車両5の車幅とS17で検知した駐車空間の幅(Side1−Side2)とを比較し、駐車空間の幅が、並列駐車は自車幅+クリアランス分より大きければ、また縦列駐車の場合は自車長+クリアランス分より大きければ、駐車可と判断し、小さければ駐車不可と判断する。なお、車両5が2台目の駐車車両62のコーナー621に未だ到達しておらず、通過時2台目コーナーSide2を検知できていないときには、駐車不可と判断する。駐車可と判断した場合には後退フラグFlagParkを1に設定し、駐車不可と判断した場合には後退フラグFlagParkは0のままにしておく(S18)。   Next, it is determined whether or not the parking spaces Side1 and Side2 detected in S17 can be parked, that is, whether or not the reverse flag FlagPark can be set to 1 (S18). Specifically, for example, the width of the vehicle 5 is compared with the width of the parking space (Side1-Side2) detected in S17. If the width of the parking space is larger than the width of the own vehicle + the clearance, In the case of parallel parking, it is determined that parking is possible if it is larger than the vehicle length + clearance, and it is determined that parking is impossible if it is smaller. When the vehicle 5 has not yet reached the corner 621 of the second parked vehicle 62 and the second corner Side2 has not been detected when passing, it is determined that parking is impossible. When it is determined that parking is possible, the reverse flag FlagPark is set to 1. When it is determined that parking is impossible, the reverse flag FlagPark is kept at 0 (S18).

次に、図3の処理の終了指示の有無を判断する(S19)。例えば、ドライバーよって、図3の処理の終了を指示するスイッチ(図示外)が操作されたときや、駐車が完了したときに、図3の処理の終了指示が有ると判断する。終了指示が未だ無い場合には(S19:No)、S20に進み、計測カウントnを次の値に更新する(S20)。その後、S14に戻って、更新後の計測カウントnに対して、検知距離L(n)を取得し(S14)、センサ位置SenPosを算出する(S15)。そして、前回のS18で後退フラグFlagParkが0に維持された場合には、S16では、FlagPark=0であると判断されて(S16:Yes)、再度、S17、S18の処理が行われる。このように、車両5が駐車できる駐車空間を検知するまでは、S14〜S20の処理が繰り返し実行される。   Next, it is determined whether or not there is an instruction to end the process of FIG. 3 (S19). For example, when a switch (not shown) for instructing the end of the process in FIG. 3 is operated by the driver, or when parking is completed, it is determined that there is an instruction to end the process in FIG. When there is no end instruction yet (S19: No), the process proceeds to S20, and the measurement count n is updated to the next value (S20). Thereafter, returning to S14, the detection distance L (n) is acquired for the updated measurement count n (S14), and the sensor position SenPos is calculated (S15). If the reverse flag FlagPark is maintained at 0 in the previous S18, it is determined in S16 that FlagPark = 0 (S16: Yes), and the processes of S17 and S18 are performed again. Thus, the process of S14-S20 is repeatedly performed until the parking space which the vehicle 5 can park is detected.

S18において、後退フラグFlagParkを1に設定した場合には、駐車空間が検知されて、その駐車空間への駐車動作が可能な状態になったことを示す。ここで、図6、図8は、検知された駐車空間91(以下、1次検知空間という)と実際の駐車空間9の差異を説明する図であり、図2と同様に、車両5が駐車車両61、62の側方通過時に駐車空間を検知する場面を上から見た図を示している。図6は縦列駐車の場合の図であり、図8は並列駐車の場合の図である。   In S18, when the reverse flag FlagPark is set to 1, it indicates that the parking space is detected and the parking operation in the parking space is possible. Here, FIG. 6 and FIG. 8 are diagrams for explaining the difference between the detected parking space 91 (hereinafter referred to as the primary detection space) and the actual parking space 9, and the vehicle 5 is parked as in FIG. The figure which looked at the scene which detects parking space when the vehicles 61 and 62 pass by the side was seen from the top. FIG. 6 is a diagram in the case of parallel parking, and FIG. 8 is a diagram in the case of parallel parking.

図6や図8に示すように、側方測距センサ21(図6、図8では左側方測距センサ21L)が後付けで、例えば、車両5の左側面51の車長方向中央付近に搭載されたとする。また、S13で仮設定した左側方測距センサ21Lの搭載位置SenPosIniが、車両5の左前輪付近とする。この場合、ECU11が把握する左側方測距センサ21L’と、実際の左側方測距センサ21Lとに誤差が生じる。そのため、その誤差に相当する分だけ、S17で検知される通過時1台目コーナー311は実際のコーナー611に対してオフセットした位置に検知される。   As shown in FIGS. 6 and 8, the side distance measuring sensor 21 (left side distance measuring sensor 21 </ b> L in FIGS. 6 and 8) is retrofitted and mounted, for example, near the center in the vehicle length direction of the left side surface 51 of the vehicle 5. Suppose that Further, the mounting position SenPosIni of the left-side distance measuring sensor 21L temporarily set in S13 is assumed to be near the left front wheel of the vehicle 5. In this case, an error occurs between the left side distance measuring sensor 21L 'grasped by the ECU 11 and the actual left side distance measuring sensor 21L. Therefore, the first corner 311 at the time of passage detected in S17 is detected at a position offset from the actual corner 611 by an amount corresponding to the error.

同様に、S17で検知される通過時2台目コーナー321は、左側方測距センサ21L’の誤差に相当する分だけ、実際のコーナー621に対してオフセットした位置に検知される。なお、図6、図8の例では、通過時1台目コーナー311は、実際のコーナー611よりも車両進行方向側にオフセットした位置に検知されている。同様に、通過時2台目コーナー321も、実際のコーナー621よりも車両進行方向側にオフセットした位置に検知されている。図6、図8には、通過時1台目コーナー311から把握される駐車車両を破線61’で、通過時2台目コーナー321から把握される駐車車両を破線62’で図示している。   Similarly, the second corner 321 at the time of passage detected in S17 is detected at a position offset from the actual corner 621 by an amount corresponding to the error of the left side distance measuring sensor 21L '. 6 and 8, the first corner 311 at the time of passing is detected at a position offset from the actual corner 611 toward the vehicle traveling direction. Similarly, the second corner 321 at the time of passing is also detected at a position offset from the actual corner 621 toward the vehicle traveling direction. 6 and 8, the parked vehicle grasped from the first corner 311 at the time of passage is illustrated by a broken line 61 ′, and the parked vehicle grasped from the second corner 321 at the time of passage is illustrated by a broken line 62 ′.

このように、ECU11が把握する左側方測距センサ21L’と実際の左側方測距センサ21Lとに誤差が生じると、コーナー311、321はオフセットした位置に検知され、それらコーナー311、321から求まる1次検知空間91も実際の駐車空間9からオフセットした位置に検知される。なお、図6、図8の例では、1次検知空間91は、駐車空間9よりも車両進行方向側にオフセットした位置に検知されている。   As described above, when an error occurs between the left-side distance measuring sensor 21L ′ grasped by the ECU 11 and the actual left-side distance measuring sensor 21L, the corners 311 and 321 are detected at offset positions and are obtained from the corners 311 and 321. The primary detection space 91 is also detected at a position offset from the actual parking space 9. 6 and 8, the primary detection space 91 is detected at a position offset from the parking space 9 toward the vehicle traveling direction.

また、側方測距センサ21が純正であったとしても、駐車動作を繰り返し行ううちに、側方測距センサ21の搭載位置が初期位置からずれていくことがある。この場合も、図6、図8に示すように、1次検知空間91は、実際の駐車空間9からオフセットした位置に検知されてしまう。   Even if the side distance measuring sensor 21 is genuine, the mounting position of the side distance measuring sensor 21 may deviate from the initial position during repeated parking operations. Also in this case, as shown in FIGS. 6 and 8, the primary detection space 91 is detected at a position offset from the actual parking space 9.

そこで、以降の処理では、ECU11が把握する側方測距センサ21の搭載位置(メモリ111に記憶された搭載位置SenPosIni)の誤差を解消するための処理(誤差の補正又はダイアグ検出)を行っている。すなわち、S18で、後退フラグFlagParkを1に設定した場合には、検知した駐車空間Side1、Side2へのバック駐車動作が開始される。このときのバック駐車は、ドライバー自身の運転操作による駐車であっても、ドライバーが運転操作をしなくても駐車可能とする自動駐車であっても良い。ただし、検知精度が低い駐車空間に自動駐車をしたときには、実際の駐車空間の中心から偏った位置に駐車してしまう可能性があることを考えると、側方測距センサ21が後付けの場合には、後付けしてから最初の1回又は複数回(例えば5回程度)は、ドライバー自身の運転操作でバック駐車を行わせるのが好ましい。この場合、ドライバー自身の運転操作による駐車過程で、以降の処理により搭載位置SenPosIniが正しい位置になるように学習(補正)させられる。そして、その学習が終わった後の回から自動駐車に切り替えるようにする。ドライバー自身の運転操作でバック駐車を行わせる場合には、例えば、S18で後退フラグFlagParkを1に設定したときに、ECU11は、ドライバー自身の運転操作で駐車をするよう促す報知を行う。   Therefore, in the subsequent processing, processing (error correction or diagnosis detection) for eliminating the error of the mounting position of the side ranging sensor 21 (mounting position SenPosIni stored in the memory 111) grasped by the ECU 11 is performed. Yes. That is, if the reverse flag FlagPark is set to 1 in S18, the back parking operation to the detected parking spaces Side1, Side2 is started. The back parking at this time may be parking by the driver's own driving operation or may be automatic parking that allows the driver to park without performing the driving operation. However, when automatic parking is performed in a parking space with low detection accuracy, there is a possibility of parking at a position deviated from the center of the actual parking space. It is preferable that the back parking is performed by the driver's own driving operation for the first time or a plurality of times (for example, about 5 times) after the retrofitting. In this case, in the parking process by the driver's own driving operation, the mounting position SenPosIni is learned (corrected) by the subsequent processing so as to be the correct position. Then, the automatic parking is switched from the time after the learning is finished. In the case of performing the back parking by the driver's own driving operation, for example, when the reverse flag FlagPark is set to 1 in S18, the ECU 11 performs a notification for urging to park by the driver's own driving operation.

また、自動駐車を行う場合には、S18で後退フラグFlagParkを1に設定したときに、ECU11は、1次検知空間と車両5の位置関係に基づき、車両5が1次検知空間へ移動するための移動経路を算出する。そして、ECU11は、その移動経路にしたがって車両5が移動するように、車両5のステアリングアクチュエータを制御する。   When performing automatic parking, when the reverse flag FlagPark is set to 1 in S18, the ECU 11 moves to the primary detection space based on the positional relationship between the primary detection space and the vehicle 5. Is calculated. Then, the ECU 11 controls the steering actuator of the vehicle 5 so that the vehicle 5 moves according to the movement route.

ECU11は、駐車動作開始後も、S19の終了指示があるまでは(S19:No)、測距センサ2に距離検知を行わせ(S14)、センサ位置SenPosの算出を行う(S15)。先のS18で後退フラグFlagPark=1に設定されているので、S16では駐車動作中であると判断されて(S16:No)、S21に進む。S21では、駐車態様選択スイッチ14(図1参照)から入力される駐車態様が、縦列駐車か並列駐車かを判断する(S21)。なお、駐車態様選択スイッチ14をドライバーに操作させるタイミングは例えば図3の処理開始時とすれば良い。   Even after the parking operation is started, the ECU 11 causes the distance measuring sensor 2 to detect the distance (S14) and calculates the sensor position SenPos (S15) until an instruction to end S19 is received (S19: No). Since the reverse flag FlagPark = 1 is set in S18, it is determined that the parking operation is being performed in S16 (S16: No), and the process proceeds to S21. In S21, it is determined whether the parking mode input from the parking mode selection switch 14 (see FIG. 1) is parallel parking or parallel parking (S21). Note that the timing at which the driver operates the parking mode selection switch 14 may be, for example, at the start of the process in FIG.

縦列駐車の場合には(S21:Yes)、S22に進み、前部測距センサ22(図2参照)と後部測距センサ23(図2参照)とを用いて、車両5が駐車しようとしている駐車空間を検知する(S22)。ここで、図7は、図6の検知場面後の場面であり、駐車空間9への駐車動作時に前部測距センサ22及び後部測距センサ23を用いてその駐車空間9を検知する場面を示している。なお、図7において、図6と変更がない部分には同一符号を付している。図7を参照して、S22の処理を説明すると、S22では、後部測距センサ23を用いて1台目の駐車車両61のコーナー611の位置Park1(以下、駐車時1台目コーナーという)を検知する。具体的には、後部測距センサ23が検知した検知距離L(n)の履歴を用いて、駐車時1台目コーナーPark1を検知する。より具体的には、例えば、S17で1次検知空間を検知したときと同様に、後部測距センサ23が検知した検知距離L(n)の履歴と後部測距センサ23のセンサ位置SenPosの履歴とに基づき、三角測量の原理により(式1〜式6により)反射点を算出する。この反射点は、1台目の駐車車両61の前面、後面のうち駐車空間9側の面612に略一致した位置に検知される。そして、例えば、反射点の履歴のうち、X座標が最大となっている反射点のX座標を駐車時1台目コーナーPark1のX座標Park1Xとし、Y座標が最小となっている反射点のY座標を駐車時1台目コーナーPark1のY座標Park1Yとする。図7には、駐車時1台目コーナーPark1の点を符号312で図示している。   In the case of parallel parking (S21: Yes), the process proceeds to S22, and the vehicle 5 is about to park using the front ranging sensor 22 (see FIG. 2) and the rear ranging sensor 23 (see FIG. 2). A parking space is detected (S22). Here, FIG. 7 is a scene after the detection scene of FIG. 6, and a scene in which the parking space 9 is detected using the front distance measuring sensor 22 and the rear distance measuring sensor 23 during the parking operation in the parking space 9. Show. In FIG. 7, parts that are the same as those in FIG. 6 are given the same reference numerals. Referring to FIG. 7, the process of S <b> 22 will be described. In S <b> 22, the position Park <b> 1 of the corner 611 of the first parked vehicle 61 (hereinafter referred to as the first corner during parking) is determined using the rear distance measuring sensor 23. Detect. Specifically, the first corner Park1 during parking is detected using the history of the detection distance L (n) detected by the rear distance measuring sensor 23. More specifically, for example, the history of the detection distance L (n) detected by the rear ranging sensor 23 and the history of the sensor position SenPos of the rear ranging sensor 23 are the same as when the primary detection space is detected in S17. Based on the above, the reflection point is calculated according to the principle of triangulation (Equation 1 to Equation 6). This reflection point is detected at a position substantially coincident with the surface 612 on the parking space 9 side of the front and rear surfaces of the first parked vehicle 61. For example, in the history of reflection points, the X coordinate of the reflection point having the maximum X coordinate is set as the X coordinate Park1X of the first corner Park1 during parking, and the Y of the reflection point having the minimum Y coordinate. Let the coordinates be the Y coordinate Park1Y of the first corner Park1 during parking. In FIG. 7, a point of the first corner Park <b> 1 at the time of parking is illustrated by reference numeral 312.

前部測距センサ22を用いて2台目の駐車車両62のコーナー621の位置Park2(以下、駐車時2台目コーナーという)を検知する。具体的には、駐車時1台目コーナーPark1を検知したときと同様に、例えば、前部測距センサ22が検知した検知距離L(n)の履歴と前部測距センサ22のセンサ位置SenPosの履歴とに基づき、三角測量の原理により反射点を算出する。この反射点は、2台目の駐車車両62の前面、後面のうち駐車空間9側の面622に略一致した位置に検知される。そして、例えば、反射点の履歴のうち、X座標が最小となっている反射点のX座標を駐車時2台目コーナーPark2のX座標Park2Xとし、Y座標が最小となっている反射点のY座標を駐車時2台目コーナーPark2のY座標Park2Yとする。図7には、駐車時2台目コーナーPark2の点を符号322で図示している。   The front distance measuring sensor 22 is used to detect the position Park2 of the corner 621 of the second parked vehicle 62 (hereinafter referred to as the second corner when parked). Specifically, for example, the history of the detection distance L (n) detected by the front distance measuring sensor 22 and the sensor position SenPos of the front distance measuring sensor 22 are the same as when the first corner Park1 is detected during parking. Based on this history, the reflection point is calculated by the triangulation principle. This reflection point is detected at a position substantially coincident with the surface 622 on the parking space 9 side of the front and rear surfaces of the second parked vehicle 62. For example, in the history of reflection points, the X coordinate of the reflection point having the smallest X coordinate is set as the X coordinate Park2X of the second corner Park2 during parking, and the Y of the reflection point having the smallest Y coordinate. The coordinates are set as the Y coordinate Park2Y of the second corner Park2 at the time of parking. In FIG. 7, the point of the second corner Park <b> 2 at the time of parking is indicated by reference numeral 322.

なお、前部測距センサ22、後部測距センサ23の搭載位置SenPosIniに誤差があったとしても、X軸方向における反射点のオフセット量にはほとんど影響を与えない。よって、図7の駐車時1台目コーナー312は実際のコーナー611に近い位置に検知される。同様に、駐車時2台目コーナー322は実際のコーナー621に近い位置に検知される。   Note that even if there is an error in the mounting position SenPosIni of the front distance measuring sensor 22 and the rear distance measuring sensor 23, the offset amount of the reflection point in the X-axis direction is hardly affected. Therefore, the first corner 312 during parking in FIG. 7 is detected at a position close to the actual corner 611. Similarly, the second corner 322 is detected at a position close to the actual corner 621 during parking.

S22では、検知した駐車時1台目コーナーPark1と駐車時2台目コーナーPark2の間の空間(以下、2次検知空間という)を駐車空間として検知する。図7の例では、駐車時1台目コーナー312と駐車時2台目コーナー322の間の空間92が2次検知空間として検知される。その2次検知空間92は実際の駐車空間9に近い位置に検知される。   In S22, the detected space between the first parking corner Park1 and the second parking parking corner Park2 (hereinafter referred to as secondary detection space) is detected as a parking space. In the example of FIG. 7, a space 92 between the first vehicle corner 312 during parking and the second vehicle corner 322 during parking is detected as a secondary detection space. The secondary detection space 92 is detected at a position close to the actual parking space 9.

一方、S21において、並列駐車の場合には(S21:No)、S23に進む。S23では、左右の側方測距センサ21L、21Rの両方を用いて、車両が駐車しようとする駐車空間を検知する(S23)。ここで、図9は、図8の検知場面後の場面であり、駐車空間9への駐車動作時に左右の側方測距センサ21L、21Rの両方を用いてその駐車空間9を検知する場面を示している。なお、図9において、図8と変更がない部分には同一符号を付している。図9を参照してS23の処理を説明すると、S23では、右側方測距センサ21Rを用いて駐車時1台目コーナーPark1を検知する。具体的には、S17、S22と同様に、右側方測距センサ21Rが検知した検知距離L(n)の履歴と、右側方測距センサ21Rのセンサ位置SenPosの履歴とに基づき、三角測量の原理により(式1〜式6により)反射点を算出する。この反射点は、1台目の駐車車両61の駐車空間9側の側面613に略一致した位置に検知される。この反射点の履歴に基づき駐車時1台目コーナーPark1を検知する。具体的には、例えばS22と同様にして駐車時1台目コーナーPark1を検知しても良いし、反射点の履歴から駐車車両61の向き(側面613の向き)が分かるので、その向きに応じて、S17で検知した通過時1台目コーナー311や1次検知空間91(図8参照)の向きを補正するようにしても良い。通過時1台目コーナーを補正する場合、補正後の通過時1台目コーナーが駐車時1台目コーナーPark1となる。図9には、駐車時1台目コーナーPark1の点を符号312で図示している。   On the other hand, in S21, in the case of parallel parking (S21: No), it progresses to S23. In S23, the parking space where the vehicle is to park is detected using both the left and right side distance measuring sensors 21L and 21R (S23). Here, FIG. 9 is a scene after the detection scene of FIG. 8, and a scene in which the parking space 9 is detected using both the left and right side distance measuring sensors 21 </ b> L and 21 </ b> R during the parking operation in the parking space 9. Show. In FIG. 9, parts that are the same as those in FIG. The process of S23 will be described with reference to FIG. 9. In S23, the first corner Park1 during parking is detected using the right side distance measuring sensor 21R. Specifically, similarly to S17 and S22, based on the history of the detection distance L (n) detected by the right side distance measuring sensor 21R and the history of the sensor position SenPos of the right side distance measuring sensor 21R, triangulation The reflection point is calculated according to the principle (Equation 1 to Equation 6). This reflection point is detected at a position substantially coincident with the side surface 613 of the first parking vehicle 61 on the parking space 9 side. Based on the history of the reflection points, the first corner Park1 during parking is detected. Specifically, for example, the first vehicle corner Park1 may be detected in the same manner as in S22, and the direction of the parked vehicle 61 (direction of the side surface 613) can be known from the history of reflection points. Thus, the orientation of the first corner 311 during passage and the primary detection space 91 (see FIG. 8) detected in S17 may be corrected. When the first vehicle corner is corrected when passing, the corrected first vehicle corner becomes the first vehicle corner Park1 during parking. In FIG. 9, the point of the first corner Park <b> 1 at the time of parking is indicated by reference numeral 312.

S23では、左側方測距センサ21Lを用いて駐車時2台目コーナーPark2を検知する。その検知方法は、駐車時1台目コーナーPark1の検知方法と同じである。図9には、駐車時2台目コーナーPark2の点を符号322で図示している。   In S23, the second corner Park2 at the time of parking is detected using the left side distance measuring sensor 21L. The detection method is the same as the detection method of the first corner Park1 during parking. In FIG. 9, the point of the second corner Park <b> 2 at the time of parking is indicated by reference numeral 322.

なお、側方測距センサ21の搭載位置SenPosIniに誤差があったとしても、駐車動作時の検知場面でのその誤差の影響は、側方通過時の検知場面に比べて小さい。図10、図11はそのことを説明するための図であり、図10は図9と同様の図であり、図11は、図10のA部の拡大図である。図10の時点で左側方測距センサ21Lが検知した検知距離をLとすると、図10には、左側方測距センサ21Lから左側方測距センサ21Lの正面方向に検知距離Lだけ離れた測距点81と、ECU11が把握する左側方測距センサ21L’から左側方測距センサ21L’の正面方向に検知距離Lだけ離れた測距点82とを図示している。測距点81は実際の測距点とされ、測距点82はECU11が把握する測距点とされる。左側方測距センサ21L’の誤差(左側方測距センサ21L’の搭載位置と実際の搭載位置との差)をd、車両5の駐車空間9に対する傾きをαとする。このとき、図11に示すように、実際の測距点81に対する測距点82のX軸方向の誤差Δxは、Δx=d×sinαで求まる。車両5が側方通過時では、傾きα=90°(車両5の移動方向に対して、駐車車両61、62(駐車空間9)が傾いていない場合)となるので、Δx=dとなる。つまり、側方通過時では、左側方測距センサ21L’の誤差dがそのまま測距点のX軸方向の誤差Δxとなるので、その測距点の履歴(検知距離の履歴)に基づき算出される反射点やコーナーの検知精度は低くなる。   Even if there is an error in the mounting position SenPosIni of the side ranging sensor 21, the influence of the error in the detection scene at the time of the parking operation is smaller than that in the detection scene at the side passage. 10 and 11 are diagrams for explaining this, FIG. 10 is a view similar to FIG. 9, and FIG. 11 is an enlarged view of a portion A in FIG. If the detection distance detected by the left side distance measuring sensor 21L at the time of FIG. 10 is L, FIG. 10 shows a measurement distance from the left side distance measuring sensor 21L by the detection distance L in the front direction of the left side distance measuring sensor 21L. A distance point 81 and a distance measurement point 82 separated from the left side distance measurement sensor 21L ′ grasped by the ECU 11 by a detection distance L in the front direction of the left side distance measurement sensor 21L ′ are illustrated. The distance measuring point 81 is an actual distance measuring point, and the distance measuring point 82 is a distance measuring point grasped by the ECU 11. An error of the left side distance measuring sensor 21L '(a difference between the mounting position of the left side distance measuring sensor 21L' and the actual mounting position) is d, and the inclination of the vehicle 5 with respect to the parking space 9 is α. At this time, as shown in FIG. 11, the error Δx in the X-axis direction of the distance measuring point 82 with respect to the actual distance measuring point 81 is obtained by Δx = d × sin α. When the vehicle 5 passes by the side, the inclination α = 90 ° (when the parked vehicles 61 and 62 (parking space 9) are not inclined with respect to the moving direction of the vehicle 5), and therefore Δx = d. That is, at the time of passing through the side, the error d of the left-side distance measuring sensor 21L ′ becomes the error Δx in the X-axis direction of the distance measuring point as it is, and is calculated based on the history of the distance measuring point (detected distance history). The accuracy of detecting reflection points and corners is low.

これに対し、駐車完了時では、傾きα=0°となるので、Δx=0となる。つまり、駐車完了時では、左側方測距センサ21L’に誤差dがあったとしても、その誤差dは、測距点のX軸方向の誤差Δxに影響を与えない。また、駐車動作時では、傾きαは0°<α<90°の範囲内の値となるので、誤差Δxは、0<Δx<dの範囲内の値となる。このように、駐車動作時に算出される反射点(測距点)は、側方通過時に比べて精度が高い(特にX座標の精度が高い)ので、その反射点に基づき検知されたコーナーの検知精度は高い。よって、図9の駐車時1台目コーナー312は実際のコーナー611に近い位置に検知される。同様に、駐車時2台目コーナー322は実際のコーナー621に近い位置に検知される。   On the other hand, when the parking is completed, the inclination α = 0 °, so Δx = 0. That is, even when there is an error d in the left-side distance measuring sensor 21L 'when parking is completed, the error d does not affect the error Δx in the X-axis direction of the distance measuring point. In the parking operation, the inclination α is a value in the range of 0 ° <α <90 °, and the error Δx is a value in the range of 0 <Δx <d. As described above, the reflection point (ranging point) calculated during the parking operation has higher accuracy (particularly the accuracy of the X-coordinate is higher) than when passing through the side, so that the corner detected based on the reflection point is detected. The accuracy is high. 9 is detected at a position close to the actual corner 611 during parking. Similarly, the second corner 322 is detected at a position close to the actual corner 621 during parking.

S23では、検知した駐車時1台目コーナーPark1と駐車時2台目コーナーPark2の間の空間を2次検知空間として検知する。図9の例では、駐車時1台目コーナー312と駐車時2台目コーナー322の間の空間92が2次検知空間として検知される。その2次検知空間92は実際の駐車空間9に近い位置に検知される。   In S23, the detected space between the first parking corner Park1 and the second parking parking corner Park2 is detected as a secondary detection space. In the example of FIG. 9, a space 92 between the first vehicle corner 312 during parking and the second vehicle corner 322 during parking is detected as a secondary detection space. The secondary detection space 92 is detected at a position close to the actual parking space 9.

なお、S19で終了指示があるまでは(S19:No)、S22の処理又はS23の処理は繰り返し実行される。このとき、駐車動作の開始直後では、検知距離の履歴が少ないなどの理由で2次検知空間Park1、Park2を検知できなかったとしても、駐車動作を進めるうちに検知距離の履歴が蓄積されていくので、駐車完了時には2次検知空間を検知できる。   Note that the process of S22 or S23 is repeatedly executed until an end instruction is issued in S19 (S19: No). At this time, immediately after the start of the parking operation, even if the secondary detection spaces Park1 and Park2 cannot be detected because the history of the detection distance is small, the history of the detection distance is accumulated as the parking operation proceeds. Therefore, the secondary detection space can be detected when parking is completed.

S19において、終了指示があった場合(駐車が完了した場合など)には(S19:Yes)、S24に進む。S24では、S12と同様に、Modeの値が1か否かを判断する。Mode=1の場合、つまり側方測距センサ21が後付けの場合には(S24:Yes)、S25に進む。S25では、1次検知空間Side1、Side2と2次検知空間Park1、Park2とに基づき、側方測距センサ21の搭載位置SenPosIniを補正する補正処理を実行する。   In S19, when there is an end instruction (such as when parking is completed) (S19: Yes), the process proceeds to S24. In S24, as in S12, it is determined whether the value of Mode is 1. If Mode = 1, that is, if the side ranging sensor 21 is retrofitted (S24: Yes), the process proceeds to S25. In S25, based on the primary detection spaces Side1 and Side2 and the secondary detection spaces Park1 and Park2, a correction process for correcting the mounting position SenPosIni of the side ranging sensor 21 is executed.

一方、S24において、Mode≠1の場合、つまり側方測距センサ21が純正の場合には(S24:No)、S26に進む。S26では、1次検知空間Side1、Side2と2次検知空間Park1、Park2とに基づき、側方測距センサ21のダイアグ検出のための警告フラグFlagCheckの設定処理を実行する。   On the other hand, if Mode ≠ 1 in S24, that is, if the lateral distance measuring sensor 21 is genuine (S24: No), the process proceeds to S26. In S26, based on the primary detection spaces Side1 and Side2 and the secondary detection spaces Park1 and Park2, a setting process of a warning flag FlagCheck for diagnostic detection of the side ranging sensor 21 is executed.

図12は、S25及びS26の詳細のフローチャートを示している。図12の処理に移行すると、先ず、通過時1台目コーナーSide1のX座標Side1Xと駐車時1台目コーナーPark1のX座標Park1Xの差分(Side1X−Park1X)を、1台目オフセット量Offset1として算出する(S31)。同様に、通過時2台目コーナーSide2のX座標Side2Xと駐車時2台目コーナーPark2のX座標Park2Xの差分(Side2X−Park2X)を、2台目オフセット量Offset2として算出する(S32)。図7、図9の例では、通過時1台目コーナー311のX座標と、駐車時1台目コーナー312のX座標の差分が1台目オフセット量Offset1として算出され、通過時2台目コーナー321のX座標と駐車時2台目コーナー322のX座標の差分が2台目オフセット量Offset2として算出される。   FIG. 12 shows a detailed flowchart of S25 and S26. When the process proceeds to FIG. 12, first, the difference (Side1X−Park1X) between the X coordinate Side1X of the first vehicle corner Side1 during passage and the X coordinate Park1X of the first vehicle corner Park1 during parking is calculated as the first vehicle offset amount Offset1. (S31). Similarly, the difference (Side2X−Park2X) between the X coordinate Side2X of the second vehicle corner Side2 during passage and the X coordinate Park2X of the second vehicle corner Park2 during parking is calculated as the second vehicle offset amount Offset2 (S32). 7 and 9, the difference between the X coordinate of the first vehicle corner 311 when passing and the X coordinate of the first vehicle corner 312 when parking is calculated as the first vehicle offset amount Offset1, and the second vehicle corner when passing. The difference between the X coordinate of 321 and the X coordinate of the second vehicle corner 322 during parking is calculated as the second vehicle offset amount Offset2.

次に、搭載位置SenPosIniの補正方法を特定するパラメータMethodの値を確認する(S32)。本実施形態では、その補正方法として3つの実施例を用意しており、第1の実施例に係る補正方法をMethod=1、第2の実施例に係る補正方法をMethod=2、第3の実施例に係る補正方法をMethod=3としている。どの実施例の補正方法が実施されるか、つまりMethodの値はROM等に予め設定されている。   Next, the value of the parameter Method specifying the correction method for the mounting position SenPosIni is confirmed (S32). In this embodiment, three examples are prepared as the correction method. The correction method according to the first example is Method = 1, the correction method according to the second example is Method = 2, and the third method is used. The correction method according to the embodiment is Method = 3. The correction method of which embodiment is executed, that is, the value of Method is preset in the ROM or the like.

(実施例1:Method=1)
S32においてMethod=1の場合には、S34に進む。S34では、1台目オフセット量Offset1と2台目オフセット量Offset2の平均値を、1次検知空間Side1、Side2と2次検知空間Park1、Park2のオフセット量Offsetとして算出する(S34)。これにより、オフセット量Offsetとして、1台目オフセット量Offset1(1台目の駐車車両61の検知結果)と2台目オフセット量Offset2(2台目の駐車車両62の検知結果)の両方を反映した値を得ることができる。このオフセット量Offsetは、搭載位置SenPosIniの誤差に相当する。
(Example 1: Method = 1)
If Method = 1 in S32, the process proceeds to S34. In S34, the average value of the first unit offset amount Offset1 and the second unit offset amount Offset2 is calculated as the offset amount Offset of the primary detection spaces Side1, Side2, and the secondary detection spaces Park1, Park2 (S34). Thereby, both the first offset amount Offset1 (detection result of the first parked vehicle 61) and the second offset amount Offset2 (detection result of the second parked vehicle 62) are reflected as the offset amount Offset. A value can be obtained. This offset amount Offset corresponds to an error of the mounting position SenPosIni.

次に、オフセット量Offsetが予め定められた閾値th2より大きいか否かを判断する。小さい場合は(S35:No)、S42に進み、Method=3か否かを判断する。Method=1の場合には(S42:No)、図12のフローチャートの処理を終了する。このように、Method=1で、オフセット量Offsetが閾値th2より小さい場合には、現在の搭載位置SenPosIniの精度が高いとして、搭載位置SenPosIniの補正や、ダイアグ検出の警告(FlagCheck=1)は行われない。   Next, it is determined whether or not the offset amount Offset is larger than a predetermined threshold th2. If it is smaller (S35: No), the process proceeds to S42 to determine whether Method = 3. If Method = 1 (S42: No), the process of the flowchart of FIG. 12 is terminated. As described above, when Method = 1 and the offset amount Offset is smaller than the threshold value th2, it is determined that the accuracy of the current mounting position SenPosIni is high, and the mounting position SenPosIni is corrected and a warning for diagnosis detection (FlagCheck = 1) is performed. I will not.

S35において、オフセット量Offsetが閾値th2より大きい場合には(S35:Yes)、S36に進み、Method=3か否かを判断する。Method=1の場合には(S36:No)、S39に進み、Mode=1か否かを判断する。Mode=1の場合、つまり側方測距センサ21が後付けの場合には(S39:Yes)、S40に進み、搭載位置SenPosIniの補正を行う。具体的には、現在の搭載位置SenPosIniのX座標SenPosIniXからオフセット量Offsetを差し引いた値(SenPosIniX−Offset)を新たな搭載位置SenPosIniのX座標SenPosIniXとする。これにより、搭載位置SenPosIniを実際の搭載位置に近づけることができる(搭載位置SenPosIniの誤差を解消できる)。S40の後、図12のフローチャートの処理を終了する。   In S35, when the offset amount Offset is larger than the threshold th2 (S35: Yes), the process proceeds to S36, and it is determined whether Method = 3. In the case of Method = 1 (S36: No), the process proceeds to S39, and it is determined whether Mode = 1. When Mode = 1, that is, when the lateral distance measuring sensor 21 is retrofitted (S39: Yes), the process proceeds to S40, and the mounting position SenPosIni is corrected. Specifically, a value obtained by subtracting the offset amount Offset from the X coordinate SenPosIniX of the current mounting position SenPosIni (SenPosIniX-Offset) is set as the X coordinate SenPosIniX of the new mounting position SenPosIni. As a result, the mounting position SenPosIni can be brought closer to the actual mounting position (the error of the mounting position SenPosIni can be eliminated). After S40, the process of the flowchart of FIG.

S39において、Mode≠1の場合、つまり側方測距センサ21が純正の場合には(S39:No)、S41に進み、警告フラグFlagCheckを1に設定する。警告フラグFlagCheck=1に設定されることで、後述する図3のS28で警告が行われる。S41の後、図12のフローチャートの処理を終了する。   In S39, if Mode ≠ 1, that is, if the side distance measuring sensor 21 is genuine (S39: No), the process proceeds to S41, and the warning flag FlagCheck is set to 1. By setting the warning flag FlagCheck = 1, a warning is issued in S28 of FIG. 3 to be described later. After S41, the process of the flowchart of FIG.

このように、Method=1の場合には、オフセット量Offsetが閾値th2より大きいか否かで、搭載位置の補正や警告を行うか否かが決まるので、後述するMethod=2、3の場合に比べて、処理を簡素にできる。   Thus, in the case of Method = 1, whether or not the mounting position is corrected or warned is determined depending on whether or not the offset amount Offset is larger than the threshold value th2. Therefore, in the case of Method = 2 and 3, which will be described later. Compared with this, processing can be simplified.

(実施例2:Method=2)
S32において、Method=2の場合にはS33に進む。S33では、1台目オフセット量Offset1と2台目オフセット量Offset2の差分の絶対値が、予め定められた閾値th1より小さいか否かを判断する(S33)。ここで、S33の処理の趣旨を説明する。測距センサ2が検知する検知距離の精度が高い場合には、1台目オフセット量Offset1と2台目オフセット量Offset2は同等の値になる。つまり、絶対値|Offset1−Offset2|が閾値th1より小さくなる。これに対し、絶対値|Offset1−Offset2|が閾値th1より大きい場合には、低精度の検知距離から1台目オフセット量Offset1や2台目オフセット量Offset2が算出された可能性がある。この場合には、搭載位置SenPosIniの誤差を正確に評価できなくなってしまう。
(Example 2: Method = 2)
In S32, if Method = 2, the process proceeds to S33. In S33, it is determined whether or not the absolute value of the difference between the first unit offset amount Offset1 and the second unit offset amount Offset2 is smaller than a predetermined threshold th1 (S33). Here, the purpose of the process of S33 will be described. When the accuracy of the detection distance detected by the distance measuring sensor 2 is high, the first unit offset amount Offset1 and the second unit offset amount Offset2 are equivalent values. That is, the absolute value | Offset1-Offset2 | is smaller than the threshold value th1. On the other hand, when the absolute value | Offset1-Offset2 | is larger than the threshold th1, the first offset amount Offset1 and the second offset amount Offset2 may be calculated from the low-precision detection distance. In this case, the error of the mounting position SenPosIni cannot be accurately evaluated.

そこで、絶対値|Offset1−Offset2|が閾値th1より大きい場合には(S33:No)、S42に進み、Method=3か否かを判断する。Method=2の場合には(S42:No)、図12のフローチャートの処理を終了する。このように、Method=2で、絶対値|Offset1−Offset2|が閾値th1より大きい場合には、搭載位置SenPosIniの補正や、ダイアグ検出の警告(FlagCheck=1)は行われない。これにより、搭載位置SenPosIniの誤差を正確に評価できないときに、搭載位置SenPosIniに対する補正や警告を行ってしまうのを防止できる。   Therefore, when the absolute value | Offset1-Offset2 | is larger than the threshold th1 (S33: No), the process proceeds to S42, and it is determined whether Method = 3. If Method = 2 (S42: No), the process of the flowchart of FIG. 12 is terminated. As described above, when Method = 2 and the absolute value | Offset1-Offset2 | is larger than the threshold value th1, the correction of the mounting position SenPosIni and the warning of the diagnosis detection (FlagCheck = 1) are not performed. Thereby, when the error of the mounting position SenPosIni cannot be accurately evaluated, it is possible to prevent the mounting position SenPosIni from being corrected or warned.

S33において、絶対値|Offset1−Offset2|が閾値th1より小さい場合には、S33に進む。以降の処理は上述の実施例1(Method=1)と同じである。   If the absolute value | Offset1-Offset2 | is smaller than the threshold value th1 in S33, the process proceeds to S33. The subsequent processing is the same as in the first embodiment (Method = 1).

(実施例3:Method=3)
S32において、Method=3の場合には、S33に進み、実施例2で説明したように絶対値|Offset1−Offset2|が閾値th1より小さいか否かを判断する。絶対値|Offset1−Offset2|が閾値th1より大きい場合には(S34:No)、S42に進み、Method=3か否かを判断する。Method=3の場合には(S42:Yes)、S43に進み、S34で算出するオフセット量OffsetがS35の閾値th2を超えた回数(以下、閾値超回数という)を示したパラメータFlagCheckNumをゼロに設定する。その後、図12のフローチャートの処理を終了する。このように、Method=3で、絶対値|Offset1−Offset2|が閾値th1より大きい場合には、搭載位置SenPosIniの補正や、ダイアグ検出の警告(FlagCheck=1)は行われない。これにより、搭載位置SenPosIniの誤差を正確に評価できないときに、搭載位置SenPosIniの補正や警告を行ってしまうのを防止できる。
(Example 3: Method = 3)
If Method = 3 in S32, the process proceeds to S33, and it is determined whether or not the absolute value | Offset1-Offset2 | is smaller than the threshold th1 as described in the second embodiment. If the absolute value | Offset1-Offset2 | is larger than the threshold th1 (S34: No), the process proceeds to S42, and it is determined whether Method = 3. If Method = 3 (S42: Yes), the process proceeds to S43, and the parameter FlagCheckNum indicating the number of times that the offset amount Offset calculated in S34 exceeds the threshold th2 in S35 (hereinafter referred to as the superthreshold number) is set to zero. To do. Then, the process of the flowchart of FIG. As described above, when Method = 3 and the absolute value | Offset1-Offset2 | is larger than the threshold value th1, the correction of the mounting position SenPosIni and the warning of diagnosis detection (FlagCheck = 1) are not performed. Thereby, when the error of the mounting position SenPosIni cannot be accurately evaluated, it is possible to prevent the mounting position SenPosIni from being corrected or warned.

S33において、絶対値|Offset1−Offset2|が閾値th1より小さい場合には(S33:Yes)、S34に進む。そして、1台目オフセット量Offset1と2台目オフセット量Offset2の平均値をオフセット量Offsetとして算出する(S34)。次に、そのオフセット量Offsetが閾値th2より大きいか否かを判断する(S35)。小さい場合には(S35:No)、S42を経て、S43に進み、閾値超回数FlagCheckNumをゼロに設定する。   If the absolute value | Offset1-Offset2 | is smaller than the threshold th1 in S33 (S33: Yes), the process proceeds to S34. Then, an average value of the first unit offset amount Offset1 and the second unit offset amount Offset2 is calculated as the offset amount Offset (S34). Next, it is determined whether or not the offset amount Offset is larger than the threshold value th2 (S35). If it is smaller (S35: No), the process proceeds to S43 via S42, and the threshold value overthrow FlagCheckNum is set to zero.

S35において、オフセット量Offsetが閾値th2より大きい場合には(S35:Yes)、S36に進み、Method=3か否かを判断する。Method=3の場合には(S36:Yes)、S37に進み、閾値超回数FlagCheckNumに「1」を加算して、閾値超回数FlagCheckNumを更新する(FlagCheckNum=FlagCheckNum+1)。次に、閾値超回数FlagCheckNumが所定回数以上か否かを判断する(S38)。所定回数未満の場合には(S38:No)、図12のフローチャートの処理を終了する。   In S35, when the offset amount Offset is larger than the threshold th2 (S35: Yes), the process proceeds to S36, and it is determined whether Method = 3. In the case of Method = 3 (S36: Yes), the process proceeds to S37, and “1” is added to the threshold number of times FlagCheckNum, and the flag number of times FlagCheckNum is updated (FlagCheckNum = FlagCheckNum + 1). Next, it is determined whether or not the threshold number of times FlagCheckNum is equal to or greater than a predetermined number (S38). When the number is less than the predetermined number (S38: No), the process of the flowchart of FIG.

閾値超回数FlagCheckNumが所定回数以上の場合には(S38:Yes)、S39に進み、Mode=1か否かを判断する。Mode=1の場合には(S39:Yes)、S40に進み、搭載位置SenPosIniの補正を行う(SenPosInix=SenPosInix−Offset)。Mode≠1の場合には(S39:No)、S41に進み、警告フラグFlagCheckを1に設定する。   If the threshold value excess number FlagCheckNum is equal to or greater than the predetermined number (S38: Yes), the process proceeds to S39, and it is determined whether Mode = 1. When Mode = 1 (S39: Yes), the process proceeds to S40, and the mounting position SenPosIni is corrected (SenPosInix = SenPosInix-Offset). If Mode ≠ 1 (S39: No), the process proceeds to S41, and the warning flag FlagCheck is set to 1.

このように、実施例3では、所定回数以上、連続して、オフセット量Offsetが閾値th2を超えた場合に(FlagCheckNum≧所定回数)、搭載位置SenPosIniの補正や警告が行われる。別の言い方をすると、所定回数に達するまでに、閾値th2より小さいオフセット量Offsetが検知された場合には、搭載位置SenPosIniの補正や警告が行われない。これにより、搭載位置SenPosIniに誤差が生じているという状態を正確に判断でき、搭載位置SenPosIniの補正や警告を正確に行うことができる。   As described above, in the third embodiment, when the offset amount Offset exceeds the threshold th2 continuously for a predetermined number of times (FlagCheckNum ≧ predetermined number), the mounting position SenPosIni is corrected or warned. In other words, when the offset amount Offset smaller than the threshold th2 is detected before the predetermined number of times is reached, the mounting position SenPosIni is not corrected or warned. As a result, it is possible to accurately determine that there is an error in the mounting position SenPosIni, and it is possible to accurately correct and warn the mounting position SenPosIni.

図3の説明に戻り、S25又はS26の処理が終わると、S27に進み、警告フラグFlagCheck=1か否かを判断する。警告フラグFlagCheck=0の場合には(S27:No)、図3のフローチャートの処理を終了する。この場合には、純正の側方測距センサ21に位置ズレが生じていないとして、側方測距センサ21の搭載状態に対する警告は行われない。これに対し、警告フラグFlagCheck=1の場合には(S27:Yes)、S28に進み、純正の側方測距センサ21に位置ズレが生じているとして、警告部15(図1参照)に、側方測距センサ21の搭載状態に対する警告を行わせる。警告部15は、例えば、側方測距センサ21の搭載状態に異常が生じていることを音声や表示でドライバーに警告する。これにより、ディーラー等で側方測距センサ21の搭載状態を修理点検することで、搭載位置SenPosIniの誤差を解消できる。S28の後、図3のフローチャートの処理を終了する。   Returning to the description of FIG. 3, when the processing of S25 or S26 ends, the process proceeds to S27 to determine whether or not the warning flag FlagCheck = 1. If the warning flag FlagCheck = 0 (S27: No), the processing of the flowchart of FIG. 3 is terminated. In this case, no warning is given to the mounted state of the side distance measuring sensor 21 on the assumption that the genuine side distance measuring sensor 21 is not misaligned. On the other hand, when the warning flag FlagCheck = 1 (S27: Yes), the process proceeds to S28, and the warning unit 15 (see FIG. 1) assumes that there is a positional deviation in the genuine lateral distance measuring sensor 21. A warning is given to the mounting state of the lateral distance measuring sensor 21. For example, the warning unit 15 warns the driver by voice or display that an abnormality has occurred in the mounting state of the lateral distance measuring sensor 21. Thereby, the error of the mounting position SenPosIni can be eliminated by repairing and inspecting the mounting state of the side ranging sensor 21 at a dealer or the like. After S28, the process of the flowchart of FIG.

以上説明したように、本実施形態によれば、1次検知空間と2次検知空間の差異(オフセット量Offset)が大きいときには、測距センサの搭載位置に対する補正や警告を行っているので、搭載位置の誤差を解消できる。その結果、1次検知空間の検知精度を向上できる。   As described above, according to the present embodiment, when the difference between the primary detection space and the secondary detection space (offset amount Offset) is large, correction and warning are performed for the mounting position of the distance measuring sensor. The position error can be eliminated. As a result, the detection accuracy of the primary detection space can be improved.

なお、本発明に係る駐車空間検知装置は上記実施形態に限定されるものではなく、特許請求の範囲の記載を逸脱しない限度で種々の変更が可能である。例えば、図12のS34では1台目オフセット量Offset1と2台目オフセット量Offset2の平均値をオフセット量Offsetとしていたが、1台目オフセット量Offset1と2台目オフセット量Offset2のどちらか一方をオフセット量Offsetとして用いても良い。これにより、オフセット量Offsetを求めるときの計算量を低減できる。   In addition, the parking space detection apparatus which concerns on this invention is not limited to the said embodiment, A various change is possible in the limit which does not deviate from description of a claim. For example, in S34 of FIG. 12, the average value of the first unit offset amount Offset1 and the second unit offset amount Offset2 is set as the offset amount Offset, but either the first unit offset amount Offset1 or the second unit offset amount Offset2 is offset. It may be used as a quantity Offset. Thereby, the calculation amount when calculating | requiring offset amount Offset can be reduced.

また、図12のMethod=3の場合には、所定回数以上、連続して、オフセット量Offsetが閾値th2を超えた場合に搭載位置に対する補正や警告を行っていたが、「連続して」の要件を外しても良い。これによって、搭載位置に対する補正や警告の正確性をある程度維持しつつ、それら補正、警告を行いやすくできる。   In the case of Method = 3 in FIG. 12, correction and warning for the mounting position are performed when the offset amount Offset exceeds the threshold th2 continuously for a predetermined number of times or more. You may remove the requirement. Accordingly, it is possible to easily perform the correction and warning while maintaining the accuracy of the correction and warning for the mounting position to some extent.

1 駐車支援装置
2 測距センサ
5 車両
6、61、62 駐車車両
11 ECU
111 メモリ
12 車速センサ
13 操舵角センサ
15 警告部
91 1次検知空間
92 2次検知空間
DESCRIPTION OF SYMBOLS 1 Parking assistance apparatus 2 Distance sensor 5 Vehicle 6, 61, 62 Parked vehicle 11 ECU
111 Memory 12 Vehicle speed sensor 13 Steering angle sensor 15 Warning section 91 Primary detection space 92 Secondary detection space

Claims (15)

車両(5)の周囲に存在する駐車車両(6、61、62)までの距離を逐次検知する距離検知手段(2、21〜23)と、
前記距離検知手段の前記車両における搭載位置を記憶する記憶手段(111)と、
前記車両の移動状態を検知する移動状態検知手段(12、13)と、
前記搭載位置と前記車両の移動状態とに基づいて前記駐車車両の距離検知を行うときの前記距離検知手段の位置であるセンサ位置を算出する位置算出手段(S15)と、
前記距離検知手段が検知した距離である検知距離と前記センサ位置とに基づいて、前記駐車車両の側方通過時に前記駐車車両に隣接した駐車空間(9)を検知する第1の空間検知手段(S17)と、
前記駐車空間に対する駐車動作時に前記駐車空間を検知する第2の空間検知手段(S22、S23)と、
前記第1の空間検知手段が検知した駐車空間である1次検知空間(91)と、前記第2の空間検知手段が検知した駐車空間である2次検知空間(92)の差異を算出する差異算出手段(S31、S34)と、
前記差異に相当する前記搭載位置の誤差に対する対策処理を実行する対策実行手段(S40、S41、S28、15)と、
を備えることを特徴とする駐車空間検知装置(1)。
Distance detecting means (2, 21-23) for sequentially detecting the distance to the parked vehicles (6, 61, 62) existing around the vehicle (5);
Storage means (111) for storing the mounting position of the distance detection means in the vehicle;
A moving state detecting means (12, 13) for detecting the moving state of the vehicle;
Position calculating means (S15) for calculating a sensor position which is the position of the distance detecting means when detecting the distance of the parked vehicle based on the mounting position and the moving state of the vehicle;
First space detecting means (9) for detecting a parking space (9) adjacent to the parked vehicle when the parked vehicle passes laterally based on a detected distance that is a distance detected by the distance detecting means and the sensor position. S17)
Second space detection means (S22, S23) for detecting the parking space during a parking operation with respect to the parking space;
The difference which calculates the difference of the primary detection space (91) which is the parking space which the said 1st space detection means detected, and the secondary detection space (92) which is the parking space which the said 2nd space detection means detected Calculating means (S31, S34);
Countermeasure execution means (S40, S41, S28, 15) for executing countermeasure processing for an error in the mounting position corresponding to the difference;
A parking space detecting device (1) comprising:
前記対策実行手段は、前記対策処理として前記差異の分だけ前記搭載位置を補正する補正手段(S40)であることを特徴とする請求項1に記載の駐車空間検知装置。   The parking space detection device according to claim 1, wherein the countermeasure execution means is correction means (S40) that corrects the mounting position by the difference as the countermeasure processing. 前記対策実行手段は、前記距離検知手段の搭載状態に対して警告を発する警告手段(S41、S28、15)であることを特徴とする請求項1に記載の駐車空間検知装置。   The parking space detection device according to claim 1, wherein the countermeasure execution means is a warning means (S41, S28, 15) that issues a warning with respect to a mounted state of the distance detection means. 前記距離検知手段は、前記車両の側面に搭載されて前記車両の側方に存在する障害物までの距離を検知する側方距離検知手段(21)を含み、
前記第1の空間検知手段は、前記側方距離検知手段を用いて前記1次検知空間を検知し、
前記対策実行手段は、前記側方距離検知手段に対する前記対策処理を実行することを特徴とする請求項1〜3のいずれか1項に記載の駐車空間検知装置。
The distance detection means includes a side distance detection means (21) that is mounted on a side surface of the vehicle and detects a distance to an obstacle present on a side of the vehicle.
The first space detection means detects the primary detection space using the side distance detection means,
The parking space detection device according to any one of claims 1 to 3, wherein the countermeasure execution unit executes the countermeasure process for the lateral distance detection unit.
縦列駐車と並列駐車のどちらを行うかを判断する駐車態様判断手段(S21、14)を備え、
前記距離検知手段は、前記車両の前後に搭載されて前記車両の前方に存在する障害物及び後方に存在する障害物までの距離を検知する前後距離検知手段(22、23)を含み、
前記第2の空間検知手段(S22)は、前記駐車態様判断手段が縦列駐車を行うと判断した場合には、前記前後距離検知手段を用いて前記2次検知空間を検知することを特徴とする請求項4に記載の駐車空間検知装置。
Parking mode determination means (S21, 14) for determining whether to perform parallel parking or parallel parking,
The distance detection means includes front and rear distance detection means (22, 23) that are mounted in front of and behind the vehicle and detect a distance to an obstacle existing in front of the vehicle and an obstacle existing behind.
The second space detection means (S22) detects the secondary detection space using the front-rear distance detection means when the parking mode determination means determines to perform parallel parking. The parking space detection device according to claim 4.
前記側方距離検知手段は、前記車両の左右側面のそれぞれに搭載されており、
前記第2の空間検知手段(S23)は、前記駐車態様判断手段が並列駐車を行うと判断した場合には、前記車両の左側面に搭載された前記側方距離検知手段(21L)と、前記車両の右側面に搭載された前記側方距離検知手段(21R)の両方を用いて前記2次検知空間を検知することを特徴とする請求項3に記載の駐車空間検知装置。
The lateral distance detection means is mounted on each of the left and right side surfaces of the vehicle,
When the second space detection means (S23) determines that the parking mode determination means performs parallel parking, the side distance detection means (21L) mounted on the left side surface of the vehicle; The parking space detection device according to claim 3, wherein the secondary detection space is detected using both of the side distance detection means (21R) mounted on the right side surface of the vehicle.
前記第1の空間検知手段及び前記第2の空間検知手段は、前記駐車車両のコーナー(611、621)を前記駐車空間のコーナーとして検知し、
前記差異算出手段は、前記第1の空間検知手段が検知したコーナー(311、321)と前記第2の空間検知手段が検知したコーナー(312、322)の差分であるオフセット量を前記差異として算出することを特徴とする請求項1〜6のいずれか1項に記載の駐車空間検知装置。
The first space detection means and the second space detection means detect corners (611, 621) of the parked vehicle as corners of the parking space,
The difference calculating means calculates, as the difference, an offset amount that is a difference between the corners (311 and 321) detected by the first space detecting means and the corners (312 and 322) detected by the second space detecting means. The parking space detection device according to any one of claims 1 to 6, wherein
前記第1の空間検知手段及び前記第2の空間検知手段は、第1の駐車車両(61)のコーナーである第1コーナー(611)と第2の駐車車両(62)のコーナーである第2コーナー(621)に挟まれた駐車空間を検知し、
前記差異算出手段は、
前記第1の空間検知手段が検知した第1コーナー(311)と前記第2の空間検知手段が検知した第1コーナー(312)の差分である第1オフセット量と、前記第1の空間検知手段が検知した第2コーナー(321)と前記第2の空間検知手段が検知した第2コーナー(322)の差分である第2オフセット量とを算出するオフセット量算出手段(S31)と、
前記第1オフセット量と前記第2オフセット量の平均値を前記オフセット量として算出する平均値算出手段(S34)とを備えることを特徴とする請求項7に記載の駐車空間検知装置。
The first space detection means and the second space detection means are a first corner (611) that is a corner of the first parked vehicle (61) and a second corner that is the corner of the second parked vehicle (62). Detect the parking space sandwiched between the corners (621),
The difference calculating means includes
A first offset amount which is a difference between a first corner (311) detected by the first space detection means and a first corner (312) detected by the second space detection means; and the first space detection means. Offset amount calculating means (S31) for calculating a second offset amount which is a difference between the second corner (321) detected by the second space detecting means and the second corner (322) detected by the second space detecting means;
The parking space detection device according to claim 7, further comprising an average value calculating means (S34) for calculating an average value of the first offset amount and the second offset amount as the offset amount.
前記第1オフセット量と前記第2オフセット量の差分であるオフセット差分が予め定められた第1閾値より大きいか小さいかを判断する差分判断手段(S33)を備え、
前記対策実行手段は、前記オフセット差分が前記第1閾値より小さい場合に前記対策処理を実行し、前記オフセット差分が前記第1閾値より大きい場合には前記対策処理の実行を中止することを特徴とする請求項8に記載の駐車空間検知装置。
Difference determining means (S33) for determining whether an offset difference, which is a difference between the first offset amount and the second offset amount, is larger or smaller than a predetermined first threshold;
The countermeasure execution means executes the countermeasure process when the offset difference is smaller than the first threshold, and stops execution of the countermeasure process when the offset difference is larger than the first threshold. The parking space detection device according to claim 8.
前記オフセット量が予め定められた第2閾値より大きいか小さいかを判断するオフセット量判断手段(S35)を備え、
前記対策実行手段は、前記オフセット量が前記第2閾値より大きい場合に前記対策処理を実行し、前記オフセット量が前記第2閾値より小さい場合には前記対策処理の実行を中止することを特徴とする請求項7〜9のいずれか1項に記載の駐車空間検知装置。
An offset amount determining means (S35) for determining whether the offset amount is larger or smaller than a predetermined second threshold;
The countermeasure execution means executes the countermeasure process when the offset amount is larger than the second threshold value, and stops executing the countermeasure process when the offset amount is smaller than the second threshold value. The parking space detection device according to any one of claims 7 to 9.
前記オフセット量は、前記車両が駐車を行うたびに算出されて、前記第2閾値より大きいか小さいかが判断され、
所定回数以上、前記オフセット量が前記第2閾値より大きくなった状態であるか否かを判断する状態判断手段(S37、S38、S43)を備え、
前記対策実行手段は、前記状態の場合に前記対策処理を実行し、前記状態ではない場合には前記対策処理の実行を中止することを特徴とする請求項10に記載の駐車空間検知装置。
The offset amount is calculated every time the vehicle parks, and it is determined whether it is larger or smaller than the second threshold,
A state determining means (S37, S38, S43) for determining whether or not the offset amount is greater than the second threshold value a predetermined number of times or more;
The parking space detection device according to claim 10, wherein the countermeasure execution unit executes the countermeasure process in the state and stops the execution of the countermeasure process when the state is not the state.
前記状態判断手段は、前記所定回数以上、連続して、前記オフセット量が前記第2閾値より大きくなった前記状態であるか否かを判断することを特徴とする請求項11に記載の駐車空間検知装置。   The parking space according to claim 11, wherein the state determination unit determines whether or not the state is the state in which the offset amount is greater than the second threshold continuously for the predetermined number of times or more. Detection device. 前記距離検知手段は、前記車両の出荷後に前記車両に搭載された後付けの距離検知手段であることを特徴とする請求項2に記載の駐車空間検知装置。   The parking space detection device according to claim 2, wherein the distance detection unit is a retrofit distance detection unit mounted on the vehicle after the vehicle is shipped. 前記後付けの距離検知手段を前記車両に搭載してから最初の1回又は複数回はドライバー自身の運転操作で駐車を行わせ、その駐車時に前記補正手段による補正が行われることを特徴とする請求項13に記載の駐車空間検知装置。   The vehicle is parked by the driver's own driving operation for the first time or a plurality of times after the retrofit distance detecting means is mounted on the vehicle, and correction by the correcting means is performed at the time of parking. Item 14. The parking space detection device according to Item 13. 前記車両には、前記1次検知空間に自動駐車させる自動駐車手段(11)が備えられており、その自動駐車手段による自動駐車時に前記補正手段による補正が行われることを特徴とする請求項13に記載の駐車空間検知装置。   The vehicle is provided with an automatic parking means (11) for automatically parking in the primary detection space, and correction by the correction means is performed during automatic parking by the automatic parking means. The parking space detection device according to.
JP2012215809A 2012-09-28 2012-09-28 Parking space detector Active JP5860788B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2012215809A JP5860788B2 (en) 2012-09-28 2012-09-28 Parking space detector

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012215809A JP5860788B2 (en) 2012-09-28 2012-09-28 Parking space detector

Publications (2)

Publication Number Publication Date
JP2014071569A true JP2014071569A (en) 2014-04-21
JP5860788B2 JP5860788B2 (en) 2016-02-16

Family

ID=50746735

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012215809A Active JP5860788B2 (en) 2012-09-28 2012-09-28 Parking space detector

Country Status (1)

Country Link
JP (1) JP5860788B2 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108682177A (en) * 2018-05-28 2018-10-19 杭州目博科技有限公司 Using the parking lot detector and control method of multisensor
CN109416882A (en) * 2016-07-08 2019-03-01 罗伯特·博世有限公司 In the determination of the separate parking space in side
JP2020035034A (en) * 2018-08-28 2020-03-05 パイオニア株式会社 Information transmission device
WO2021261139A1 (en) * 2020-06-26 2021-12-30 株式会社デンソー Distance estimation device

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003246248A (en) * 2002-02-21 2003-09-02 Mitsubishi Motors Corp Parking-support apparatus
JP2009280092A (en) * 2008-05-22 2009-12-03 Mitsubishi Electric Corp Parking support apparatus
JP2009286355A (en) * 2008-05-30 2009-12-10 Aisin Aw Co Ltd Parking assisting apparatus, parking assisting method, and computer program
JP2011522737A (en) * 2008-06-11 2011-08-04 ヴァレオ・シャルター・ウント・ゼンゾーレン・ゲーエムベーハー How to assist a vehicle driver when parking in a parking space
DE102010062322A1 (en) * 2010-12-02 2012-06-06 Robert Bosch Gmbh Method for calibrating system for assisting driver of motor car during driving maneuvers in e.g. narrow road, involves averaging error, and correcting distance detected before starting of maneuvers to objects by error average value
JP2014054912A (en) * 2012-09-12 2014-03-27 Denso Corp Parking support system

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003246248A (en) * 2002-02-21 2003-09-02 Mitsubishi Motors Corp Parking-support apparatus
JP2009280092A (en) * 2008-05-22 2009-12-03 Mitsubishi Electric Corp Parking support apparatus
JP2009286355A (en) * 2008-05-30 2009-12-10 Aisin Aw Co Ltd Parking assisting apparatus, parking assisting method, and computer program
JP2011522737A (en) * 2008-06-11 2011-08-04 ヴァレオ・シャルター・ウント・ゼンゾーレン・ゲーエムベーハー How to assist a vehicle driver when parking in a parking space
DE102010062322A1 (en) * 2010-12-02 2012-06-06 Robert Bosch Gmbh Method for calibrating system for assisting driver of motor car during driving maneuvers in e.g. narrow road, involves averaging error, and correcting distance detected before starting of maneuvers to objects by error average value
JP2014054912A (en) * 2012-09-12 2014-03-27 Denso Corp Parking support system

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109416882A (en) * 2016-07-08 2019-03-01 罗伯特·博世有限公司 In the determination of the separate parking space in side
CN109416882B (en) * 2016-07-08 2022-06-14 罗伯特·博世有限公司 Determination of laterally remote parking spaces
CN108682177A (en) * 2018-05-28 2018-10-19 杭州目博科技有限公司 Using the parking lot detector and control method of multisensor
CN108682177B (en) * 2018-05-28 2023-09-22 杭州目博科技有限公司 Parking space detector adopting multiple sensors and control method
JP2020035034A (en) * 2018-08-28 2020-03-05 パイオニア株式会社 Information transmission device
WO2021261139A1 (en) * 2020-06-26 2021-12-30 株式会社デンソー Distance estimation device

Also Published As

Publication number Publication date
JP5860788B2 (en) 2016-02-16

Similar Documents

Publication Publication Date Title
US8130120B2 (en) Parking assistance device
US9953532B2 (en) Obstacle warning apparatus
EP2590152B1 (en) Device for estimating vehicle travel path
US20110241857A1 (en) Driver assistance method for moving a motor vehicle and driver assistance device
JP6430777B2 (en) Object detection device
JP5008529B2 (en) Parking assistance device
JP6404679B2 (en) Object detection device
JP6474228B2 (en) Object detection device
JP4914787B2 (en) Vehicle object detection device
JP2018103703A (en) Drive assisting device
JP2015155878A (en) Obstacle detection device for vehicle
JP5843948B1 (en) Parking assistance device and parking assistance method
JP6040945B2 (en) Predecessor selection device
JP5860788B2 (en) Parking space detector
JP2016080641A (en) Object detector
US10884125B2 (en) Parking assistance device
JP2013054614A (en) Drive assisting device
JP5644516B2 (en) Parking space detection device
JP6442225B2 (en) Object detection device
JP2014094725A (en) Parking support device
WO2016194426A1 (en) Work machine for mine
JP2014159182A (en) Parking space sensing device
JP5012669B2 (en) Parking assistance device, parking assistance method, and computer program
KR102304601B1 (en) Apparatus for controlling autonomous parking and method thereof
US11142187B2 (en) Parking assistance device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20141203

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20150820

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20150826

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20151009

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20151203

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20151221

R150 Certificate of patent or registration of utility model

Ref document number: 5860788

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250