JP2019215177A - Track setting device - Google Patents

Track setting device Download PDF

Info

Publication number
JP2019215177A
JP2019215177A JP2018111031A JP2018111031A JP2019215177A JP 2019215177 A JP2019215177 A JP 2019215177A JP 2018111031 A JP2018111031 A JP 2018111031A JP 2018111031 A JP2018111031 A JP 2018111031A JP 2019215177 A JP2019215177 A JP 2019215177A
Authority
JP
Japan
Prior art keywords
exit
vehicle
likelihood
node
setting device
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
JP2018111031A
Other languages
Japanese (ja)
Other versions
JP7067290B2 (en
Inventor
雄介 田中
Yusuke Tanaka
雄介 田中
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Denso Corp
Original Assignee
Denso 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 Denso Corp filed Critical Denso Corp
Priority to JP2018111031A priority Critical patent/JP7067290B2/en
Publication of JP2019215177A publication Critical patent/JP2019215177A/en
Application granted granted Critical
Publication of JP7067290B2 publication Critical patent/JP7067290B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Abstract

To provide a technique which improves accuracy of measurement of a position of an own vehicle without the need of including position data of a stationary target in map data.SOLUTION: A relative position calculation unit acquires a setting route set using a node and a link included in map data and calculates an exit relative position representing a relative position of an exit node Oj to an entrance node Ii at a specific intersection, the specific intersection being a next intersection at which a right or left turn is made, in the setting route. A range calculation unit calculates, on the basis of a position of the entrance node, a candidate range U1 which is a range within which a position of a real exit as an actual exit may be present. A likelihood calculation unit calculates an exit distribution which is a distribution of an exit likelihood representing a likelihood of the exit within the candidate range. An exit setting unit sets as the real exit P2 a spot within the candidate range corresponding to a point having the maximum exit likelihood. A track calculation unit calculates a running track A1 from a position of an own vehicle toward the real exit.SELECTED DRAWING: Figure 9

Description

本開示は、軌道設定装置に関する。   The present disclosure relates to a trajectory setting device.

車両の自動運転を行う上では、自車の位置及び自車が走行する軌道を設定する必要がある。特に交差点では、車両が右折又は左折を行うため、車両や歩行者などの移動する物標が密集する。このため、自動運転を行うために使用される位置情報の精度は、一般的な車両のナビゲーションに用いられる位置情報の精度よりも高い測定精度が必要となる。   In order to perform automatic driving of a vehicle, it is necessary to set the position of the own vehicle and the trajectory on which the own vehicle runs. Particularly at intersections, moving targets such as vehicles and pedestrians are crowded because vehicles make right or left turns. For this reason, the accuracy of position information used for performing automatic driving requires higher measurement accuracy than the accuracy of position information used for general vehicle navigation.

ここで、特許文献1には、信号機や標識といった道路上に設けられている自車周辺のランドマークやインフラなどの静止した物標(以下、静止物標)をカメラ等で検出し、当該静止物標が検出された位置と、検出された静止物標の地図データ上の位置とを照合し、照合された位置データを用いて自車の位置を補正する技術が開示されている。   Here, in Patent Document 1, a stationary target (hereinafter referred to as a stationary target) such as a landmark or an infrastructure around the own vehicle such as a traffic light or a sign provided on the road is detected by a camera or the like, and the stationary target is detected. A technique is disclosed in which a position at which a target is detected is compared with a position of the detected stationary target on map data, and the position of the vehicle is corrected using the verified position data.

特開2017−9553号公報JP 2017-9553 A

しかしながら、発明者の詳細な検討の結果、以下の課題が見いだされた。
すなわち、上述した自車の位置を設定する方法では、地図データ上における静止物標の位置データを含む必要がある。しかし、道路上には静止物標が多数存在するため、すべての静止物標の位置データを地図データに含めることは不可能である。また、自車の周囲の地図データに、静止物標の位置データが存在しない場合、自車の位置を照合することができず、自車の位置を補正することができない。
However, as a result of detailed studies by the inventor, the following problems were found.
That is, in the above-described method of setting the position of the own vehicle, it is necessary to include the position data of the stationary target on the map data. However, since there are many stationary targets on the road, it is impossible to include the position data of all the stationary targets in the map data. Further, when the position data of the stationary target does not exist in the map data around the own vehicle, the position of the own vehicle cannot be verified, and the position of the own vehicle cannot be corrected.

本開示の1つの局面は、地図情報に静止物標の位置情報が含まれていない場合にも、自車位置の測定精度を向上させる技術を提供することにある。   One aspect of the present disclosure is to provide a technique for improving the measurement accuracy of the position of a vehicle even when map information does not include position information of a stationary target.

本開示の一態様は、車両に搭載される軌道設定装置であって、地図データ部(30)と、相対位置算出部(S320)と、位置取得部(S210)と、範囲算出部(S120)と、物標取得部(S420)と、尤度算出部(S420)と、退出設定部(S430)と、軌道算出部(S440)と、を備える。地図データ部は、交差点及び道路の行き止まり点を表すノードと、ノード間を接続するリンクとを用いて交通網が表現され、交差点は、それぞれが当該交差点の進入口又は退出口を表しかつ車線ごとに設定された複数のノードで表現される地図データを記憶する。相対位置算出部は、ノード及びリンクを用いて設定された設定ルートを取得し、取得した設定ルートにおいて、車両が右折又は左折する最寄りの交差点を特定交差点とし、特定交差点に属する複数のノードのうち、特定交差点への進入時に車両を通過させるノードを進入口ノード(Ii)とし、特定交差点からの退出時に車両を通過させるノードを退出口ノード(Oj)とし、進入口ノードに対する退出口ノードの相対位置を表す退出相対位置を算出する。位置取得部は、車両の位置である自車位置を取得する。範囲算出部は、地図データ及び自車位置に含まれ得る誤差の上限値を用いて、進入口ノードの位置を基準として、実際の退出口である実退出口(P2)の位置が存在し得る範囲である候補範囲(U1)を算出する。物標取得部は、候補範囲で検出される静止物標について車両に対する相対位置を含んだ物標情報を取得する。尤度算出部は、物標情報を用いて、候補範囲での退出口らしさを表す退出口尤度の分布である退出口分布を算出する。退出設定部は、退出口分布において退出口尤度が最大となる点に対応する候補範囲の地点を、実退出口として設定する。軌道算出部は、自車位置から実退出口に向かって車両を通過させるための軌道である走行軌道(A1)を算出する。   One embodiment of the present disclosure is a track setting device mounted on a vehicle, and includes a map data unit (30), a relative position calculation unit (S320), a position acquisition unit (S210), and a range calculation unit (S120). And a target acquisition unit (S420), a likelihood calculation unit (S420), an exit setting unit (S430), and a trajectory calculation unit (S440). In the map data section, a traffic network is represented using nodes representing intersections and dead ends of roads, and links connecting the nodes, and each intersection represents an entrance or exit of the intersection, and each lane represents a traffic lane. Is stored in the map data represented by the plurality of nodes set in. The relative position calculation unit obtains a set route set using the node and the link, and determines, in the obtained set route, a nearest intersection where the vehicle turns right or left as a specific intersection, and among a plurality of nodes belonging to the specific intersection, A node that allows vehicles to pass when entering a specific intersection is referred to as an entry node (Ii), a node that allows vehicles to pass when exiting from a specific intersection is an exit node (Oj), and the relative position of the exit node with respect to the entrance node. The exit relative position representing the position is calculated. The position acquisition unit acquires the position of the vehicle, which is the position of the vehicle. The range calculation unit may use the map data and the upper limit value of the error that may be included in the position of the own vehicle to locate the actual exit (P2), which is the actual exit, based on the position of the entrance node. A candidate range (U1), which is a range, is calculated. The target acquisition unit acquires target information including a relative position of the stationary target detected in the candidate range with respect to the vehicle. The likelihood calculation unit calculates an exit distribution, which is a distribution of exit likelihoods indicating the likelihood of exit in the candidate range, using the target information. The exit setting unit sets a point in the candidate range corresponding to the point at which the exit likelihood is maximum in the exit distribution as an actual exit. The trajectory calculation unit calculates a trajectory (A1) that is a trajectory for passing the vehicle from the own vehicle position toward the actual exit.

このような構成によれば、交差点の実退出口が存在し得る範囲である候補範囲を算出し、算出された候補範囲に存在する、実退出口との相対的な位置関係があらかじめ決められた静止物標を取得し、取得した静止物標の位置との位置関係を用いて退出口が存在する尤度である退出口尤度を算出する。そして、算出された尤度を元に実退出口の位置を設定し、設定された実退出口の位置に基づいて走行軌道を算出する。このため、地図データ上において静止物標の位置データを必要とすることなく、自車位置の測定精度を向上させることができる。   According to such a configuration, a candidate range that is a range in which an actual exit at an intersection can exist is calculated, and a relative positional relationship with the actual exit that exists in the calculated candidate range is determined in advance. A stationary target is acquired, and an exit likelihood, which is a likelihood that an exit exists, is calculated using the positional relationship with the acquired position of the stationary target. Then, the position of the actual exit is set based on the calculated likelihood, and the traveling trajectory is calculated based on the set position of the actual exit. For this reason, the measurement accuracy of the own vehicle position can be improved without requiring the position data of the stationary target on the map data.

なお、この欄及び特許請求の範囲に記載した括弧内の符号は、一つの態様として後述する実施形態に記載の具体的手段との対応関係を示すものであって、本開示の技術的範囲を限定するものではない。   Note that the reference numerals in parentheses described in this column and in the claims indicate the correspondence with the specific means described in the embodiment described later as one aspect, and the technical scope of the present disclosure It is not limited.

自動運転システムの構成を示すブロック図である。It is a block diagram showing composition of an automatic operation system. 自動運転処理のフローチャートである。It is a flowchart of an automatic operation process. 交差点特定処理のフローチャートである。It is a flowchart of an intersection specification process. 範囲算出処理のフローチャートである。It is a flowchart of a range calculation process. 走行制御処理のフローチャートである。It is a flowchart of a traveling control process. 地図データに含まれる交差点を表した図である。It is a figure showing the intersection included in map data. 進入位置及び実退出口での誤差範囲を表した図である。It is a figure showing the error range in an approach position and an actual exit. 誤差範囲を足し合わせた候補範囲を表した図である。It is a figure showing the candidate range which added the error range. 座標変換した撮像画像において算出された実退出口及び候補範囲を表した図である。FIG. 9 is a diagram illustrating an actual exit and a candidate range calculated in a coordinate-transformed captured image. 交差点を退出するために算出した走行軌道を表した図である。It is a figure showing the running track calculated for exiting the intersection.

以下、図面を参照しながら、本開示の実施形態を説明する。
[1.構成]
図1に示すように、自動運転システム1は、GNSS受信機10、センサ部20、地図メモリ30、ナビゲーションシステム40、軌道設定装置100及び車両制御装置200を備える。軌道設定装置100を搭載した車両を、以下では自車とも表記する。
Hereinafter, embodiments of the present disclosure will be described with reference to the drawings.
[1. Constitution]
As shown in FIG. 1, the automatic driving system 1 includes a GNSS receiver 10, a sensor unit 20, a map memory 30, a navigation system 40, a track setting device 100, and a vehicle control device 200. Hereinafter, a vehicle equipped with the track setting device 100 is also referred to as a host vehicle.

GNSS受信機10は、アンテナを介してGNSS用の人工衛星からの送信電波を受信し、自車位置を測定する装置である。なお、GNSSはGlobal Navigation Satellite Systemの略称である。   The GNSS receiver 10 is a device that receives a transmission radio wave from a GNSS artificial satellite via an antenna and measures the position of the own vehicle. GNSS is an abbreviation for Global Navigation Satellite System.

センサ部20は、自車の前方を含む周辺領域に存在する各種物体に関する情報や路面に描かれた区画線等の道路標示及び路面形状の凹凸などの静止物標を少なくとも含む物標を検出するカメラやレーダセンサを含む。なお、レーダセンサとしては、例えば、ミリ波レーダ、レーザレーダ及び超音波レーダ等を用いることができる。また、センサ部20はカメラやレーダセンサにより取得された物標のうち静止物標を認識する。   The sensor unit 20 detects information about various objects existing in a peripheral area including the front of the own vehicle, a road marking such as a lane marking drawn on a road surface, and a target including at least a stationary target such as unevenness of a road surface shape. Includes cameras and radar sensors. As the radar sensor, for example, a millimeter wave radar, a laser radar, an ultrasonic radar, or the like can be used. Further, the sensor unit 20 recognizes a stationary target among the targets acquired by the camera and the radar sensor.

静止物標の認識は例えば、自車の速度を取得し、自車に対する相対速度が自車の速度と一致する物標を静止物標として認識することにより行われてもよい。
地図メモリ30は、地図データを記憶するメモリである。
The recognition of the stationary target may be performed, for example, by acquiring the speed of the own vehicle and recognizing a target whose relative speed to the own vehicle matches the speed of the own vehicle as the stationary target.
The map memory 30 is a memory that stores map data.

地図データには、車両が走行する道路のノード情報及びリンク情報が含まれる。
ノード情報とは複数のノードの位置を表した情報であり、ノードは、交差点及び道路の行き止まりとなっている地点である行き止まり点を表す。また、リンク情報は、複数のリンクの位置を表した情報であり、リンクは、ノード間を接続し、車両が走行する道路ごとに設定される。なお、ノード及びリンクは、道路ごとに設定されるものに限定されるものではなく、例えば道路に複数の車線が存在する場合には、車線ごとにノード及びリンクが設定されてもよい。以下では車線毎にノード及びリンクが設定されているものとして説明する。
The map data includes node information and link information of a road on which the vehicle travels.
The node information is information indicating the positions of a plurality of nodes, and the nodes represent an intersection and a dead end point which is a point where the road is at a dead end. The link information is information indicating the positions of a plurality of links, and the links connect nodes and are set for each road on which the vehicle travels. Note that the nodes and links are not limited to those set for each road. For example, when a road has a plurality of lanes, the nodes and links may be set for each lane. Hereinafter, description will be made assuming that nodes and links are set for each lane.

図6に示すようにノード情報には、進入口ノードIi、退出口ノードOj及び交差点リンクLijが含まれる。進入口ノードIiは、交差点への進入時に車両を通過させるノードである。また、退出口ノードOjは、交差点からの退出時に車両を通過させるノードである。交差点リンクLijは、進入口ノードIiと退出口ノードOjとの間を接続するリンクであり、交差点内において、車線に沿って進入口ノードIiから退出口ノードOjまでを接続する車線の車幅方向の中央位置を表す。   As illustrated in FIG. 6, the node information includes an entrance node Ii, an exit node Oj, and an intersection link Lij. The entrance node Ii is a node that passes a vehicle when entering an intersection. The exit node Oj is a node that allows vehicles to pass when exiting from an intersection. The intersection link Lij is a link connecting the entrance node Ii and the exit node Oj, and in the intersection, in the vehicle width direction of the lane connecting the entrance node Ii to the exit node Oj along the lane in the intersection. Represents the center position of.

ここで、i及びjはそれぞれ、交差点に接続される車線ごとに割り当てられる番号を表す。例えば図6に示すように、進入口ノードIi及び退出口ノードOjはそれぞれ、交差点に接続する車線ごとに進入口ノードI1〜4及び退出口ノードO1〜4と表される。また、例えば、進入口ノードI1から退出口ノードO2への交差点リンクLijを交差点リンクL12とも表記し、進入口ノードI3から退出口ノードO4への交差点リンクLijを交差点リンクL34とも表記する。   Here, i and j each represent a number assigned to each lane connected to the intersection. For example, as shown in FIG. 6, the entrance node Ii and the exit node Oj are respectively represented as entrance nodes I1-4 and exit nodes O1-4 for each lane connected to the intersection. Further, for example, the intersection link Lij from the entrance node I1 to the exit node O2 is also described as an intersection link L12, and the intersection link Lij from the entrance node I3 to the exit node O4 is also described as an intersection link L34.

ナビゲーションシステム40は、少なくとも自車の現在位置から自車のドライバ等が設定した目的地までの地図上のルートを設定ルートとして設定する機能を有する。
ここで、設定ルートは、地図メモリ30に記憶された地図データに含まれるノード及びリンクを用いて設定される。
The navigation system 40 has a function of setting at least a route on a map from a current position of the own vehicle to a destination set by a driver of the own vehicle as a set route.
Here, the set route is set using nodes and links included in the map data stored in the map memory 30.

また、設定ルートには、自車が目的地までに右折または左折する交差点の進入口ノードIi及び退出口ノードOjのデータが含まれる。
軌道設定装置100は、GNSS受信機10、センサ部20、地図メモリ30及びナビゲーションシステム40から取得した情報に基づいて、自車が走行する走行軌道の設定を行う。
The set route includes data of the entrance node Ii and the exit node Oj of the intersection where the vehicle turns right or left to the destination.
The trajectory setting device 100 sets the trajectory on which the vehicle travels based on information acquired from the GNSS receiver 10, the sensor unit 20, the map memory 30, and the navigation system 40.

軌道設定装置100は、CPU110と、例えば、RAM又はROM等の半導体メモリ(以下、メモリ120)と、を有するマイクロコンピュータを備える。軌道設定装置100の各機能は、CPU110が非遷移的実体的記録媒体に格納されたプログラムを実行することにより実現される。この例では、メモリ120が、プログラムを格納した非遷移的実体的記録媒体に該当する。また、このプログラムが実行されることで、プログラムに対応する方法が実行される。なお、軌道設定装置100は、1つのマイクロコンピュータを備えてもよいし、複数のマイクロコンピュータを備えてもよい。   The trajectory setting device 100 includes a microcomputer having a CPU 110 and a semiconductor memory (hereinafter, a memory 120) such as a RAM or a ROM. Each function of the trajectory setting device 100 is realized by the CPU 110 executing a program stored in a non-transitional substantial recording medium. In this example, the memory 120 corresponds to a non-transitional substantial recording medium storing a program. Also, by executing this program, a method corresponding to the program is executed. The trajectory setting device 100 may include one microcomputer, or may include a plurality of microcomputers.

軌道設定装置100の各種機能を実現する手法はソフトウェアに限られるものではなく、その一部又は全部の要素について、一つあるいは複数のハードウェアを用いて実現されてもよい。例えば、上記機能がハードウェアである電子回路によって実現される場合、その電子回路は、デジタル回路、又はアナログ回路、あるいはこれらの組合せによって実現されてもよい。   The method for realizing the various functions of the trajectory setting device 100 is not limited to software, and some or all of the elements may be realized using one or a plurality of hardware. For example, when the above functions are implemented by an electronic circuit that is hardware, the electronic circuit may be implemented by a digital circuit, an analog circuit, or a combination thereof.

車両制御装置200は、軌道設定装置100により設定された自車が走行する走行軌道に従って自車のアクセル、ブレーキ及びステアリングの制御を行うことにより自動運転を実現する。   The vehicle control device 200 realizes automatic driving by controlling the accelerator, brake, and steering of the own vehicle according to the traveling trajectory on which the own vehicle travels set by the trajectory setting device 100.

なお、地図メモリ30が地図データ部に相当する。
[2.処理]
<自動運転処理>
次に、CPU110が実行する自動運転処理について、図2のフローチャートを用いて説明する。自動運転処理は、例えば、軌道設定装置100が起動されると、実行される。
Note that the map memory 30 corresponds to a map data section.
[2. processing]
<Automatic operation processing>
Next, the automatic driving process executed by the CPU 110 will be described with reference to the flowchart of FIG. The automatic driving process is executed, for example, when the track setting device 100 is started.

S110で、CPU110は、自車の地図上の位置及びナビゲーションシステム40において設定された自車の設定ルートを取得し、自車が次に右折又は左折する交差点を特定交差点として特定する処理である交差点特定処理を行う。   In S110, the CPU 110 obtains the position of the host vehicle on the map and the set route of the host vehicle set in the navigation system 40, and specifies an intersection where the host vehicle turns right or left next as a specific intersection. Perform specific processing.

S120で、CPU110は地図データ中の特定交差点の進入口ノードIiが表す進入口の位置に対して退出口ノードOjが表す退出口の位置が存在し得る範囲である候補範囲を算出する範囲算出処理を行う。   In S120, the CPU 110 calculates a candidate range that is a range in which the exit position indicated by the exit node Oj can exist with respect to the entrance position indicated by the entrance node Ii of the specific intersection in the map data. I do.

S130で、CPU110は自車が特定交差点に進入したか否かを、進入口ノードIiと自車位置を用いて判定する。具体的には、GNSS受信機10により取得される自車の位置が特定交差点に含まれる進入口ノードIiから退出口ノードOjの間のあらかじめ決められた領域である交差点領域にある場合には、自車が特定交差点に進入したと判定する。一方、GNSS受信機10により取得される自車の位置が特定交差点に含まれる交差点領域にない場合には、自車が特定交差点に進入していないと判定する。ここで、交差点領域は、例えば進入口ノードIiから退出口ノードOjまでの交差点リンクLijを中心として、道路幅の分だけ路面に沿って広げた範囲が設定されてもよい。すなわち、交差点領域は車両が当該交差点内を通過しているとみなされる領域が設定される。   In S130, CPU 110 determines whether or not the vehicle has entered the specific intersection, using entrance node Ii and the position of the vehicle. Specifically, when the position of the vehicle acquired by the GNSS receiver 10 is in an intersection area that is a predetermined area between the entrance node Ii and the exit node Oj included in the specific intersection, It is determined that the vehicle has entered the specific intersection. On the other hand, when the position of the vehicle acquired by the GNSS receiver 10 is not in the intersection area included in the specific intersection, it is determined that the vehicle has not entered the specific intersection. Here, for example, the intersection area may be set to have a range extended along the road surface by an amount corresponding to the road width around an intersection link Lij from the entrance node Ii to the exit node Oj. That is, the intersection area is set as an area where the vehicle is considered to be passing through the intersection.

CPU110は、S130で自車が特定交差点に進入したと判定した場合には、S140に処理を移行する。
S140で、CPU110は進入した特定交差点から退出するように特定交差点の進入口ノードIiの表す進入口の位置から退出口ノードOjが表す退出口の位置まで交差点リンクLijに沿って走行するように走行制御を行わせる走行制御処理を行い、S110に戻り、以降の処理を行う。
If CPU 110 determines in S130 that the vehicle has entered the specific intersection, the process proceeds to S140.
In S140, the CPU 110 travels along the intersection link Lij from the entrance position indicated by the entrance node Ii of the specific intersection to the exit position indicated by the exit node Oj so as to exit from the specific intersection that has entered. A traveling control process for performing the control is performed, and the process returns to S110 to perform the subsequent processes.

一方、CPU110は、S130で自車が特定交差点に進入していないと判定した場合、S150に処理を移行する。
S150で、CPU110は、ナビゲーションシステム40で設定された設定ルートを取得する。
On the other hand, if the CPU 110 determines in step S130 that the vehicle has not entered the specific intersection, the process proceeds to step S150.
In S150, CPU 110 acquires the set route set by navigation system 40.

S160で、CPU110は、S110で取得した設定ルートと、S150で取得した設定ルートとが同一であるか否かを判定することにより、特定交差点を変更するか否かを判定する。   In S160, the CPU 110 determines whether or not to change the specific intersection by determining whether the setting route acquired in S110 and the setting route acquired in S150 are the same.

具体的には、CPU110は、S110で取得した設定ルートと、S150で取得した設定ルートとが同一である場合には、S130に処理を移行する。一方、S110で取得した設定ルートと、S150で取得した設定ルートとが異なる場合には、S110に処理を移行する。   Specifically, if the setting route acquired in S110 is the same as the setting route acquired in S150, CPU 110 shifts the processing to S130. On the other hand, if the setting route acquired in S110 is different from the setting route acquired in S150, the process proceeds to S110.

すなわち、ナビゲーションシステム40により設定ルートが変更された場合、S110に戻り、新たに設定された設定ルートにおいて特定交差点を再設定する。一方、ナビゲーションシステム40により設定ルートが変更されていない場合には、特定交差点を再設定する必要はないと判定し、特定交差点に進入したか否かの判定を引き続き行う。   That is, when the set route is changed by the navigation system 40, the process returns to S110, and the specific intersection is reset on the newly set route. On the other hand, if the set route has not been changed by the navigation system 40, it is determined that there is no need to reset the specific intersection, and it is continuously determined whether or not the specific intersection has been entered.

なお、S120での処理が範囲算出部としての処理に相当する。
<交差点特定処理>
次に、CPU110がS110で行う交差点特定処理について、図3を用いて説明する。
Note that the processing in S120 corresponds to processing as a range calculation unit.
<Intersection identification processing>
Next, the intersection specifying process performed by the CPU 110 in S110 will be described with reference to FIG.

S210で、CPU110は、GNSS受信機10を用いて自車位置を取得する。
S220で、CPU110は、地図メモリ30を用いて地図データを取得する。
S230で、CPU110はナビゲーションシステム40から設定ルートを取得する。
In S210, CPU 110 obtains the own vehicle position using GNSS receiver 10.
In S220, CPU 110 acquires map data using map memory 30.
In S230, CPU 110 obtains the set route from navigation system 40.

S240で、CPU110はS230で取得した設定ルート上を自車が走行した際に、次に右折又は左折する交差点を特定し、特定交差点として設定する。
なお、S210での処理が、位置取得部としての処理に相当する。
<範囲算出処理>
次に、CPU110がS120で行う範囲算出処理について、図4を用いて説明する。
In S240, when the vehicle travels on the set route acquired in S230, the CPU 110 specifies an intersection to turn right or left next, and sets it as a specific intersection.
Note that the processing in S210 corresponds to processing as a position acquisition unit.
<Range calculation processing>
Next, the range calculation process performed by the CPU 110 in S120 will be described with reference to FIG.

S310で、CPU110はS110の交差点特定処理により特定した特定交差点の進入口ノードIi及び退出口ノードOjを抽出する。
S320で、CPU110は、S310で抽出された特定交差点の進入口ノードIiに対する退出口ノードOjの相対位置を表す退出相対位置を算出する。退出相対位置は、例えば、進入口ノードIi及び退出口ノードOjの表す位置から求めてもよい。S330で、CPU110は自車位置に含まれ得る誤差の上限値と、特定交差点における退出口ノードOjの位置に含まれ得る誤差の上限値を取得する。自車位置に含まれ得る誤差の上限値とは、例えば、GNSS受信機10が自車位置を測定する際に生じる誤差の上限値をいう。特定交差点における退出口ノードOjの位置に含まれ得る誤差の上限値は、例えば、地図メモリ30に含まれる地図データが表す退出口ノードOjの位置と実際の退出口の位置との間で生じる誤差の上限値をいう。自車位置の誤差σ1及び退出口ノードOjの位置の誤差σ2を図7に表すと、それぞれ例えば自車位置及び退出口ノードOjの表す位置を中心とする略円形ないし楕円形で表される。
In S310, the CPU 110 extracts the entrance node Ii and the exit node Oj of the specific intersection specified by the intersection specification processing of S110.
In S320, the CPU 110 calculates an exit relative position indicating the relative position of the exit node Oj with respect to the entrance node Ii of the specific intersection extracted in S310. The exit relative position may be obtained, for example, from the positions represented by the entrance node Ii and the exit node Oj. In S330, CPU 110 obtains the upper limit of the error that can be included in the position of the vehicle and the upper limit of the error that can be included in the position of exit node Oj at the specific intersection. The upper limit value of the error that can be included in the own vehicle position refers to, for example, the upper limit value of an error that occurs when the GNSS receiver 10 measures the own vehicle position. The upper limit value of the error that can be included in the position of the exit node Oj at the specific intersection is, for example, an error generated between the position of the exit node Oj represented by the map data included in the map memory 30 and the actual exit position. Means the upper limit. When the error σ1 of the own vehicle position and the error σ2 of the position of the exit node Oj are shown in FIG. 7, they are represented by, for example, a substantially circular or elliptical shape centered on the own vehicle position and the position represented by the exit node Oj, respectively.

S340で、CPU110は自車位置に対する退出口の誤差範囲σ3を算出する。自車位置に対する誤差範囲σ3は、図8に示すように、退出口ノードOjの位置を中心として、自車位置の誤差σ1及び退出口ノードOjの位置の誤差σ2を足し合わせることにより算出される。   In S340, CPU 110 calculates error range σ3 of the exit from the own vehicle position. The error range σ3 with respect to the own vehicle position is calculated by adding the error σ1 of the own vehicle position and the error σ2 of the position of the exit node Oj with the position of the exit node Oj as the center, as shown in FIG. .

すなわち、自車位置に対する退出口ノードOjの誤差範囲σ3は、地図データが表す道路地図上に車両の位置データを表示する際に生じる誤差である誤差データに相当する。
S350で、CPU110は、図9に示すようにセンサ部20の検出範囲である車両の前方における範囲となるよう進入位置に対する実退出口P2の誤差範囲σ3を座標変換し、候補範囲U1として算出する。
That is, the error range σ3 of the exit node Oj with respect to the own vehicle position corresponds to error data which is an error generated when displaying the position data of the vehicle on the road map represented by the map data.
In S350, the CPU 110 performs coordinate conversion of the error range σ3 of the actual exit P2 with respect to the approach position so as to be a range in front of the vehicle, which is the detection range of the sensor unit 20, as shown in FIG. 9, and calculates the candidate range U1. .

S320が相対位置算出部としての処理に相当する。
<走行制御処理>
次に、CPU110がS160で行う走行制御処理について、図5を用いて説明する。
S320 corresponds to processing as a relative position calculation unit.
<Driving control processing>
Next, the traveling control process performed by the CPU 110 in S160 will be described with reference to FIG.

S410で、CPU110はS120の範囲算出処理により算出された、候補範囲U1を取得する。
S420で、CPU110は、候補範囲U1内における、退出口尤度の分布である退出口分布を算出する。ここで、退出口尤度とは、候補範囲U1のうち実退出口P2が存在する位置である尤度をいう。つまり、退出口尤度とは、交差点の退出口らしさの度合いを表す。
In S410, the CPU 110 acquires the candidate range U1 calculated by the range calculation process in S120.
In S420, the CPU 110 calculates an exit distribution which is a distribution of exit likelihoods in the candidate range U1. Here, the exit likelihood refers to the likelihood that is the position where the actual exit P2 exists in the candidate range U1. That is, the exit likelihood indicates the degree of exit-likeness of an intersection.

ここで、退出口尤度の算出は、道路上に存在する物標の位置及び形状に基づいて算出される。
例えば、候補範囲に車線の外側の端部を表す一対の区画線P21,P22の位置に対応した情報である区画線情報を、センサ部20を用いて取得した場合には、当該一対の区画線P21,P22の幅方向の中央の位置を実退出口P2の尤度が高くなるように算出してもよい。この際、例えば、候補範囲に存在し、あらかじめ決められた区画線の形状と一致する物標を、区画線として取得してもよい。
Here, the exit likelihood is calculated based on the position and shape of the target existing on the road.
For example, in a case where the lane marking information, which is information corresponding to the positions of the pair of lane markings P21 and P22 representing the outer end of the lane in the candidate range, is acquired using the sensor unit 20, the pair of lane markings is obtained. The position of the center in the width direction of P21 and P22 may be calculated such that the likelihood of the actual exit P2 increases. At this time, for example, a target that exists in the candidate range and matches the shape of the predetermined lane marking may be acquired as the lane marking.

また、車線の外側を表す区画線の代わりに、凹凸形状を取得し道路の端部に設置された縁石を表す程度の大きさの凹凸が検出された場合に、その位置を車線の外側の境界の位置として、縁石の位置から車線の半分の幅だけ幅方向に移動した位置を車線の中央として、当該車線の中央の位置の実退出口P2の尤度が高くなるように算出してもよい。   Also, instead of the lane markings representing the outside of the lane, if the unevenness is acquired and irregularities large enough to represent a curb at the end of the road are detected, the position is determined by the outer boundary of the lane. May be calculated such that the likelihood of the actual exit P2 at the position of the center of the lane becomes high, with the position moved in the width direction by half the width of the lane from the position of the curb as the center of the lane. .

車両がその上を通過することができる程度の凹凸の大きさに凹凸閾値を設定し、当該凹凸閾値以下である位置を平坦位置として、平坦位置以外の位置よりも、平坦位置の退出口尤度が高くなるように算出してもよい。   The unevenness threshold is set to the size of the unevenness such that the vehicle can pass over it, and the position that is equal to or less than the unevenness threshold is defined as the flat position, and the exit likelihood of the flat position is higher than the position other than the flat position. May be calculated to be higher.

また、候補範囲に横断歩道P10の位置に対応した情報である横断歩道情報を、センサ部20を用いて取得した場合には、交差点の中心からみて外側に当該横断歩道からあらかじめ決められた距離だけ離れた位置を退出口尤度が高くなるように算出してもよい。   When the pedestrian crossing information, which is information corresponding to the position of the pedestrian crossing P10 in the candidate range, is acquired using the sensor unit 20, only a predetermined distance from the pedestrian crossing outward from the crossing center when viewed from the center of the intersection. The distant position may be calculated so that the exit likelihood increases.

S430で、CPU110はS420において取得された候補範囲の退出口分布において、退出口尤度が最大となる地点を実退出口P2として設定する。
すなわち、S410からS430において、センサ部20を用いて検出される範囲において、候補範囲U1内の実退出口P2を実際の退出口の位置として抽出する。
In S430, the CPU 110 sets, as the actual exit P2, a point where the exit likelihood is maximum in the exit distribution of the candidate range acquired in S420.
That is, in S410 to S430, the actual exit P2 within the candidate range U1 is extracted as the actual exit position in the range detected using the sensor unit 20.

S440で、CPU110は、図10に示すようにS430で取得した実退出口P2と自車位置との間に走行軌道A1を設定する。設定される走行軌道A1の形状は、例えば、自車位置を始点とし、実退出口P2を終点とし、実退出口P2において、設定ルートが表すルートの進行方向を向くような経路が設定されてもよい。なお、設定される走行軌道A1の軌道はこのような方法で設定されるものに限定されるものではなく、種々の方法で設定されてもよい。   In S440, the CPU 110 sets the traveling trajectory A1 between the actual exit P2 acquired in S430 and the own vehicle position as shown in FIG. The shape of the traveling trajectory A1 to be set is such that, for example, a path is set such that the start point is the vehicle position, the actual exit P2 is the end point, and the actual exit P2 is in the traveling direction of the route represented by the set route. Is also good. The trajectory of the traveling trajectory A1 to be set is not limited to the one set by such a method, and may be set by various methods.

S450で、CPU110はS440で設定された走行軌道A1に沿って走行するように車両制御装置200に自車の制御を行わせる。
S460で、CPU110は、GNSS受信機10から自車位置を取得し、特定交差点の交差点領域に含まれるか否かを判定することにより特定交差点での退出が完了したか否か判定する。すなわち、自車位置が特定交差点の交差点領域に含まれる場合、特定交差点からの退出が未完了であると判定し、自車位置が特定交差点の交差点領域に含まれない場合、特定交差点からの退出が完了したと判定する。
In S450, CPU 110 causes vehicle control device 200 to control the own vehicle so as to travel along traveling trajectory A1 set in S440.
In S460, CPU 110 obtains the vehicle position from GNSS receiver 10 and determines whether or not the exit at the specific intersection is completed by determining whether or not the vehicle is included in the intersection area of the specific intersection. That is, when the own vehicle position is included in the intersection area of the specific intersection, it is determined that the exit from the specific intersection is not completed, and when the own vehicle position is not included in the intersection area of the specific intersection, the exit from the specific intersection is performed. Is determined to be completed.

CPU110はS470で、特定交差点での退出が完了したと判定した場合、走行制御処理を終了する。
一方、CPU110はS470で、特定交差点からの退出が未完了であると判定した場合、S410に処理を移行する。
If the CPU 110 determines in S470 that the exit at the specific intersection has been completed, the traveling control process ends.
On the other hand, if the CPU 110 determines in S470 that the exit from the specific intersection is not completed, the process proceeds to S410.

すなわち、自車の特定交差点からの退出が完了するまでの間、繰り返し、走行制御処理を行い、自車の特定交差点からの退出が完了すると、走行制御処理を終了する。
なお、S420での処理が物標取得部、凹凸取得部、凹凸算出部及び尤度算出部としての処理に相当し、S430での処理が退出設定部しての処理に相当し、S440での処理が軌道算出部としての処理に相当する。
That is, the travel control process is repeatedly performed until the vehicle exits from the specific intersection, and the travel control process ends when the vehicle exits from the specific intersection.
Note that the processing in S420 corresponds to processing as a target acquisition unit, unevenness acquisition unit, unevenness calculation unit, and likelihood calculation unit, the processing in S430 corresponds to processing as an exit setting unit, and the processing in S440. The processing corresponds to the processing as a trajectory calculation unit.

[3.効果]
以上詳述した実施形態によれば、以下の効果を奏する。
(1)上記実施形態によれば、あらかじめ地図データから候補範囲を設定し、退出口との相対的な位置関係が既知である静止物標を利用して、退出口の位置を推定し、退出口に向かって車両が進行するように設定することで、交差点における自動運転を実現させる。
[3. effect]
According to the embodiment described in detail above, the following effects can be obtained.
(1) According to the above embodiment, the candidate range is set in advance from the map data, and the position of the exit is estimated using a stationary target whose relative positional relationship with the exit is known. By setting the vehicle to proceed toward the exit, automatic driving at the intersection is realized.

そのため、静止物標自体の位置データを地図データにあらかじめ記憶する必要がなく、自車位置の推定精度を向上させることができる。そして、推定精度が向上した自車位置に基づいて、走行軌道A1を算出することができる。   Therefore, the position data of the stationary target itself does not need to be stored in the map data in advance, and the accuracy of estimating the position of the own vehicle can be improved. Then, the traveling trajectory A1 can be calculated based on the position of the own vehicle with the improved estimation accuracy.

(2)上記実施形態によれば、交差点から退出するまで自車の位置から実退出口P2までの位置を繰り返し算出するため、前回の算出結果に応じた車両の進行が退出口に向かう走行軌道からずれていたとしても再算出により補正することができる。   (2) According to the above-described embodiment, the position from the position of the own vehicle to the actual exit P2 is repeatedly calculated until the vehicle exits the intersection, so that the travel of the vehicle according to the previous calculation result is directed to the exit. Even if it deviates, it can be corrected by recalculation.

(3)また、交差点から退出するまで、実退出口P2の位置を繰り返し算出する。このため、交差点に進入した位置から実退出口P2の位置が遮蔽物により遮られていたとしても、特定交差点内を自車が進行している間に、遮蔽物との位置関係が変化すると、再度検出された実退出口P2の位置に基づいて走行軌道A1を算出する。走行軌道A1を算出する精度を向上することができる。   (3) The position of the actual exit P2 is repeatedly calculated until the vehicle exits the intersection. Therefore, even if the position of the actual exit P2 is blocked by the shield from the position where the vehicle has entered the intersection, if the positional relationship with the shield changes while the vehicle is traveling in the specific intersection, The travel trajectory A1 is calculated based on the position of the actual exit P2 detected again. Accuracy of calculating the traveling trajectory A1 can be improved.

[4.他の実施形態]
以上、本開示の実施形態について説明したが、本開示は上述の実施形態に限定されることなく、種々変形して実施することができる。
[4. Other Embodiments]
As mentioned above, although embodiment of this indication was described, this indication is not limited to the above-mentioned embodiment, and can carry out various modifications.

(1)上記実施形態では、CPU110は、実退出口P2を設定してから走行軌道を設定する。しかし、走行軌道を設定するタイミングは、実退出口P2を設定したあとに自車位置と実退出口P2との間に設定するものに限られるものではない。例えば、候補範囲を設定した段階で、候補範囲の中央と自車位置とを繋ぐ仮の走行軌道を設定し、実退出口P2を設定したタイミングで、設定された仮の走行軌道を修正することにより走行軌道を設定してもよい。   (1) In the above embodiment, the CPU 110 sets the travel path after setting the actual exit P2. However, the timing of setting the traveling trajectory is not limited to the timing set between the host vehicle position and the actual exit P2 after the actual exit P2 is set. For example, at the stage where the candidate range is set, a temporary traveling trajectory connecting the center of the candidate range and the position of the own vehicle is set, and the set temporary traveling trajectory is corrected at the timing when the actual exit P2 is set. May be used to set the traveling trajectory.

(2)上記実施形態では、GNSS受信機10により自車位置を測定するが、自車位置を測定する装置としてはGNSS受信機10に限定されるものでない。例えば、GNSS受信機10に代えて又はGNSS受信機10に加えて、速度センサ、加速度センサ及びヨーレートセンサなどを用いて自車位置を測定してもよい。   (2) In the above-described embodiment, the own vehicle position is measured by the GNSS receiver 10, but the device for measuring the own vehicle position is not limited to the GNSS receiver 10. For example, the position of the host vehicle may be measured using a speed sensor, an acceleration sensor, a yaw rate sensor, or the like instead of or in addition to the GNSS receiver 10.

(3)上記実施形態では、地図メモリ30から地図データを取得したが、更に地図情報において車両が走行できる範囲が制限される情報である制限情報を取得してもよい。ここで、制限情報とは、例えば、工事が行われている場所の情報であってもよい。また、制限情報を取得した場合、候補範囲U1が広く設定してもよい。これにより、道路標示が検出できない場合にも自動運転の制御をすることができる。   (3) In the above embodiment, the map data is acquired from the map memory 30. However, restriction information that is information that restricts a range in which the vehicle can travel in the map information may be further acquired. Here, the restriction information may be, for example, information on a place where construction is being performed. Further, when the restriction information is acquired, the candidate range U1 may be set wider. Thereby, even when a road sign cannot be detected, it is possible to control automatic driving.

さらに、制限情報には、道路上の車両の走行ができない範囲である走行不可範囲の情報を更に含めてもよい。この場合、候補範囲U1が走行不可範囲を除いた範囲となるように設定されてもよい。   Furthermore, the restriction information may further include information on a non-traveling range, which is a range in which vehicles on the road cannot travel. In this case, the candidate range U1 may be set so as to be a range excluding the non-traveling range.

(4)上記実施形態では、センサ部20を用いて候補範囲の道路端を表す道路標示及び縁石などの凹凸形状を求め、当該道路端から相対的な位置を道路の中央として、退出口尤度が高くなるように退出口尤度を算出したが、退出口尤度の算出はこのような方法に限定されるものではない。例えば、「止まれ」などの道路の中央に存在する可能性の高い道路標示を検出した場合に、その位置の退出口尤度を高くなるように算出してもよく、画像中に検出された物標の平坦度合いを、センサ部20を用いて取得し、最も平坦な位置を他の平坦ではない部分に比して退出口尤度が高くなるように算出してもよい。   (4) In the above embodiment, the sensor unit 20 is used to determine the road markings representing the road edges of the candidate range and the irregularities such as curbs, and the exit likelihood is set with the relative position from the road edges as the center of the road. The exit likelihood is calculated so that the exit probability becomes higher, but the calculation of the exit likelihood is not limited to such a method. For example, when a road sign that is likely to be at the center of the road such as “stop” is detected, the exit likelihood at that position may be calculated to be higher, and the detected object may be detected in the image. The degree of flatness of the target may be obtained using the sensor unit 20, and the maximum flatness position may be calculated so that the exit likelihood is higher than other non-flat parts.

(5)上記実施形態では走行制御処理において、S450で走行制御後にS460に処理を移行するが、S450の後、1イテレーション分の待機時間が経過してからS460に処理を移行してもよい。ここで、1イテレーションとは、GNSS受信機10が自車位置を測定する間隔をいう。また、待機時間はこのような時間に限定されるものではなく、例えば、CPU110がGNSS受信機10から自車位置を取得する間隔であってもよい。   (5) In the above-described embodiment, in the travel control process, the process shifts to S460 after the travel control in S450. However, after S450, the process may shift to S460 after a standby time for one iteration has elapsed. Here, one iteration refers to an interval at which the GNSS receiver 10 measures the position of the own vehicle. Further, the standby time is not limited to such a time, and may be, for example, an interval at which the CPU 110 acquires the own vehicle position from the GNSS receiver 10.

(6)上記実施形態における1つの構成要素が有する複数の機能を、複数の構成要素によって実現したり、1つの構成要素が有する1つの機能を、複数の構成要素によって実現したりしてもよい。また、複数の構成要素が有する複数の機能を、1つの構成要素によって実現したり、複数の構成要素によって実現される1つの機能を、1つの構成要素によって実現したりしてもよい。また、上記実施形態の構成の一部を省略してもよい。また、上記実施形態の構成の少なくとも一部を、他の上記実施形態の構成に対して付加又は置換してもよい。なお、特許請求の範囲に記載した文言から特定される技術思想に含まれるあらゆる態様が本開示の実施形態である。   (6) A plurality of functions of one component in the above embodiment may be realized by a plurality of components, or one function of one component may be realized by a plurality of components. . Further, a plurality of functions possessed by a plurality of constituent elements may be realized by one constituent element, or one function realized by a plurality of constituent elements may be realized by one constituent element. Moreover, you may abbreviate | omit a part of structure of the said embodiment. In addition, at least a part of the configuration of the above embodiment may be added to or replaced with the configuration of the other embodiment. In addition, all the aspects included in the technical idea specified from the wording described in the claims are embodiments of the present disclosure.

(7)上述した軌道設定装置100の他、当該軌道設定装置100を構成要素とするシステム、当該軌道設定装置100としてコンピュータを機能させるためのプログラム、このプログラムを記録した半導体メモリ等の非遷移的実態的記録媒体、軌道設定方法など、種々の形態で本開示を実現することもできる。   (7) In addition to the trajectory setting device 100 described above, a system including the trajectory setting device 100 as a component, a program for causing a computer to function as the trajectory setting device 100, and a non-transitional device such as a semiconductor memory storing the program. The present disclosure can be realized in various forms, such as an actual recording medium and a trajectory setting method.

1…自動運転システム、10…受信機、20…センサ部、30…地図メモリ、40…ナビゲーションシステム、100…軌道設定装置、110…CPU、120…メモリ、200…車両制御装置、A1…走行軌道、Lij…交差点リンク、Ii…進入口ノード、Oj…退出口ノード、P10…横断歩道、P2…実退出口、P21…区画線、U1…候補範囲。   DESCRIPTION OF SYMBOLS 1 ... Automatic driving system, 10 ... Receiver, 20 ... Sensor part, 30 ... Map memory, 40 ... Navigation system, 100 ... Track setting device, 110 ... CPU, 120 ... Memory, 200 ... Vehicle control device, A1: Running track , Lij ... intersection link, Ii ... entrance node, Oj ... exit node, P10 ... crosswalk, P2 ... actual exit, P21 ... compartment line, U1 ... candidate range.

Claims (8)

車両に搭載される軌道設定装置であって、
交差点及び道路の行き止まり点を表すノードと、前記ノード間を接続するリンクとを用いて交通網が表現され、前記交差点は、それぞれが当該交差点の進入口又は退出口を表しかつ車線ごとに設定された複数の前記ノードで表現される地図データを記憶する地図データ部(30)と、
前記ノード及び前記リンクを用いて設定された設定ルートを取得し、取得した前記設定ルートにおいて、前記車両が右折又は左折する最寄りの交差点を特定交差点とし、前記特定交差点に属する前記複数のノードのうち、前記特定交差点への進入時に前記車両を通過させるノードを進入口ノード(Ii)とし、前記特定交差点からの退出時に前記車両を通過させるノードを退出口ノード(Oj)とし、前記進入口ノードに対する前記退出口ノードの相対位置を表す退出相対位置を算出するように構成された相対位置算出部(S320)と、
前記車両の位置である自車位置を取得するように構成された位置取得部(S210)と、
前記地図データ及び前記自車位置に含まれ得る誤差の上限値を用いて、前記進入口ノードの位置を基準として、実際の退出口である実退出口(P2)の位置が存在し得る範囲である候補範囲(U1)を算出するように構成された範囲算出部(S120)と、
前記候補範囲で検出される静止物標について前記車両に対する相対位置を含んだ物標情報を取得するように構成された物標取得部(S420)と、
前記物標情報を用いて、前記候補範囲での前記退出口らしさを表す退出口尤度の分布である退出口分布を算出するように構成された尤度算出部(S420)と、
前記退出口分布において前記退出口尤度が最大となる点に対応する前記候補範囲の地点を、前記実退出口として設定するように構成された退出設定部(S430)と、
前記自車位置から前記実退出口に向かって前記車両を通過させるための軌道である走行軌道(A1)を算出するように構成された軌道算出部(S440)と、
を備える、軌道設定装置。
A track setting device mounted on a vehicle,
A traffic network is represented by using nodes representing intersections and dead ends of roads, and links connecting the nodes, and the intersections each represent an entrance or exit of the intersection and are set for each lane. A map data unit (30) for storing map data represented by the plurality of nodes;
A set route obtained by using the node and the link is obtained, and in the obtained set route, a nearest intersection where the vehicle turns right or left is a specific intersection, and among the plurality of nodes belonging to the specific intersection, A node that allows the vehicle to pass when entering the specific intersection is referred to as an entry node (Ii); a node that allows the vehicle to pass when exiting from the specific intersection is an exit node (Oj); A relative position calculator (S320) configured to calculate an exit relative position indicating a relative position of the exit node;
A position acquisition unit (S210) configured to acquire the position of the host vehicle that is the position of the vehicle;
Using the map data and the upper limit value of the error that can be included in the position of the vehicle, a position where the actual exit (P2), which is an actual exit, can exist based on the position of the entrance node. A range calculator (S120) configured to calculate a certain candidate range (U1);
A target acquisition unit (S420) configured to acquire target information including a relative position of the stationary target detected in the candidate range with respect to the vehicle;
A likelihood calculation unit (S420) configured to calculate an exit distribution, which is a distribution of exit likelihoods representing the likelihood of exit in the candidate range, using the target information;
An exit setting unit (S430) configured to set a point in the candidate range corresponding to a point at which the exit likelihood is maximum in the exit distribution as the actual exit;
A track calculating unit (S440) configured to calculate a running track (A1) that is a track for passing the vehicle from the host vehicle position toward the actual exit;
A trajectory setting device comprising:
請求項1に記載の軌道設定装置であって、
前記物標取得部は、前記物標情報として車線の端部の位置を表す少なくとも一対の区画線の位置を表した情報を取得するように構成され、
前記尤度算出部は、前記物標取得部により取得された前記一対の区画線により挟まれた範囲の中央における前記退出口尤度が高くなるように算出する、軌道設定装置。
The trajectory setting device according to claim 1,
The target acquisition unit is configured to acquire information representing the position of at least one pair of lane markings representing the position of the end of the lane as the target information,
The trajectory setting device, wherein the likelihood calculating unit calculates the likelihood of the exit at the center of a range sandwiched by the pair of lane markings acquired by the target acquiring unit so as to increase the likelihood.
請求項1又は請求項2に記載の軌道設定装置であって、
前記物標取得部は前記物標情報として、前記特定交差点に含まれる横断歩道(P10)の位置を表す情報である横断歩道情報を取得するように構成され、
前記尤度算出部は、前記物標取得部により取得された前記横断歩道情報が表す横断歩道の位置を基準として、前記横断歩道の位置と前記退出口ノードが表す前記退出口の位置との対応関係に従って算出される位置の前記退出口尤度が高くなるように算出する、軌道設定装置。
The trajectory setting device according to claim 1 or 2, wherein:
The target acquisition unit is configured to acquire, as the target information, pedestrian crossing information that is information indicating a position of a pedestrian crossing (P10) included in the specific intersection,
The likelihood calculation unit is configured to correspond to the position of the pedestrian crossing and the position of the exit represented by the exit node based on the position of the pedestrian crossing represented by the pedestrian crossing information acquired by the target acquisition unit. A trajectory setting device that calculates the likelihood of the exit at a position calculated according to a relationship.
請求項1から請求項3までのいずれか1項に記載の軌道設定装置であって
前記物標取得部は、前記候補範囲の路面形状の凹凸を取得するように構成された凹凸取得部(S420)を更に備え、
前記尤度算出部は、前記凹凸取得部により取得された前記路面形状の凹凸に基づいて、退出口尤度を算出する凹凸算出部(S420)を備える、
を備える、軌道設定装置。
4. The trajectory setting device according to claim 1, wherein the target acquiring unit is configured to acquire irregularities of a road surface shape in the candidate range (S <b> 420). )
The likelihood calculation unit includes an unevenness calculation unit (S420) that calculates an exit likelihood based on the unevenness of the road surface shape acquired by the unevenness acquisition unit.
A trajectory setting device comprising:
請求項4に記載の軌道設定装置であって、
前記凹凸取得部は、前記候補範囲における凹凸を取得し、
前記凹凸算出部は、あらかじめ決められた凹凸の大きさに設定された凹凸閾値以下である平坦位置における前記退出口尤度が、前記平坦位置以外の位置での前記退出口尤度に比べて高くなるように算出し、
前記凹凸閾値は、車両が通過できる程度の凹凸の大きさ及び道路の中央の凹凸の大きさの一方が設定される、軌道設定装置。
The trajectory setting device according to claim 4, wherein
The unevenness acquisition unit acquires unevenness in the candidate range,
The unevenness calculation unit, the exit likelihood at a flat position that is equal to or less than an unevenness threshold value set to a predetermined unevenness size is higher than the exit likelihood at a position other than the flat position. Calculated so that
The trajectory setting device, wherein the unevenness threshold is set to one of a size of unevenness enough to allow a vehicle to pass and a size of unevenness at the center of a road.
請求項4に記載の軌道設定装置であって、
前記凹凸取得部は、道路の端部に設置される縁石の大きさの凹凸を少なくとも取得するように構成され、
前記凹凸算出部は、前記凹凸取得部により取得された縁石の大きさの凹凸により挟まれた範囲の中央における前記退出口尤度が高くなるように算出する、軌道設定装置。
The trajectory setting device according to claim 4, wherein
The unevenness acquisition unit is configured to acquire at least unevenness of a curb size installed at an end of a road,
The trajectory setting device, wherein the unevenness calculating unit calculates the exit likelihood at the center of a range sandwiched by the unevenness of the curb size acquired by the unevenness acquiring unit so as to increase.
請求項1から請求項6までのいずれか1項に記載の軌道設定装置であって、
前記物標取得部、前記尤度算出部、前記退出設定部及び前記軌道算出部は、前記進入口ノードが表す位置から前記退出口ノードが表す位置との間に前記自車位置が含まれる場合に、各構成に割り当てられた処理を実行するように構成された、軌道設定装置。
The trajectory setting device according to any one of claims 1 to 6, wherein
The target acquisition unit, the likelihood calculation unit, the exit setting unit, and the trajectory calculation unit may include a case where the vehicle position is included between a position represented by the entrance node and a position represented by the exit node. A trajectory setting device configured to execute a process assigned to each configuration.
請求項1から請求項7までのいずれか1項に記載の軌道設定装置であって、
前記物標取得部、前記尤度算出部、前記退出設定部及び前記軌道算出部は、前記進入口ノードが表す位置から前記退出口ノードが表す位置に前記自車位置が含まれる間、各構成に割り当てられた処理を繰り返し実行するように構成された、軌道設定装置。
The trajectory setting device according to any one of claims 1 to 7, wherein:
The target acquisition unit, the likelihood calculation unit, the exit setting unit, and the trajectory calculation unit are configured such that the own vehicle position is included in a position represented by the entrance node from a position represented by the entrance node. A trajectory setting device configured to repeatedly execute a process assigned to the trajectory.
JP2018111031A 2018-06-11 2018-06-11 Orbit setting device Active JP7067290B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2018111031A JP7067290B2 (en) 2018-06-11 2018-06-11 Orbit setting device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2018111031A JP7067290B2 (en) 2018-06-11 2018-06-11 Orbit setting device

