JP2014004933A - Parking support device, control method, and program - Google Patents
Parking support device, control method, and program Download PDFInfo
- Publication number
- JP2014004933A JP2014004933A JP2012142317A JP2012142317A JP2014004933A JP 2014004933 A JP2014004933 A JP 2014004933A JP 2012142317 A JP2012142317 A JP 2012142317A JP 2012142317 A JP2012142317 A JP 2012142317A JP 2014004933 A JP2014004933 A JP 2014004933A
- Authority
- JP
- Japan
- Prior art keywords
- steering
- vehicle
- target position
- steering mode
- 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.)
- Pending
Links
Images
Landscapes
- Traffic Control Systems (AREA)
- Steering-Linkage Mechanisms And Four-Wheel Steering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
Description
本発明の実施形態は、駐車支援装置、制御方法、およびプログラムに関する。 Embodiments described herein relate generally to a parking assistance device, a control method, and a program.
従来、前輪のみが操舵された場合と前輪および後輪の双方が操舵された場合との両方について目標位置までの移動経路が算出される駐車支援装置が知られている。 2. Description of the Related Art Conventionally, there is known a parking assist device that calculates a movement route to a target position both when a front wheel is steered and when both a front wheel and a rear wheel are steered.
駐車支援装置では、一例としては、移動経路に関する演算結果をより有効に活用できるのは好ましい。 In the parking assistance apparatus, as an example, it is preferable that the calculation result regarding the movement route can be used more effectively.
本発明の実施形態にかかる駐車支援装置は、一例として、車輪としての前輪と後輪とを有し操舵される前記車輪が異なる複数の操舵モードで操舵可能な車両の、目標位置までの移動経路を算出可能な経路算出部と、前記算出された移動経路に対応した前記操舵モードを示すデータを、前記算出された移動経路に基づく処理後に利用可能に記憶部に記憶させる記憶制御部と、を備えた。よって、一例としては、算出された移動経路に対応した操舵モードを示すデータを、算出された移動経路に基づく処理後に、利用することができる。よって、一例としては、同じ上記目標位置について上記移動経路が算出される際の手間やエネルギが減りやすい。 As an example, a parking assist apparatus according to an embodiment of the present invention has a front and rear wheels as wheels, and a travel path to a target position of a vehicle that can be steered in a plurality of steering modes in which the steered wheels are different. And a storage control unit that stores data indicating the steering mode corresponding to the calculated travel route in a storage unit so that the data can be used after processing based on the calculated travel route. Prepared. Therefore, as an example, data indicating the steering mode corresponding to the calculated travel route can be used after processing based on the calculated travel route. Therefore, as an example, it is easy to reduce labor and energy when the movement route is calculated for the same target position.
また、上記駐車支援装置では、一例として、上記記憶部は、書き換え可能な不揮発性の記憶部である。よって、一例としては、上記記憶部には、上記算出された移動経路に対応した操舵モードを示すデータが、算出された移動経路に基づく処理後まで、より確実に記憶されやすい。 In the parking assist device, as an example, the storage unit is a rewritable nonvolatile storage unit. Therefore, as an example, data indicating the steering mode corresponding to the calculated travel route is more easily stored in the storage unit until after processing based on the calculated travel route.
また、上記駐車支援装置では、一例として、上記記憶制御部は、上記車両の上記目標位置への移動制御に使われた上記移動経路に対応した上記操舵モードを示す上記データを、上記記憶部に記憶させる。よって、一例としては、上記目標位置に対して、上記車両が、より不都合の少ない移動経路で出入りしやすい。 In the parking assist device, as an example, the storage control unit stores the data indicating the steering mode corresponding to the movement route used for the movement control of the vehicle to the target position in the storage unit. Remember me. Therefore, as an example, the vehicle is likely to enter and exit from the target position on a less inconvenient moving route.
また、上記駐車支援装置では、一例として、上記記憶制御部は、上記移動経路の上記操舵モードに上記前輪および上記後輪が操舵される操舵モードが含まれる場合に、少なくとも上記前輪および上記後輪が操舵される操舵モードを示すデータを上記記憶部に記憶させる。よって、一例としては、上記前輪および上記後輪が操舵されて運転者が上記車両の挙動を把握しにくい上記操舵モードで、上記駐車支援装置は、例えば、自動操舵制御を行うことで運転を支援したり、手動操舵時に表示装置や音声出力部等から報知を行うことで運転者に注意を喚起したりすることができる。 In the parking assist device, as an example, the storage control unit may include at least the front wheel and the rear wheel when the steering mode of the moving path includes a steering mode in which the front wheels and the rear wheels are steered. Data indicating the steering mode in which the is steered is stored in the storage unit. Therefore, as an example, in the steering mode in which the front wheel and the rear wheel are steered and it is difficult for the driver to grasp the behavior of the vehicle, the parking assistance device supports driving by performing automatic steering control, for example. Or alerting the driver by performing notification from the display device or the audio output unit during manual steering.
また、上記駐車支援装置では、一例として、上記記憶制御部は、上記操舵モードを示すデータを、上記目標位置に対応したデータと対応させて、上記記憶部に記憶させる。よって、一例としては、上記駐車支援装置は、上記目標位置に対応したデータに基づいて、上記操舵モードを示すデータを、より迅速にあるいはより精度良く取得しやすい。 In the parking assist device, as an example, the storage control unit stores data indicating the steering mode in the storage unit in association with data corresponding to the target position. Therefore, as an example, the parking assist device can easily acquire data indicating the steering mode more quickly or more accurately based on data corresponding to the target position.
また、上記駐車支援装置は、一例として、上記目標位置に位置した上記車両が当該目標位置から出る際に、上記記憶部に記憶された上記操舵モードを示すデータに対応した上記操舵モードで上記車輪の操舵を制御する操舵制御部を備えた。よって、一例としては、上記車両は上記目標位置からより迅速にあるいはより円滑に外に出やすい。 In addition, as an example, when the vehicle located at the target position leaves the target position, the parking assist device may use the wheel in the steering mode corresponding to the data indicating the steering mode stored in the storage unit. The steering control part which controls steering of this was provided. Therefore, as an example, the vehicle tends to go out of the target position more quickly or more smoothly.
また、本発明の実施形態にかかる制御方法では、一例として、上記駐車支援装置が、車輪としての前輪と後輪とを有し操舵される上記車輪が異なる複数の操舵モードで操舵可能な車両の、目標位置までの移動経路を算出するステップと、上記算出された移動経路に対応した上記操舵モードを示すデータを、前記算出された移動経路に基づく処理後に利用可能に記憶部に記憶させるステップと、を含む。よって、一例としては、算出された移動経路に対応した操舵モードを示すデータを、算出された移動経路に基づく処理後に、利用することができる。よって、一例としては、同じ上記目標位置について上記移動経路が算出される際の手間やエネルギが減りやすい。 Moreover, in the control method according to the embodiment of the present invention, as an example, the parking assist device includes a front wheel and a rear wheel as wheels, and the steered vehicle is steerable in a plurality of different steering modes. A step of calculating a movement route to a target position, and a step of storing data indicating the steering mode corresponding to the calculated movement route in a storage unit so as to be usable after processing based on the calculated movement route; ,including. Therefore, as an example, data indicating the steering mode corresponding to the calculated travel route can be used after processing based on the calculated travel route. Therefore, as an example, it is easy to reduce labor and energy when the movement route is calculated for the same target position.
また、本発明の実施形態にかかるプログラムは、一例として、コンピュータに、車輪としての前輪と後輪とを有し操舵される上記車輪が異なる複数の操舵モードで操舵可能な車両の、目標位置までの移動経路を算出するステップと、上記算出された移動経路に対応した上記操舵モードを示すデータを、前記算出された移動経路に基づく処理後に利用可能に記憶部に記憶させるステップと、を実行させる。よって、一例としては、算出された移動経路に対応した操舵モードを示すデータを、算出された移動経路に基づく処理後に、利用することができる。よって、一例としては、同じ上記目標位置について上記移動経路が算出される際の手間やエネルギが減りやすい。 In addition, as an example, the program according to the embodiment of the present invention includes a computer that has a front wheel and a rear wheel as wheels, and is steered to a target position of a vehicle that can be steered in a plurality of different steering modes. And a step of storing data indicating the steering mode corresponding to the calculated movement route in a storage unit so as to be usable after processing based on the calculated movement route. . Therefore, as an example, data indicating the steering mode corresponding to the calculated travel route can be used after processing based on the calculated travel route. Therefore, as an example, it is easy to reduce labor and energy when the movement route is calculated for the same target position.
本実施形態では、車両１は、例えば、内燃機関（エンジン、図示されず）を駆動源とする自動車（内燃機関自動車）であってもよいし、電動機（モータ、図示されず）を駆動源とする自動車（電気自動車、燃料電池自動車等）であってもよいし、それらの双方を駆動源とする自動車（ハイブリッド自動車）であってもよい。また、車両１は、種々の変速装置を搭載することができるし、内燃機関や電動機を駆動するのに必要な種々の装置（システム、部品等）を搭載することができる。また、車両１における車輪３の駆動に関わる装置の方式や、数、レイアウト等は、種々に設定することができる。
In the present embodiment, the
図１に示されるように、車体２は、乗員（図示されず）が乗車する車室２ａを構成している。車室２ａ内には、乗員としての運転者の座席２ｂに臨む状態で、操舵部４や、加速操作部５、制動操作部６、変速操作部７等が設けられている。本実施形態では、一例として、操舵部４は、ダッシュボード（インストルメントパネル）から突出したステアリングホイールであり、加速操作部５は、運転者の足下に位置されたアクセルペダルであり、制動操作部６は、運転者の足下に位置されたブレーキペダルであり、変速操作部７は、センターコンソールから突出したシフトレバーであるが、これらには限定されない。
As shown in FIG. 1, the
また、車室２ａ内には、表示装置８（表示出力部）や、音声出力装置９（音声出力部）が設けられている。表示装置８は、例えば、ＬＣＤ（liquid crystal display）や、ＯＥＬＤ（organic electroluminescent display）等である。音声出力装置９は、一例として、スピーカである。また、本実施形態では、一例として、表示装置８は、透明な操作入力部１０（例えば、タッチパネル等）で覆われている。乗員等は、操作入力部１０を介して表示装置８の表示画面に表示される映像（画像）を視認することができる。また、乗員等は、表示装置８の表示画面に表示される映像（画像）に対応した位置で手指等で操作入力部１０を触れたり押したり動かしたりして操作することで、操作入力（指示入力）を実行することができる。また、本実施形態では、一例として、表示装置８や、音声出力装置９、操作入力部１０等は、ダッシュボードの車幅方向（左右方向）の中央部に位置されたモニタ装置１１に設けられている。モニタ装置１１は、スイッチや、ダイヤル、ジョイスティック、押しボタン等の操作入力部（図示されず）を有することができる。また、モニタ装置１１とは異なる車室２ａ内の他の位置に音声出力装置（図示されず）を設けることができるし、モニタ装置１１の音声出力装置９と他の音声出力装置から、音声を出力することができる。また、本実施形態では、一例として、モニタ装置１１は、ナビゲーションシステムやオーディオシステムと兼用されているが、駐車支援装置用のモニタ装置を、これらシステムとは別に設けてもよい。また、音声出力装置９の他に、ブザー２４（図３参照）等の音声出力部から、警報音等が出力されるように構成することができる。
Further, a display device 8 (display output unit) and a sound output device 9 (sound output unit) are provided in the
また、図１，２に示されるように、本実施形態では、一例として、車両１は、四輪車（四輪自動車）であり、左右二つの前輪３Ｆと、左右二つの後輪３Ｒとを有する。さらに、本実施形態では、これら四つの車輪３は、いずれも操舵されうるように（転舵可能に）構成されている。具体的には、図３に示されるように、車両１は、前輪３Ｆを操舵する前輪操舵システム１２と、後輪３Ｒを操舵する後輪操舵システム１３とを有している。これら前輪操舵システム１２および後輪操舵システム１３は、駐車支援ＥＣＵ１４（electronic control unit）等によって電気的に制御されて、それぞれのアクチュエータ１２ａ，１３ａを動作させる。前輪操舵システム１２ならびに後輪操舵システム１３は、例えば、電動パワーステアリングシステムや、ＳＢＷ（steer by wire）システム等である。前輪操舵システム１２ならびに後輪操舵システム１３は、アクチュエータ１２ａ，１３ａによって操舵部４にトルク（アシストトルク）を付加して操舵力を補ったり、対応する車輪３（前輪３Ｆまたは後輪３Ｒ）を操舵（自動操舵）したりする。アクチュエータ１２ａ，１３ａは、一つの車輪３を操舵してもよいし、複数の車輪３を操舵してもよい。また、本実施形態では、一例として、二つの前輪３Ｆは、互いに同相（同位相、同転舵方向、同回動方向）で略平行に転舵され、二つの後輪３Ｒは、互いに同相で略平行に転舵される。なお、駆動輪は種々に設定可能である。
As shown in FIGS. 1 and 2, in the present embodiment, as an example, the
また、本実施形態では、一例として、前輪３Ｆのみが操舵される二輪操舵モード（第一の操舵モード）と、前輪３Ｆおよび後輪３Ｒが操舵される四輪操舵モード（第二の操舵モード）とが設定されている。操舵モードは、乗員による操作入力部１０の操作や、車室２ａ内に設けられた操舵モード切替操作部１５（例えば、スイッチ等、図３参照）の操作等によって、切り替えられる。また、本実施形態では、一例として、駐車支援に関しては、四輪操舵モードでは、前輪３Ｆおよび後輪３Ｒは、逆相（逆位相、逆転舵方向、逆回動方向）で転舵される。なお、前輪３Ｆは、操舵部４の操作により、機械的に転舵されることができる。
In the present embodiment, as an example, a two-wheel steering mode (first steering mode) in which only the
また、本実施形態では、一例として、図２に示されるように、車両１（車体２）には、複数（本実施形態では、一例として四つ）の撮像部１６（１６ａ〜１６ｄ）が設けられている。撮像部１６は、例えば、ＣＣＤ（charge coupled device）やＣＩＳ（CMOS image sensor）等の撮像素子を内蔵するデジタルカメラである。撮像部１６は、所定のフレームレートで画像データ（動画データ、フレームデータ）を出力することができる。撮像部１６は、それぞれ、広角レンズを有し、水平方向には１４０°〜１９０°の範囲（視野角）を撮影することができる。また、撮像部１６の光軸は下方（斜め下方）に向けて設定されている。よって、撮像部１６は、路面を含む車体２の周辺を撮影することができる。本実施形態では、一例として、撮像部１６ａは、車体２の前側（車両前後方向の前方側）の端部２ｃ（平面視での端部）に位置され、フロントバンパー等に設けられている。撮像部１６ｂは、車体２の左側（車幅方向の左側）の端部２ｄに位置され、左側のドアミラー２ｇ（突出部）に設けられている。撮像部１６ｃは、車体２の後側（車両前後方向の後方側）の端部２ｅに位置され、リヤトランクのドア２ｈの下方の壁部に設けられている。撮像部１６ｄは、車体２の右側（車幅方向の右側）の端部２ｆに位置され、右側のドアミラー２ｇ（突出部）に設けられている。駐車支援ＥＣＵ１４は、複数の撮像部１６で得られた画像データに基づいて演算処理や画像処理を実行し、より広い視野角の画像を生成したり、車両１（車体２）を上方から見た仮想的な俯瞰画像（平面画像）を生成したりすることができる。また、駐車支援ＥＣＵ１４は、撮像部１６ｄの画像から、車両１の周辺に位置され移動する車両１と干渉する可能性がある物体（障害物）を検出（抽出）することができる。よって、撮像部１６は、物体検出部の一例である。
In the present embodiment, as an example, as shown in FIG. 2, the vehicle 1 (the vehicle body 2) is provided with a plurality of (in the present embodiment, four as an example) imaging units 16 (16 a to 16 d). It has been. The
また、本実施形態では、一例として、図１，２に示されるように、車両１（車体２）には、複数（本実施形態では、一例として四つ）の測距部１７（１７ａ〜１７ｄ、探知部）が設けられている。測距部１７は、例えば、超音波を発射してその反射波を捉えるソナー（ソナーセンサ、超音波探知器）である。駐車支援ＥＣＵ１４は、測距部１７の検出結果により、車両１（車体２）の後方に位置された物体（障害物）の有無や距離を測定することができる。すなわち、測距部１７は、物体検出部の一例である。
In the present embodiment, as an example, as shown in FIGS. 1 and 2, the vehicle 1 (the vehicle body 2) includes a plurality of (in the present embodiment, four as an example) distance measuring units 17 (17 a to 17 d). , A detection unit) is provided. The
また、本実施形態では、一例として、図３に示されるように、駐車支援システム１００では、駐車支援ＥＣＵ１４や、モニタ装置１１、前輪操舵システム１２、後輪操舵システム１３、操舵モード切替操作部１５、測距部１７等の他、ブレーキシステム１８、舵角センサ１９（角度センサ）、アクセルセンサ２０、シフトセンサ２１、車輪速センサ２２、ＧＰＳ２５（global positioning system）等が、車内ネットワーク２３（電気通信回線）を介して電気的に接続されている。車内ネットワーク２３は、一例としては、ＣＡＮ（controller area network）として構成されている。駐車支援ＥＣＵ１４は、車内ネットワーク２３を通じて制御信号を送ることで、前輪操舵システム１２や、後輪操舵システム１３、ブレーキシステム１８等を制御することができる。また、駐車支援ＥＣＵ１４は、車内ネットワーク２３を介して、トルクセンサ１２ｂ、舵角センサ１３ｂ（後輪３Ｒ用）、測距部１７、ブレーキセンサ１８ｂ、舵角センサ１９（前輪３Ｆ用）、アクセルセンサ２０、シフトセンサ２１、車輪速センサ２２等の検出結果、ならびに、操作入力部１０や、操舵モード切替操作部１５等の指示信号（制御信号、切替信号、操作信号、入力信号、データ）を受け取ることができる。
In the present embodiment, as an example, as shown in FIG. 3, in the
駐車支援ＥＣＵ１４は、一例として、ＣＰＵ１４ａ（central processing unit）や、ＲＯＭ１４ｂ（read only memory）、ＲＡＭ１４ｃ（random access memory）、表示制御部１４ｄ、音声制御部１４ｅ、ＳＳＤ１４ｆ（solid state drive、フラッシュメモリ）等を有している。ＣＰＵ１４ａは、例えば、表示装置８で表示される画像に関連した画像処理や、車両１の移動経路の演算、物体との干渉の有無の判断等の各種の演算処理を実行することができる。ＣＰＵ１４ａは、ＲＯＭ１４ｂ等の不揮発性の記憶装置に記憶された（インストールされた）プログラムを読み出し、当該プログラムにしたがって演算処理を実行することができる。ＲＡＭ１４ｃは、ＣＰＵ１４ａでの演算で用いられる各種のデータを一時的に記憶する。また、表示制御部１４ｄは、駐車支援ＥＣＵ１４での演算処理のうち、主として、撮像部１６で得られた画像データを用いた画像処理や、表示装置８で表示される画像データの画像処理（一例としては合成等）等を実行する。また、音声制御部１４ｅは、駐車支援ＥＣＵ１４での演算処理のうち、主として、音声出力装置９で出力される音声データの処理を実行する。また、ＳＳＤ１４ｆは、書き換え可能な不揮発性の記憶部であって、駐車支援ＥＣＵ１４の電源がオフされた場合にあってもデータを記憶することができる。なお、ＣＰＵ１４ａや、ＲＯＭ１４ｂ、ＲＡＭ１４ｃ等は、同一パッケージ内に集積されることができる。また、駐車支援ＥＣＵ１４は、ＣＰＵ１４ａに替えて、ＤＳＰ（digital signal processor）等の他の論理演算プロセッサや論理回路等が用いられる構成であってもよい。また、ＳＳＤ１４ｆに替えてＨＤＤ（hard disk drive）が設けられてもよいし、ＳＳＤ１４ｆやＨＤＤは、駐車支援ＥＣＵ１４とは別に設けられてもよい。
As an example, the parking assist
ブレーキシステム１８は、ブレーキのロックを抑制するＡＢＳ（anti-lock brake system）や、コーナリング時の車両１の横滑りを抑制する横滑り防止装置（ＥＳＣ：electronic stability control）、ブレーキ力を増強させる（ブレーキアシストを実行する）電動ブレーキシステム、ＢＢＷ（brake by wire）等である。ブレーキシステム１８は、アクチュエータ１８ａを介して、車輪３（車両１）に制動力を与える。
The
舵角センサ１９は、操舵部４（本実施形態では、一例としてステアリングホイール）の操舵量（回動角度）を検出するセンサであり、一例としては、ホール素子などを用いて構成される。また、舵角センサ１３ｂは、後輪３Ｒの操舵量（回動角度）を検出するセンサであり、一例としては、ホール素子などを用いて構成される。駐車支援ＥＣＵ１４は、運転者による操舵部４の操舵量や、自動操舵時の各車輪３の操舵量等を、舵角センサ１９，１３ｂから取得して各種制御を実行する。なお、トルクセンサ１２ｂは、運転者が操舵部４に与えるトルクを検出する。
The
車輪速センサ２２は、車輪３の回転量や単位時間当たりの回転数を検出するセンサであり、一例としては、ホール素子などを用いて構成される。駐車支援ＥＣＵ１４は、車輪速センサ２２から取得したデータに基づいて車両１の移動量などを演算し、各種制御を実行する。車輪速センサ２２は、ブレーキシステム１８に設けられている場合もある。また、ブレーキシステム１８は、左右の車輪３の回転差などからブレーキのロックや、車輪３の空回り、横滑りの兆候等を検出して、各種制御を実行することができる。車輪速センサ２２がブレーキシステム１８に設けられている場合には、駐車支援ＥＣＵ１４は、ブレーキシステム１８を介してデータを取得する。ブレーキセンサ１８ｂは、ブレーキペダルの操作量を検出するセンサであり、駐車支援ＥＣＵ１４は、ブレーキシステム１８を介して情報を取得する。駐車支援ＥＣＵ１４は、例えば、自動操舵中に制動操作部６が操作されたような場合に、自動操舵には適さない状況にあるとして自動操舵を中断したり中止したりすることができる。
The wheel speed sensor 22 is a sensor that detects the amount of rotation of the
シフトセンサ２１は、一例としては、変速操作部７の可動部（レバーや、アーム、ボタン等）の位置を検出するセンサ（スイッチ）であり、変位センサなどを用いて構成される。例えば、駐車支援ＥＣＵ１４は、可動部がリバースにセットされた場合に支援制御を開始したり、リバースから前進に変更された場合に支援制御を終了させたりすることができる。
As an example, the
なお、上述した各種センサやアクチュエータの構成や、配置、電気的な接続形態等は、あくまで一例であって、種々に設定（変更）することができる。 The configuration, arrangement, electrical connection form, and the like of the various sensors and actuators described above are merely examples, and can be set (changed) in various ways.
また、本実施形態では、一例として、駐車支援ＥＣＵ１４は、ハードウエアとソフトウエア（プログラム）との協働によって、駐車支援装置３０の少なくとも一部として機能（動作）する。すなわち、本実施形態では、一例として、図４に示されるように、駐車支援ＥＣＵ１４は、表示制御部１４ｄ（図３参照）ならびに音声制御部１４ｅ（図３参照）の他、検出制御部３０ａや、目標位置設定部３０ｂ、経路算出部３０ｃ、軌跡算出部３０ｄ、干渉判断部３０ｅ、経路選択部３０ｆ、操舵方式決定部３０ｇ、自動操舵制御部３０ｈ（操舵制御部）、手動操舵制御部３０ｉ（操舵制御部）、切り返し制御部３０ｊ、操作入力制御部３０ｋ、記憶制御部３０ｍ、出車制御部３０ｎ等として機能（動作）する。なお、プログラムには、一例としては、図４に示される各ブロックに対応したモジュールが含まれうる。また、画像処理は、表示制御部１４ｄの他、ＣＰＵ１４ａでも実行されうる。
In the present embodiment, as an example, the
上述したように、本実施形態では、一例として、車両１は、前輪３Ｆのみが操舵される二輪操舵モード（第一の操舵モード、２ＷＳ：2 wheel steering）と、前輪３Ｆおよび後輪３Ｒが操舵される四輪操舵モード（第二の操舵モード、４ＷＳ：4 wheel steering）とで、操舵可能に構成されている。図５には、第一の操舵モード（２ＷＳ）で操舵された場合の車両１の移動経路Ｐ１および軌跡Ｔｉ，Ｔｏの一例が示され、図６には、第二の操舵モード（４ＷＳ）で操舵された場合の車両１の移動経路Ｐ２および軌跡Ｔｉ，Ｔｏの一例が示されている。なお、操舵方式は、自動操舵であっても良いし、手動操舵であってもよい。また、図５，６で、前輪３Ｆの舵角は同じである。また、図５，６ともに、最大舵角（最小回転半径）の場合が示されている。第一の操舵モードでは、図５に示されるように、旋回中心Ｃ１は、転舵された前輪３Ｆの側方（前輪３Ｆの回転軸の略延長線上）に位置するとともに、転舵されていない（中立位置の、車両前後方向に沿って転動する）後輪３Ｒの側方（後輪３Ｒの回転軸の略延長線上）に位置する。一方、第二の操舵モードでは、図６に示されるように、旋回中心Ｃ２は、転舵された前輪３Ｆおよび転舵された後輪３Ｒの側方に位置する。前輪３Ｆおよび後輪３Ｒは、逆相（逆位相、逆転舵方向、逆回動方向）に、転舵されている。図５，６を比較参照すれば、第二の操舵モードでの旋回中心Ｃ２は、後輪３Ｒが転舵されている分、第一の操舵モードでの旋回中心Ｃ１より車両１の近くに位置されていることがわかる。すなわち、一例として、車両１は、図５に示されるように、第一の操舵モードでは一度の移動（切り返し無しの移動、後退）では目標位置Ｔａ（目標領域、図５，６では一例として二本の平行な線Ｌ間の領域）に到達できない場合にあっても、図６に示されるように、第二の操舵モードであれば一度の移動（切り返し無しの移動、後退）で目標位置Ｔａに到達できる場合がある。そこで、本実施形態では、経路算出部３０ｃが、複数の移動経路、一例としては、第一の操舵モードでの移動を含む目標位置Ｔａに向けての移動経路Ｐ１と、第二の操舵モードでの移動を含む目標位置Ｔａに向けての移動経路Ｐ２とを算出する。そして、経路選択部３０ｆは、複数の移動経路のうち、目標位置Ｔａに到達できる移動経路（図５，６の例では移動経路Ｐ２）を、使用する（自動操舵に用いる、あるいは運転者に提示する、案内する）移動経路として選択する。経路選択部３０ｆは、操舵モード決定部、あるいは操舵輪決定部の一例でもある。
As described above, in the present embodiment, as an example, in the present embodiment, the
また、図５，６から、第一の操舵モード（２ＷＳ）と第二の操舵モード（４ＷＳ）とで、移動経路Ｐ１，Ｐ２とともに、車両１の移動の軌跡Ｔｉ，Ｔｏが異なっていることがわかる。特に、第一の操舵モードと第二の操舵モードとで、上述した旋回中心Ｃ１，Ｃ２の場所の違いにより、車両１のうち最も旋回中心Ｃ１に近い側を通る点Ｐｉ（以下、最内点と称する）が相違するため、旋回中心Ｃ１，Ｃ２側の軌跡Ｔｉの差異は、より大きくなりやすい。すなわち、図５に示されるように、第一の操舵モードでは、最内点Ｐｉは、旋回中心Ｃ１に近い側の後輪３Ｒ（図５の例では右側の後輪３Ｒ）の位置である。一方、図６に示されるように、第二の操舵モードでは、最内点Ｐｉは、車体２（車両１）の車幅方向の旋回中心Ｃ２側の端部（図６の例では左側の端部２ｄ）の平面視で前輪３Ｆと後輪３Ｒとの間の部位（位置、部分）である。平面視とは、車両１の上方からの視線である。よって、本実施形態では、干渉判断部３０ｅは、各操舵モードで異なる最内点Ｐｉの軌跡に基づいて車両１と物体Ｂとの干渉の有無を判断する。なお、最外点Ｐｏは、第一の操舵モードおよび第二の操舵モードともに、旋回中心Ｃ１から遠い側の車体２の角部２ｉである。
5 and 6, the movement trajectories Ti and To of the
図７〜９には、車両１が縦列駐車される場合が例示されている。図７には、車両１が第一の操舵モード（２ＷＳ）で操舵される場合が例示され、図８には、車両１が第二の操舵モード（４ＷＳ）で操舵される場合が例示され、図９には、車両１が第二の操舵モードで操舵されかつ図８より車輪３の舵角が大きい場合が例示されている。図７〜９のいずれの場合も、移動経路Ｐ１〜Ｐ３はＳ字状である。すなわち、車輪３は、当初は一方側（図７〜９の例では平面視で左方向、反時計回り方向）に転舵され、その後、中立位置を経て他方側（同右方向、時計周り方向）に転舵され、再び中立位置に戻される。なお、操舵方式は、自動操舵であっても良いし、手動操舵であってもよい。
The case where the
図７の例では、目標位置Ｔａは、壁Ｗに寄った二つの物体Ｂ（他の駐車車両）間に位置される。二つの物体Ｂ間の距離はＬ１である。図７の例では、第一の操舵モードでは、車両１は、一度の移動（切り返し無しの移動、後退）では目標位置Ｔａに到達できない。このような場合、本実施形態では、経路算出部３０ｃは、第二の操舵モードでの目標位置Ｔａへの移動経路（例えば、図８の移動経路Ｐ２）を算出する。そして、第二の操舵モードでの移動経路Ｐ２が、車両１が物体Ｂや壁Ｗと干渉することなく目標位置Ｔａへ到達できる移動経路である場合、経路選択部３０ｆは、当該移動経路Ｐ２を選択することができる。
In the example of FIG. 7, the target position Ta is located between two objects B (other parked vehicles) that have approached the wall W. The distance between the two objects B is L1. In the example of FIG. 7, in the first steering mode, the
図９の例では、二つの物体Ｂ間の距離は、図８のＬ２より短いＬ３である。図９の例では、図８の車輪３の舵角では、一度の移動（切り返し無しの移動、後退）で目標位置Ｔａに到達できない。このような場合、本実施形態では、経路算出部３０ｃは、第二の操舵モードでより舵角が大きい状態での目標位置Ｔａへの移動経路（例えば、図９の移動経路Ｐ３）を算出する。そして、第二の操舵モードでより舵角が大きい状態での移動経路Ｐ３が、車両１が物体Ｂや壁Ｗと干渉することなく目標位置Ｔａへ到達できる移動経路である場合、経路選択部３０ｆは、当該移動経路Ｐ３を選択することができる。
In the example of FIG. 9, the distance between the two objects B is L3 shorter than L2 of FIG. In the example of FIG. 9, at the rudder angle of the
また、図８に例示される二つの物体Ｂ間の距離がＬ２の場合には、図９に例示される車輪３の舵角の移動経路Ｐ３であっても、目標位置Ｔａへ到達することができる。しかしながら、本実施形態では、一例として、経路選択部３０ｆは、目標位置Ｔａへ到達できる複数の移動経路Ｐ２，Ｐ３のうち、車輪３の舵角がより小さい、すなわち車輪３の操舵量がより少ない（一例としては、舵角の角度範囲がより狭い、最大舵角がより小さい）移動経路Ｐ３を選択する。よって、本実施形態によれば、一例としては、車輪３の操舵に要するエネルギをより減らしやすい。
Further, when the distance between the two objects B illustrated in FIG. 8 is L2, the target position Ta can be reached even in the travel path P3 of the steering angle of the
また、図示されないが、図７より二つの物体Ｂ間の距離が長く（Ｌ１より長く）第一の操舵モードでの移動経路（例えばＰ１）でも車両１が目標位置（図示されず）へ到達できる場合、図８，９に示されるような第二の操舵モードでの移動経路Ｐ２，Ｐ３でも車両１は当該目標位置へ到達できる。しかしながら、本実施形態では、一例として、経路選択部３０ｆは、目標位置へ到達できる複数の移動経路に、第一の操舵モードでの移動経路Ｐ１（第一の移動経路）と、第二の操舵モードでの移動経路Ｐ２，Ｐ３（第二の移動経路）とが含まれる場合、第一の操舵モードでの移動経路Ｐ１を選択する。すなわち、この場合も、経路選択部３０ｆは、目標位置へ到達できる複数の移動経路Ｐ１〜Ｐ３のうち、後輪３Ｒが操舵されない分車輪３の操舵量がより少ない移動経路Ｐ１を選択する。よって、本実施形態によれば、一例としては、車輪３の操舵に要するエネルギをより減らしやすい。
Although not shown, the distance between the two objects B is longer than that in FIG. 7 (longer than L1), and the
また、本実施形態にかかる駐車支援装置３０は、一例として、図１０に示される手順で処理を実行することができる。まず、駐車支援装置３０は、検出制御部３０ａ（図４参照）として機能し、物体検出部としての撮像部１６や、測距部１７等から取得したデータに基づいて、車両１の周辺の物体Ｂを検出する（ステップＳ１０１）。このステップＳ１０１で検出される物体は、車両１と干渉（例えば、接触、衝突等）する可能性がある物体であり、所定の条件（例えば、地面からの距離や、高さ等）を満たしている。このステップＳ１０１により、車両１と物体Ｂとの相対的な位置関係や、制御の基準となる二次元座標系における車両１や物体Ｂの位置、物体Ｂの領域等がわかる。ステップＳ１０１自体は、他の公知の手法でも実行されうる。
Moreover, the
次に、駐車支援装置３０は、目標位置設定部３０ｂ（図４参照）として機能し、目標位置Ｔａを設定する（ステップＳ１０２）。このステップＳ１０２では、例えば、表示装置８に表示された車両１を含む平面図（俯瞰図）の画像に対応した操作入力部１０での操作入力（指示入力、指定入力）により、操作者（運転者や乗員等）によって指定された位置あるいは領域として、目標位置Ｔａが設定される。また、目標位置設定部３０ｂは、例えば、車両１の挙動に対応して撮像部１６で取得された車両１の周辺の画像に基づいて、目標位置Ｔａを自動的に検出し、設定することができる。ステップＳ１０２自体は、他の公知の手法でも実行されうる。
Next, the
次に、駐車支援装置３０は、経路算出部３０ｃ（図４参照）として機能し、車両１の現在位置から目標位置Ｔａまでの移動経路を算出する（ステップＳ１０３）。ステップＳ１０３では、一例として、まずは、第一の操舵モード（２ＷＳ）での移動経路が算出される。このステップＳ１０３で、経路算出部３０ｃは、例えば、車両１の現在位置と目標位置Ｔａとに基づいて所定の手順や条件にしたがった幾何学的な演算を行って、車両１の移動経路を算出することができる。あるいは、経路算出部３０ｃは、例えば、ＲＯＭ１４ｂやＳＳＤ１４ｆ等に記憶された複数の経路パターンのデータを参照し、現在位置と目標位置Ｔａとに合致する経路パターンを選択することができる。また、このステップＳ１０３で、経路算出部３０ｃは、目標位置Ｔａへ到達できる複数の移動経路を算出するのが好適である。移動経路の算出自体は、他の公知の手法でも実行されうる。
Next, the
次に、駐車支援装置３０は、軌跡算出部３０ｄ（図４参照）として機能し、ステップＳ１０３で算出された第一の操舵モードでの各移動経路に対応した軌跡を算出する（ステップＳ１０４）。このステップＳ１０４で、軌跡算出部３０ｄは、例えば、移動経路に基づいて幾何学的な演算を行って、少なくとも、上述した最内点Ｐｉおよび最外点Ｐｏの軌跡Ｔｉ，Ｔｏを算出する。あるいは、経路算出部３０ｃは、例えば、ＲＯＭ１４ｂやＳＳＤ１４ｆ等に記憶された複数の経路パターンに対応した軌跡Ｔｉ，Ｔｏのデータを取得することができる。ステップＳ１０４自体は、他の公知の手法でも実行されうる。
Next, the
次に、駐車支援装置３０は、干渉判断部３０ｅ（図４参照）として機能し、ステップＳ１０４で算出された車両１の各軌跡と物体Ｂとの干渉の有無を判断する（ステップＳ１０５）。
Next, the
ステップＳ１０５で、いずれの移動経路の軌跡も物体Ｂとの干渉があると判断された場合、駐車支援装置３０は、経路算出部３０ｃ（図４参照）として機能し、車両１の現在位置から目標位置Ｔａまでのさらに別の移動経路を算出する（ステップＳ１０６）。ステップＳ１０６では、一例として、第二の操舵モード（４ＷＳ）での移動経路が算出される。また、このステップＳ１０６で、経路算出部３０ｃは、目標位置Ｔａへ到達できる複数の移動経路を算出するのが好適である。
In step S105, when it is determined that any of the trajectories of the moving route has interference with the object B, the parking assist
次に、駐車支援装置３０は、軌跡算出部３０ｄ（図４参照）として機能し、ステップＳ１０６で算出された第二の操舵モードでの移動経路に対応した軌跡を算出する（ステップＳ１０７）。上述したように、この場合の最内点Ｐｉは、車体２（車両１）の車幅方向の旋回中心Ｃ２側の端部（図６の例では左側の端部２ｄ）の前輪３Ｆと後輪３Ｒとの間の位置である。
Next, the
次に、駐車支援装置３０は、干渉判断部３０ｅ（図４参照）として機能し、ステップＳ１０７で算出された車両１の各軌跡と物体Ｂとの干渉の有無を判断する（ステップＳ１０８）。
Next, the
ステップＳ１０５で車両１の一つ以上（少なくとも一つ）の軌跡（第一の操舵モードでの移動経路に対応した軌跡）が物体Ｂと干渉しない場合（ステップＳ１０５でＮｏ）、駐車支援装置３０は、経路選択部３０ｆ（図４参照）として機能し、当該軌跡に対応する一つ以上の移動経路のうち、最も車輪３の操舵量の少ない移動経路を選択する（ステップＳ１０９）。また、ステップＳ１０８で車両１の一つ以上の軌跡（第二の操舵モードでの移動経路に対応した軌跡）が物体Ｂと干渉しない場合にあっても（ステップＳ１０８でＮｏ）、駐車支援装置３０は、経路選択部３０ｆ（図４参照）として機能し、当該軌跡に対応する一つ以上の移動経路のうち、最も車輪３の操舵量の少ない移動経路を選択する（ステップＳ１０９）。ここで、図１０の例では、ステップＳ１０５で、第一の操舵モード（２ＷＳ）で物体Ｂと干渉しない移動経路があった場合には、ステップＳ１０６には移行しないので、仮に、第二の操舵モード（４ＷＳ）で物体Ｂと干渉しない移動経路があったとしても、当該移動経路は選択されない。なお、ステップＳ１０９では、選択の対象となる軌跡が一つである場合には、当該軌跡に対応した移動経路が選択される。
When one or more (at least one) trajectory (trajectory corresponding to the travel route in the first steering mode) of the
次に、駐車支援装置３０は、自動操舵制御部３０ｈ（図４参照）として機能し、ステップＳ１０９で選択された移動経路での車両１の移動について、自動操舵による車輪３の操舵を実行する（ステップＳ１１０）。このステップＳ１１０では、車両１は、運転者の加速操作部５あるいは制動操作部６の操作に応じて、加速あるいは減速（制動）される。ただし、車輪３は、駐車支援装置３０により、車両１の位置に応じて自動的に操舵される。自動操舵制御自体は、他の公知の手法でも実行されうる。このように、図１０の例では、操舵方式は自動操舵に設定される。よって、運転者の誤操作による車両１と物体Ｂとの干渉が抑制されやすい。
Next, the parking assist
また、ステップＳ１０８で、いずれの移動経路の軌跡も物体Ｂとの干渉があると判断された場合（ステップＳ１０８でＹｅｓ）、駐車支援装置３０は、切り返し制御部３０ｊ（図４参照）として機能し、切り返し制御を実行する（ステップＳ１１１）。このステップＳ１１１では、車両１の現在位置および目標位置Ｔａとは異なる第二の目標位置Ｔｂ（図１７，２０参照）が設定され、まずは、当該第二の目標位置Ｔｂに向けた制御（自動操舵，案内表示等）が実行される。この第二の目標位置Ｔｂは、切り返し点であり、最終的な目標位置Ｔａに向けた出発点（移動再開点）である場合もある。切り返しの制御自体は、他の公知の手法でも実行されうる。
Further, when it is determined in step S108 that any trajectory of the moving route has interference with the object B (Yes in step S108), the
また、本実施形態にかかる駐車支援装置３０は、一例として、図１１に示される手順で処理を実行することができる。図１１に示される手順は、ステップＳ１０１〜Ｓ１１１については図１０に示された手順と同様であるが、下記の点で異なる。
Moreover, the
まず、図１１の例では、ステップＳ１１０で自動操舵が開始された後、駐車支援装置３０は、操舵方式決定部３０ｇ（図４参照）として機能し、自動操舵のキャンセル（手動操作への変更）を決定することができる（ステップＳ１１５）。このステップＳ１１５では、操舵方式決定部３０ｇは、ユーザ（運転者や乗員等）による操作入力部１０の操作入力等に基づく自動操舵をキャンセルする指示入力を受けない限り、操舵方式を自動操舵に決定する（ステップＳ１１５でＮｏ）。このような制御によれば、運転者は、自動操舵を望まない場合に、手動操舵で車両１を操作（運転）することができる。
First, in the example of FIG. 11, after the automatic steering is started in step S110, the parking assist
ユーザの操作によって自動操舵がキャンセルされると（ステップＳ１１５でＹｅｓ）、自動操舵制御部３０ｈは、自動操舵による制御を中止し（ステップＳ１１６）、駐車支援装置３０は、手動操舵制御部３０ｉ（図４参照）として機能し、各部の制御を実行する（ステップＳ１１４）。ここで、手動操舵制御部３０ｉ（制御部、運転支援制御部、手動操舵支援制御部）は、操舵を制御するのではなく、運転者による手動操舵時（手動操舵が選択（指示）された際）に、表示装置８等の表示出力部における各種画像（例えば、カメラ画像や、操舵角に応じた予想軌跡の画像等）の表示や、音声出力装置９等の音声出力部における音声（例えば、警報音、案内音声等）の出力等を、制御する。すなわち、手動操舵制御部３０ｉによる各部の制御によって、運転者の手動操舵による車両１の操作（運転）が支援され、運転者は車両１をより操作（運転）しやすくなる。
When the automatic steering is canceled by the user's operation (Yes in Step S115), the automatic
また、図１１の例では、上記ステップＳ１０５で車両１の一つ以上（少なくとも一つ）の軌跡（第一の操舵モードでの移動経路に対応した軌跡）が物体Ｂと干渉しない場合、操舵モードとしては、第一の操舵モード（２ＷＳ）が選択される。この場合、駐車支援装置３０は、操舵方式決定部３０ｇ（図４参照）として機能し、ユーザによって操舵方式を選択する入力（選択入力、操作入力、操作指示）が行われるよう、各部を制御するとともに、当該入力に応じて操舵方式を決定（選択）する（ステップＳ１１２）。具体的に、このステップＳ１１２で、操舵方式決定部３０ｇは、一例としては、表示装置８等の表示出力部でユーザに操舵方式（自動操舵か手動操舵か）の選択操作（指示入力）を促す画像が表示されるよう、表示制御部１４ｄを制御する。あるいは、操舵方式決定部３０ｇは、別の一例としては、音声出力装置９等の音声出力部でユーザに操舵方式の選択操作を促す音声が出力されるよう、音声制御部１４ｅを制御する。そして、操舵方式決定部３０ｇは、このようにして出力された画像あるいは音声にしたがった入力操作部の操作に応じて、ユーザによって決定（選択）された操舵方式を示すデータを取得する。そして、ステップＳ１１２で自動操舵が選択された場合（ステップＳ１１３でＹｅｓ）、駐車支援装置３０は、経路選択部３０ｆ（図４参照）として機能し、当該軌跡に対応する一つ以上の移動経路のうち、最も車輪３の操舵量の少ない移動経路を選択する（ステップＳ１０９）。一方、ステップＳ１１２で手動操舵が選択された場合（ステップＳ１１３でＮｏ）、駐車支援装置３０は、手動操舵制御部３０ｉ（図４参照）として機能し、各部の制御を実行する（ステップＳ１１４）。このように、図１１の例では、第一の操舵モード（２ＷＳ）では、ユーザが、操舵方式（自動操舵か手動操舵か）を選択することができる。
In the example of FIG. 11, when one or more (at least one) trajectory (trajectory corresponding to the movement route in the first steering mode) of the
一方、図１１の例では、第一の操舵モード（２ＷＳ）では物体Ｂと干渉しない移動経路が無く（ステップＳ１０５でＹｅｓ）、かつ、第二の操舵モード（４ＷＳ）では物体Ｂと干渉しない移動経路があった場合には（ステップＳ１０８でＮｏ）、自動操舵に設定される。第二の操舵モード（４ＷＳ）の場合は、第一の操舵モード（２ＷＳ）と比較して、旋回半径が小さい分、車両１の軌跡の幅（旋回半径方向の幅）が大きくなりやすく、手動操舵の誤操作によって物体Ｂと干渉する可能性が高まりやすい。この点、本実施形態によれば、第二の操舵モード（４ＷＳ）の場合には、まずは自動操舵に設定されることで、運転者の誤操作による車両１と物体Ｂとの干渉が抑制されやすい。図１１のような制御は、一例としては、運転者が第一の操舵モード（２ＷＳ）での運転（操作、操舵）には慣れているが、第二の操舵モード（４ＷＳ）での運転（操舵、操舵）には慣れていない場合等に、有用である。
On the other hand, in the example of FIG. 11, there is no movement path that does not interfere with the object B in the first steering mode (2WS) (Yes in step S105), and the movement that does not interfere with the object B in the second steering mode (4WS). If there is a route (No in step S108), automatic steering is set. In the case of the second steering mode (4WS), compared to the first steering mode (2WS), the width of the trajectory of the vehicle 1 (the width in the direction of the turning radius) is likely to increase because the turning radius is small. The possibility of interference with the object B due to an erroneous steering operation is likely to increase. In this regard, according to the present embodiment, in the second steering mode (4WS), the automatic steering is first set so that the interference between the
また、図１０，１１の第二の操舵モードによる経路算出では（ステップＳ１０６）、経路算出部３０ｃ（図４参照）は、目標位置Ｔａに向かう途中の位置で車輪３の操舵量が変化する移動経路を算出することができる。例えば、図１２，１３に例示されるように、車両１が車輪３の舵角が大きい状態で壁Ｗに近付くと、第二の操舵モード（４ＷＳ）では車両１の軌跡の幅がより大きくなりやすく、かつ車両１の場所によっては移動量がより大きくなるため、車両１が壁Ｗにより近付く場合がある。この点、図１４に例示されるように、車輪３が壁Ｗに近付いた時点で、当初より車輪３の舵角が小さくなると、図１３に例示される場合に比べて、車両１が壁Ｗからより離れた位置を通る場合がある。よって、本実施形態によれば、一例として、車両１は、壁Ｗや物体Ｂ等とより干渉する虞が低い移動経路で移動しやすい。
Further, in the route calculation in the second steering mode of FIGS. 10 and 11 (step S106), the route calculation unit 30c (see FIG. 4) moves in which the steering amount of the
また、干渉判断部３０ｅ（図４参照）は、例えば図１２に示されるような、車両１が算出された移動経路を移動して目標位置Ｔａに向かう途中の位置で、改めて車両１と物体Ｂとの干渉の有無を判断することができる。さらに、その場合、当該途中の位置で、物体検出部としての撮像部１６や測距部１７等が物体Ｂや壁Ｗ等を検出し、干渉判断部３０ｅが、その検出結果に基づいて、壁Ｗや物体Ｂ等と車両１との干渉の有無を判断することができる。よって、本実施形態によれば、一例としては、干渉の有無の判断の精度がより高まりやすい。また、図１２の例の場合、移動開始当初よりも車両１が壁Ｗや物体Ｂに近付いているため、壁Ｗや物体Ｂ等の検出の精度（例えば、方向、距離、大きさ等）がより高まりやすく、ひいては、干渉の有無の判断の精度がより高まりやすい。
In addition, the interference determination unit 30e (see FIG. 4) revisits the
また、図１５，１６には、車両１が、切り返し制御部３０ｊ（図４参照）によって制御される場合の、第二の目標位置Ｔｂ（切り返し点、移動再開点）に位置された状態が例示されている。図１５に示されるように、車両１が第二の目標位置Ｔｂに移動した際に、後輪３Ｒが転舵された状態であると、図１６に示されるように車両１が移動を再開する際に、後輪３Ｒが転舵された状態のままで、壁Ｗに近付く方向に移動するなど、不都合な移動経路で移動する場合がある。そこで、本実施形態では、一例として、図１７に示されるように、経路算出部３０ｃ（図４参照）は、車両１が第二の目標位置Ｔｂに到達する前に少なくとも後輪３Ｒの舵角を小さくし（漸減し）、車両１が第二の目標位置Ｔｂに到達した時点では少なくとも後輪３Ｒの舵角が０（ゼロ、中立位置）となる移動経路を算出する。そして、自動操舵では、自動操舵制御部３０ｈ（図４参照）は、少なくとも後輪３Ｒの舵角を第二の目標位置Ｔｂに到達した状態で中立位置となるように制御する。よって、本実施形態によれば、一例としては、車両１が切り返し開始時に不都合な方向に移動するのが抑制されやすい。なお、切り返し制御部３０ｊは、車両１が第二の目標位置Ｔｂに到達した状態で前輪３Ｆも中立位置となるように、制御することができる。
15 and 16 illustrate a state where the
また、図１８，１９には、車両１が、切り返し制御部３０ｊ（図４参照）によって制御される場合の、第二の目標位置Ｔｂ（切り返し点、移動再開点）に位置された状態が例示されている。図１８に示されるように、車両１が第二の目標位置Ｔｂに移動した際に、後輪３Ｒが転舵された状態であると、図１９に示されるように車両１が移動を再開する際に、後輪３Ｒが転舵された状態のままで、次の目標位置（切り返し点）へ向かわない（次の目標位置から離れる）不都合な移動経路で移動する場合がある。そこで、本実施形態では、一例として、図２０に示されるように、経路算出部３０ｃ（図４参照）は、車両１が第二の目標位置Ｔｂに到達する前に少なくとも後輪３Ｒの舵角を小さくし（漸減し）、車両１が第二の目標位置Ｔｂに到達した時点では少なくとも後輪３Ｒの舵角が０（ゼロ、中立位置）となる移動経路を算出する。そして、自動操舵では、自動操舵制御部３０ｈ（図４参照）は、少なくとも後輪３Ｒの舵角を第二の目標位置Ｔｂに到達した状態で中立位置となるように制御する。よって、本実施形態によれば、一例としては、車両１が切り返し時に不都合な方向に移動するのが抑制されやすい。なお、切り返し制御部３０ｊは、車両１が第二の目標位置Ｔｂに到達した状態で前輪３Ｆも中立位置となるように、制御することができる。
18 and 19 illustrate a state where the
また、本実施形態では、一例として、記憶制御部３０ｍ（図４参照）は、上述したようにして算出され、選択され、あるいは使用された移動経路に対応した操舵モードを示すデータを、当該移動経路に基づく処理（例えば、自動操舵制御（にかかる処理）、あるいは手動操舵時の表示出力制御あるいは音声出力制御等（にかかる処理））後に利用可能に不揮発性の書き換え可能な記憶部の一例であるＳＳＤ１４ｆに記憶する。これにより、駐車支援装置３０は、上記移動経路に基づく処理の後においても、移動経路に対応した操舵モードを示すデータを、利用することができる。すなわち、例えば、車両１が、目標位置Ｔａ（停車位置、駐車位置）から出る際や、次回目標位置Ｔａに再び入る際等に、駐車支援装置３０は、記憶されているデータに対応した操舵モードで、移動経路（目標位置Ｔａへの進入経路、目標位置Ｔａからの退出経路）を、より容易にあるいはより迅速に算出しやすい。具体的には、例えば、第二の操舵モードでなければ目標位置Ｔａに入れなかった場所にあっては、目標位置Ｔａから車両１が出る際にも第二の操舵モードでなければ出られないという状況がありうる。そのような場合、経路算出部３０ｃは、第一の操舵モードでの移動経路を算出せずに済むため、移動経路の算出にかかる時間やエネルギが減りやすい。
Further, in the present embodiment, as an example, the
図２１には、操舵モードを示すデータが、他のデータ（識別子（ＩＤ）、名称、緯度・経度を示すデータ等）と対応付けられてＳＳＤ１４ｆに記憶された状態が、模式的に例示されている。識別子（ＩＤ）は、便宜上付与されており、目標位置Ｔａ毎にデータ（関連するデータ群）を識別（区別）するのに用いられる。また、名称のデータは、一例としては、ユーザの操作入力部１０の操作入力によって入力される。また、名称には、一例としては、目標位置Ｔａに関連したあるいは近辺の名称（例えば、場所や、建物、施設等の名称）が用いられる。また、緯度・経度のデータは、ＧＰＳ２５から取得される。また、図２１では、例えば、第一の操舵モードを示すデータが「１」に設定され、第二の操舵モードを示すデータが「２」に設定されることができる。
FIG. 21 schematically illustrates a state in which the data indicating the steering mode is associated with other data (identifier (ID), name, data indicating latitude / longitude, etc.) and stored in the
また、図２２，２３には、特定の操舵モードを示すデータが、より簡単な形式で記憶された場合が例示されている。図２２では、ＳＳＤ１４ｆの所定のアドレス（記憶領域）に、操舵モードを示すデータとして、値「１」が記憶されている。例えば、このアドレスには、駐車支援装置３０で使用された移動経路の操舵モードが第二の操舵モード（４ＷＳ）であった場合には、値「１」が書き込まれ（図２２参照）、それ以外の場合には、値が入れられない（ＮＵＬＬ、図２３参照）。よって、駐車支援装置３０は、ＳＳＤ１４ｆのこのアドレスを参照することで、駐車支援装置３０で使用された移動経路の操舵モードが第二の操舵モード（４ＷＳ）であった場合に対応した制御を、より容易にあるいはより迅速に実行することができる。なお、図２２，２３の例で、値「１」が書き込まれる条件は、種々に設定することができる。例えば、図１４のように目標位置Ｔａに入る直前に操舵モードが例えば第二の操舵モード（４ＷＳ）から第一の操舵モード（２ＷＳ）に切り替わった場合に、当該切り替わったことを示すデータとして、値「１」が書き込まれてもよい。
22 and 23 illustrate a case where data indicating a specific steering mode is stored in a simpler form. In FIG. 22, the value “1” is stored as data indicating the steering mode at a predetermined address (storage area) of the
また、本実施形態にかかる駐車支援装置３０は、一例として、図２４に示される手順で出車時の処理を実行することができる。まず、駐車支援装置３０は、出車制御部３０ｎ（制御部、図４参照）として機能し、ＳＳＤ１４ｆにおいて、車両１の停車位置（目標位置Ｔａ）に対応した操舵モードを示すデータをサーチする（ステップＳ２０１）。このステップＳ２０１では、ＳＳＤ１４ｆに記憶されたデータが、図２１に例示されたようなデータである場合、出車制御部３０ｎは、例えば、目標位置Ｔａに対応したデータ（例えば、目標位置Ｔａの緯度・経度情報や、当該目標位置Ｔａに対応した場所や、建物、施設等の名称など）から、操舵モードを示すデータをサーチすることができる。具体的には、例えば、出車制御部３０ｎは、ＧＰＳ２５から取得した緯度・経度情報と、記憶された緯度・経度情報とを比較し、ＧＰＳ２５から取得した緯度・経度情報に近い記憶された緯度・経度情報に対応した操舵モードを示すデータを、ＳＳＤ１４ｆから取得することができる。また、出車制御部３０ｎは、表示装置８に名称や、緯度・経度情報、ＩＤ等を表示させ、ユーザに、操作入力部１０に対するデータの選択あるいは指定の操作を促すことができる。この場合、出車制御部３０ｎは、操作入力部１０での操作入力（指示入力、選択入力）に対応したデータを、ＳＳＤ１４ｆから取得する。また、ＳＳＤ１４ｆに記憶されたデータが、図２２，２３に例示されたようなデータである場合、出車制御部３０ｎは、ＳＳＤ１４ｆの特定のアドレスを参照することで、データを得ることができる。
Moreover, the
ここで、ＳＳＤ１４ｆに、車両１の停車位置に対応した操舵モードを示すデータが記憶されていた場合（ステップＳ２０２でＹｅｓ）、駐車支援装置３０は、操舵方式決定部３０ｇ（図４参照）として機能し、操舵方式を自動操舵に決定する（設定する、切り替える、ステップＳ２０３）。次に、駐車支援装置３０は、出車制御部３０ｎとして機能し、操舵モードを、ＳＳＤ１４ｆに記憶されたデータに対応した操舵モードに設定する（ステップＳ２０４）。次に、駐車支援装置３０は、経路算出部３０ｃ（図４参照）として機能し、設定された操舵モードによる停車位置（目標位置Ｔａ）から外へ出る際の移動経路を算出する（ステップＳ２０５）。なお、このステップＳ２０５では、目標位置Ｔａへ入る際の移動経路と同じ移動経路が算出されうる（設定されうる）。また、このステップＳ２０５では、ＳＳＤ１４ｆに、操舵モードを示すデータと対応した移動経路を示すデータが記憶されていた場合には、経路算出部３０ｃは、ＳＳＤ１４ｆから、当該移動経路を示すデータを取得することができる。次に、駐車支援装置３０は、自動操舵制御部３０ｈとして機能し、車両１の出車に際して車輪３の操舵の自動制御を実行する（ステップＳ２０６）。なお、かかる一連の手順は、車両１が再度目標位置Ｔａに入る際にも、ほぼ同様に適用することができる。
Here, when the data indicating the steering mode corresponding to the stop position of the
以上、説明したように、本実施形態では、一例として、記憶制御部３０ｍは、算出された移動経路に対応した操舵モードを示すデータを、算出された移動経路に基づく処理後に利用可能に、記憶部の一例であるＳＳＤ１４ｆに記憶させる。よって、本実施形態によれば、一例としては、算出された移動経路に対応した操舵モードを示すデータを、算出された移動経路に基づく処理後に、利用することができる。よって、一例としては、経路算出部が３０ｃ同じ目標位置Ｔａ（停車位置、駐車位置）について移動経路を算出する際の手間やエネルギが減りやすい。また、一例としては、車両１が目標位置Ｔａに入った後、当該目標位置Ｔａから出る際に、車輪３が当該目標位置Ｔａに適さない方向や角度に操舵されるのが抑制されやすい。よって、一例としては、車両１は目標位置Ｔａからより迅速にあるいはより円滑に外に出やすい。
As described above, in the present embodiment, as an example, in the present embodiment, the
また、本実施形態では、一例として、ＳＳＤ１４ｆは、書き換え可能な不揮発性の記憶部である。よって、一例としては、ＳＳＤ１４ｆには、上記算出された移動経路に対応した操舵モードを示すデータが、算出された移動経路に基づく処理後まで、より確実に記憶されやすい。
In the present embodiment, as an example, the
また、本実施形態では、一例として、記憶制御部３０ｍは、車両１の目標位置Ｔａへの移動制御に実際に使われた移動経路に対応した操舵モードを示すデータを、ＳＳＤ１４ｆに記憶させることができる。よって、本実施形態によれば、一例としては、目標位置Ｔａ（停車位置、駐車位置）に対して、車両１が、より不都合の少ない移動経路で出入りしやすい。
In the present embodiment, as an example, the
また、本実施形態では、一例として、記憶制御部３０ｍは、移動経路の操舵モードに前輪３Ｆおよび後輪３Ｒが操舵される操舵モードが含まれる場合に、少なくとも前輪３Ｆおよび後輪３Ｒが操舵される操舵モードを示すデータをＳＳＤ１４ｆに記憶させる。よって、本実施形態によれば、一例としては、前輪３Ｆおよび後輪３Ｒが操舵されて運転者が車両１の挙動を把握しにくい第二の操舵モードが必要となる状況で、駐車支援装置３０は、例えば、自動操舵制御を行うことで運転を支援したり、手動操舵時に表示装置８や音声出力部等から報知を行うことで運転者に注意を喚起したりすることができる。
In the present embodiment, as an example, the
また、本実施形態では、一例として、記憶制御部３０ｍは、操舵モードを示すデータを、目標位置Ｔａに対応したデータ（例えば、目標位置Ｔａの緯度・経度情報や、当該目標位置Ｔａに対応した場所や、建物、施設等の名称など）と対応させて、ＳＳＤ１４ｆに記憶させる。よって、本実施形態によれば、一例としては、駐車支援装置３０は、目標位置Ｔａに対応したデータに基づいて、操舵モードを示すデータを、より迅速にあるいはより精度良く取得しやすい。
Further, in the present embodiment, as an example, the
また、本実施形態によれば、一例としては、自動操舵制御部３０ｈ（操舵制御部）は、車両１が目標位置Ｔａから出る際に、ＳＳＤ１４ｆに記憶された操舵モードを示すデータに対応した操舵モードで車輪３の操舵を制御する。よって、一例としては、車両１は目標位置Ｔａ（停車位置、駐車位置）からより迅速にあるいはより円滑に外に出やすい。
According to the present embodiment, as an example, the automatic
以上、本発明の実施形態を例示したが、上記実施形態および変形例はあくまで一例であって、発明の範囲を限定することは意図していない。これら実施形態や変形例は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、組み合わせ、変更を行うことができる。また、各実施形態の構成や形状は、部分的に入れ替えて実施することも可能である。また、各構成や形状等のスペック（構造や、種類、方向、形状、大きさ、長さ、幅、厚さ、高さ、数、配置、位置、材質等）は、適宜に変更して実施することができる。また、上記実施形態では、左右の前輪が同じ転舵角（角度）に転舵され、左右の後輪が同じ転舵角（角度）に転舵される構成が例示されたが、これには限定されず、各車輪の転舵角（角度）がそれぞれ異なってもよい。また、経路算出部は、異なる複数の操舵モードを含む移動経路を算出しても良い。 As mentioned above, although embodiment of this invention was illustrated, the said embodiment and modification are examples to the last, Comprising: It is not intending limiting the range of invention. These embodiments and modifications can be implemented in various other forms, and various omissions, replacements, combinations, and changes can be made without departing from the scope of the invention. In addition, the configuration and shape of each embodiment can be partially exchanged. In addition, specifications (structure, type, direction, shape, size, length, width, thickness, height, number, arrangement, position, material, etc.) of each configuration and shape, etc. are changed as appropriate. can do. In the above-described embodiment, the left and right front wheels are steered to the same turning angle (angle), and the left and right rear wheels are steered to the same turning angle (angle). Without being limited, the turning angle (angle) of each wheel may be different. Further, the route calculation unit may calculate a movement route including a plurality of different steering modes.
１…車両、３…車輪、３Ｆ…前輪、３Ｒ…後輪、１４ｆ…ＳＳＤ（記憶部）、３０…駐車支援装置、３０ｃ…経路算出部、３０ｈ…自動操舵制御部（操舵制御部）、３０ｍ…記憶制御部、Ｐ１〜Ｐ３…移動経路、Ｔａ…目標位置。
DESCRIPTION OF
Claims (8)
前記算出された移動経路に対応した前記操舵モードを示すデータを、前記算出された移動経路に基づく処理後に利用可能に記憶部に記憶させる記憶制御部と、
を備えた、駐車支援装置。 A route calculation unit capable of calculating a movement route to a target position of a vehicle having a front wheel and a rear wheel as wheels and being steerable in a plurality of steering modes different from each other;
A storage control unit that stores data indicating the steering mode corresponding to the calculated travel route in a storage unit so that the data can be used after processing based on the calculated travel route;
A parking assistance device comprising:
前記駐車支援装置が、
車輪としての前輪と後輪とを有し操舵される前記車輪が異なる複数の操舵モードで操舵可能な車両の、目標位置までの移動経路を算出するステップと、
前記算出された移動経路に対応した前記操舵モードを示すデータを、前記算出された移動経路に基づく処理後に利用可能に記憶部に記憶させるステップと、
を含む、制御方法。 A control method using a parking assistance device,
The parking assist device is
Calculating a movement path to a target position of a vehicle that has front and rear wheels as wheels and that can be steered in a plurality of different steering modes.
Storing data indicating the steering mode corresponding to the calculated travel route in a storage unit so as to be usable after processing based on the calculated travel route;
Including a control method.
車輪としての前輪と後輪とを有し操舵される前記車輪が異なる複数の操舵モードで操舵可能な車両の、目標位置までの移動経路を算出するステップと、
前記算出された移動経路に対応した前記操舵モードを示すデータを、前記算出された移動経路に基づく処理後に利用可能に記憶部に記憶させるステップと、
を実行させるためのプログラム。 On the computer,
Calculating a movement path to a target position of a vehicle that has front and rear wheels as wheels and that can be steered in a plurality of different steering modes.
Storing data indicating the steering mode corresponding to the calculated travel route in a storage unit so as to be usable after processing based on the calculated travel route;
A program for running
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2012142317A JP2014004933A (en) | 2012-06-25 | 2012-06-25 | Parking support device, control method, and program |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2012142317A JP2014004933A (en) | 2012-06-25 | 2012-06-25 | Parking support device, control method, and program |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2014004933A true JP2014004933A (en) | 2014-01-16 |
Family
ID=50103079
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2012142317A Pending JP2014004933A (en) | 2012-06-25 | 2012-06-25 | Parking support device, control method, and program |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2014004933A (en) |
Cited By (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2016039410A1 (en) * | 2014-09-12 | 2016-03-17 | アイシン精機株式会社 | Drive assist device |
| WO2019058614A1 (en) * | 2017-09-19 | 2019-03-28 | 株式会社Ｊｖｃケンウッド | Display control device, display control system, display control method, and program |
| JP2019055610A (en) * | 2017-09-19 | 2019-04-11 | 株式会社Ｊｖｃケンウッド | Display control device, display control system, display control method, and program |
| JP2019055609A (en) * | 2017-09-19 | 2019-04-11 | 株式会社Ｊｖｃケンウッド | Display control device, display control system, display control method, and program |
| JP2020519516A (en) * | 2017-05-02 | 2020-07-02 | ゴマコ・コーポレーション | Free steering system for mobile machinery |
| US10843731B2 (en) | 2016-08-31 | 2020-11-24 | Honda Motor Co., Ltd. | Device for assisting a vehicle with exiting a parking space |
-
2012
- 2012-06-25 JP JP2012142317A patent/JP2014004933A/en active Pending
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2016039410A1 (en) * | 2014-09-12 | 2016-03-17 | アイシン精機株式会社 | Drive assist device |
| JP2016060217A (en) * | 2014-09-12 | 2016-04-25 | アイシン精機株式会社 | Drive assisting device |
| US10843731B2 (en) | 2016-08-31 | 2020-11-24 | Honda Motor Co., Ltd. | Device for assisting a vehicle with exiting a parking space |
| JP2020519516A (en) * | 2017-05-02 | 2020-07-02 | ゴマコ・コーポレーション | Free steering system for mobile machinery |
| JP7178363B2 (en) | 2017-05-02 | 2022-11-25 | ゴマコ・コーポレーション | Free steering system for mobile machinery |
| WO2019058614A1 (en) * | 2017-09-19 | 2019-03-28 | 株式会社Ｊｖｃケンウッド | Display control device, display control system, display control method, and program |
| JP2019055610A (en) * | 2017-09-19 | 2019-04-11 | 株式会社Ｊｖｃケンウッド | Display control device, display control system, display control method, and program |
| JP2019055609A (en) * | 2017-09-19 | 2019-04-11 | 株式会社Ｊｖｃケンウッド | Display control device, display control system, display control method, and program |
| CN109996706A (en) * | 2017-09-19 | 2019-07-09 | Jvc 建伍株式会社 | Display control unit, display control program, display control method and program |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6096156B2 (en) | Parking assistance device | |
| EP3124360B1 (en) | Parking assistance device | |
| JP5989729B2 (en) | Delivery support device | |
| JP6015314B2 (en) | Device for calculating parking target position, method and program for calculating parking target position | |
| JP6275006B2 (en) | Parking assistance device | |
| JP6129800B2 (en) | Parking assistance device | |
| JP6096157B2 (en) | Parking assistance device | |
| WO2016039411A1 (en) | Vehicle position detection apparatus | |
| JP2017154711A (en) | Parking support device | |
| WO2016039430A1 (en) | Parking assistance device and parking assistance method | |
| JP6006765B2 (en) | Driving assistance device | |
| JP5991112B2 (en) | Parking assistance device, control method, and program | |
| JP2018036878A (en) | Parking support device | |
| JP6500435B2 (en) | Parking assistance device | |
| WO2018198530A1 (en) | Parking assistance device | |
| JP2014004933A (en) | Parking support device, control method, and program | |
| JP6629156B2 (en) | Parking assistance device | |
| WO2018198531A1 (en) | Parking assistance device | |
| JP2014004930A (en) | Parking support device, parking support method, and parking support program | |
| WO2018198536A1 (en) | Parking assistance device | |
| JP2014004932A (en) | Parking support device, parking support method, and program | |
| JP6227514B2 (en) | Parking assistance device | |
| JP2019138655A (en) | Traveling support device | |
| JP2021062752A (en) | Parking support apparatus, parking support method, and parking support program | |
| JP2021062738A (en) | Parking support device, parking support method, and program |