WO2019171821A1 - 列車位置推定装置 - Google Patents
列車位置推定装置 Download PDFInfo
- Publication number
- WO2019171821A1 WO2019171821A1 PCT/JP2019/002725 JP2019002725W WO2019171821A1 WO 2019171821 A1 WO2019171821 A1 WO 2019171821A1 JP 2019002725 W JP2019002725 W JP 2019002725W WO 2019171821 A1 WO2019171821 A1 WO 2019171821A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- peripheral shape
- vehicle
- shape data
- position estimation
- train
- Prior art date
Links
- 238000012545 processing Methods 0.000 claims abstract description 16
- 238000005259 measurement Methods 0.000 claims abstract description 6
- 230000002093 peripheral effect Effects 0.000 claims description 62
- 230000004913 activation Effects 0.000 claims description 13
- 230000008034 disappearance Effects 0.000 claims 2
- 238000000034 method Methods 0.000 description 23
- 238000009826 distribution Methods 0.000 description 14
- 238000001514 detection method Methods 0.000 description 9
- 238000010586 diagram Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 230000001678 irradiating effect Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B61—RAILWAYS
- B61L—GUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
- B61L25/00—Recording or indicating positions or identities of vehicles or trains or setting of track apparatus
- B61L25/02—Indicating or recording positions or identities of vehicles or trains
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/4808—Evaluating distance, position or velocity data
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B61—RAILWAYS
- B61L—GUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
- B61L25/00—Recording or indicating positions or identities of vehicles or trains or setting of track apparatus
- B61L25/02—Indicating or recording positions or identities of vehicles or trains
- B61L25/025—Absolute localisation, e.g. providing geodetic coordinates
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B61—RAILWAYS
- B61L—GUIDING RAILWAY TRAFFIC; ENSURING THE SAFETY OF RAILWAY TRAFFIC
- B61L2205/00—Communication or navigation systems for railway traffic
- B61L2205/04—Satellite based navigation systems, e.g. global positioning system [GPS]
Definitions
- the present invention relates to an apparatus for detecting the position of a train.
- the vehicle position information is required to run the train along the predetermined speed pattern.
- a method of measuring the vehicle position there is a method of calculating the distance by integrating the speed measured by the speed sensor, but it is inevitable that the integration error caused by the deviation of the wheel diameter of the train is accumulated. Therefore, a method of correcting an error by installing a ground element storing position information in a gauge and reading out the position information when a train passes over it is widely used.
- Patent Document 1 discloses an invention in which a search range of a database is dynamically limited using features on input sensor data.
- a map reference area is set around the latest self position, a similar image of the current image is searched from the image in the map within the area, and the self position is estimated based on the distribution.
- the accuracy of self-position estimation can be improved and the processing load can be reduced in any driving environment.
- one of the representative train position estimation devices of the present invention is installed in a vehicle traveling on a traveling road, measures the peripheral shape at the current point of the vehicle, and measures the measured peripheral shape data
- a peripheral shape measuring unit that outputs the measured peripheral shape data
- a map storage unit that stores reference peripheral shape data that is data of the peripheral shape at each position measured in advance, and the measured peripheral shape data and the reference peripheral shape
- a train position estimation device for calculating the position of the vehicle by comparing data, and an activation position estimation unit for storing the existence probability of the position of the vehicle, and the reference peripheral shape data at the position in descending order of the existence probability
- the map reading section determining device for outputting the measured peripheral shape data and the reference peripheral shape data output by the map reading section determining device, and the difference There is achieved by providing a matching processing unit for outputting a position equal to or less than a predetermined threshold.
- the peripheral shape data at a position where the vehicle exists is preferentially read and compared with the current peripheral shape data. Therefore, the time required for the processing can be shortened.
- the block diagram which shows the structural example of the train position estimation apparatus in 1st embodiment.
- Example of probability distribution stored in the activation position estimation unit in the first embodiment Example of comparison by the matching processing device in the first embodiment
- the flowchart which shows the example of the procedure of the position estimation in 1st embodiment
- the vehicle 100 is equipped with a peripheral shape measuring unit 101 that measures the peripheral shape of the host vehicle.
- the mounting position of the peripheral shape measuring unit 101 is set so that the peripheral shape data of the vehicle can be measured over a wide range. For example, it is installed on the front of the vehicle or on the top of the vehicle.
- the peripheral shape measuring unit 101 has a function of measuring the peripheral shape near the vehicle at the current location as two-dimensional or three-dimensional coordinate information.
- An example of means for measuring the peripheral shape is LiDAR.
- LiDAR can measure the peripheral shape near the current vehicle by irradiating light in each direction and calculating the distance from the time it takes for the light to be reflected back to the object.
- the means for measuring the peripheral shape near the current vehicle is not limited to LiDAR, and a millimeter wave radar or a camera may be used.
- the map storage unit 102 has a function of holding and outputting peripheral shape data (map) at each position.
- the peripheral shape data at each position can be acquired by measuring the peripheral shape data for each position in advance by the peripheral shape measuring unit 101 or the like.
- SLAM Simultaneous Localization and Mapping
- SLAM Simultaneous Localization and Mapping
- the activation position estimation unit 103 has a function of storing a probability distribution that is a probability distribution of the vehicle existing at each position on the track.
- FIG. 2 shows an example of the probability distribution stored in the activation position estimation unit 103.
- the probability distribution that the vehicle is present at each position is calculated from the train schedule / operation plan, actually measured travel data, and vehicle berthing information. In general, there is a high probability around stations and indwelling lines. This probability distribution may be calculated in advance, or may be calculated (in real time or in advance) by the activation position estimation unit 103.
- the information obtained from the information on the station where the berth is allowed and the detained line, and whether the berthing train is set in the train schedule is listed.
- the train existence probability of a station with a berthing plan Increases the probability that a train will be present (hereinafter referred to as the train existence probability of a station with a berthing plan) for a station or detained line where a train staying in the train schedule is set.
- the probability that a train will be present (hereinafter referred to as the train existence probability for a station without a plan) Lower than the existence probability.
- the probability that a train exists is set lower than the train existence probability of a station with an unplanned stay and the train existence probability of a station without a staying plan.
- the map readout section determination device 104 has a function of outputting the map output from the map storage unit 102 to the matching processing device 105 in the order of the position having the highest probability of existence.
- the matching processing device 105 compares the peripheral shape data of the current location output from the peripheral shape measuring unit 101 with the peripheral shape data at each position output from the map reading section determining device 104, and calculates a difference.
- FIG. 3 shows an example of comparison processing in the matching processing device 105.
- the peripheral shape data of the current location output from the peripheral shape measuring unit 101 is compared with the peripheral shape data output from the map reading section determination device 104, and a difference is calculated. If the difference is smaller than a predetermined threshold, the position is output as the estimated position.
- NDT Normal Distributions Transform
- This process is performed when the vehicle 100 is started, but is not limited thereto, and may be performed as necessary.
- step S11 the peripheral shape data of the current point is output from the peripheral shape measuring unit 101.
- step S12 the map reading section determination device 104 reads the peripheral shape data from the map storage unit 102 in the order of the position having the highest probability distribution, based on the probability distribution data from the activation position estimation unit 103.
- step S13 the matching processing device 105 compares the surrounding shape data of the current location with the surrounding shape data output from the map reading section determining device 104, and calculates a difference.
- step S14 the difference is compared with a predetermined threshold value. If the difference is smaller than the threshold value, the process proceeds to step S15. If the difference is larger than the threshold value, the process returns to step S12, and the next order map is read.
- step S15 the position determined in step S14 is output as the estimated position.
- the peripheral shape data of the position where the vehicle exists and having a high probability distribution is preferentially read, By comparing with the peripheral shape data, the time required for the processing can be shortened.
- the position estimation procedure of the present embodiment may be performed as necessary not only when the vehicle is started, but also when the vehicle loses the current position information or when the current position information is updated. .
- the activation position estimation unit 103 stores the position where the vehicle has previously lost the current position information, calculates the probability of losing the current position information for each position, You may output as probability distribution which is distribution of the probability which exists in a position.
- the activation position estimation unit 103 may store the “existence probability at the time of vehicle activation” and the “existence probability at the time of vehicle position loss (probability of position loss)” separately.
- the map reading section determination device 104 selects “the existence probability at the time of starting the vehicle” at the time of map matching at the time of starting, and outputs the reference peripheral shape data in descending order of the “the existence probability at the time of starting the vehicle”.
- the map reading section determination device 104 selects “existence probability at the time of vehicle position loss (probability of position loss)” in map matching at the time of position loss and selects “existence probability at the time of vehicle position loss (position loss).
- the control peripheral shape data is output in descending order. According to such a process, it is possible to adaptively switch the existence probability to be used at the time of activation and at the time of position loss, and the time required for map matching can be shortened.
- the map reading section determination device 104 may include GPS position detection means, determine a GPS detection error, and determine whether the detection error is larger than a predetermined amount (or undetectable). In this case, when the GPS detection error is larger than a predetermined amount (or cannot be detected), the map reading section determination device 104 outputs the control peripheral data in descending order of the existence probability output by the activation position estimation unit 103. . Furthermore, in the other cases (when the GPS detection accuracy is reliable), the map reading section determination device 104 outputs the reference peripheral shape data in the order of the position detected by the GPS position detection means. According to such processing, the time required for map matching can be shortened even in a situation where the GPS detection error is large (or undetectable).
- this invention is not limited to an above-described Example, Various deformation
- transformation are possible.
- the embodiments have been described in detail in order to easily explain the present invention. Therefore, the present invention is not limited to the one having all the configurations described.
- a part of the configuration of a certain embodiment can be replaced with the configuration of another embodiment. It is also possible to add the configuration of another embodiment to the configuration of one embodiment.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
- Train Traffic Observation, Control, And Security (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
予め定められた軌道を走行する車両に設置され前記車両の現在地点における周辺形状を計測する周辺形状計測部と、 予め計測した各位置における周辺形状データを記憶する地図記憶部を備えて、前記車両の位置を算出する列車位置推定装置であって、 前記車両の位置の存在確率を記憶する起動位置推定部と、 前記存在確率の高い順にその位置における周辺形状データを出力する地図読出区間決定装置と、 前記現在地点の周辺形状データと読み出した周辺形状データとを比較し、その差分が予め定めた閾値以下となる位置を出力するマッチング処理装置と を備えることを特徴とする列車位置推定装置。
Description
本発明は、列車の位置を検知する装置に関する。
事前に定めた速度パターンに沿って列車を走行させるためには自車位置情報が必要である。自車位置を計測する方法として、速度センサで計測した速度を積分して距離を算出する方法があるが、列車の車輪径の偏差によって発生する積分誤差の蓄積を避けられない。そこで、位置情報を記憶した地上子を軌間に設置し、その上を列車が通過する際に位置情報を読み出すことによって、誤差を補正する方法が広く用いられている。
一方、地上子は軌間に設置するため、設置コストおよびメンテナンスコストを要するという課題がある。この方法の代わりに、カメラやLiDAR(Light Detection and Ranging、Laser Imaging Detection and Ranging)を用いて、現在の周辺形状データを取得し、事前に記憶した各位置における周辺形状データとの比較を行うことによって位置を算出するマップマッチング技術が開発されている。
マップマッチングによって位置を算出する際には、マッチング処理の負荷を軽減するために、データベースの探索範囲をGPSなど他の位置計測手段から求めた推定位置周辺に限定することが一般的である。
特許文献1では、データベースの探索範囲を、入力センサデータ上の特徴を使って、探索範囲を動的に限定する発明が開示されている。この特許文献1には「最新自己位置を中心に地図参照エリアを設定し、前記エリア内で現在の画像の類似画像を地図中の画像から検索し、その分布をもとに自己位置を推定することで、任意の走行環境において、自己位置推定の確度を向上し、処理負荷を低減できる。」と記載されている。
しかしながら、推定位置の誤差が大きい場合には、正確な位置を算出することができなくなる。また、データベース上に特徴点をもつデータが多く存在している場合、不要に探索範囲を拡大してしまうため、マッチング処理に時間を要するという課題がある。
上記課題を解決するために、代表的な本発明の列車位置推定装置の一つは、走行路を走行する車両に設置され前記車両の現在地点における周辺形状を計測し、計測した周辺形状のデータを実測周辺形状データとして出力する周辺形状計測部と、予め計測した各位置における周辺形状のデータである対照周辺形状データを記憶する地図記憶部とを備え、前記実測周辺形状データと前記対照周辺形状データを比較して前記車両の位置を算出する列車位置推定装置であって、前記車両の位置の存在確率を記憶する起動位置推定部と、前記存在確率の高い順にその位置における前記対照周辺形状データを出力する地図読出区間決定装置と、前記実測周辺形状データと前記地図読出区間決定装置が出力した前記対照周辺形状データとを比較し、その差分が予め定めた閾値以下となる位置を出力するマッチング処理装置とを備えることにより達成される。
本発明によれば、マップマッチング技術によって車両の起動時などの位置を算出する際、車両の存在する確率の高い位置の周辺形状データを優先的に読み出して、現在の周辺形状データと比較することによって、その処理に要する時間を短縮できる。
以下、実施例について図面を参照して説明する。
本実施の形態では、マップマッチングに用いるデータベースの読み出しを、車両の存在する確率の高い位置から順番に行うことによって、マッチング処理に要する時間を短縮する方法について説明する。
まず、図1を用いて、列車位置推定装置の構成と各構成要素の役割を説明する。
車両100は自車の周辺形状を計測する周辺形状計測部101を搭載している。周辺形状計測部101の搭載位置は、車両の周辺形状データが広範囲に計測できるように設置する。例えば、車両の前面もしくは車両の上部に設置する。
周辺形状計測部101は、現在地点での車両付近の周辺形状を、2次元もしくは3次元の座標情報として計測する機能を有する。周辺形状を計測する手段には、例えばLiDARが挙げられる。LiDARは、各方向に光線を照射し、光線が物体に反射して返ってくるまでの時間から距離を計算することによって、現在の車両付近の周辺形状を計測することができる。なお、現在の車両付近の周辺形状を計測する手段はLiDARに限るものではなく、ミリ波レーダやカメラを用いてもよい。
地図記憶部102は、各位置での周辺形状データ(地図)を保持し出力する機能を有する。各位置での周辺形状データは、事前に周辺形状計測部101などが周辺形状データを位置ごとに計測することによって取得できる。例えば、移動前の地点と現在の地点の周辺形状データの差分から算出した移動距離から、各位置での周辺形状データを作成する手法であるSLAM(Simultaneous Localization and Mapping)を用いてもよい。
起動位置推定部103は、車両が線路上の各位置に存在する確率の分布である確率分布を記憶する機能を有する。図2に起動位置推定部103が記憶する確率分布の例を示す。車両が各位置に存在する確率分布は、列車のダイヤ・運行計画や実測の走行データ、車両の滞泊情報から算出する。一般的には駅や留置線周辺の確率が高くなる。この確率分布はあらかじめ算出しても良いし、起動位置推定部103が(リアルタイムに、又は、あらかじめ)算出しても良い。
確率分布の算出の例として、滞泊可能駅と留置線の情報、及び、列車のダイヤにおいて滞泊する列車が設定されているか、から求めるものを挙げる。
列車のダイヤにおいて滞泊する列車が設定されている滞泊可能駅または留置線について、列車が存在する確率(以下、滞泊計画有駅の列車存在確率と呼ぶ)を高くする。列車のダイヤにおいて滞泊する列車が設定されていない滞泊可能駅または留置線については列車が存在する確率(以下、滞泊計画無駅の列車存在確率と呼ぶ)を滞泊計画有駅の列車存在確率より低くする。滞泊可能でない駅、または留置線以外の線については列車が存在する確率を滞泊計画有駅の列車存在確率及び滞泊計画無駅の列車存在確率より低くする。
列車が存在する確率が同じになる場合は、一定の規則に従った順序(例えば起点に近い順序)により優先度を設定し、列車が存在する確率の大きさの比較をするとき、同じ確率になった場合はこの優先度の順序に従って比較を行う。すなわち、列車が存在する確率が同じになる場合は優先度の高い方が確率が高いとする。
あるいは、実測の走行データより、走行路の各地点ごと(例えば停車可能な駅、留置線、車庫、等)に列車が存在する時間を算出し、1日の内にそれぞれの地点ごとにどの割合でその地点に滞在しているかを算出し、列車の存在確率としても良い。
地図読出区間決定装置104は、存在する確率が高い位置の順番に、地図記憶部102から出力された地図を、マッチング処理装置105へ出力する機能を有する。
マッチング処理装置105は、周辺形状計測部101から出力された現在地点の周辺形状データと、地図読出区間決定装置104から出力された各位置での周辺形状データとを比較し差分を計算する。図3にマッチング処理装置105における比較処理の例を示す。周辺形状計測部101から出力された現在地点の周辺形状データと、地図読出区間決定装置104から出力された周辺形状データを比較し、差分を計算する。そして、その差分が予め定めた閾値より小さい場合に、その位置を推定位置として出力する。
差分を計算する方法として、地図空間を一定の大きさの格子に区切り、各格子での一致率・不一致率を計算する手法であるNDT(Normal Distributions Transform)がある。なお、図3では2次元の周辺形状データのマッチング処理の例を用いて説明したが、本実施例は周辺形状データの計測を2次元に限るものではなく、3次元の周辺形状データのマッチング処理に対しても同様に適用できる。
以上が、列車位置推定装置の構成と各構成要素の役割の説明である。
次に、本実施例を用いた時の、位置推定の手順の例を図4のフローチャートを用いて説明する。
この処理は車両100の起動時に実施するが、これに限定するものではなく、必要に応じて実施してもよい。
ステップS11で、周辺形状計測部101から現在地点の周辺形状データを出力する。
ステップS12で、地図読出区間決定装置104は、起動位置推定部103からの確率分布データに基づいて、確率分布の高い位置の順番に地図記憶部102から周辺形状データを読み出す。
ステップS13で、マッチング処理装置105は、現在地点の周辺形状データと地図読出区間決定装置104から出力された周辺形状データとを比較し、差分を算出する。
ステップS14で、差分が予め定めた閾値を比較し、差分が閾値よりも小さい場合はステップS15に進み、差分が閾値よりも大きい場合はステップS12に戻り、次の順番の地図を読み出す。
ステップS15で、ステップS14で判定した位置を推定位置として出力する。
以上が列車位置推定装置の処理の流れの説明である。
以上説明したように、本実施の形態によれば、マップマッチング技術によって車両の起動時の位置を算出する際、車両の存在する確率分布の高い位置の周辺形状データを優先的に読み出して、現在の周辺形状データと比較することによって、その処理に要する時間を短縮できる。
また、本実施の位置推定の手順は、車両の起動時のみならず、車両が現在位置の情報を消失したときや、現在位置の情報を更新するとき等、必要に応じて実施しても良い。
例えば、起動位置推定部103は、以前に車両が現在位置の情報を消失した位置を記憶し、それぞれの位置毎に現在位置の情報を消失する確率を算出し、それを車両が線路上の各位置に存在する確率の分布である確率分布として出力してもよい。
これにより、車両が現在位置の情報を消失したとき再度現在地を算出するのに要する時間を短縮することができる。
なお、起動位置推定部103は、「車両の起動時の存在確率」と「車両の位置消失時の存在確率(位置消失の確率)」とを区分して記憶してもよい。
この場合、地図読出区間決定装置104は、起動時のマップマッチングに際して、「車両の起動時の存在確率」を選択し、「車両の起動時の存在確率」の高い順に対照周辺形状データを出力する。
さらに、地図読出区間決定装置104は、位置消失時のマップマッチングに際して、「車両の位置消失時の存在確率(位置消失の確率)」を選択し、「車両の位置消失時の存在確率(位置消失の確率)」の高い順に対照周辺形状データを出力する。
このような処理によれば、起動時と位置消失時に際して、使用する存在確率を適応的に切り替えることが可能になり、マップマッチングに要する時間を短縮することができる。
この場合、地図読出区間決定装置104は、起動時のマップマッチングに際して、「車両の起動時の存在確率」を選択し、「車両の起動時の存在確率」の高い順に対照周辺形状データを出力する。
さらに、地図読出区間決定装置104は、位置消失時のマップマッチングに際して、「車両の位置消失時の存在確率(位置消失の確率)」を選択し、「車両の位置消失時の存在確率(位置消失の確率)」の高い順に対照周辺形状データを出力する。
このような処理によれば、起動時と位置消失時に際して、使用する存在確率を適応的に切り替えることが可能になり、マップマッチングに要する時間を短縮することができる。
また、地図読出区間決定装置104は、GPSによる位置検出手段を備え、GPSの検出誤差を判定し、検出誤差が所定量より大きい(または検出不能)か否かを判定してもよい。
この場合、地図読出区間決定装置104は、GPSの検出誤差が所定量より大きい(または検出不能)となった際に、起動位置推定部103が出力する存在確率の高い順に対照周辺データを出力する。
さらに、地図読出区間決定装置104は、それ以外の場合(GPSの検出精度が信頼できる場合)、GPSの位置検出手段により検出された位置に近い順に対照周辺形状データを出力する。
このような処理によれば、GPSの検出誤差が大きい(または検出不能)となる状況においても、マップマッチングに要する時間を短縮することができる。
この場合、地図読出区間決定装置104は、GPSの検出誤差が所定量より大きい(または検出不能)となった際に、起動位置推定部103が出力する存在確率の高い順に対照周辺データを出力する。
さらに、地図読出区間決定装置104は、それ以外の場合(GPSの検出精度が信頼できる場合)、GPSの位置検出手段により検出された位置に近い順に対照周辺形状データを出力する。
このような処理によれば、GPSの検出誤差が大きい(または検出不能)となる状況においても、マップマッチングに要する時間を短縮することができる。
なお、本発明は、上記した実施例に限定されるものではなく、様々な変形が可能である。
例えば、実施例は、本発明を分かりやすく説明するために、詳細に説明したものである。そのため、本発明は、説明した全ての構成を備えるものに限定されない。
また、ある実施例の構成の一部を他の実施例の構成に置き換えることが可能である。また、ある実施例の構成に他の実施例の構成を加えることも可能である。
例えば、実施例は、本発明を分かりやすく説明するために、詳細に説明したものである。そのため、本発明は、説明した全ての構成を備えるものに限定されない。
また、ある実施例の構成の一部を他の実施例の構成に置き換えることが可能である。また、ある実施例の構成に他の実施例の構成を加えることも可能である。
100 車両
101 周辺形状計測部
102 地図記憶部
103 起動位置推定部
104 地図読出区間決定装置
105 マッチング処理装置
101 周辺形状計測部
102 地図記憶部
103 起動位置推定部
104 地図読出区間決定装置
105 マッチング処理装置
Claims (5)
- 走行路を走行する車両に設置され前記車両の現在地点における周辺形状を計測し、計測した周辺形状のデータを実測周辺形状データとして出力する周辺形状計測部と、
予め計測した各位置における周辺形状のデータである対照周辺形状データを記憶する地図記憶部とを備え、前記実測周辺形状データと前記対照周辺形状データを比較して前記車両の位置を算出する列車位置推定装置であって、
前記車両が存在しうるそれぞれの位置における存在確率を記憶する起動位置推定部と、
前記存在確率の高い順にその位置における前記対照周辺形状データを出力する地図読出区間決定装置と、
前記実測周辺形状データと前記地図読出区間決定装置が出力した前記対照周辺形状データとを比較し、その差分が予め定めた閾値以下となる位置を出力するマッチング処理装置と
を備えることを特徴とする列車位置推定装置。 - 請求項1に記載の列車位置推定装置において、
前記周辺形状計測部が、レーザー光を照射しその反射光が戻ってくるまでの時間から、物体までの距離を計測することによって周辺形状を計測する
ことを特徴とする列車位置推定装置。 - 請求項1乃至請求項2のいずれか一つに記載の列車位置推定装置において、
前記地図記憶部が、事前に各位置において前記周辺形状計測部で計測した前記周辺形状のデータを記憶する
ことを特徴とする列車位置推定装置。 - 請求項1乃至請求項3のいずれか一つに記載の列車位置推定装置において、
前記起動位置推定部が、前記車両のダイヤ、運行計画、走行データ又は滞泊情報から前記存在確率を算出する
ことを特徴とする列車位置推定装置。 - 請求項1乃至請求項4のいずれか一つに記載の列車位置推定装置において、
前記起動位置推定部は、以前に位置の情報を消失した位置について位置消失の確率を記憶し、前記位置消失の確率に基づいて前記存在確率を求める
ことを特徴とする列車位置推定装置。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP19763508.9A EP3763597B1 (en) | 2018-03-05 | 2019-01-28 | Train position estimation device |
US16/977,542 US11938983B2 (en) | 2018-03-05 | 2019-01-28 | Train position estimation device |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2018-038176 | 2018-03-05 | ||
JP2018038176A JP7016276B2 (ja) | 2018-03-05 | 2018-03-05 | 列車位置推定装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2019171821A1 true WO2019171821A1 (ja) | 2019-09-12 |
Family
ID=67846024
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2019/002725 WO2019171821A1 (ja) | 2018-03-05 | 2019-01-28 | 列車位置推定装置 |
Country Status (4)
Country | Link |
---|---|
US (1) | US11938983B2 (ja) |
EP (1) | EP3763597B1 (ja) |
JP (1) | JP7016276B2 (ja) |
WO (1) | WO2019171821A1 (ja) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6822800B2 (ja) * | 2016-08-19 | 2021-01-27 | 株式会社東芝 | 列車位置検出装置及び方法 |
JP6947699B2 (ja) * | 2018-07-25 | 2021-10-13 | 公益財団法人鉄道総合技術研究所 | 情報処理装置および点群位置補正方法、ならびにプログラム |
DE102021207482A1 (de) | 2021-07-14 | 2023-01-19 | Siemens Mobility GmbH | Verfahren und Einrichtung zur Überprüfung von Kartendaten und/oder Sensordaten |
KR102507906B1 (ko) * | 2022-10-04 | 2023-03-09 | 주식회사 라이드플럭스 | 저용량 ndt 지도를 이용한 자율주행 차량의 측위 방법, 장치 및 컴퓨터프로그램 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004005593A (ja) * | 2002-04-17 | 2004-01-08 | Matsushita Electric Works Ltd | 自律移動装置 |
JP2008247154A (ja) * | 2007-03-30 | 2008-10-16 | Kyosan Electric Mfg Co Ltd | 列車位置検知装置と列車制御装置 |
JP2016162013A (ja) | 2015-02-27 | 2016-09-05 | 株式会社日立製作所 | 自己位置推定装置および移動体 |
JP2017001638A (ja) * | 2015-06-16 | 2017-01-05 | 西日本旅客鉄道株式会社 | 画像処理を利用した列車位置検出システムならびに画像処理を利用した列車位置および環境変化検出システム |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5259286B2 (ja) * | 2008-07-16 | 2013-08-07 | 株式会社日立製作所 | 3次元物体認識システム及びそれを用いた棚卸システム |
JP5216690B2 (ja) * | 2009-06-01 | 2013-06-19 | 株式会社日立製作所 | ロボット管理システム、ロボット管理端末、ロボット管理方法およびプログラム |
US9036865B2 (en) * | 2012-09-12 | 2015-05-19 | International Business Machines Corporation | Location determination for an object using visual data |
JP2017019421A (ja) * | 2015-07-13 | 2017-01-26 | 日立オートモティブシステムズ株式会社 | 周辺環境認識装置、及び周辺環境認識プログラム |
JP6493422B2 (ja) * | 2016-02-10 | 2019-04-03 | 株式会社デンソー | 走行支援装置 |
US10551201B2 (en) * | 2016-02-25 | 2020-02-04 | Hitachi, Ltd. | Moving body control method, moving body, and moving body control system |
WO2018229872A1 (ja) * | 2017-06-13 | 2018-12-20 | 日産自動車株式会社 | 地図データ格納方法及び装置 |
-
2018
- 2018-03-05 JP JP2018038176A patent/JP7016276B2/ja active Active
-
2019
- 2019-01-28 WO PCT/JP2019/002725 patent/WO2019171821A1/ja unknown
- 2019-01-28 EP EP19763508.9A patent/EP3763597B1/en active Active
- 2019-01-28 US US16/977,542 patent/US11938983B2/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004005593A (ja) * | 2002-04-17 | 2004-01-08 | Matsushita Electric Works Ltd | 自律移動装置 |
JP2008247154A (ja) * | 2007-03-30 | 2008-10-16 | Kyosan Electric Mfg Co Ltd | 列車位置検知装置と列車制御装置 |
JP2016162013A (ja) | 2015-02-27 | 2016-09-05 | 株式会社日立製作所 | 自己位置推定装置および移動体 |
JP2017001638A (ja) * | 2015-06-16 | 2017-01-05 | 西日本旅客鉄道株式会社 | 画像処理を利用した列車位置検出システムならびに画像処理を利用した列車位置および環境変化検出システム |
Also Published As
Publication number | Publication date |
---|---|
US11938983B2 (en) | 2024-03-26 |
EP3763597A4 (en) | 2021-12-01 |
JP7016276B2 (ja) | 2022-02-04 |
US20210001902A1 (en) | 2021-01-07 |
EP3763597B1 (en) | 2024-04-24 |
EP3763597A1 (en) | 2021-01-13 |
JP2019151227A (ja) | 2019-09-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2019171821A1 (ja) | 列車位置推定装置 | |
US10698100B2 (en) | Method and device for determining the position of a vehicle | |
US10160281B2 (en) | Road roughness preview with drive history | |
US11287524B2 (en) | System and method for fusing surrounding V2V signal and sensing signal of ego vehicle | |
US9273971B2 (en) | Apparatus and method for detecting traffic lane using wireless communication | |
US20180165525A1 (en) | Traveling lane determining device and traveling lane determining method | |
WO2020232648A1 (zh) | 车道线的检测方法、电子设备与存储介质 | |
US20130271607A1 (en) | Positioning apparatus and positioning method | |
RU2013151093A (ru) | Система и способ для определения местоположения транспортного средства | |
JP7347373B2 (ja) | インフラセンサ装置の位置較正方法 | |
JP7349318B2 (ja) | センサ性能評価システム及び方法、並びに、自動運転システム | |
CN109923438B (zh) | 用于确定车辆速度的装置和方法 | |
JP7166325B2 (ja) | 車両走行システム、死角推定方法 | |
US20220266825A1 (en) | Sourced lateral offset for adas or ad features | |
JPWO2020184013A1 (ja) | 車両制御装置 | |
CN112240767A (zh) | 车辆定位识别 | |
CN110929475A (zh) | 对象的雷达简档的注释 | |
US11908206B2 (en) | Compensation for vertical road curvature in road geometry estimation | |
CN115950441B (zh) | 自动驾驶车辆的融合定位方法、装置及电子设备 | |
US20220075053A1 (en) | Method and apparatus for sensor data fusion for a vehicle | |
CN116890847A (zh) | 车辆姿势评估 | |
JP7299007B2 (ja) | 位置推定装置及び方法 | |
US11551456B2 (en) | Enhanced infrastructure | |
US11555913B2 (en) | Object recognition device and object recognition method | |
US11945439B2 (en) | AD or ADAS aided maneuvering of a vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 19763508 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2019763508 Country of ref document: EP Effective date: 20201005 |