JP6167846B2 - Parking assistance device - Google Patents

Parking assistance device Download PDF

Info

Publication number
JP6167846B2
JP6167846B2 JP2013222374A JP2013222374A JP6167846B2 JP 6167846 B2 JP6167846 B2 JP 6167846B2 JP 2013222374 A JP2013222374 A JP 2013222374A JP 2013222374 A JP2013222374 A JP 2013222374A JP 6167846 B2 JP6167846 B2 JP 6167846B2
Authority
JP
Japan
Prior art keywords
route
parking
vehicle
marker
unit
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.)
Active
Application number
JP2013222374A
Other languages
Japanese (ja)
Other versions
JP2015083430A (en
Inventor
毅 清水
毅 清水
康治 田口
康治 田口
幸男 豊良
幸男 豊良
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp filed Critical Toyota Motor Corp
Priority to JP2013222374A priority Critical patent/JP6167846B2/en
Publication of JP2015083430A publication Critical patent/JP2015083430A/en
Application granted granted Critical
Publication of JP6167846B2 publication Critical patent/JP6167846B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

本発明は、駐車支援装置に関する。   The present invention relates to a parking assistance device.

従来、車両の駐車経路を算出して駐車動作を支援する駐車支援装置が提案されている。例えば、下記の特許文献1に記載の駐車支援システムは、駐車の対象となる環境において目印となる指標を設定し、その指標との距離や方向に基づいて車両を誘導して駐車支援を行う。   2. Description of the Related Art Conventionally, a parking support device that supports a parking operation by calculating a parking path of a vehicle has been proposed. For example, the parking support system described in Patent Document 1 below sets an index that serves as a mark in an environment that is to be parked, and performs parking support by guiding the vehicle based on the distance and direction from the index.

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

特許文献1に記載の駐車支援システムでは、小石の存在、横風の発生、路面形状の経年劣化等の環境条件を原因として誘導中の車両の位置にズレが生じる可能性があり、ズレの生じ具合によっては指標を見失う可能性がある。その場合に、車両の位置を的確に検出できなくなることから駐車支援を適切に行うことができなくなってしまう可能性がある。   In the parking assistance system described in Patent Document 1, there is a possibility that the position of the vehicle being guided may be displaced due to environmental conditions such as the presence of pebbles, the occurrence of crosswinds, and aging of the road surface shape. Some indicators may be missed. In that case, since it becomes impossible to detect the position of the vehicle accurately, there is a possibility that parking assistance cannot be performed appropriately.

そこで、本発明は、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる駐車支援装置を提供することを目的とする。   Then, an object of this invention is to provide the parking assistance apparatus which employ | adopts the path | route which can detect the position of a vehicle exactly and can perform parking assistance appropriately.

上記目的を達成するために、本発明の一態様に係る駐車支援装置は、自車両を駐車位置に誘導する駐車支援を、当該駐車位置と異なるマーカーが予め設定されたマップ情報を用いて行うための駐車支援装置において、自車両の周辺状況を検出してマーカーを検出する周辺検出部と、周辺検出部によって検出されたマーカーと自車両との相対的な位置関係に基づいて自車両の現在位置を推定する位置推定部と、位置推定部によって推定された現在位置から駐車位置までの移動経路を算出する移動経路算出部と、移動経路算出部によって算出された移動経路上における自車両の進行方向と周辺検出部によるマーカー検出範囲とに基づいて、当該移動経路を進む自車両から周辺検出部によって検出可能なマーカーの個数を推定するマーカー推定部と、移動経路算出部によって算出された移動経路について、マーカー推定部によって推定されたマーカーの個数が規定数以上となる場合に、当該移動経路を駐車支援に用いる経路として採用する駐車支援部と、を備える。 In order to achieve the above object, the parking support apparatus according to one aspect of the present invention performs parking support for guiding the host vehicle to a parking position using map information in which a marker different from the parking position is set in advance. In the parking support apparatus, a surrounding detection unit that detects a surrounding situation of the own vehicle and detects a marker, and a current position of the own vehicle based on a relative positional relationship between the marker detected by the surrounding detection unit and the own vehicle A position estimation unit for estimating the travel route, a travel route calculation unit for calculating a travel route from the current position estimated by the position estimation unit to the parking position, and a traveling direction of the host vehicle on the travel route calculated by the travel route calculation unit And a marker estimation unit that estimates the number of markers that can be detected by the periphery detection unit from the vehicle traveling on the travel route based on the marker detection range by the periphery detection unit; For movement route calculated by the movement route calculating unit, when the number of markers estimated by the marker estimator becomes a specified value or more, the parking car support part you employed as a path using the moving path to the parking assist, Is provided.

この発明によれば、算出された移動経路上における自車両から検出可能なマーカーの個数に基づいて、算出された移動経路を駐車支援に用いる経路として採用するか否かを決定することにより、マーカーを見失う可能性の少ない移動経路が採用され易くなるため、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる。   According to the present invention, the marker is determined based on the number of markers that can be detected from the host vehicle on the calculated moving route, by determining whether or not to adopt the calculated moving route as a route used for parking assistance. Since it is easy to adopt a travel route that has a low possibility of losing sight of the vehicle, it is possible to appropriately perform parking support by employing a route that can accurately detect the position of the vehicle.

また本発明の一態様に係る駐車支援装置において、位置推定部によって推定された現在位置に基づいて、自車両が駐車支援部によって採用された移動経路上に存在しないことが検出された場合に、当該自車両を当該移動経路上に誘導させるための修正経路を駐車支援に用いる経路として算出する修正経路算出部を更に備えてもよい。   Further, in the parking assistance device according to one aspect of the present invention, when it is detected that the host vehicle does not exist on the moving route adopted by the parking assistance unit based on the current position estimated by the position estimation unit, You may further provide the correction route calculation part which calculates the correction route for guiding the said own vehicle on the said movement route as a path | route used for parking assistance.

この場合、自車両が移動経路上に存在しないことが検出された場合に修正経路を算出することにより、自車両が移動経路上に存在しないことが検出されても、修正経路を用いて自車両を当該移動経路上に誘導させて駐車支援を適切に行うことができる。   In this case, even if it is detected that the host vehicle does not exist on the moving route by calculating the corrected route when it is detected that the own vehicle does not exist on the moving route, Can be guided on the moving route, and parking assistance can be appropriately performed.

また本発明の一態様に係る駐車支援装置において、マーカー推定部は、修正経路算出部によって算出された修正経路上における自車両の進行方向とマーカーを検出可能な範囲とに基づいて、当該修正経路を進む自車両から周辺検出部によって検出可能なマーカーの個数と、予め定められたマーカーの総数とに基づくマーカーの検出率を複数算出し、修正経路算出部は、修正経路に関して、マーカー推定部によって算出された全てのマーカーの検出率のうち最も低い値が所定の閾値より大きい修正経路を駐車支援に用いる経路として採用してもよい。   Further, in the parking assist device according to one aspect of the present invention, the marker estimation unit may perform the correction route based on the traveling direction of the host vehicle on the correction route calculated by the correction route calculation unit and the range in which the marker can be detected. A plurality of marker detection rates are calculated based on the number of markers that can be detected by the periphery detection unit from the vehicle traveling on the vehicle and a predetermined total number of markers. You may employ | adopt as a path | route used for parking assistance the correction path | route where the lowest value among the calculated detection rates of all the markers is larger than a predetermined threshold value.

この場合、修正経路を進む自車両から検出可能なマーカーの個数と予め定められたマーカーの総数とに基づくマーカーの検出率のうち最も低い値が所定の閾値より大きい修正経路を採用することにより、マーカーの検出率が所定の閾値以下であるためにマーカーを見失う可能性のある修正経路は採用されないようになるため、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる。   In this case, by adopting a correction route in which the lowest value of the marker detection rate based on the number of markers that can be detected from the host vehicle traveling on the correction route and the predetermined total number of markers is greater than a predetermined threshold, Since the correction route that may cause the marker to be lost because the detection rate of the marker is below a predetermined threshold is not adopted, the route that can accurately detect the position of the vehicle is adopted and parking assistance is appropriately performed. Can do.

本発明によれば、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる駐車支援装置を提供することができる。   ADVANTAGE OF THE INVENTION According to this invention, the parking assistance apparatus which employ | adopts the path | route which can detect the position of a vehicle exactly and can perform parking assistance appropriately can be provided.

本発明に係る駐車支援装置の実施形態を示すブロック図である。It is a block diagram which shows embodiment of the parking assistance apparatus which concerns on this invention. 自車両の正面前方を示す図である。It is a figure which shows the front front of the own vehicle. 自車両を真上から見た俯瞰図である。It is the bird's-eye view which looked at the own vehicle from right above. 自車両を真上から見た俯瞰図である。It is the bird's-eye view which looked at the own vehicle from right above. 自車両を真上から見た俯瞰図である。It is the bird's-eye view which looked at the own vehicle from right above. 図1のECUの処理の流れを示すフローチャートである。It is a flowchart which shows the flow of a process of ECU of FIG. 自車両を真上から見た俯瞰図である。It is the bird's-eye view which looked at the own vehicle from right above. 自車両を真上から見た俯瞰図である。It is the bird's-eye view which looked at the own vehicle from right above. 自車両を真上から見た俯瞰図である。It is the bird's-eye view which looked at the own vehicle from right above.

以下、本発明の好適な実施形態について、図面を参照して詳細に説明する。なお、各図において同一又は相当部分には同一符号を付し、重複する説明を省略する。   DESCRIPTION OF EMBODIMENTS Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the drawings. In addition, in each figure, the same code | symbol is attached | subjected to the same or an equivalent part, and the overlapping description is abbreviate | omitted.

図1に示されるように、本実施形態に係る駐車支援装置1は、自車両に備えられ、自車両を目的の駐車位置に誘導する駐車支援を実施するものである。駐車支援装置1は、一実施形態において、駐車位置と異なるマーカーが予め設定されたマップ情報(以下、駐車場マップ情報)を駐車場の入口等において取得し、目的の駐車位置までの移動経路を一又は複数算出する。そして、駐車支援装置1は、その移動経路上から検出可能なマーカーの個数に基づいて、算出されたその移動経路を採用するか否かを決定する。そして、駐車支援装置1は、採用が決定された移動経路に沿って自車両を誘導することによって駐車支援を実施する。なお、駐車支援装置1は、取得した駐車場マップ情報に対して改めてマーカーを設定することが可能である。また、駐車場マップ情報においては、自車両の駐車が可能な駐車位置が、予め示されていてもよく、駐車場マップ情報の取得後に設定されてもよい。また、目的の駐車位置は、自車両の駐車が可能な駐車位置の中から、ドライバによる選択が可能な構成としてもよく、駐車場マップ情報の取得時に既に決定されていてもよい。   As shown in FIG. 1, a parking assist device 1 according to the present embodiment is provided in a host vehicle and performs parking support that guides the host vehicle to a target parking position. In one embodiment, the parking assistance device 1 acquires map information (hereinafter referred to as parking lot map information) in which a marker different from the parking position is set in advance at the entrance of the parking lot, etc., and determines the movement route to the target parking position. Calculate one or more. Then, the parking assistance device 1 determines whether or not to adopt the calculated movement route based on the number of markers that can be detected from the movement route. And the parking assistance apparatus 1 implements parking assistance by guide | inducing the own vehicle along the movement path | route determined to employ | adopt. In addition, the parking assistance apparatus 1 can set a marker anew with respect to the acquired parking lot map information. Moreover, in the parking lot map information, a parking position where the host vehicle can be parked may be indicated in advance, or may be set after acquisition of the parking lot map information. The target parking position may be configured to be selectable by the driver from parking positions where the host vehicle can be parked, and may be already determined when the parking lot map information is acquired.

以下、駐車支援装置1の構成について説明する。図1に示されるように、駐車支援装置1は、装置を統括的に制御するECU[Electronic Control Unit]2を備えている。ECU2は、CPU[Central Processing Unit]、ROM[Read Only Memory]、RAM[Random Access Memory]などからなる電子制御ユニットである。ECU2では、ROMに記憶されているアプリケーションプログラムをRAMにロードし、CPUで実行することで、ACC[Adaptive Cruise Control]やブレーキアシスト等の走行制御に係る演算処理が行われる。ECU2は、通信部4、GPS[Global Positioning System]受信部5、周辺センサ6、及び車両センサ7と接続されている。また、ECU2は、車両制御部8及びHMI[Human Machine Interface]9と接続されている。   Hereinafter, the structure of the parking assistance apparatus 1 is demonstrated. As shown in FIG. 1, the parking assist device 1 includes an ECU [Electronic Control Unit] 2 that controls the device in an integrated manner. The ECU 2 is an electronic control unit including a CPU [Central Processing Unit], a ROM [Read Only Memory], a RAM [Random Access Memory], and the like. In the ECU 2, an application program stored in the ROM is loaded into the RAM and executed by the CPU, whereby arithmetic processing related to travel control such as ACC [Adaptive Cruise Control] and brake assist is performed. The ECU 2 is connected to a communication unit 4, a GPS [Global Positioning System] receiving unit 5, a peripheral sensor 6, and a vehicle sensor 7. The ECU 2 is connected to a vehicle control unit 8 and an HMI [Human Machine Interface] 9.

通信部4は、例えば駐車場入口に設置された路側送受信機との間で無線通信を行う通信ユニットである。通信部4は、無線通信によって駐車場マップ情報を取得する。駐車場マップ情報は、例えば、駐車可能スペースの配置位置を示す配置状況、駐車場入口から駐車可能スペースまでの入庫通路、及び駐車可能スペースから駐車場出口までの出庫通路を示すマップ情報である。駐車可能スペースは、例えば、自車両の駐車が可能な位置として駐車場マップ情報において予め設定されている。駐車可能スペースには、自車両が実際に駐車しようとする目標の駐車位置が含まれている。通信部4は、取得した駐車場マップ情報をECU2に送信する。なお、通信部4は、駐車場マップ情報の取得後に、駐車可能スペースの配置位置を示す配置状況を無線通信によって別途取得することも可能である。   The communication unit 4 is a communication unit that performs wireless communication with, for example, a roadside transmitter / receiver installed at a parking lot entrance. The communication unit 4 acquires parking lot map information by wireless communication. The parking lot map information is, for example, map information indicating an arrangement state indicating an arrangement position of a parking space, an entry passage from the parking lot entrance to the parking available space, and a delivery passage from the parking available space to the parking lot exit. The parking space is set in advance in the parking lot map information as a position where the host vehicle can be parked, for example. The parking available space includes a target parking position where the host vehicle actually attempts to park. The communication unit 4 transmits the acquired parking lot map information to the ECU 2. In addition, the communication part 4 can also acquire separately the arrangement | positioning condition which shows the arrangement position of parking available space by wireless communication after acquisition of parking lot map information.

GPS受信部5は、複数のGPS衛星から送信されるGPS信号を受信することで、自車両の現在位置を検出するものである。GPS受信部5は、検出した自車両の現在位置に関する自車両位置情報をECU2に送信する。   The GPS receiving unit 5 detects the current position of the host vehicle by receiving GPS signals transmitted from a plurality of GPS satellites. The GPS receiver 5 transmits to the ECU 2 the vehicle position information regarding the detected current position of the vehicle.

周辺センサ6は、自車両の周辺状況を検出するセンサである。周辺センサ6は、ミリ波レーダや外部カメラ等の種々の機器から構成されている。周辺センサ6は、外部カメラにより駐車場の内部を逐次認識することで、自車両の現在地の推定に用いられる現在地情報を逐次取得する。また、周辺センサ6は、ミリ波レーダや外部カメラ等によって自車両Cの周囲に存在するマーカー及び駐車中の他車両を逐次認識することで、周辺情報を逐次取得する。自車両Cの正面前方を示す図2に示されるように、周辺センサ6は自車両Cの正面前方の略中央に設置される。そして、自車両Cを真上から見た俯瞰図を示す図3に示されるように、周辺センサ6は自車両Cの進行方向F前方の扇形状範囲のエリアAをセンシングして上述の現在地情報や周辺情報を取得することができる。図1に戻って、周辺センサ6は、取得した現在地情報や周辺情報の各種情報をECU2に送信する。周辺センサ6は、特許請求の範囲に記載の周辺検出部として機能する。   The surrounding sensor 6 is a sensor that detects the surrounding situation of the host vehicle. The peripheral sensor 6 includes various devices such as a millimeter wave radar and an external camera. The peripheral sensor 6 sequentially acquires the current location information used for estimating the current location of the host vehicle by sequentially recognizing the inside of the parking lot with an external camera. The peripheral sensor 6 sequentially acquires peripheral information by sequentially recognizing markers existing around the host vehicle C and other parked vehicles using a millimeter wave radar, an external camera, or the like. As shown in FIG. 2 showing the front side of the host vehicle C, the peripheral sensor 6 is installed at the approximate center in front of the host vehicle C. Then, as shown in FIG. 3 which shows an overhead view of the host vehicle C as viewed from directly above, the peripheral sensor 6 senses the area A of the fan-shaped range ahead of the traveling direction F of the host vehicle C, and the above-described current location information. And surrounding information can be acquired. Returning to FIG. 1, the peripheral sensor 6 transmits the acquired current location information and various types of peripheral information to the ECU 2. The peripheral sensor 6 functions as a peripheral detector described in the claims.

車両センサ7は、自車両Cの挙動を検出するセンサである。車両センサ7は、車速センサ、ブレーキセンサ、加速度センサ、操舵センサ、及びアクセルセンサ等から構成されている。車両センサ7は、各種センサによって自車両Cの挙動に関する自車両挙動情報を取得する。この自車両挙動情報には、自車両Cの速度変化に関する自車両速度変化情報が含まれる。車両センサ7は、取得した自車両挙動情報をECU2に送信する。   The vehicle sensor 7 is a sensor that detects the behavior of the host vehicle C. The vehicle sensor 7 includes a vehicle speed sensor, a brake sensor, an acceleration sensor, a steering sensor, an accelerator sensor, and the like. The vehicle sensor 7 acquires own vehicle behavior information related to the behavior of the own vehicle C using various sensors. The host vehicle behavior information includes host vehicle speed change information related to the speed change of the host vehicle C. The vehicle sensor 7 transmits the acquired own vehicle behavior information to the ECU 2.

車両制御部8は、自車両Cの走行制御を実施する制御ユニットである。車両制御部8は、スロットルバルブアクチュエータ、ブレーキアクチュエータ、及びステアリングアクチュエータ等の各種アクチュエータを有している。車両制御部8は、ECU2からの駐車支援信号に応じて各種アクチュエータを駆動させ、自車両Cの走行制御を実施する。   The vehicle control unit 8 is a control unit that performs traveling control of the host vehicle C. The vehicle control unit 8 includes various actuators such as a throttle valve actuator, a brake actuator, and a steering actuator. The vehicle control unit 8 drives the various actuators in accordance with the parking assistance signal from the ECU 2 and performs traveling control of the host vehicle C.

HMI9は、自車両Cの運転者に対する情報提供を行う設備である。HMI9は、音声情報を出力するスピーカや映像情報を出力するモニタを備えている。HMI9は、ECU2からの駐車支援信号に応じて自車両Cの走行に利用される各種情報を運転者に提供する。   The HMI 9 is a facility that provides information to the driver of the host vehicle C. The HMI 9 includes a speaker that outputs audio information and a monitor that outputs video information. The HMI 9 provides the driver with various types of information used for traveling the host vehicle C in response to a parking assistance signal from the ECU 2.

ECU2は、位置推定部11、移動経路算出部12、マーカー推定部13、駐車支援部14、及び修正経路算出部15を有している。   The ECU 2 includes a position estimation unit 11, a movement route calculation unit 12, a marker estimation unit 13, a parking support unit 14, and a correction route calculation unit 15.

位置推定部11は、通信部4から送信された駐車場マップ情報と、GPS受信部5から送信された自車両位置情報と、周辺センサ6から送信された各種情報と、車両センサ7から送信された自車両挙動情報とに基づいて、自車両の現在位置を推定する。より詳しくは、位置推定部11は、まず、それら受信した情報に基づいて、駐車場入口から駐車可能スペースまでの入庫通路の両側、駐車可能スペースの周囲、及び駐車可能スペースから駐車場出口までの出庫通路の両側を含むマップに、マーカーを等間隔で複数設定する。各マーカーは、一意に識別可能なIDを有している。なお、マーカーは、マップ上に仮想的に設定されるものであってもよい。また、カラーコーン(登録商標)といった駐車場内で目印となり得る物体を、仮想的なマーカーとして設定してもよい。   The position estimating unit 11 is transmitted from the parking lot map information transmitted from the communication unit 4, the own vehicle position information transmitted from the GPS receiving unit 5, various information transmitted from the peripheral sensor 6, and the vehicle sensor 7. The current position of the host vehicle is estimated based on the host vehicle behavior information. More specifically, the position estimation unit 11 first determines, based on the received information, both sides of the entrance passage from the parking lot entrance to the parking space, around the parking space, and from the parking space to the parking lot exit. A plurality of markers are set at equal intervals on a map including both sides of the exit passage. Each marker has an ID that can be uniquely identified. The marker may be virtually set on the map. Further, an object that can be a mark in a parking lot such as a color cone (registered trademark) may be set as a virtual marker.

そして、位置推定部11は、周辺センサ6から送信された各種情報に基づいて、自車両の現在位置から検出可能なマーカーを検出する。そして、位置推定部11は、自車両と自車両周辺で検出された一又は複数のマーカーとの相対的な位置関係及びその変化に基づいて、自車両の現在位置を逐次推定する。例えば、位置推定部11は、周辺センサ6から送信された駐車場入口付近の様子と、駐車場マップ情報における駐車場入口付近において設定されたマーカーが検出可能な位置が自車両の現在位置であるという情報とに基づいて、自車両の現在位置は駐車場入口付近であると推定する。位置推定部11は、特許請求の範囲に記載の周辺検出部及び位置推定部として機能する。   And the position estimation part 11 detects the marker which can be detected from the present position of the own vehicle based on the various information transmitted from the periphery sensor 6. FIG. Then, the position estimation unit 11 sequentially estimates the current position of the host vehicle based on the relative positional relationship between the host vehicle and one or a plurality of markers detected around the host vehicle and changes thereof. For example, in the position estimation unit 11, the current position of the host vehicle is a position near the parking lot entrance transmitted from the peripheral sensor 6 and a position where a marker set in the vicinity of the parking lot entrance in the parking lot map information can be detected. Based on this information, it is estimated that the current position of the host vehicle is near the parking lot entrance. The position estimation unit 11 functions as a periphery detection unit and a position estimation unit described in the claims.

移動経路算出部12は、位置推定部11により推定された現在位置から所定の駐車位置までの移動経路を車両モデルにより一又は複数算出する。車両モデルによる移動経路の算出とは、自車両の車体やタイヤのサイズといった自車両の特徴が考慮された仮想の車両をモデルとして移動経路を算出することである。所定の駐車位置は、他車両が駐車していない駐車スペースの位置である。所定の駐車位置は、通信部4から送信された駐車場マップ情報と、GPS受信部5から送信された自車両位置情報と、周辺センサ6から送信された各種情報と、車両センサ7から送信された自車両挙動情報とに基づいて、移動経路算出部12によって決定される。   The movement route calculation unit 12 calculates one or more movement routes from the current position estimated by the position estimation unit 11 to a predetermined parking position using a vehicle model. The calculation of the movement route by the vehicle model is to calculate the movement route using a virtual vehicle in which the characteristics of the own vehicle such as the size of the vehicle body and the tire of the own vehicle are taken into consideration. The predetermined parking position is a position of a parking space where no other vehicle is parked. The predetermined parking position is transmitted from the parking sensor map information transmitted from the communication unit 4, own vehicle position information transmitted from the GPS receiving unit 5, various information transmitted from the peripheral sensor 6, and the vehicle sensor 7. Based on the own vehicle behavior information, it is determined by the movement route calculation unit 12.

マーカー推定部13は、移動経路算出部12によって算出された複数の移動経路のそれぞれに関して、移動経路上の各ポイントにおける自車両から実際に検出可能なマーカーの個数を推定する。マーカー推定部13は、移動経路算出部12によって算出された移動経路のそれぞれに関して、移動経路を進む自車両の進行方向と、現在位置からマーカーを検出可能な範囲である検出エリアとに基づいて、上記の推定処理を行う。例えば、自車両Cを真上から見た俯瞰図を示す図5に示されるように、移動経路R上に存在する自車両Cの現在位置から実際に検出可能なマーカーの個数は4であるとして推定される。   The marker estimation unit 13 estimates the number of markers that can actually be detected from the host vehicle at each point on the movement route for each of the plurality of movement routes calculated by the movement route calculation unit 12. For each of the travel routes calculated by the travel route calculation unit 12, the marker estimation unit 13 is based on the traveling direction of the host vehicle traveling along the travel route and a detection area that is a range in which the marker can be detected from the current position. The above estimation process is performed. For example, as shown in FIG. 5 showing an overhead view of the host vehicle C viewed from directly above, the number of markers that can be actually detected from the current position of the host vehicle C existing on the movement route R is four. Presumed.

また、マーカー推定部13は、後述の修正経路算出部15によって算出された修正経路上の複数のポイントのそれぞれにおける、位置推定部11によって検出可能と推定されるマーカーの個数と、予め定められたマーカーの総数とに基づいて、後述のマーカーの検出率を各ポイントで算出することが可能である。マーカー推定部13は、自車両の進行方向と、マーカーを検出可能な範囲である検出エリアとに基づいて、後述のマーカーの検出率を算出する。例えば、自車両Cを真上から見た俯瞰図を示す図4に示されるように、後述のズレ修正位置Pから実際に検出可能なマーカーの個数は3であるとして推定される。予め定められたマーカーの総数とは、例えば、自車両が駐車しようとする駐車場に関して設定されたマーカーの総数であってもよく、自車両の現在位置から検出可能なマーカーの総数であってもよい。マーカーの検出率は、例えば、位置推定部11によって検出可能なマーカーの個数を、予め定められたマーカーの総数で除することによって得られる。通常、各修正経路の各ポイントにおけるマーカーの検出率は各ポイントにおいて異なるため、各修正経路におけるマーカーの検出率は最低値及び最高値を有することになる。   In addition, the marker estimation unit 13 has a predetermined number of markers estimated to be detectable by the position estimation unit 11 at each of a plurality of points on the correction path calculated by the correction path calculation unit 15 described later. Based on the total number of markers, a marker detection rate described later can be calculated at each point. The marker estimation unit 13 calculates a marker detection rate, which will be described later, based on the traveling direction of the host vehicle and a detection area that is a range in which the marker can be detected. For example, as shown in FIG. 4 showing an overhead view of the host vehicle C as viewed from directly above, it is estimated that the number of markers that can actually be detected from a displacement correction position P described later is three. The total number of markers determined in advance may be, for example, the total number of markers set for a parking lot where the host vehicle is to park, or the total number of markers detectable from the current position of the host vehicle. Good. The marker detection rate is obtained, for example, by dividing the number of markers detectable by the position estimation unit 11 by a predetermined total number of markers. Usually, since the marker detection rate at each point of each correction path is different at each point, the marker detection rate at each correction path has a minimum value and a maximum value.

駐車支援部14は、移動経路算出部12によって算出された移動経路について、マーカー推定部13によって推定されたマーカーの個数に基づいて、その移動経路を駐車支援に用いる経路として採用するか否かを決定する。例えば、駐車支援部14は、マーカー推定部13によって推定されたマーカーの個数が規定数以上となる移動経路を、駐車支援に用いる経路として採用することが可能である。その規定数は、駐車支援部14に予め記憶されているが、ドライバ等による変更設定が可能である。そして、駐車支援部14は、採用することが決定された移動経路及び後述の修正経路算出部15によって採用することが決定された修正経路に基づいて駐車支援を実施する。   Based on the number of markers estimated by the marker estimation unit 13, the parking support unit 14 determines whether or not to adopt the movement route as a route used for parking support for the movement route calculated by the movement route calculation unit 12. decide. For example, the parking support unit 14 can employ a travel route in which the number of markers estimated by the marker estimation unit 13 is equal to or greater than a specified number as a route used for parking support. The specified number is stored in advance in the parking support unit 14, but can be changed by a driver or the like. And the parking assistance part 14 implements parking assistance based on the movement path | route determined to employ | adopt and the correction path | route determined to employ | adopt by the below-mentioned correction path | route calculation part 15. FIG.

なお、駐車支援部14は、移動経路及び修正経路に沿って自車両を走行制御させるための駐車支援信号を車両制御部8やHMI9に送信することで、駐車支援を実施する。駐車支援としては、ACCやブレーキアシスト、モータ等のアクチュエータによる自車両Cの旋回及びそれに伴う加減速、運転者に対する情報提供等がある。例えば、自車両Cを真上から見た俯瞰図を示す図5に示されるように、位置推定部11によって上述のエリアA内のマーカーMと自車両Cとの相対的な位置関係に基づいて自車両Cの現在地が特定されると、駐車支援部14は、移動経路算出部12によって算出された移動経路Rに沿って、駐車位置としての駐車枠T1〜T7のうち他車両が駐車していない位置に自車両Cを移動制御して駐車支援を実施する。   In addition, the parking assistance part 14 implements parking assistance by transmitting the parking assistance signal for carrying out driving control of the own vehicle along a movement path | route and a correction path | route to the vehicle control part 8 or HMI9. Parking assistance includes ACC, brake assist, turning of the vehicle C by an actuator such as a motor, accompanying acceleration / deceleration, and provision of information to the driver. For example, as shown in FIG. 5 that shows an overhead view of the host vehicle C as viewed from directly above, the position estimation unit 11 uses the relative position relationship between the marker M in the area A and the host vehicle C described above. When the current location of the host vehicle C is specified, the parking support unit 14 has parked other vehicles in the parking frames T1 to T7 as parking positions along the movement route R calculated by the movement route calculation unit 12. Parking support is performed by controlling the movement of the own vehicle C to a position where there is not.

修正経路算出部15は、通信部4から送信された駐車場マップ情報と、GPS受信部5から送信された自車両位置情報と、周辺センサ6から送信された各種情報と、車両センサ7から送信された自車両挙動情報と、位置推定部11によって推定された現在位置とに基づいて、自車両が、駐車支援部14によって採用された移動経路上に存在せず誤差としてのズレが生じていることが検出された場合に、自車両を移動経路上に誘導させるための修正経路を車両モデルにより一又は複数算出することが可能である。例えば、自車両Cを真上から見た俯瞰図を示す図4に示されるように、自車両Cが移動経路R上に存在せず誤差としてのズレが生じていることが検出された場合に、修正経路算出部15は、自車両Cを移動経路上に誘導させるための修正経路S1,S2を、駐車支援に用いる経路として算出する。   The correction route calculation unit 15 transmits the parking lot map information transmitted from the communication unit 4, the own vehicle position information transmitted from the GPS reception unit 5, various information transmitted from the peripheral sensor 6, and the vehicle sensor 7. The own vehicle does not exist on the moving route adopted by the parking support unit 14 based on the obtained own vehicle behavior information and the current position estimated by the position estimation unit 11 and a deviation as an error occurs. When this is detected, it is possible to calculate one or a plurality of correction routes for guiding the host vehicle on the movement route using the vehicle model. For example, as shown in FIG. 4 showing an overhead view of the host vehicle C viewed from directly above, when it is detected that the host vehicle C does not exist on the moving route R and a deviation as an error occurs. The corrected route calculation unit 15 calculates the corrected routes S1 and S2 for guiding the host vehicle C on the moving route as the routes used for parking assistance.

そして、修正経路算出部15は、各修正経路に関して、マーカー推定部13によって推定されたマーカーの検出率に基づいて、算出した一又は複数の修正経路のそれぞれを採用するか否かを決定する。例えば、修正経路算出部15は、各修正経路に関して、マーカー推定部13によって算出された全てのマーカーの検出率の最低値が所定の閾値より大きい修正経路を採用する。所定の閾値は、修正経路算出部15に予め記憶されているが、ドライバ等による変更設定が可能である。   And the correction path | route calculation part 15 determines whether each one or some calculated correction path | routes are employ | adopted based on the detection rate of the marker estimated by the marker estimation part 13 regarding each correction path | route. For example, the correction path calculation unit 15 employs a correction path in which the minimum value of the detection rates of all markers calculated by the marker estimation unit 13 is greater than a predetermined threshold for each correction path. The predetermined threshold value is stored in advance in the correction route calculation unit 15, but can be changed by a driver or the like.

更に、修正経路算出部15は、移動経路算出部12によって算出された移動経路上の複数のポイントと、修正経路算出部15によって算出された各修正経路上の対応する複数のポイントとの距離に関するパラメータである誤差パラメータの全ポイントにおける合計値を算出することが可能である。その距離に関する誤差パラメータは、例えば、移動経路上の複数のポイントと、各修正経路上の対応する複数のポイントとの距離を示す数値であってもよい。そして、修正経路算出部15は、全ポイントにおける誤差パラメータの合計値が最小となる修正経路を採用することが可能である。ここで、移動経路算出部12によって算出された移動経路上の複数のポイントとは、例えば、その移動経路を所定数に等分に区切るためのポイントのことであり、修正経路算出部15によって算出された修正経路上の対応する複数のポイントとは、その修正経路をその所定数に等分に区切るためのポイントのことである。   Further, the corrected route calculation unit 15 relates to the distance between a plurality of points on the movement route calculated by the movement route calculation unit 12 and a plurality of corresponding points on each correction route calculated by the correction route calculation unit 15. It is possible to calculate the total value of all the error parameters as parameters. The error parameter related to the distance may be a numerical value indicating the distance between a plurality of points on the movement route and a plurality of corresponding points on each correction route, for example. And the correction path | route calculation part 15 can employ | adopt the correction path | route where the total value of the error parameter in all the points becomes the minimum. Here, the plurality of points on the movement route calculated by the movement route calculation unit 12 are points for equally dividing the movement route into a predetermined number, and are calculated by the correction route calculation unit 15. The corresponding points on the corrected route are points for equally dividing the corrected route into the predetermined number.

例えば、自車両Cを真上から見た俯瞰図を示す図4に示されるように、自車両Cが移動経路R上に存在せず誤差としてのズレが生じていることが検出された時点におけるズレ修正位置Pからの修正経路として、修正経路S1,S2が算出されたとする。以下、上述の所定数は2であるとして説明する。修正経路S1は、始点をズレ修正位置Pとし、移動経路R上のポイントP12で移動経路Rと接しており、このポイントP12を修正経路S1終点とする。また、修正経路S2は、始点をズレ修正位置Pとし、移動経路R上のポイントP22で移動経路Rと接しており、このポイントP22を修正経路S2の終点とする。修正経路S1上にはポイントP12の他に修正経路S1の中点となるズレ修正位置P11(上述の等分に区切るためのポイント)が設定されており、修正経路S2上にはポイントP22の他に修正経路S2の中点となるズレ修正位置P21(上述の等分に区切るためのポイント)が設定されている。また、移動経路R上には、ズレ修正位置Pに最も近い(即ちズレ修正位置Pに対応する)ポイントP0と、ズレ修正位置P11に最も近い(即ちズレ修正位置P11に対応する)ポイントP1と、ズレ修正位置P21に最も近い(即ちズレ修正位置P21に対応する)ポイントP2とが設定されている。修正経路算出部15は、修正経路S1に関して、ズレ修正位置PとポイントP0との距離とズレ修正位置P11とポイントP1との距離との合計値SUM1を算出する。ズレ修正位置(例:ズレ修正位置P)とポイント(例:ポイントP0)との距離を示す誤差パラメータDは、下記式(1)により算出される。ここで、nは、上述の所定数(ズレ修正位置とポイントとの組み合わせの個数)から1を引いた数であり、x及びyは上述のポイントのx座標及びy座標であり、xnow及びynowは対応するズレ修正位置のx座標及びy座標である。

Figure 0006167846

同様に、修正経路算出部15は、修正経路S2に関して、ズレ修正位置PとポイントP0との距離とズレ修正位置P21とポイントP2との距離との合計値SUM2を算出する。そして、修正経路算出部15は、合計値SUM1と合計値SUM2の中で最小となる合計値(ここでは合計値SUM1)の修正経路(ここでは修正経路S1)を採用する。 For example, as shown in FIG. 4 that shows an overhead view of the host vehicle C viewed from directly above, at the time when it is detected that the host vehicle C does not exist on the movement route R and a deviation as an error occurs. It is assumed that correction paths S1 and S2 are calculated as correction paths from the displacement correction position P. Hereinafter, description will be made assuming that the predetermined number is two. The correction route S1 has a start point as a displacement correction position P, is in contact with the movement route R at a point P12 on the movement route R, and this point P12 is an end point of the correction route S1. The correction route S2 has a start point as a displacement correction position P, is in contact with the movement route R at a point P22 on the movement route R, and this point P22 is an end point of the correction route S2. On the correction path S1, in addition to the point P12, a misalignment correction position P11 (a point for dividing into the above-mentioned equal parts) is set as the midpoint of the correction path S1, and other than the point P22 on the correction path S2. Is set to the misalignment correction position P21 (the point for dividing into the above-mentioned equal parts), which is the midpoint of the correction path S2. On the movement route R, a point P0 closest to the displacement correction position P (ie, corresponding to the displacement correction position P) and a point P1 closest to the displacement correction position P11 (ie, corresponding to the displacement correction position P11) The point P2 closest to the deviation correction position P21 (that is, corresponding to the deviation correction position P21) is set. The correction path calculation unit 15 calculates a total value SUM1 of the distance between the shift correction position P and the point P0 and the distance between the shift correction position P11 and the point P1 with respect to the correction path S1. The error parameter D indicating the distance between the deviation correction position (example: deviation correction position P) and the point (example: point P0) is calculated by the following equation (1). Here, n is a number obtained by subtracting 1 from the above-mentioned predetermined number (the number of combinations of displacement correction positions and points), x i and y i are the x-coordinate and y-coordinate of the above-mentioned point, and x Now and y now are the x-coordinate and y-coordinate of the corresponding misalignment correction position.
Figure 0006167846

Similarly, the correction route calculation unit 15 calculates a total value SUM2 of the distance between the displacement correction position P and the point P0 and the distance between the displacement correction position P21 and the point P2 with respect to the correction route S2. Then, the correction route calculation unit 15 employs a correction route (here, the correction route S1) of the total value (here, the total value SUM1) that is the smallest of the total value SUM1 and the total value SUM2.

次に、上述したECU2の処理の流れについて図面を参照して説明する。   Next, the process flow of the ECU 2 described above will be described with reference to the drawings.

図6に示されるように、ECU2では、まず位置推定部11が、自車両の現在位置を推定し、移動経路算出部12が、現在位置から駐車位置までの移動経路を複数算出した後に、修正経路算出部15が、自車両が移動経路上に存在せず誤差としてのズレが発生している場合にそれを検知する(ステップS01)。そして、修正経路算出部15が、自車両を移動経路上に誘導させるための修正経路を一又は複数算出する(ステップS03)。   As shown in FIG. 6, in the ECU 2, first, the position estimation unit 11 estimates the current position of the host vehicle, and the movement route calculation unit 12 calculates a plurality of movement routes from the current position to the parking position. The route calculation unit 15 detects this when the vehicle does not exist on the moving route and a deviation as an error occurs (step S01). Then, the corrected route calculation unit 15 calculates one or a plurality of corrected routes for guiding the host vehicle on the moving route (step S03).

次に、マーカー推定部13が、修正経路のそれぞれに関して、修正経路上における自車両から実際に検出可能なマーカーの個数を推定し、修正経路上の複数のポイントのそれぞれにおける、検出可能なマーカーの個数と、予め定められたマーカーの総数とに基づいて、マーカーの検出率を算出する(ステップS05)。ここで、修正経路算出部15が、各修正経路に関して、マーカーの検出率の最低値が所定の閾値以下であるか否かを判定する(ステップS07)。マーカーの検出率の最低値が所定の閾値以下である修正経路が存在する場合、該当の修正経路は破棄され不採用になる(ステップS09)。   Next, the marker estimation unit 13 estimates the number of markers that can actually be detected from the own vehicle on the corrected route for each of the corrected routes, and detects the detectable markers at each of a plurality of points on the corrected route. Based on the number and the predetermined total number of markers, the marker detection rate is calculated (step S05). Here, the correction path calculation unit 15 determines whether or not the minimum value of the marker detection rate is equal to or less than a predetermined threshold for each correction path (step S07). If there is a correction route whose minimum marker detection rate is less than or equal to a predetermined threshold, the correction route is discarded and not adopted (step S09).

一方、マーカーの検出率の最低値が所定の閾値より大きい修正経路が存在する場合、修正経路算出部15は、その残った修正経路のそれぞれに関して、全ポイントにおける誤差パラメータの合計値を算出する(ステップS11)。次に、修正経路算出部15が、全ポイントにおける誤差パラメータの合計値が最小となる修正経路を採用する(ステップS13)。そして、駐車支援部14が、採用することが決定された移動経路及び修正経路算出部15によって採用することが決定された修正経路に沿って自車両Cを制御することによって、駐車支援を実施する(ステップS15)。そして、一連の処理が終了する。   On the other hand, when there is a correction path having a minimum marker detection rate greater than a predetermined threshold, the correction path calculation unit 15 calculates the total value of error parameters at all points for each of the remaining correction paths ( Step S11). Next, the correction path calculation unit 15 employs a correction path that minimizes the total value of error parameters at all points (step S13). And the parking assistance part 14 implements parking assistance by controlling the own vehicle C along the movement route determined to be adopted and the correction route decided to be adopted by the correction route calculation unit 15. (Step S15). Then, a series of processing ends.

続いて、上述した駐車支援装置1の作用効果について説明する。   Then, the effect of the parking assistance apparatus 1 mentioned above is demonstrated.

例えば、自車両Cを真上から見た俯瞰図を示す図4に示されるように、強風や突風の発生、小石等の存在等の突発的な外乱によって自車両Cが移動経路R上に存在せず誤差としてのズレが生じていることが検出されたとする。ここで、検出可能なマーカーの個数を考慮せずにそのズレだけを考慮して修正された経路を走行させるライントレース制御が行われると、自車両Dを真上から見た俯瞰図を示す図7に示されるように、本来その位置で向くはずのない向きに自車両Dが向いてしまうことで、マーカー検出範囲としてのエリアAにマーカーMが含まれず、検出可能なマーカーMが無くなってしまうことがある(又は、マーカーMの検出精度が低くなってしまうことがある)。   For example, as shown in FIG. 4 which shows an overhead view of the host vehicle C as viewed from directly above, the host vehicle C exists on the moving route R due to sudden disturbance such as generation of strong winds, gusts, or pebbles. Suppose that a deviation as an error is detected. Here, a diagram showing an overhead view of the host vehicle D as viewed from directly above when line trace control is performed to travel a route that has been corrected in consideration of only the deviation without considering the number of detectable markers. As shown in FIG. 7, when the host vehicle D is oriented in a direction that should not be directed at the position, the marker M is not included in the area A as the marker detection range, and the detectable marker M is lost. (Or the detection accuracy of the marker M may be lowered).

ここで、上述のライントレース制御が更に行われると、自車両Dを真上から見た俯瞰図を示す図8に示されるように、マーカー検出範囲としてのエリアAにマーカーMが含まれず、検出可能なマーカーMが無くなってしまう状態になる。この状態で改めて駐車位置までの移動経路R2が算出されても、検出可能なマーカーMが無い状態が継続したままであるため、自車両Dの存在位置の検出精度が更に低くなってしまうことがある。また、自車両Dと同様の駐車支援が行われる他車両が同じ駐車場に存在する場合、自車両Dとその他車両とが接触してしまうおそれがある。   Here, when the above-described line trace control is further performed, the marker M is not included in the area A as the marker detection range, as shown in FIG. 8 showing an overhead view when the host vehicle D is viewed from directly above. The possible marker M is lost. Even if the movement route R2 to the parking position is calculated again in this state, the state where there is no detectable marker M continues, and the detection accuracy of the position where the host vehicle D is present may be further lowered. is there. Moreover, when the other vehicle in which the parking assistance similar to the own vehicle D is performed exists in the same parking lot, there exists a possibility that the own vehicle D and another vehicle may contact.

また、自車両Cを真上から見た俯瞰図を示す図9に示されるように、検出可能なマーカーの個数を考慮せずに移動経路Rに沿って駐車枠T3に自車両Cを移動制御させても、実際の走行経路は、移動経路Rが進行方向に対して前後方向(図9におけるY軸方向)にズレた経路W1を自車両Cが走行する、又は、移動経路Rが進行方向に対して左右方向(図9におけるX軸方向)にズレた経路W2を自車両Cが走行する状態が発生してしまうおそれがある。   Further, as shown in FIG. 9 showing an overhead view of the host vehicle C viewed from directly above, the host vehicle C is controlled to move along the moving path R in the parking frame T3 without considering the number of detectable markers. Even if it is made, the actual travel route is that the host vehicle C travels on the route W1 in which the travel route R is shifted in the front-rear direction (Y-axis direction in FIG. 9) with respect to the travel direction, or the travel route R is the travel direction. On the other hand, there is a possibility that the vehicle C may travel on a route W2 that is shifted in the left-right direction (X-axis direction in FIG. 9).

これに対して、本実施形態に係る駐車支援装置1によれば、算出された移動経路R上における自車両Cから検出可能なマーカーMの個数に基づいて、算出された移動経路Rを駐車支援に用いる経路として採用するか否かを決定することにより、自車両Cの位置によってはマーカーを見失う可能性の少ない移動経路Rが採用され易くなるため、自車両Cの位置を的確に検出できる移動経路Rを採用して駐車支援を適切に行うことができる。この結果、駅前等の地価の高い場所を避け、その地価の高い場所から離れた地価の安い駐車場において、多数の車両を接触させることなく安全に詰め込んだ状態で駐車させる細密充填駐車が容易になる。   On the other hand, according to the parking assistance device 1 according to the present embodiment, the calculated movement route R is parked based on the number of markers M that can be detected from the own vehicle C on the calculated movement route R. By determining whether or not to adopt as a route to be used for the vehicle, it is easy to adopt a movement route R that is less likely to miss the marker depending on the position of the host vehicle C, and thus the movement that can accurately detect the position of the host vehicle C By using the route R, parking assistance can be appropriately performed. As a result, avoiding places with high land prices such as in front of the station, in a low-cost parking lot away from places with high land prices, it is easy to carry out finely packed parking that allows many vehicles to be parked safely without touching them. Become.

また、本実施形態に係る駐車支援装置1では、多くの地物をマーカーとして実際に自車両Cの周囲に設置することを必要としないため、管理費や維持費をかけずに低コストで、車両の存在位置の検出精度を高めることができる。また、突起物をマーカーとして実際に自車両Cの周囲に設置することを必要としないため、突起物と接触するようなことなく車両の存在位置の検出精度を高めることができる。更に、広範囲の様子を的確に検知可能なセンサは通常高価であるが、本実施形態に係る駐車支援装置1では、そのようなセンサを必要としないため、低コストで車両の存在位置の検出精度を高めることができる。   Moreover, in the parking assistance apparatus 1 according to the present embodiment, since it is not necessary to actually install many features as markers as the surroundings of the own vehicle C, it is low cost without incurring management costs and maintenance costs, The detection accuracy of the vehicle presence position can be increased. Moreover, since it is not necessary to actually install the protrusion as a marker around the host vehicle C, it is possible to improve the detection accuracy of the vehicle presence position without contacting the protrusion. Furthermore, although a sensor that can accurately detect a wide range is usually expensive, the parking assist device 1 according to the present embodiment does not require such a sensor, and therefore, the detection accuracy of the vehicle location can be reduced at a low cost. Can be increased.

また、この駐車支援装置1によれば、自車両Cが移動経路R上に存在しないことが検出された場合に修正経路S1を算出することにより、自車両Cが移動経路上に存在しないことが検出されても、修正経路を用いて自車両Cをその移動経路R上に誘導させて駐車支援を適切に行うことができる。   Moreover, according to this parking assistance apparatus 1, when it is detected that the own vehicle C does not exist on the moving route R, the own vehicle C may not exist on the moving route by calculating the correction route S1. Even if it is detected, the host vehicle C can be guided on the moving route R using the corrected route, and parking assistance can be appropriately performed.

また、この駐車支援装置1によれば、修正経路を進む自車両Cから検出可能なマーカーの個数と予め定められたマーカーの総数とに基づくマーカーの検出率のうち最も低い値が所定の閾値より大きい修正経路を採用することにより、マーカーの検出率が所定の閾値以下であるためにマーカーを見失う可能性のある修正経路は採用されないようになるため、自車両Cの位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる。   Further, according to the parking assist device 1, the lowest value of the marker detection rate based on the number of markers detectable from the host vehicle C traveling on the correction route and the predetermined total number of markers is lower than the predetermined threshold. By adopting a large correction route, a correction route that may cause the marker to be missed because the marker detection rate is equal to or lower than a predetermined threshold value is not adopted, and thus a route that can accurately detect the position of the host vehicle C. Can be used to support parking properly.

なお、上述した実施形態は本発明に係る駐車支援装置の実施形態を説明したものであり、本発明に係る駐車支援装置は本実施形態に記載したものに限定されるものではない。本発明に係る駐車支援装置は、各請求項に記載した要旨を変更しないように実施形態に係る駐車支援装置を変形し、又は他のものに適用したものであってもよい。   In addition, embodiment mentioned above demonstrated embodiment of the parking assistance apparatus which concerns on this invention, and the parking assistance apparatus which concerns on this invention is not limited to what was described in this embodiment. The parking assistance device according to the present invention may be modified from the parking assistance device according to the embodiment or applied to other devices without changing the gist described in each claim.

例えば、上述した実施形態では、図3に示されるように、周辺センサ6は自車両Cの進行方向F前方の扇形状範囲のエリアAをセンシングして現在地情報や周辺情報を取得する構成としたが、周辺センサは自車両Cの前後左右を含む全方向の範囲のエリアをセンシングして現在地情報や周辺情報を取得する構成としてもよい。   For example, in the above-described embodiment, as shown in FIG. 3, the surrounding sensor 6 senses the current area information and the surrounding information by sensing the area A of the fan-shaped range ahead of the traveling direction F of the host vehicle C. However, the surrounding sensor may be configured to sense the current location information and surrounding information by sensing an area in a range in all directions including front, rear, left and right of the host vehicle C.

また、上述した実施形態では、通信部4は、例えば駐車場入口に設置された路側送受信機との間で無線通信を行う構成としたが、通信部4を、自車両周辺の他車両との車々間通信を行う通信ユニットとする構成としてもよい。   In the above-described embodiment, the communication unit 4 is configured to perform wireless communication with, for example, a roadside transmitter / receiver installed at a parking lot entrance. However, the communication unit 4 is connected to other vehicles around the host vehicle. It is good also as a structure set as the communication unit which performs communication between vehicles.

また、上述した実施形態では、検出可能なマーカーの個数に基づいて経路の採用可否を決定しているが、例えば検出可能なマーカーの検出量といったような数量に基づいて経路の採用可否を決定してもよい。   In the above-described embodiment, whether or not a route is adopted is determined based on the number of detectable markers. However, whether or not a route can be adopted is determined based on a quantity such as the detected amount of a detectable marker. May be.

また、上述した実施形態では、駐車支援部14は、マーカー推定部13によって推定されたマーカーの個数が規定数以上となる移動経路を採用することが可能であるとしているが、マーカー推定部13が移動経路に関して上述のマーカーの検出率を複数算出し、駐車支援部14がマーカー推定部13によって推定されたマーカーの検出率の最低値が所定の閾値より大きい移動経路を採用してもよい。   In the above-described embodiment, the parking support unit 14 can adopt a movement route in which the number of markers estimated by the marker estimation unit 13 is equal to or greater than a specified number. However, the marker estimation unit 13 A plurality of marker detection rates may be calculated for the travel route, and the parking support unit 14 may employ a travel route in which the minimum marker detection rate estimated by the marker estimation unit 13 is greater than a predetermined threshold.

本発明によれば、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる駐車支援装置を提供することができる。   ADVANTAGE OF THE INVENTION According to this invention, the parking assistance apparatus which employ | adopts the path | route which can detect the position of a vehicle exactly and can perform parking assistance appropriately can be provided.

1…駐車支援装置、4…通信部、5…GPS受信部、6…周辺センサ、7…車両センサ、8…車両制御部、9…HMI、11…位置推定部、12…移動経路算出部、13…マーカー推定部、14…駐車支援部、15…修正経路算出部、A…エリア、C,D…自車両、F…進行方向、M…マーカー、P,P11,P21…ズレ修正位置、P0,P1,P2,P12,P22…ポイント、R,R2…移動経路、S1,S2…修正経路、T1〜T7…駐車枠、W1,W2…経路。   DESCRIPTION OF SYMBOLS 1 ... Parking assistance apparatus, 4 ... Communication part, 5 ... GPS receiving part, 6 ... Perimeter sensor, 7 ... Vehicle sensor, 8 ... Vehicle control part, 9 ... HMI, 11 ... Position estimation part, 12 ... Movement route calculation part, DESCRIPTION OF SYMBOLS 13 ... Marker estimation part, 14 ... Parking assistance part, 15 ... Correction route calculation part, A ... Area, C, D ... Own vehicle, F ... Traveling direction, M ... Marker, P, P11, P21 ... Deviation correction position, P0 , P1, P2, P12, P22 ... points, R, R2 ... movement route, S1, S2 ... correction route, T1 to T7 ... parking frame, W1, W2 ... route.

Claims (3)

自車両を駐車位置に誘導する駐車支援を、当該駐車位置と異なるマーカーが予め設定されたマップ情報を用いて行うための駐車支援装置において、
前記自車両の周辺状況を検出して前記マーカーを検出する周辺検出部と、
前記周辺検出部によって検出された前記マーカーと前記自車両との相対的な位置関係に基づいて前記自車両の現在位置を推定する位置推定部と、
前記位置推定部によって推定された前記現在位置から前記駐車位置までの移動経路を算出する移動経路算出部と、
前記移動経路算出部によって算出された前記移動経路上における前記自車両の進行方向と前記周辺検出部によるマーカー検出範囲とに基づいて、当該移動経路を進む前記自車両から前記周辺検出部によって検出可能な前記マーカーの個数を推定するマーカー推定部と、
前記移動経路算出部によって算出された前記移動経路について、前記マーカー推定部によって推定された前記マーカーの個数が規定数以上となる場合に、当該移動経路を前記駐車支援に用いる経路として採用する駐車支援部と、を備えた駐車支援装置。
In the parking support device for performing parking support for guiding the host vehicle to the parking position using map information in which a marker different from the parking position is set in advance,
A surrounding detection unit that detects the surrounding situation of the host vehicle and detects the marker;
A position estimation unit that estimates a current position of the host vehicle based on a relative positional relationship between the marker detected by the periphery detection unit and the host vehicle;
A movement route calculation unit for calculating a movement route from the current position to the parking position estimated by the position estimation unit;
Based on the travel direction of the host vehicle on the travel route calculated by the travel route calculation unit and the marker detection range by the periphery detection unit, the periphery detection unit can detect the vehicle traveling along the travel route. A marker estimation unit for estimating the number of such markers,
For the moving path calculated by the movement route calculating unit, when the number of the markers estimated by said marker estimator becomes a specified value or more, stationed you employed as a path using the moving path in the parking assist A parking assistance device comprising a vehicle assistance unit.
前記位置推定部によって推定された前記現在位置に基づいて、前記自車両が前記駐車支援部によって採用された前記移動経路上に存在しないことが検出された場合に、当該自車両を当該移動経路上に誘導させるための修正経路を前記駐車支援に用いる経路として算出する修正経路算出部を更に備えた、請求項1に記載の駐車支援装置。   Based on the current position estimated by the position estimating unit, when it is detected that the own vehicle does not exist on the moving route adopted by the parking support unit, the own vehicle is placed on the moving route. The parking support device according to claim 1, further comprising a correction route calculation unit that calculates a correction route for guiding the vehicle as a route used for the parking support. 前記マーカー推定部は、前記修正経路算出部によって算出された前記修正経路上における前記自車両の進行方向と前記マーカーを検出可能な範囲とに基づいて、当該修正経路を進む前記自車両から前記周辺検出部によって検出可能な前記マーカーの個数と、予め定められた前記マーカーの総数とに基づく前記マーカーの検出率を複数算出し、
前記修正経路算出部は、前記修正経路に関して、前記マーカー推定部によって算出された全ての前記マーカーの検出率のうち最も低い値が所定の閾値より大きい修正経路を前記駐車支援に用いる経路として採用する、請求項2に記載の駐車支援装置。
The marker estimation unit, based on a traveling direction of the host vehicle on the correction route calculated by the correction route calculation unit and a range in which the marker can be detected, from the host vehicle traveling on the correction route to the surroundings Calculating a plurality of detection rates of the marker based on the number of markers detectable by the detection unit and a predetermined total number of the markers;
The correction route calculation unit employs, as the route used for the parking assistance, a correction route in which the lowest value among the detection rates of all the markers calculated by the marker estimation unit is greater than a predetermined threshold with respect to the correction route. The parking assistance device according to claim 2.
JP2013222374A 2013-10-25 2013-10-25 Parking assistance device Active JP6167846B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2013222374A JP6167846B2 (en) 2013-10-25 2013-10-25 Parking assistance device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2013222374A JP6167846B2 (en) 2013-10-25 2013-10-25 Parking assistance device

Publications (2)

Publication Number Publication Date
JP2015083430A JP2015083430A (en) 2015-04-30
JP6167846B2 true JP6167846B2 (en) 2017-07-26

Family

ID=53047306

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2013222374A Active JP6167846B2 (en) 2013-10-25 2013-10-25 Parking assistance device

Country Status (1)

Country Link
JP (1) JP6167846B2 (en)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9696720B2 (en) 2015-08-27 2017-07-04 Hyundai Motor Company Apparatus and method for controlling autonomous navigation
MX368341B (en) 2015-12-17 2019-09-30 Nissan Motor Parking support method and device.
KR102237229B1 (en) * 2017-02-20 2021-04-07 현대자동차주식회사 A vehicle and method for controlling the same
WO2018173580A1 (en) 2017-03-21 2018-09-27 株式会社デンソー Driving assistance device
JP6996246B2 (en) * 2017-11-16 2022-01-17 株式会社アイシン Vehicle control device
JP6930600B2 (en) * 2017-11-17 2021-09-01 株式会社アイシン Vehicle position estimation device and vehicle control device
JP6992563B2 (en) * 2018-02-08 2022-01-13 株式会社デンソー Parking support device
JP7275520B2 (en) * 2018-10-03 2023-05-18 株式会社アイシン vehicle controller
JP7243141B2 (en) * 2018-11-16 2023-03-22 株式会社豊田中央研究所 Movement route generation device, movement route generation method, and computer program

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3804161B2 (en) * 1997-03-25 2006-08-02 日産自動車株式会社 Automatic parking device and parking guidance device
JP2001142532A (en) * 1999-11-12 2001-05-25 Nippon Signal Co Ltd:The Position detection device for mobile object
JP2006072431A (en) * 2004-08-31 2006-03-16 Matsushita Electric Ind Co Ltd Automatic parking system
JP2009208742A (en) * 2008-03-06 2009-09-17 Aisin Seiki Co Ltd Parking assist device

Also Published As

Publication number Publication date
JP2015083430A (en) 2015-04-30

Similar Documents

Publication Publication Date Title
JP6167846B2 (en) Parking assistance device
US10493984B2 (en) Vehicle control method and vehicle control device
US11313976B2 (en) Host vehicle position estimation device
US20200241531A1 (en) Automated driving apparatus
JP6219312B2 (en) Method for determining the position of a vehicle in a lane traffic path of a road lane and a method for detecting alignment and collision risk between two vehicles
JP4295298B2 (en) Vehicle driving support control device
WO2007132860A1 (en) Object recognition device
KR20080037708A (en) Vehicle positioning information update device
US20140032078A1 (en) Apparatus and method for calculating inter-vehicle distance
CN104670208A (en) Device and method for controlling speed of vehicle
US11608059B2 (en) Method and apparatus for method for real time lateral control and steering actuation assessment
CN102822881A (en) Vehicle collision judgment device
JP2019026099A (en) Traveling control system of vehicle
WO2017017705A1 (en) Host-position estimation device and host-position estimation method
CN110562233A (en) driver assistance
KR102227845B1 (en) System and method for controlling group driving based on v2v and das sensor
JP6436235B2 (en) Tracking control device and tracking control method
US11210953B2 (en) Driving support device
JP6941178B2 (en) Automatic operation control device and method
CA3031723A1 (en) Self-position estimation method and self-position estimation device
CN111089985A (en) Information processing system, nonvolatile storage medium storing program, and information processing method
WO2016126318A1 (en) Method of automatically controlling an autonomous vehicle based on cellular telephone location information
US10339395B2 (en) Display device, vehicle controller, transmitter, and travelling assistance system
CN104176055A (en) Apparatus and method for detecting a critical driving situation of a vehicle
WO2020148561A1 (en) Driving assistance method and driving assistance device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20160301

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20161011

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20161018

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20161214

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: 20170530

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20170612

R151 Written notification of patent or utility model registration

Ref document number: 6167846

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151