JP2022161437A - Parking-space-exiting route generation device - Google Patents
Parking-space-exiting route generation device Download PDFInfo
- 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
Links
- 230000002093 peripheral effect Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 28
- 238000005259 measurement Methods 0.000 description 9
- 238000000034 method Methods 0.000 description 8
- 230000008569 process Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 3
- 230000000295 complement effect Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Landscapes
- Navigation (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
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)
従来の駐車支援装置では、出庫経路生成時に推定する駐車可能空間は、入庫時の情報が前提となっており、駐車後の時間経過に従い、周辺環境が変化した際に、入庫情報をもとに出庫経路を作成すると、出庫できなくなる可能性があるという問題があった。 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は、実施の形態1による出庫経路生成装置の概略構成を示すブロック図である。
図1において、出庫経路生成装置100は、車両に搭載され、次のように構成されている。
自車位置取得部10(自車位置情報取得部)は、自車位置情報を取得する。自車位置情報の詳細は後述する。
周辺環境取得部20(環境情報取得部)は、自車周辺の障害物情報を含む周辺環境情報を取得する。
目標状態設定部30は、目標状態を設定し、出力する。ここで、目標状態とは、ユーザの指示によって決まる出庫方向と、ユーザが乗車可能な車両状態(車両の角度、位置を含む)である。
FIG. 1 is a block diagram showing a schematic configuration of an exit route generation device according to
In FIG. 1, the leaving
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
走行禁止領域生成部40は、自車位置情報および周辺環境情報に基づいて、走行禁止領域を検出、生成する。走行禁止領域とは、自車が障害物により、走行不能の領域を表している。
走行禁止領域生成部40は、走行禁止領域判断部41(走行禁止領域判定部)と、走行禁止領域更新部42とを有する。走行禁止領域判断部41は、自車位置情報と周辺環境情報に基づき、走行禁止領域を更新すべきかどうかを判断する。走行禁止領域更新部42は、走行禁止領域判断部41の判断結果をもとに随時、走行禁止領域を更新する。
The travel-restricted
The travel-restricted
出庫経路生成部50は、走行禁止領域を避けるように、自車位置から、目標状態設定部30によって出力された目標状態に至る出庫経路を生成する。
出庫経路生成部50は、経路更新要求部51(経路更新判定部)と経路更新部52とを有する。経路更新要求部51は、走行禁止領域更新部42により、走行禁止領域が更新された場合に、出庫経路が、更新された走行禁止領域と重なるか否かを判定し、出庫経路が走行禁止領域と重なる場合に、出庫経路の更新を要求する。
経路更新部52は、経路更新要求部51からの要求に基づいて、走行禁止領域を避けるように出庫経路を更新する。
The leaving
The leaving
Based on the request from the route
図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
FIG. 3(a) shows the
図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,
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
図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
In FIG. 4(b), an exit route is generated from the initial state based on the provisional travel prohibited
In FIG. 4(c), an exit route update request is generated when the left and
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
次に、動作について説明する。
実施の形態1は、センサの計測周期で、刻々と変化する自車301および障害物車両302の位置を推定し、周囲の走行禁止領域305を更新する。そして、この更新された走行禁止領域305を用いて、出庫経路を生成するようにしたものである。
Next, operation will be described.
出庫経路生成に先立ち、出庫経路の目標となる目標状態を設定する。
目標状態は、ユーザの指示によって決まる出庫方向と、ユーザが乗車可能な車両状態(車両の角度、位置を含む)である。例えば、駐車位置から右方向に出庫し、通路の中央位置で通路に対して平行な位置のことである。
設定した目標状態は、目標状態設定部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
以下に、図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
The own vehicle
Specifically, the own vehicle
In addition, the own vehicle
Also, the vehicle
自車の位置と姿勢角を算出するには、様々な方法が考えられるが、一例として、ヨーレートと車輪速を用いる方法について説明する。
自車データ取得開始時の自車位置と自車姿勢角を基準軸とし、自車位置取得部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
The vehicle position coordinates are obtained based on the movement distance for each hour obtained from the wheel speed output from the vehicle
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
The vehicle position detected by the vehicle
次に、ステップS002で、周辺環境取得部20により、センサを用いて、障害物車両302を検出し、走行禁止領域判断部41に出力する。図3に示すとおり、自車には、前方・後方・左右方向に距離を計測可能なセンサが搭載されている。
Next, in step S<b>002 , the surrounding
次に、ステップS003で、走行禁止領域生成部40の走行禁止領域判断部41により、自車位置および障害物車両302に基づき、走行不能の領域である走行禁止領域の更新が必要か否かを判断する。
ステップS003で、走行禁止領域の変更が必要な場合は、ステップS004に進む。走行禁止領域の変更が必要でない場合は、処理を終える。
Next, in step S003, based on the position of the vehicle and the
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
自車301には、前方・後方・左右方向に距離を計測可能なセンサが搭載されている。
図3を用いて、時刻t=T1からT3にかけて、障害物車両302に挟まれた自車301が前進するケースを考える。
ここで、走行禁止領域の原点は、時刻t=T1における自車301の位置とする。
走行禁止領域とは、自車が障害物により、走行不能の領域であり、障害物の存在範囲は、センサによる計測値で推定可能である。
すなわち、時刻t=T1におけるセンサの計測値から、時刻t=T1における走行禁止領域を推定することができる。
The
Using FIG. 3, consider a case where the
Here, the origin of the travel-prohibited area is the position of the
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
In step S005, the route
In step S005, when the travel-prohibited area overlaps with the exit route, the
ステップS006で、出庫経路生成部50は、目標状態設定部30から目標状態を取得する。そして、ステップS007に進む。
ステップS007では、出庫経路生成部50の経路更新部52が、更新された走行禁止領域を避けるように、現在位置から目標状態までの出庫経路を更新する。
ステップS007の詳細については、図4を用いて後述する。
In step S<b>006 , the leaving
In step S007, the
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
In the initial state as shown in FIG. 4A, there is a possibility that the
そして、図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
As shown in FIG. 4C, when the travel-prohibited area created by the
次いで、左右方向の走行禁止領域が更新されていき、図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
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,
The target
The target position arrival
ここで、目標状態は、ユーザ指示によって決まる出庫方向と、ユーザが乗車可能な車両状態(車両位置、角度)を示す。
目標位置は、目標状態に包含される。走行禁止領域に含まれない、かつ、目標状態を満たす所定の領域内における位置であり、目標とする駐車位置およびその位置における自車の姿勢を定めている。
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,
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
ここから、図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
Next, the route is updated as a
Further, by detecting the position of the
そして、図6(c)のように、更新された走行禁止領域をもとに、目標位置405を再設定し、目標位置405に至る経路406を再演算する。
Then, as shown in FIG. 6C, the
すなわち、実施の形態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
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
Then, after updating the travel-prohibited area related to the passage position, the target position is updated from the
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,
The surrounding environment storage unit 60 stores surrounding environment information at the time of warehousing. The elapsed
図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,
FIG. 8(a) is a diagram showing the initial state, and FIG. 8(b) is a diagram showing that a
実施の形態3の出庫経路生成装置100は、周辺環境記憶部60と経過時間算出部70とを有する。
実施の形態3の走行禁止領域生成部40は、周辺環境記憶部60から出力される入庫時の周辺環境と、経過時間算出部70により算出される入庫完了からの経過時間とを用いて、走行禁止領域を生成する。
すなわち、走行禁止領域生成部40は、入庫完了時からの経過時間算出結果が、予め決められた時間未満の場合に、周辺環境取得部20により取得される周辺環境と、自車位置取得部10により取得される自車位置に基づいて、入庫時の周辺環境を踏まえて、走行禁止領域を生成する。
The exit
The travel-prohibited
That is, when the elapsed time calculation result from the completion of parking is less than a predetermined time, the travel-prohibited
次に、図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
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-
そして、初期の自車位置から、障害物位置、通路位置を仮定して、図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
入庫完了時の環境情報を活用する場合でも、自車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
However, if the surrounding environment has not changed from when the parking was completed, or if the change in the travel-prohibited
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,
実施の形態4は、ユーザ指示情報を取得するユーザ指示情報取得部80を設けて、取得したユーザ指示情報を用いて、出庫経路を生成する。
実施の形態4の走行禁止領域判断部41は、ユーザ指示情報取得部80により取得されたユーザ指示情報と、周辺環境取得部20により取得された周辺環境と、自車位置取得部10により取得された自車位置に基づいて、走行禁止領域の更新可否を判断する。
走行禁止領域更新部42は、走行禁止領域判断部41の判断結果と、ユーザ指示情報に基づいて、随時、走行禁止領域を更新する。
そして、出庫経路生成部50は、走行禁止領域更新部42により更新された走行禁止領域を用いて、目標状態設定部30から出力される目標状態と、自車位置取得部10により取得された自車位置に基づいて、随時、出庫経路を生成するようにした。
Embodiment 4 is provided with a user instruction
The travel-prohibited
The travel-restricted
Then, the exit
図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,
A
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
A
次に、図10(b)のように、仮の走行禁止領域306から、障害物位置に基づき、走行禁止領域305が更新されることで、経路502を更新し、経路503とする。
図10(c)のように、自車301の走行中に、リモコンのボタン押下などのユーザの指示があった場合、その位置504より前方に走行禁止領域を設定するように、走行禁止領域305を更新する。
そして、更新された走行禁止領域305を基にして、目標状態505に至る経路506を再演算する。
Next, as shown in FIG. 10(b), the
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
Then, based on the updated travel-prohibited
実施の形態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
本開示は、様々な例示的な実施の形態及び実施例が記載されているが、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
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
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:
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)
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 |
-
2021
- 2021-04-09 JP JP2021066266A patent/JP7258073B2/en active Active
Patent Citations (5)
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 |