JP2022161437A - Parking-space-exiting route generation device - Google Patents

Parking-space-exiting route generation device Download PDF

Info

Publication number
JP2022161437A
JP2022161437A JP2021066266A JP2021066266A JP2022161437A JP 2022161437 A JP2022161437 A JP 2022161437A JP 2021066266 A JP2021066266 A JP 2021066266A JP 2021066266 A JP2021066266 A JP 2021066266A JP 2022161437 A JP2022161437 A JP 2022161437A
Authority
JP
Japan
Prior art keywords
travel
vehicle
route
unit
area
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2021066266A
Other languages
Japanese (ja)
Other versions
JP7258073B2 (en
Inventor
浩史 山田
Hiroshi Yamada
隆史 松本
Takashi Matsumoto
政隆 四郎園
Masataka Shirouzono
健太 勝
Kenta Katsu
和宏 徳山
Kazuhiro Tokuyama
千春 松村
Chiharu Matsumura
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Priority to JP2021066266A priority Critical patent/JP7258073B2/en
Publication of JP2022161437A publication Critical patent/JP2022161437A/en
Application granted granted Critical
Publication of JP7258073B2 publication Critical patent/JP7258073B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Abstract

To provide a parking-space-exiting route generation device for generating a parking-space-exiting route which expands opportunity to exit a parking space, without depending on information at the time of entering the parking space.SOLUTION: An own vehicle position acquisition section 10 acquires information on the position of an own vehicle during traveling, and a peripheral environment acquisition section 20 acquires information on an environment including an obstacle around the own vehicle. On the basis of the information, a traveling-prohibited area generation section 40 generates a traveling-prohibited area where traveling is prohibited. On the other hand, a target state setting section 30 determines the end point state of a parking-space-exiting route on the basis of the state of the own vehicle including the attitude of the own vehicle and sets it as a target state. A parking-space-exiting route generation section 50 generates the parking-space-exiting route from the position of the own vehicle to the target state in such a manner as to avoid the traveling-prohibited area generated by the traveling-prohibited area generation section 40.SELECTED DRAWING: Figure 1

Description

本願は、出庫経路生成装置に関するものである。 The present application relates to an exit route generation device.

従来の駐車支援装置においては、駐車区画から自車が出庫する際、入庫時の情報を使用して、出庫時の死角情報を補完して出庫経路を生成する。この駐車支援装置では、センサ情報処理部が、自車が駐車枠に向かって入庫移動するときに取得される空間認識用センサからのポイントクラウド情報などを入力し、入力情報に基づいて、駐車可能空間および走路境界を推定するようになっている。(特許文献1参照) In the conventional parking assist system, when the vehicle leaves the parking space, the information at the time of entering the parking space is used to complement blind spot information at the time of leaving the parking space to generate a leaving route. In this parking assist system, the sensor information processing unit receives point cloud information from the space recognition sensor that is acquired when the vehicle moves toward the parking frame, and based on the input information, determines whether parking is possible. Spatial and track boundaries are estimated. (See Patent Document 1)

特開2018-83481号公報(第6~7頁、第2図)JP 2018-83481 A (pages 6-7, FIG. 2)

従来の駐車支援装置では、出庫経路生成時に推定する駐車可能空間は、入庫時の情報が前提となっており、駐車後の時間経過に従い、周辺環境が変化した際に、入庫情報をもとに出庫経路を作成すると、出庫できなくなる可能性があるという問題があった。 With conventional parking assistance systems, the available parking space estimated when generating a parking exit route is based on the information at the time of parking. There was a problem that it might not be possible to leave the car after creating the leaving route.

本願は、上記のような課題を解決するための技術を開示するものであり、入庫時の情報に頼ることなく、出庫機会を拡大させる出庫経路を生成する出庫経路生成装置を提供することを目的とする。 The present application discloses a technique for solving the above-described problems, and aims to provide a delivery route generation device that generates a delivery route that expands delivery opportunities without relying on information at the time of warehousing. and

本願に開示される出庫経路生成装置は、出庫経路を生成する出庫経路生成装置であって、自車の位置情報を取得する自車位置情報取得部、自車周辺の障害物を含む環境情報を取得する環境情報取得部、自車位置情報取得部により取得された自車の位置情報および環境情報取得部により取得された環境情報に基づき、走行禁止領域を生成する走行禁止領域生成部、自車の姿勢を含む自車の状態によって、出庫経路の終点の在り方を定め、目標状態として設定する目標状態設定部、走行禁止領域生成部により生成された走行禁止領域を避けるように、自車位置から目標状態までの出庫経路を生成する出庫経路生成部を備えたものである。 A parking exit route generation device disclosed in the present application is a parking exit route generation device that generates a parking exit route, and includes a vehicle position information acquisition unit that acquires position information of the vehicle, and environmental information including obstacles around the vehicle. an environment information acquisition unit to acquire, a no-travel area generation unit that creates a no-travel area based on the vehicle position information acquired by the vehicle position information acquisition unit and the environment information acquired by the environment information acquisition unit; Depending on the state of the vehicle, including the attitude of the vehicle, the end point of the exit route is determined, and the target state setting unit that sets the target state is set. It is provided with a delivery route generation unit that generates a delivery route to the target state.

本願に開示される出庫経路生成装置によれば、入庫時の情報に頼ることなく、出庫機会を拡大させる出庫経路を生成することができる。 According to the delivery route generation device disclosed in the present application, it is possible to generate a delivery route that expands the delivery opportunities without relying on information at the time of warehousing.

実施の形態1による出庫経路生成装置の概略構成を示すブロック図である。1 is a block diagram showing a schematic configuration of an exit route generation device according to Embodiment 1; FIG. 実施の形態1による出庫経路生成装置の動作を示すフローチャートである。4 is a flow chart showing the operation of the leaving route generation device according to Embodiment 1; 実施の形態1による出庫経路生成装置の走行禁止領域の設定を示す図である。FIG. 4 is a diagram showing setting of a travel-prohibited area of the exit route generation device according to Embodiment 1; 実施の形態1による出庫経路生成装置の出庫経路の更新を示す図である。FIG. 7 is a diagram showing the updating of the delivery route of the delivery route generation device according to Embodiment 1; 実施の形態2による出庫経路生成装置の概略構成を示すブロック図である。FIG. 10 is a block diagram showing a schematic configuration of a leaving route generating device according to Embodiment 2; FIG. 実施の形態2による出庫経路生成装置の走行禁止領域・目標位置の更新と出庫経路の更新を示す図である。FIG. 10 is a diagram showing updating of the travel-prohibited area/target position and updating of the leaving route by the leaving route generating device according to Embodiment 2; 実施の形態3による出庫経路生成装置の概略構成を示すブロック図である。FIG. 11 is a block diagram showing a schematic configuration of a parking exit route generating device according to Embodiment 3; 実施の形態3による出庫経路生成装置の入庫時の環境情報を用いた出庫経路の更新を示す図である。FIG. 12 is a diagram showing the updating of the leaving route using the environment information at the time of entering the leaving route of the leaving route generating device according to Embodiment 3; 実施の形態4による出庫経路生成装置の概略構成を示すブロック図である。FIG. 12 is a block diagram showing a schematic configuration of a parking exit route generating device according to Embodiment 4; 実施の形態4による出庫経路生成装置のユーザ指示による走行禁止領域の更新と出庫経路の更新を示す図である。FIG. 14 is a diagram showing updating of a travel-prohibited area and updating of a leaving route according to a user's instruction of the leaving route generating device according to Embodiment 4; 実施の形態1~実施の形態4による出庫経路生成装置のハードウェア構成を示す図である。FIG. 2 is a diagram showing the hardware configuration of the exit route generation device according to Embodiments 1 to 4; FIG.

実施の形態1.
図1は、実施の形態1による出庫経路生成装置の概略構成を示すブロック図である。
図1において、出庫経路生成装置100は、車両に搭載され、次のように構成されている。
自車位置取得部10(自車位置情報取得部)は、自車位置情報を取得する。自車位置情報の詳細は後述する。
周辺環境取得部20(環境情報取得部)は、自車周辺の障害物情報を含む周辺環境情報を取得する。
目標状態設定部30は、目標状態を設定し、出力する。ここで、目標状態とは、ユーザの指示によって決まる出庫方向と、ユーザが乗車可能な車両状態(車両の角度、位置を含む)である。
Embodiment 1.
FIG. 1 is a block diagram showing a schematic configuration of an exit route generation device according to Embodiment 1. As shown in FIG.
In FIG. 1, the leaving route generation device 100 is mounted on a vehicle and configured as follows.
The vehicle position acquisition unit 10 (vehicle position information acquisition unit) acquires vehicle position information. Details of the vehicle position information will be described later.
The surrounding environment acquisition unit 20 (environment information acquisition unit) acquires surrounding environment information including obstacle information around the vehicle.
The target state setting unit 30 sets and outputs a target state. Here, the target state is the exit direction determined by the user's instruction and the vehicle state (including the angle and position of the vehicle) in which the user can get in.

走行禁止領域生成部40は、自車位置情報および周辺環境情報に基づいて、走行禁止領域を検出、生成する。走行禁止領域とは、自車が障害物により、走行不能の領域を表している。
走行禁止領域生成部40は、走行禁止領域判断部41(走行禁止領域判定部)と、走行禁止領域更新部42とを有する。走行禁止領域判断部41は、自車位置情報と周辺環境情報に基づき、走行禁止領域を更新すべきかどうかを判断する。走行禁止領域更新部42は、走行禁止領域判断部41の判断結果をもとに随時、走行禁止領域を更新する。
The travel-restricted area generator 40 detects and creates a travel-restricted area based on the vehicle position information and the surrounding environment information. The travel-prohibited area represents an area where the own vehicle cannot travel due to an obstacle.
The travel-restricted area generation unit 40 includes a travel-restricted area determination unit 41 (run-restricted area determination unit) and a travel-restricted area update unit 42 . The travel-restricted area determination unit 41 determines whether or not the travel-restricted area should be updated based on the vehicle position information and the surrounding environment information. The travel-restricted area update unit 42 updates the travel-restricted area as needed based on the determination result of the travel-restricted area determination unit 41 .

出庫経路生成部50は、走行禁止領域を避けるように、自車位置から、目標状態設定部30によって出力された目標状態に至る出庫経路を生成する。
出庫経路生成部50は、経路更新要求部51(経路更新判定部)と経路更新部52とを有する。経路更新要求部51は、走行禁止領域更新部42により、走行禁止領域が更新された場合に、出庫経路が、更新された走行禁止領域と重なるか否かを判定し、出庫経路が走行禁止領域と重なる場合に、出庫経路の更新を要求する。
経路更新部52は、経路更新要求部51からの要求に基づいて、走行禁止領域を避けるように出庫経路を更新する。
The leaving route generation unit 50 generates a leaving route from the vehicle position to the target state output by the target state setting unit 30 so as to avoid the travel prohibited area.
The leaving route generation unit 50 has a route update request unit 51 (route update determination unit) and a route update unit 52 . When the travel prohibited area is updated by the travel prohibited area updating unit 42, the route update request unit 51 determines whether or not the exit route overlaps the updated travel prohibited area. , request to update the delivery route.
Based on the request from the route update requesting unit 51, the route updating unit 52 updates the leaving route so as to avoid the travel prohibited area.

図3は、実施の形態1による出庫経路生成装置の走行禁止領域の設定を示す図である。
図3において、実環境、計測値、走行禁止領域について、時刻ごとの推移を示している。自車301は、障害物車両302に挟まれている。自車301の後方は壁303になっている。センサによる計測領域304内に障害物車両302が存在する。走行禁止領域305は、センサの計測周期ごとに自車301の位置を推定して、更新される。
図3(a)は、時刻t=T1における自車301と障害物車両302と壁303と計測領域304と走行禁止領域305を示す図、図3(b)は、時刻t=T2における自車301と障害物車両302と壁303と計測領域304と走行禁止領域305を示す図、図3(c)は、時刻t=T3における自車301と障害物車両302と壁303と計測領域304と走行禁止領域305を示す図である。
FIG. 3 is a diagram showing setting of the travel-prohibited area of the exit route generation device according to the first embodiment.
FIG. 3 shows transitions of the actual environment, measured values, and travel-prohibited areas over time. The host vehicle 301 is sandwiched between obstacle vehicles 302 . A wall 303 is formed behind the vehicle 301 . An obstacle vehicle 302 exists within a measurement area 304 by the sensor. The travel-prohibited area 305 is updated by estimating the position of the own vehicle 301 at each sensor measurement cycle.
FIG. 3(a) shows the own vehicle 301, the obstacle vehicle 302, the wall 303, the measurement area 304, and the travel prohibited area 305 at time t=T1, and FIG. 3(b) shows the own vehicle at time t=T2. 301, an obstacle vehicle 302, a wall 303, a measurement area 304, and a travel-prohibited area 305, and FIG. 3 is a diagram showing a travel prohibited area 305. FIG.

図4は、実施の形態1による出庫経路生成装置の出庫経路の更新を示す図である。
図4において、符号301、302は図3におけるものと同一のものである。仮の走行禁止領域306は、駐車位置からの出庫の初期状態に、仮に設定した走行禁止領域である。
図4(a)は、出庫の初期状態を示す図、図4(b)は、仮の走行禁止領域306を設定し、そこから出庫経路が生成されることを示す図、図4(c)は、図4(b)の段階で生成した経路での移動中に、走行禁止領域が更新されたことを示す図、図4(d)は、更新された走行禁止領域をもとに障害物を巻き込まないように出庫経路を更新することを示す図である。
FIG. 4 is a diagram showing the updating of the delivery route by the delivery route generation device according to the first embodiment.
4, reference numerals 301 and 302 are the same as those in FIG. A provisional travel prohibition area 306 is a travel prohibition area provisionally set in the initial state of exiting from the parking position.
FIG. 4(a) is a diagram showing the initial state of leaving the garage, FIG. 4(b) is a diagram showing that a provisional travel prohibited area 306 is set and a leaving route is generated therefrom, and FIG. 4(c). is a diagram showing that the travel-restricted area has been updated during movement on the route generated in the stage of FIG. 4(b), and FIG. FIG. 10 is a diagram showing updating the exit route so as not to involve the .

図4(a)の出庫の初期状態では、自車301と、左右の障害物車両302の位置関係が不明である。とくに、車長方向で、障害物車両302のコーナー位置がどこにあるかなどが不明である。
図4(b)では、初期状態から、仮の走行禁止領域306に基づき、出庫経路を生成する。
図4(c)で、自車301の移動中に左右の障害物車両302を検知して、走行禁止領域が更新された場合に、出庫経路更新要求を生成する。
図4(d)のように、更新された走行禁止領域を避けるように出庫経路を更新することで、障害物車両302を巻き込まない出庫経路が更新可能となる。
In the initial state of leaving the garage in FIG. 4A, the positional relationship between the own vehicle 301 and the obstacle vehicles 302 on the left and right is unknown. In particular, it is unclear where the corner position of the obstacle vehicle 302 is in the vehicle length direction.
In FIG. 4(b), an exit route is generated from the initial state based on the provisional travel prohibited area 306. In FIG.
In FIG. 4(c), an exit route update request is generated when the left and right obstacle vehicles 302 are detected while the own vehicle 301 is moving and the travel prohibited area is updated.
As shown in FIG. 4D, by updating the exit route so as to avoid the updated travel-prohibited area, the exit route that does not involve the obstacle vehicle 302 can be updated.

次に、動作について説明する。
実施の形態1は、センサの計測周期で、刻々と変化する自車301および障害物車両302の位置を推定し、周囲の走行禁止領域305を更新する。そして、この更新された走行禁止領域305を用いて、出庫経路を生成するようにしたものである。
Next, operation will be described.
Embodiment 1 estimates the ever-changing positions of the own vehicle 301 and the obstacle vehicle 302 at the sensor measurement cycle, and updates the surrounding travel-prohibited area 305 . Then, using this updated travel-prohibited area 305, the leaving route is generated.

出庫経路生成に先立ち、出庫経路の目標となる目標状態を設定する。
目標状態は、ユーザの指示によって決まる出庫方向と、ユーザが乗車可能な車両状態(車両の角度、位置を含む)である。例えば、駐車位置から右方向に出庫し、通路の中央位置で通路に対して平行な位置のことである。
設定した目標状態は、目標状態設定部30から出力される。
Prior to generating the delivery route, a target state, which is the target of the delivery route, is set.
The target state is the leaving direction determined by the user's instruction and the vehicle state (including the angle and position of the vehicle) in which the user can get in. For example, it is a position that is parallel to the aisle at the center of the aisle after exiting from the parking position to the right.
The set target state is output from the target state setting unit 30 .

以下に、図2のフローチャートを用いて説明する。
まず、ステップS001で、自車位置取得部10により、自車位置情報を取得し、走行禁止領域判断部41に出力する。
自車位置取得部10は、自車の速度および進行方向に関する状態を自車データとして検出し、検出した自車データから、自車の位置および姿勢角を検出する。
具体的には、自車位置取得部10は、自車の速度、車輪速、ステアリング角およびヨーレートなど、自車の速度および進行方向に関する状態を自車データとして検出する。
なお、自車位置取得部10は、予め設定された周期で、自車データを検出する。
また、GPS(Global Positioning System)を用いて、自車の緯度、経度および進行方向を、自車データとして検出するように、自車位置取得部10を構成しても良い。
A description will be given below with reference to the flow chart of FIG.
First, in step S<b>001 , the vehicle position acquisition unit 10 acquires vehicle position information and outputs the vehicle position information to the travel prohibited area determination unit 41 .
The own vehicle position acquisition unit 10 detects the state of the own vehicle's speed and traveling direction as own vehicle data, and detects the position and attitude angle of the own vehicle from the detected own vehicle data.
Specifically, the own vehicle position acquisition unit 10 detects, as own vehicle data, conditions related to the speed and traveling direction of the own vehicle, such as the speed of the own vehicle, the wheel speed, the steering angle, and the yaw rate.
In addition, the own vehicle position acquisition unit 10 detects the own vehicle data at a preset cycle.
Also, the vehicle position acquisition unit 10 may be configured to detect the latitude, longitude and traveling direction of the vehicle as vehicle data using GPS (Global Positioning System).

自車の位置と姿勢角を算出するには、様々な方法が考えられるが、一例として、ヨーレートと車輪速を用いる方法について説明する。
自車データ取得開始時の自車位置と自車姿勢角を基準軸とし、自車位置取得部10での自車データの検出ごとに、相対的な自車位置座標と自車の姿勢角を演算する。
自車位置座標は、自車位置取得部10から出力された車輪速から得られる時間ごとの移動距離と、自車位置取得部10から出力されたヨーレートから得られる時間ごとのヨー角に基づいて、時間ごとの移動位置を演算し、移動位置を基準軸の自車位置に足し合わせることで求める。
また、自車の姿勢角については、自車位置取得部10から出力されたヨーレートから得られる時間ごとのヨー角を、基準軸の時点から足し合わせることで求める。
また、自車位置取得部10で検出される自車位置は、自車データが検出された時刻と関連付けられて、記憶される。
Various methods are conceivable for calculating the position and attitude angle of the own vehicle. As an example, a method using yaw rate and wheel speed will be described.
Using the vehicle position and the vehicle attitude angle at the start of vehicle data acquisition as reference axes, the relative vehicle position coordinates and the vehicle attitude angle are calculated each time the vehicle data is detected by the vehicle position acquisition unit 10. Calculate.
The vehicle position coordinates are obtained based on the movement distance for each hour obtained from the wheel speed output from the vehicle position acquisition unit 10 and the yaw angle for each time obtained from the yaw rate output from the vehicle position acquisition unit 10. , the movement position for each time is calculated, and the movement position is added to the own vehicle position on the reference axis.
Also, the attitude angle of the own vehicle is obtained by adding together the yaw angles obtained from the yaw rate output from the own vehicle position acquisition unit 10 for each time from the point of time of the reference axis.
The vehicle position detected by the vehicle position acquisition unit 10 is stored in association with the time when the vehicle data is detected.

次に、ステップS002で、周辺環境取得部20により、センサを用いて、障害物車両302を検出し、走行禁止領域判断部41に出力する。図3に示すとおり、自車には、前方・後方・左右方向に距離を計測可能なセンサが搭載されている。 Next, in step S<b>002 , the surrounding environment acquisition unit 20 detects the obstacle vehicle 302 using a sensor, and outputs the detected obstacle vehicle 302 to the travel prohibited area determination unit 41 . As shown in FIG. 3, the own vehicle is equipped with sensors capable of measuring distances in the front, rear, and left and right directions.

次に、ステップS003で、走行禁止領域生成部40の走行禁止領域判断部41により、自車位置および障害物車両302に基づき、走行不能の領域である走行禁止領域の更新が必要か否かを判断する。
ステップS003で、走行禁止領域の変更が必要な場合は、ステップS004に進む。走行禁止領域の変更が必要でない場合は、処理を終える。
Next, in step S003, based on the position of the vehicle and the obstacle vehicle 302, the prohibited-travel area determination unit 41 of the prohibited-travel area generation unit 40 determines whether or not it is necessary to update the prohibited-travel area. to decide.
In step S003, if the travel prohibited area needs to be changed, the process proceeds to step S004. If it is not necessary to change the travel-prohibited area, the process ends.

ステップS004では、走行禁止領域を更新する。
ここで、走行禁止領域の設定(更新含む)について、図3を用いて、詳しく説明する。
走行禁止領域は、ステップS002で、周辺環境取得部20により、センサを用いて、障害物車両302を検出したのち、自車301の位置および障害物車両302に基づき、ステップS003、ステップS004で、走行禁止領域生成部40により、設定される。
In step S004, the travel prohibited area is updated.
Here, the setting (including updating) of the travel prohibited area will be described in detail with reference to FIG.
After the obstacle vehicle 302 is detected by the surrounding environment acquisition unit 20 using a sensor in step S002, the travel prohibited area is determined based on the position of the own vehicle 301 and the obstacle vehicle 302 in steps S003 and S004. It is set by the travel-prohibited area generation unit 40 .

自車301には、前方・後方・左右方向に距離を計測可能なセンサが搭載されている。
図3を用いて、時刻t=T1からT3にかけて、障害物車両302に挟まれた自車301が前進するケースを考える。
ここで、走行禁止領域の原点は、時刻t=T1における自車301の位置とする。
走行禁止領域とは、自車が障害物により、走行不能の領域であり、障害物の存在範囲は、センサによる計測値で推定可能である。
すなわち、時刻t=T1におけるセンサの計測値から、時刻t=T1における走行禁止領域を推定することができる。
The own vehicle 301 is equipped with sensors capable of measuring distances in the front, rear, and left and right directions.
Using FIG. 3, consider a case where the host vehicle 301, sandwiched between obstacle vehicles 302, moves forward from time t=T1 to T3.
Here, the origin of the travel-prohibited area is the position of the vehicle 301 at time t=T1.
A travel-prohibited area is an area in which the own vehicle cannot travel due to an obstacle, and the existence range of the obstacle can be estimated based on the measurement value of the sensor.
That is, the travel-prohibited area at time t=T1 can be estimated from the sensor measurement value at time t=T1.

次いで、時刻t=T2において、センサの計測値が更新された場合、時刻t=T2における自車位置と合わせることで、走行禁止領域を更新することが可能となる。
つまり、時刻t=T1では、走行禁止領域として生成していなかった場所に関しても、時刻t=T2で更新可能となる。
このように、センサの計測周期(時刻t=T1、T2、T3)ごとに車両の位置を推定することで、周囲の走行禁止領域を更新可能である。
Next, when the measured value of the sensor is updated at time t=T2, it is possible to update the travel-prohibited area by matching it with the position of the vehicle at time t=T2.
That is, at time t=T1, even a place that was not generated as a travel-restricted area can be updated at time t=T2.
In this way, by estimating the position of the vehicle at each sensor measurement cycle (time t=T1, T2, T3), it is possible to update the surrounding travel-prohibited areas.

ステップS004で、走行禁止領域が更新されれば、ステップS005~ステップS007で、出庫経路生成部50により、現在位置から目標状態までの出庫経路を生成する。
ステップS005では、出庫経路生成部50の経路更新要求部51により、ステップS004で更新された走行禁止領域と、出庫経路が重なるか否かを判定する。
ステップS005で、走行禁止領域と、出庫経路が重なる場合は、経路更新部52に対して、経路更新を要求して、ステップS006に進む。走行禁止領域と、出庫経路が重ならない場合は、処理を終える。
If the travel-prohibited area is updated in step S004, then in steps S005 to S007, the exit route generation unit 50 generates the exit route from the current position to the target state.
In step S005, the route update request unit 51 of the leaving route generation unit 50 determines whether or not the travel prohibited area updated in step S004 overlaps the leaving route.
In step S005, when the travel-prohibited area overlaps with the exit route, the route update unit 52 is requested to update the route, and the process proceeds to step S006. If the travel-prohibited area and the leaving route do not overlap, the process ends.

ステップS006で、出庫経路生成部50は、目標状態設定部30から目標状態を取得する。そして、ステップS007に進む。
ステップS007では、出庫経路生成部50の経路更新部52が、更新された走行禁止領域を避けるように、現在位置から目標状態までの出庫経路を更新する。
ステップS007の詳細については、図4を用いて後述する。
In step S<b>006 , the leaving route generation unit 50 acquires the target state from the target state setting unit 30 . Then, the process proceeds to step S007.
In step S007, the route updating unit 52 of the leaving route generation unit 50 updates the leaving route from the current position to the target state so as to avoid the updated travel-prohibited area.
Details of step S007 will be described later with reference to FIG.

次に、図4を用いて、走行禁止領域の更新に伴う出庫経路の更新について説明する。
ここでは、自車301の左右に障害物車両302が存在する場合を想定する。
図4(a)のような、初期状態において、自車301は、左右の障害物車両302の前面位置が検知できていない可能性がある。このため、図4(b)のように、左右の障害物車両302の前面位置は、自車301と同じ位置であると仮定して、仮の走行禁止領域306を作成する。
Next, with reference to FIG. 4, the update of the exit route accompanying the update of the travel-prohibited area will be described.
Here, it is assumed that there are obstacle vehicles 302 on the left and right sides of the own vehicle 301 .
In the initial state as shown in FIG. 4A, there is a possibility that the host vehicle 301 cannot detect the front positions of the left and right obstacle vehicles 302 . Therefore, as shown in FIG. 4B, a provisional travel prohibited area 306 is created on the assumption that the front positions of the left and right obstacle vehicles 302 are the same as the own vehicle 301 .

そして、図4(b)のように、仮の走行禁止領域306を基にして、出庫経路を生成する。
図4(c)のように、障害物車両302から作られる走行禁止領域が、自車301の前進とともに拡大される場合、出庫経路に沿って走行すれば、障害物車両302を巻き込む可能性が存在する。このため、左右方向の走行禁止領域が更新されるまで、生成した出庫経路において、操舵制約を設定する。
Then, as shown in FIG. 4(b), an exit route is generated based on the temporary travel-prohibited area 306. FIG.
As shown in FIG. 4C, when the travel-prohibited area created by the obstacle vehicle 302 expands as the own vehicle 301 advances, there is a possibility that the obstacle vehicle 302 will be involved if the vehicle travels along the leaving route. exist. Therefore, the steering restriction is set on the generated leaving route until the travel-prohibited area in the left and right direction is updated.

次いで、左右方向の走行禁止領域が更新されていき、図4(d)のように、左右方向の走行可能領域が、出庫経路での左右への必要移動量以上の大きさになった場合、左右方向の出庫経路での操舵制約を緩和する。 Next, the travel-prohibited area in the left-right direction is updated, and as shown in FIG. Alleviate steering restrictions on the left and right exit routes.

実施の形態1によれば、出庫時に、入庫時の周辺環境情報を予め保有していなくても、周辺環境を取得して生成される走行禁止領域に基づき、出庫経路を生成することができる。
また、周辺環境を随時取得することで、車両走行により新しく検出された障害物に対して、随時、走行禁止領域を設定することができる。
また、更新された走行禁止領域に対して、障害物への衝突回避を考慮した出庫経路を生成することができる。
According to Embodiment 1, at the time of leaving the car, even if the surrounding environment information at the time of entering the car is not stored in advance, the leaving route can be generated based on the no-travel area generated by acquiring the surrounding environment.
In addition, by acquiring the surrounding environment at any time, it is possible to set a travel-prohibited area at any time with respect to obstacles newly detected while the vehicle is traveling.
In addition, it is possible to generate an exit route in consideration of collision avoidance with obstacles for the updated travel-prohibited area.

実施の形態2.
図5は、実施の形態2による出庫経路生成装置の概略構成を示すブロック図である。
図5において、符号10、20、30、40~42、50~52、100は図1におけるものと同一のものである。図5では、経路更新部52に、目標位置設定部53と、目標位置到達経路更新部54(目標位置経路更新部)とを設けている。
目標位置設定部53は、目標状態設定部30から出力された目標状態と、走行禁止領域生成部40から生成される走行禁止領域とに基づいて、目標位置を設定する。
目標位置到達経路更新部54は、目標位置設定部53により設定された目標位置と、走行禁止領域と、自車位置取得部10により取得された自車位置と、経路更新要求部51からの経路更新要求に基づいて、現在の自車位置から目標位置に至る出庫経路を更新する。
Embodiment 2.
FIG. 5 is a block diagram showing a schematic configuration of an exit route generation device according to Embodiment 2. As shown in FIG.
5, reference numerals 10, 20, 30, 40-42, 50-52 and 100 are the same as in FIG. In FIG. 5, the route updating unit 52 is provided with a target position setting unit 53 and a target position reaching route updating unit 54 (target position route updating unit).
The target position setting unit 53 sets the target position based on the target state output from the target state setting unit 30 and the travel prohibited area generated by the travel prohibited area generation unit 40 .
The target position arrival route update unit 54 updates the target position set by the target position setting unit 53, the travel prohibited area, the vehicle position acquired by the vehicle position acquisition unit 10, and the route from the route update request unit 51. Based on the update request, the exit route from the current vehicle position to the target position is updated.

ここで、目標状態は、ユーザ指示によって決まる出庫方向と、ユーザが乗車可能な車両状態(車両位置、角度)を示す。
目標位置は、目標状態に包含される。走行禁止領域に含まれない、かつ、目標状態を満たす所定の領域内における位置であり、目標とする駐車位置およびその位置における自車の姿勢を定めている。
Here, the target state indicates the leaving direction determined by the user's instruction and the vehicle state (vehicle position, angle) in which the user can board.
The target position is contained in the target state. It is a position within a predetermined area that is not included in the travel-prohibited area and that satisfies the target state, and defines the target parking position and the attitude of the vehicle at that position.

図6は、実施の形態2による出庫経路生成装置の走行禁止領域・目標位置の更新と出庫経路の更新を示す図である。
図6において、符号301、302、306は図4におけるものと同一のものである。図6で、障害物車両308は、通路幅Lをもつ通路307を挟んで、通路の逆側にある障害物車両である。
図6(a)は、初期状態を示す図、図6(b)は、初期の自車位置から、目標位置に至る経路を生成し、更新することを示す図、図6(c)は、更新された走行禁止領域をもとに、目標位置を再設定し、目標位置に至る経路を再演算することを示す図である。
FIG. 6 is a diagram showing updating of the travel-prohibited area/target position and updating of the leaving route by the leaving route generating device according to the second embodiment.
6, reference numerals 301, 302 and 306 are the same as those in FIG. In FIG. 6, an obstacle vehicle 308 is an obstacle vehicle on the opposite side of a path 307 having a path width L across the path.
FIG. 6(a) is a diagram showing the initial state, FIG. 6(b) is a diagram showing generation and updating of a route from the initial position of the vehicle to the target position, and FIG. It is a figure which shows resetting a target position based on the updated driving|running-prohibited area|region, and recalculating the route|route to a target position.

次に、動作について説明する。
走行禁止領域・目標位置の更新に伴う経路の更新について、図6を用いて説明する。
ここでは、図6(a)のように、目標状態を通路の中央に、車両を初期状態から90度傾ける場合を想定する。
出庫の初期状態では、自車301には、左右の障害物車両302の位置関係、通路307の逆側にある障害物車両308の位置関係が不明である。
Next, operation will be described.
The update of the route accompanying the update of the travel-prohibited area/target position will be described with reference to FIG.
Here, as shown in FIG. 6A, it is assumed that the target state is the center of the passage and the vehicle is tilted 90 degrees from the initial state.
In the initial state of leaving the garage, the vehicle 301 does not know the positional relationship between the left and right obstacle vehicles 302 and the positional relationship of the obstacle vehicle 308 on the opposite side of the passage 307 .

ここから、図6(b)のように、初期の自車位置から、仮の走行禁止領域306を用いて、障害物位置、通路位置を仮定する。そして、目標とする駐車位置である目標位置401を設定し、目標位置401に至る経路402を生成する。経路402は、自車301の後車軸中央軌跡を表している。
次いで、障害物位置から生成される走行禁止領域が更新されることで、経路を更新し、経路403とする。
さらに、通路307の逆側にある障害物車両308の位置を検知することで、走行禁止領域が更新され、切り返し要求位置404で、切り返しを実施する。
From this, as shown in FIG. 6(b), the position of the obstacle and the position of the passage are assumed from the initial position of the vehicle using the temporary travel-prohibited area 306. FIG. Then, a target position 401, which is a target parking position, is set, and a route 402 leading to the target position 401 is generated. A path 402 represents the locus of the center of the rear axle of the vehicle 301 .
Next, the route is updated as a route 403 by updating the travel-prohibited area generated from the obstacle position.
Further, by detecting the position of the obstacle vehicle 308 on the opposite side of the passage 307 , the travel prohibition area is updated, and the turn-back is performed at the turn-back request position 404 .

そして、図6(c)のように、更新された走行禁止領域をもとに、目標位置405を再設定し、目標位置405に至る経路406を再演算する。 Then, as shown in FIG. 6C, the target position 405 is reset based on the updated travel-prohibited area, and the route 406 leading to the target position 405 is recalculated.

すなわち、実施の形態2では、初期の自車位置において、仮の走行禁止領域を用いて仮定した障害物位置、通路位置をもとに目標位置に至る経路生成を実施した場合、経路402は、障害物位置に関する走行禁止領域により、実施の形態1で説明した操舵制約により、経路403へと更新される。
さらに、通路の逆側にある障害物車両に関しての走行禁止領域を更新することで、切り返し要求位置404で切り返しを実施する。
そして、通路位置に関する走行禁止領域を更新後に、目標位置を通路中央となるよう目標位置401から目標位置405に更新することで、目標位置405に至る経路406を再演算する。
つまり、出庫の初期状態において、不明であった左右の障害物車両の位置関係および、通路の逆側にある障害物車両の位置関係を考慮した経路生成を実現することが可能となる。
That is, in the second embodiment, when the route to the target position is generated based on the obstacle position and passage position assumed using the provisional travel prohibited area at the initial position of the vehicle, the route 402 is: The route 403 is updated due to the steering restriction described in the first embodiment due to the travel prohibition area regarding the obstacle position.
Furthermore, by updating the no-travel area for the obstacle vehicle on the opposite side of the passage, the vehicle is turned at the turn-around request position 404 .
Then, after updating the travel-prohibited area related to the passage position, the target position is updated from the target position 401 to the target position 405 so as to be the center of the passage, thereby recalculating the route 406 to the target position 405 .
That is, it is possible to generate a route in consideration of the unknown positional relationship between the left and right obstacle vehicles and the positional relationship of the obstacle vehicle on the opposite side of the passage in the initial state of leaving the garage.

実施の形態2によれば、更新された走行禁止領域に基づき、所望の目標位置へ到達する経路を生成することができる。 According to Embodiment 2, a route to reach a desired target position can be generated based on the updated travel-prohibited area.

実施の形態3.
図7は、実施の形態3による出庫経路生成装置の概略構成を示すブロック図である。
図7において、符号10、20、30、40~42、50~52、100は図1におけるものと同一のものである。図7では、出庫経路生成装置100に、周辺環境記憶部60(環境情報記憶部)と経過時間算出部70とを設けている。
周辺環境記憶部60は、入庫時の周辺環境情報を記憶する。経過時間算出部70は、入庫完了からの経過時間を算出する。
Embodiment 3.
FIG. 7 is a block diagram showing a schematic configuration of an exit route generation device according to Embodiment 3. As shown in FIG.
7, reference numerals 10, 20, 30, 40-42, 50-52 and 100 are the same as in FIG. In FIG. 7 , the exit route generation device 100 is provided with a surrounding environment storage unit 60 (environment information storage unit) and an elapsed time calculation unit 70 .
The surrounding environment storage unit 60 stores surrounding environment information at the time of warehousing. The elapsed time calculation unit 70 calculates the elapsed time from the completion of warehousing.

図8は、実施の形態3による出庫経路生成装置の入庫時の環境情報を用いた出庫経路の更新を示す図である。
図8において、符号301、302、306、307、308は図6におけるもの、305は図3におけるものとそれぞれ同一のものである。図8では、目標位置407に至る経路408を示している。また、図8では、走行禁止領域305と、仮の走行禁止領域306が同じものになっている。
図8(a)は、初期状態を示す図、図8(b)は、入庫時の環境情報を用いて、経路408を生成し、目標位置407に到達することを示す図である。
FIG. 8 is a diagram showing the updating of the leaving route using the environment information at the time of warehousing by the leaving route generating device according to the third embodiment.
8, reference numerals 301, 302, 306, 307 and 308 are the same as in FIG. 6, and 305 is the same as in FIG. FIG. 8 shows a path 408 leading to a target position 407. FIG. Further, in FIG. 8, the travel prohibited area 305 and the temporary travel prohibited area 306 are the same.
FIG. 8(a) is a diagram showing the initial state, and FIG. 8(b) is a diagram showing that a route 408 is generated using the environment information at the time of warehousing and the target position 407 is reached.

実施の形態3の出庫経路生成装置100は、周辺環境記憶部60と経過時間算出部70とを有する。
実施の形態3の走行禁止領域生成部40は、周辺環境記憶部60から出力される入庫時の周辺環境と、経過時間算出部70により算出される入庫完了からの経過時間とを用いて、走行禁止領域を生成する。
すなわち、走行禁止領域生成部40は、入庫完了時からの経過時間算出結果が、予め決められた時間未満の場合に、周辺環境取得部20により取得される周辺環境と、自車位置取得部10により取得される自車位置に基づいて、入庫時の周辺環境を踏まえて、走行禁止領域を生成する。
The exit route generation device 100 of Embodiment 3 has a surrounding environment storage unit 60 and an elapsed time calculation unit 70 .
The travel-prohibited area generation unit 40 according to the third embodiment uses the surrounding environment at the time of parking output from the surrounding environment storage unit 60 and the elapsed time from the completion of parking calculated by the elapsed time calculation unit 70, Generate keep out areas.
That is, when the elapsed time calculation result from the completion of parking is less than a predetermined time, the travel-prohibited area generation unit 40 determines the surrounding environment acquired by the surrounding environment acquisition unit 20 Based on the position of the vehicle acquired by , the driving prohibited area is generated based on the surrounding environment at the time of parking.

次に、図8を用いて、入庫完了時の環境活用による経路の更新について説明する。
ここでは、図8(a)のように、目標状態を通路の中央に、車両を初期状態から90度傾ける場合を想定する。
Next, using FIG. 8, the update of the route by utilizing the environment at the time of completion of warehousing will be described.
Here, as shown in FIG. 8A, it is assumed that the target state is the center of the passage and the vehicle is tilted 90 degrees from the initial state.

図8(a)に示す、出庫の初期状態においては、自車301には、左右の障害物車両302の位置関係、通路307の逆側にある障害物車両308の位置関係が不明である。
入庫完了時からの経過時間が、予め決められた時間未満の場合、入庫完了時から周辺環境の変化は少ないと考えられるため、自車301に搭載されているセンサにより得られる周辺環境情報に加え、入庫完了時の障害物の位置に基づき、図8(b)のように、仮の走行禁止領域306を設定する。
In the initial state of leaving the garage shown in FIG. 8A, the positional relationship between the left and right obstacle vehicles 302 and the positional relationship of the obstacle vehicle 308 on the opposite side of the passage 307 are unknown to the own vehicle 301 .
If the elapsed time from the completion of parking is less than a predetermined time, it is considered that the surrounding environment has changed little since the completion of parking. , a provisional no-travel area 306 is set as shown in FIG.

そして、初期の自車位置から、障害物位置、通路位置を仮定して、図8(b)に示す目標位置407を設定し、目標位置407に至る経路408を生成する。経路408は、自車の後車軸中央軌跡を表している。 Then, based on the initial position of the vehicle, assuming the position of the obstacle and the position of the passage, a target position 407 shown in FIG. A path 408 represents the rear axle center trajectory of the vehicle.

入庫完了時の環境情報を活用する場合でも、自車301に搭載されたセンサにより、障害物位置を計測することで、仮の走行禁止領域306から、随時、更新し、走行禁止領域305とすることができる。
しかし、入庫完了時と周辺環境が変わっていない、もしくは、走行禁止領域305の変化が、経路408に影響を与えない場合、経路408のまま、目標位置407へ到達可能である。図8(b)は、走行禁止領域305が、仮の走行禁止領域306から変化していない場合を示している。
これによると、目標位置へ至る経路の再演算が不要であるため、出庫支援にかかる処理時間を低減することが可能になる。
Even when the environmental information at the time of completion of parking is used, by measuring the position of the obstacle with the sensor mounted on the own vehicle 301, the temporary travel prohibited area 306 is updated as needed to become the travel prohibited area 305. be able to.
However, if the surrounding environment has not changed from when the parking was completed, or if the change in the travel-prohibited area 305 does not affect the route 408 , the target position 407 can be reached along the route 408 . FIG. 8B shows a case where the travel prohibited area 305 has not changed from the temporary travel prohibited area 306 .
According to this, it is not necessary to recalculate the route to the target position, so it is possible to reduce the processing time required for the retrieval assistance.

実施の形態3によれば、入庫完了時からの経過時間が短い場合、周辺環境の変化が少ないと考えられるため、入庫時の情報を利用することで、出庫支援にかかる処理時間を低減することができる。 According to the third embodiment, when the time elapsed from the completion of warehousing is short, it is considered that there is little change in the surrounding environment. can be done.

実施の形態4.
図9は、実施の形態4による出庫経路生成装置の概略構成を示すブロック図である。
図9において、符号10、20、30、40~42、50~52、100は図1におけるものと同一のものである。図9では、出庫経路生成装置100に、ユーザ指示情報を取得するユーザ指示情報取得部80を設けている。
Embodiment 4.
FIG. 9 is a block diagram showing a schematic configuration of an exit route generation device according to Embodiment 4. As shown in FIG.
9, reference numerals 10, 20, 30, 40-42, 50-52 and 100 are the same as in FIG. In FIG. 9, the leaving route generating device 100 is provided with a user instruction information acquisition unit 80 that acquires user instruction information.

実施の形態4は、ユーザ指示情報を取得するユーザ指示情報取得部80を設けて、取得したユーザ指示情報を用いて、出庫経路を生成する。
実施の形態4の走行禁止領域判断部41は、ユーザ指示情報取得部80により取得されたユーザ指示情報と、周辺環境取得部20により取得された周辺環境と、自車位置取得部10により取得された自車位置に基づいて、走行禁止領域の更新可否を判断する。
走行禁止領域更新部42は、走行禁止領域判断部41の判断結果と、ユーザ指示情報に基づいて、随時、走行禁止領域を更新する。
そして、出庫経路生成部50は、走行禁止領域更新部42により更新された走行禁止領域を用いて、目標状態設定部30から出力される目標状態と、自車位置取得部10により取得された自車位置に基づいて、随時、出庫経路を生成するようにした。
Embodiment 4 is provided with a user instruction information acquisition unit 80 that acquires user instruction information, and uses the acquired user instruction information to generate an exit route.
The travel-prohibited area determination unit 41 of the fourth embodiment includes the user instruction information acquired by the user instruction information acquisition unit 80, the surrounding environment acquired by the surrounding environment acquisition unit 20, and the vehicle position acquisition unit 10. Based on the obtained vehicle position, it is determined whether or not the travel-prohibited area can be updated.
The travel-restricted area updating unit 42 updates the travel-restricted area as needed based on the determination result of the travel-restricted area determination unit 41 and user instruction information.
Then, the exit route generation unit 50 uses the prohibited travel area updated by the prohibited travel area update unit 42 to determine the target state output from the target state setting unit 30 and the vehicle position acquired by the vehicle position acquisition unit 10. Based on the car position, the exit route is generated at any time.

図10は、実施の形態4による出庫経路生成装置のユーザ指示による走行禁止領域の更新と出庫経路の更新を示す図である。
図10において、符号301、302、306~308は図6におけるものと同一のものである。目標状態501は、初期の目標状態である。経路502は、目標状態501までの経路である。経路503は、走行禁止領域305の更新により、更新された経路である。
位置504は、ユーザの指示として、リモコンのボタン押下などを行った位置である。目標状態505は、更新された目標状態を示し、経路506は、目標状態505に至る、再演算された経路である。
図10(a)は、初期状態を示す図、図10(b)は、目標状態を設定して、経路を生成することを示す図、図10(c)は、走行禁止領域を更新して、目標状態に至る経路の更新を示す図である。
FIG. 10 is a diagram showing updating of the travel-prohibited area and the leaving route according to the user instruction of the leaving route generating device according to the fourth embodiment.
10, reference numerals 301, 302, 306-308 are the same as those in FIG. Goal state 501 is the initial goal state. Path 502 is the path to goal state 501 . A route 503 is a route updated by updating the travel prohibited area 305 .
A position 504 is a position where a remote control button is pressed as a user instruction. Goal state 505 shows the updated goal state and path 506 is the recomputed path to goal state 505 .
FIG. 10(a) shows the initial state, FIG. 10(b) shows setting the target state and generating the route, and FIG. 10(c) shows the updated travel prohibited area. , the update of the path to the goal state;

次に、図10を用いて、実施の形態4による出庫経路生成装置のユーザ指示による走行禁止領域の更新と出庫経路の更新について説明する。
図10(a)のように、目標状態を通路の中央にとり、車両を初期状態から90度傾ける場合を想定する。
図10(a)に示す出庫の初期状態では、自車301には、左右の障害物車両302の位置関係、通路307の逆側にある障害物車両308の位置関係が不明である。
初期の自車位置から、障害物位置、通路307の位置を仮定して、目標状態501を設定し、目標状態501に至る経路502を生成する。経路502は、自車301の後車軸中央軌跡を表している。
Next, with reference to FIG. 10, updating of the travel-restricted area and updating of the leaving route according to the user's instruction of the leaving route generating device according to the fourth embodiment will be described.
As shown in FIG. 10(a), it is assumed that the target state is the center of the passage and the vehicle is tilted 90 degrees from the initial state.
In the initial state of leaving the parking lot shown in FIG. 10A, the positional relationship between the left and right obstacle vehicles 302 and the positional relationship of the obstacle vehicle 308 on the opposite side of the passage 307 are unknown to the own vehicle 301 .
A target state 501 is set by assuming the position of the obstacle and the path 307 from the initial position of the vehicle, and a path 502 leading to the target state 501 is generated. A path 502 represents the locus of the center of the rear axle of the vehicle 301 .

次に、図10(b)のように、仮の走行禁止領域306から、障害物位置に基づき、走行禁止領域305が更新されることで、経路502を更新し、経路503とする。
図10(c)のように、自車301の走行中に、リモコンのボタン押下などのユーザの指示があった場合、その位置504より前方に走行禁止領域を設定するように、走行禁止領域305を更新する。
そして、更新された走行禁止領域305を基にして、目標状態505に至る経路506を再演算する。
Next, as shown in FIG. 10(b), the route 502 is updated by updating the travel prohibition region 305 from the provisional travel prohibition region 306 based on the position of the obstacle, and the route 503 is formed.
As shown in FIG. 10(c), when there is an instruction from the user such as pressing a button on a remote controller while the vehicle 301 is running, the travel prohibition area 305 is set so that the travel prohibition area is set ahead of the position 504. to update.
Then, based on the updated travel-prohibited area 305, the route 506 leading to the target state 505 is recalculated.

実施の形態4によれば、走行禁止領域を随時、更新する際に、ユーザの指示を反映した走行禁止領域にすることで、ユーザの指示が反映された出庫経路を生成することができる。 According to the fourth embodiment, when the travel-restricted area is updated as needed, the travel-restricted area reflects the user's instruction, thereby generating a parking exit route that reflects the user's instruction.

なお、出庫経路生成装置100は、ハードウェアの一例を図11に示すように、プロセッサ101と記憶装置102から構成される。記憶装置は図示していないが、ランダムアクセスメモリ等の揮発性記憶装置と、フラッシュメモリ等の不揮発性の補助記憶装置とを具備する。また、フラッシュメモリの代わりにハードディスクの補助記憶装置を具備してもよい。プロセッサ101は、記憶装置102から入力されたプログラムを実行する。この場合、補助記憶装置から揮発性記憶装置を介してプロセッサ101にプログラムが入力される。また、プロセッサ101は、演算結果等のデータを記憶装置102の揮発性記憶装置に出力してもよいし、揮発性記憶装置を介して補助記憶装置にデータを保存してもよい。 The leaving route generating device 100 is composed of a processor 101 and a storage device 102, as shown in FIG. 11 as an example of hardware. Although not shown, the storage device includes a volatile storage device such as a random access memory and a non-volatile auxiliary storage device such as a flash memory. Also, an auxiliary storage device such as a hard disk may be provided instead of the flash memory. Processor 101 executes a program input from storage device 102 . In this case, the program is input from the auxiliary storage device to the processor 101 via the volatile storage device. Further, the processor 101 may output data such as calculation results to the volatile storage device of the storage device 102, or may store the data in an auxiliary storage device via the volatile storage device.

本開示は、様々な例示的な実施の形態及び実施例が記載されているが、1つ、または複数の実施の形態に記載された様々な特徴、態様、及び機能は特定の実施の形態の適用に限られるのではなく、単独で、または様々な組み合わせで実施の形態に適用可能である。
従って、例示されていない無数の変形例が、本願明細書に開示される技術の範囲内において想定される。例えば、少なくとも1つの構成要素を変形する場合、追加する場合または省略する場合、さらには、少なくとも1つの構成要素を抽出し、他の実施の形態の構成要素と組み合わせる場合が含まれるものとする。
While this disclosure describes various exemplary embodiments and examples, various features, aspects, and functions described in one or more of the embodiments may vary from particular embodiment to embodiment. The embodiments are applicable singly or in various combinations without being limited to the application.
Accordingly, numerous variations not illustrated are envisioned within the scope of the technology disclosed herein. For example, modification, addition or omission of at least one component, extraction of at least one component, and combination with components of other embodiments shall be included.

10 自車位置取得部、20 周辺環境取得部、30 目標状態設定部、
40 走行禁止領域生成部、41 走行禁止領域判断部、42 走行禁止領域更新部、
50 出庫経路生成部、51 経路更新要求部、52 経路更新部、
53 目標位置設定部、54 目標位置到達経路更新部、60 周辺環境記憶部、
70 経過時間算出部、80 ユーザ指示情報取得部、100 出庫経路生成装置、
101 プロセッサ、102 記憶装置、301 自車、302 障害物車両、
303 壁、304 計測領域、305 走行禁止領域、306 仮の走行禁止領域、
307 通路、308 障害物車両
10 Vehicle Position Acquisition Unit 20 Surrounding Environment Acquisition Unit 30 Target State Setting Unit
40 no-travel area generator, 41 no-travel area determination unit, 42 no-travel area update unit,
50 delivery route generation unit, 51 route update request unit, 52 route update unit,
53 target position setting unit, 54 target position arrival route update unit, 60 surrounding environment storage unit,
70 Elapsed time calculation unit 80 User instruction information acquisition unit 100 Departure route generation device
101 processor, 102 storage device, 301 host vehicle, 302 obstacle vehicle,
303 wall, 304 measurement area, 305 travel prohibited area, 306 provisional travel prohibited area,
307 Passage, 308 Obstacle vehicle

本願に開示される出庫経路生成装置は、出庫経路を生成する出庫経路生成装置であって、自車の位置情報を取得する自車位置情報取得部、自車周辺の障害物を含む環境情報を取得する環境情報取得部、自車位置情報取得部により取得された自車の位置情報および環境情報取得部により取得された環境情報に基づき、走行禁止領域を生成する走行禁止領域生成部、位置は一点に特定せず、かつ自車の姿勢および出庫方向によって、乗車可能な自車の状態を定め、目標状態として設定する目標状態設定部、走行禁止領域生成部により生成された走行禁止領域を避けるように、自車位置から目標状態までの出庫経路を生成する出庫経路生成部を備えたものである。



A parking exit route generation device disclosed in the present application is a parking exit route generation device that generates a parking exit route, and includes a vehicle position information acquisition unit that acquires position information of the vehicle, and environmental information including obstacles around the vehicle. an environment information acquisition unit that acquires, a no-travel area generation unit that creates a no-travel area based on the vehicle position information acquired by the vehicle position information acquisition unit and the environment information acquired by the environment information acquisition unit, the position is The target state setting unit that determines the state of the vehicle that can be boarded by the attitude and exit direction of the vehicle without specifying one point, and sets it as the target state, and avoids the prohibited travel area generated by the prohibited travel area generation unit. As described above, the vehicle is provided with an exit route generation unit that generates an exit route from the vehicle position to the target state.



Claims (6)

出庫経路を生成する出庫経路生成装置であって、
自車の位置情報を取得する自車位置情報取得部、
自車周辺の障害物を含む環境情報を取得する環境情報取得部、
上記自車位置情報取得部により取得された自車の位置情報および上記環境情報取得部により取得された環境情報に基づき、走行禁止領域を生成する走行禁止領域生成部、
自車の姿勢を含む自車の状態によって、出庫経路の終点の在り方を定め、目標状態として設定する目標状態設定部、
上記走行禁止領域生成部により生成された走行禁止領域を避けるように、自車位置から上記目標状態までの出庫経路を生成する出庫経路生成部を備えたことを特徴とする出庫経路生成装置。
A shipping route generation device for generating a shipping route,
an own vehicle position information acquisition unit that acquires the position information of the own vehicle;
an environment information acquisition unit that acquires environment information including obstacles around the vehicle;
A no-travel area generation unit that generates a no-travel area based on the position information of the vehicle acquired by the vehicle position information acquisition unit and the environment information acquired by the environment information acquisition unit;
A target state setting unit that determines the end point of the exit route according to the state of the vehicle including the attitude of the vehicle and sets it as a target state;
An exit route generation device, comprising: an exit route generation unit that generates an exit route from the position of the vehicle to the target state so as to avoid the prohibited travel area generated by the prohibited travel area generation unit.
上記走行禁止領域生成部は、
上記出庫経路を自車が走行中に上記自車位置情報取得部により取得された自車の位置情報および上記環境情報取得部により取得された環境情報に基づいて、上記走行禁止領域の更新の可否を判定する走行禁止領域判定部と、
この走行禁止領域判定部による上記走行禁止領域の判定に応じて、上記走行禁止領域を更新する走行禁止領域更新部とを有することを特徴とする請求項1に記載の出庫経路生成装置。
The no-travel area generation unit
Whether or not the travel-prohibited area can be updated based on the vehicle position information acquired by the vehicle position information acquiring unit and the environment information acquired by the environment information acquiring unit while the vehicle is traveling on the exit route. A no-travel area determination unit that determines
2. The exit route generation device according to claim 1, further comprising a travel-restricted area updating unit that updates the travel-restricted area according to the determination of the travel-restricted area by the travel-restricted area determination unit.
上記出庫経路を自車が走行中に、ユーザからの指示情報を取得する指示情報取得部を備え、
上記走行禁止領域判定部は、上記指示情報取得部によって取得された指示情報を用いて、上記走行禁止領域の更新の可否を判定し、
上記走行禁止領域更新部は、上記走行禁止領域判定部の判定結果および上記指示情報に応じて、上記走行禁止領域を更新するようにしたことを特徴とする請求項2に記載の出庫経路生成装置。
an instruction information acquisition unit that acquires instruction information from a user while the vehicle is traveling on the exit route;
The travel-restricted area determination unit uses the instruction information acquired by the instruction information acquisition unit to determine whether or not the travel-restricted area can be updated,
3. The exit route generation device according to claim 2, wherein the travel-restricted area update unit updates the travel-restricted area according to the determination result of the travel-restricted area determination unit and the instruction information. .
上記出庫経路生成部は、
上記走行禁止領域が更新されるつど、当該走行禁止領域に上記出庫経路が重なるか否かを判定する経路更新判定部と、
この経路更新判定部により、上記走行禁止領域に上記出庫経路が重なると判定された場合に、上記出庫経路を更新する経路更新部とを有することを特徴とする請求項2または請求項3に記載の出庫経路生成装置。
The delivery route generation unit
a route update determination unit that determines whether or not the exit route overlaps with the travel-prohibited region each time the travel-prohibited region is updated;
4. The route updating unit for updating the leaving route when the route update determining unit determines that the leaving route overlaps the travel prohibited area. outbound route generator.
上記経路更新部は、
上記更新された走行禁止領域に基づいて、上記目標状態が得られる所定の領域内における位置を定めて、目標位置として設定する目標位置設定部と、
上記出庫経路を、上記目標位置を終点とする出庫経路に更新する目標位置経路更新部とを有することを特徴とする請求項4に記載の出庫経路生成装置。
The above route update unit
a target position setting unit that determines a position within a predetermined region where the target state is obtained based on the updated travel prohibited region and sets it as a target position;
5. The delivery route generating apparatus according to claim 4, further comprising a target position route update unit for updating the delivery route to a delivery route ending at the target position.
自車の入庫時に、上記環境情報取得部により取得された環境情報を記憶する環境情報記憶部、
自車の入庫完了からの経過時間を算出する経過時間算出部を備え、
上記経過時間算出部により算出された経過時間がしきい値未満の場合に、上記走行禁止領域生成部は、上記環境情報記憶部に記憶された環境情報を用いて、上記走行禁止領域を生成するようにしたことを特徴とする請求項1から請求項5のいずれか一項に記載の出庫経路生成装置。
an environment information storage unit that stores the environment information acquired by the environment information acquisition unit when the vehicle is parked;
Equipped with an elapsed time calculation unit that calculates the elapsed time from the completion of parking of the own vehicle,
When the elapsed time calculated by the elapsed time calculation unit is less than a threshold value, the no-travel area generation unit generates the no-travel area using the environment information stored in the environment information storage unit. 6. The leaving route generating device according to any one of claims 1 to 5, characterized in that:
JP2021066266A 2021-04-09 2021-04-09 Outgoing route generator Active JP7258073B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2021066266A JP7258073B2 (en) 2021-04-09 2021-04-09 Outgoing route generator

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2021066266A JP7258073B2 (en) 2021-04-09 2021-04-09 Outgoing route generator

Publications (2)

Publication Number Publication Date
JP2022161437A true JP2022161437A (en) 2022-10-21
JP7258073B2 JP7258073B2 (en) 2023-04-14

Family

ID=83658612

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021066266A Active JP7258073B2 (en) 2021-04-09 2021-04-09 Outgoing route generator

Country Status (1)

Country Link
JP (1) JP7258073B2 (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010132029A (en) * 2008-12-02 2010-06-17 Toyota Motor Corp Parking assistant device
JP2013241088A (en) * 2012-05-21 2013-12-05 Toyota Motor Corp Parking support device
WO2018047222A1 (en) * 2016-09-06 2018-03-15 日産自動車株式会社 Dispatch support method and device
JP2020093582A (en) * 2018-12-10 2020-06-18 日産自動車株式会社 Vehicle travel control method and vehicle travel control apparatus
JP6793787B1 (en) * 2019-07-02 2020-12-02 三菱電機株式会社 Vehicle control device, parking support device, vehicle control method and parking support method

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010132029A (en) * 2008-12-02 2010-06-17 Toyota Motor Corp Parking assistant device
JP2013241088A (en) * 2012-05-21 2013-12-05 Toyota Motor Corp Parking support device
WO2018047222A1 (en) * 2016-09-06 2018-03-15 日産自動車株式会社 Dispatch support method and device
JP2020093582A (en) * 2018-12-10 2020-06-18 日産自動車株式会社 Vehicle travel control method and vehicle travel control apparatus
JP6793787B1 (en) * 2019-07-02 2020-12-02 三菱電機株式会社 Vehicle control device, parking support device, vehicle control method and parking support method

Also Published As

Publication number Publication date
JP7258073B2 (en) 2023-04-14

Similar Documents

Publication Publication Date Title
CN110531750B (en) Computer-implemented method, readable medium, and system for operating an autonomous vehicle
US10345813B2 (en) Method for the at least semi-autonomous manoeuvring of a motor vehicle, driver assistance system and motor vehicle
JP6935813B2 (en) Driving support method and driving support device
JP6658978B2 (en) Driving support vehicle position error correction method and position error correction device
CN106043302B (en) The cruise active control system and its method of vehicle
US10908608B2 (en) Method and system for stitching planning trajectories from consecutive planning cycles for smooth control execution of autonomous driving vehicles
US7308345B2 (en) Steering assistance method and device for a motor vehicle
EP3518066B1 (en) Method and system for generating reference lines for autonomous driving vehicles using multiple threads
JP6610799B2 (en) Vehicle traveling control method and traveling control apparatus
KR20190142374A (en) Driving support method and driving support device of the driving support device
CN112339747A (en) Automatic parking track generation method and device, electronic equipment and storage medium
US20210300411A1 (en) Incremental lateral control system using feedbacks for autonomous driving vehicles
JP6720751B2 (en) Parking assistance method and parking assistance device
JP7243227B2 (en) vehicle controller
JP2018202876A (en) Determination method of preceding vehicle and determination device of preceding vehicle
JP7258073B2 (en) Outgoing route generator
CN112550449B (en) Lateral control of vehicle wireless charging guidance
JP2018083481A (en) Parking support method and parking support device
KR20210119626A (en) System for parking assistance of vehicle using sensor calibration and method thereof
JP6784138B2 (en) Parking support method and parking support device
JP7195368B2 (en) VEHICLE TRIP GENERATOR AND VEHICLE CONTROL DEVICE
JPWO2019159575A1 (en) Parking support device
JP7317166B1 (en) Driving support device and driving support method
JP6673043B2 (en) Travel route generation method and travel route generation device
WO2023032092A1 (en) Vehicle control method and vehicle control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210409

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220628

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220722

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20221206

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221227

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230404

R151 Written notification of patent or utility model registration

Ref document number: 7258073

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151