Publications (2)

Publication Number Publication Date
JP2019215177A true JP2019215177A (en) 2019-12-19
JP7067290B2 JP7067290B2 (en) 2022-05-16

Family

ID=68919047

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2018111031A Active JP7067290B2 (en) 2018-06-11 2018-06-11 Orbit setting device

Country Status (1)

Country Link
JP (1) JP7067290B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023175966A1 (en) * 2022-03-18 2023-09-21 日産自動車株式会社 Vehicle travel control method and vehicle travel control device

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006284254A (en) * 2005-03-31 2006-10-19 Denso It Laboratory Inc Course prediction method, course prediction device, and course-prediction information using system
WO2010109805A1 (en) * 2009-03-26 2010-09-30 株式会社トヨタマップマスター Device and method for generating route restriction information of intersection, computer program for generating route restriction information of intersection, and recording medium for recording computer program
JP2013029378A (en) * 2011-07-27 2013-02-07 Aisin Aw Co Ltd Traveling guide system, traveling guide device, traveling guide method, and computer program
JP2016136344A (en) * 2015-01-23 2016-07-28 株式会社インテック Movement direction prediction device, movement direction prediction method, and movement direction prediction program

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006284254A (en) * 2005-03-31 2006-10-19 Denso It Laboratory Inc Course prediction method, course prediction device, and course-prediction information using system
WO2010109805A1 (en) * 2009-03-26 2010-09-30 株式会社トヨタマップマスター Device and method for generating route restriction information of intersection, computer program for generating route restriction information of intersection, and recording medium for recording computer program
JP2013029378A (en) * 2011-07-27 2013-02-07 Aisin Aw Co Ltd Traveling guide system, traveling guide device, traveling guide method, and computer program
JP2016136344A (en) * 2015-01-23 2016-07-28 株式会社インテック Movement direction prediction device, movement direction prediction method, and movement direction prediction program

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2023175966A1 (en) * 2022-03-18 2023-09-21 日産自動車株式会社 Vehicle travel control method and vehicle travel control device

Also Published As

Publication number Publication date
JP7067290B2 (en) 2022-05-16

Similar Documents

Publication Publication Date Title
JP6269552B2 (en) Vehicle travel control device
RU2703440C1 (en) Method and device for controlling movement
US11092442B2 (en) Host vehicle position estimation device
JP6822815B2 (en) Road marking recognition device
JP2004531424A (en) Sensing device for cars
US20150375752A1 (en) Confidence level determination for estimated road geometries
US10705530B2 (en) Vehicle travel control method and vehicle travel control device
JP7077967B2 (en) Driving lane estimation device, driving lane estimation method, and control program
JP7123154B2 (en) Driving support method and driving support device
JP2007126086A (en) Vehicle position estimation device, traveling support device for vehicle and vehicle position estimation method
JP6805704B2 (en) Route selection method and route selection device
JP2002098758A (en) Method and device for finding position of automobile with respect to traveling lane
JP6171499B2 (en) Risk determination device and risk determination method
JP2005257314A (en) Vehicle position detector
JP2019066445A (en) Position correction method, vehicle control method, and position correction device
JP7006203B2 (en) Trajectory setting device
WO2017013692A1 (en) Travel lane determination device and travel lane determination method
JP6747157B2 (en) Self-position estimation method and self-position estimation device
JP7067290B2 (en) Orbit setting device
JP2010190832A (en) Device and program for determining merging/leaving
JP6819441B2 (en) Target position estimation method and target position estimation device
JP2020057146A (en) Traveling lane estimation device, traveling lane estimation method, and control program
JP7463997B2 (en) Vehicle control device, vehicle control method, and vehicle control computer program
JP5682302B2 (en) Traveling road estimation device, method and program
JP2019070895A (en) Runway recognizer

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210218

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220125

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220224

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20220411

R151 Written notification of patent or utility model registration

Ref document number: 7067290

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151