JP2019002764A - Vehicle position determining device - Google Patents

Vehicle position determining device Download PDF

Info

Publication number
JP2019002764A
JP2019002764A JP2017116809A JP2017116809A JP2019002764A JP 2019002764 A JP2019002764 A JP 2019002764A JP 2017116809 A JP2017116809 A JP 2017116809A JP 2017116809 A JP2017116809 A JP 2017116809A JP 2019002764 A JP2019002764 A JP 2019002764A
Authority
JP
Japan
Prior art keywords
vehicle
lane
link
traveling
vehicle position
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
JP2017116809A
Other languages
Japanese (ja)
Other versions
JP6598122B2 (en
Inventor
仁 小西
Hitoshi Konishi
仁 小西
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.)
Honda Motor Co Ltd
Original Assignee
Honda Motor Co Ltd
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 Honda Motor Co Ltd filed Critical Honda Motor Co Ltd
Priority to JP2017116809A priority Critical patent/JP6598122B2/en
Publication of JP2019002764A publication Critical patent/JP2019002764A/en
Application granted granted Critical
Publication of JP6598122B2 publication Critical patent/JP6598122B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

To provide a vehicle position determining device with which it is possible to determine the position or travel direction of the own vehicle with high accuracy even when traveling a section, such a tunnel, where positioning signals from satellites cannot be received stably.SOLUTION: Provided is a vehicle position determining device 100 comprising first position detection means 107 for detecting a vehicle position on the basis of a signal from a satellite, second position detection means 108 for detecting a vehicle position on the basis of the result of detection of the vehicle's travel parameter including at least the vehicle bearing, and matching means 109 for causing the vehicle position to be matched to at least a map based on a link. When traveling a section where the detection accuracy of the first position detection means 107 decreases, the second position detection means 108 estimates the travel direction of the vehicle from the direction of the link of the section and the result of detection of the vehicle bearing.SELECTED DRAWING: Figure 1

Description

本発明は、位置判定装置に関するものであり、特に、車両において使用される車両位置判定装置に関する。   The present invention relates to a position determination device, and more particularly to a vehicle position determination device used in a vehicle.

近年、車両の出力、操舵、制動を自動で制御する自動走行制御システムの開発が進められている。このような自動走行制御システムは、例えば、高精度地図情報と、走行環境や自車両位置を検知する複数のセンサの検知情報とに基づいて、車両の自動走行を制御する。   In recent years, an automatic travel control system that automatically controls vehicle output, steering, and braking has been developed. Such an automatic traveling control system controls automatic traveling of a vehicle based on, for example, high-precision map information and detection information of a plurality of sensors that detect a traveling environment and the position of the host vehicle.

一般に、自車両位置の特定には、複数の衛星から送信される測位信号を受信して位置を判定する衛星航法が広く用いられている。しかし、衛星航法では、トンネル、高架下またはビル群の間などを走行する際には、測位信号が安定して受信できないため、車両位置を精度よく判定できない場合がある。   In general, satellite navigation that determines the position by receiving positioning signals transmitted from a plurality of satellites is widely used for specifying the position of the host vehicle. However, in satellite navigation, when traveling in a tunnel, under an overpass, or between buildings, a positioning signal cannot be received stably, so the vehicle position may not be determined with high accuracy.

位置検出精度の低下を補うため、衛星航法と慣性航法とを併用した車両位置判定装置が公知である(特許文献1)。慣性航法は、車両に設けられた複数のセンサ、例えば角速度センサや加速度センサなどから取得される車両の走行パラメータに基づいて、車両の進行方位や走行位置を逐次演算する手法である。   In order to compensate for the decrease in position detection accuracy, a vehicle position determination device using both satellite navigation and inertial navigation is known (Patent Document 1). Inertial navigation is a method of sequentially calculating the traveling direction and traveling position of a vehicle based on the traveling parameters of the vehicle acquired from a plurality of sensors provided in the vehicle, such as angular velocity sensors and acceleration sensors.

しかしながら、角速度センサや加速度センサは、車両の方位及び位置の変位量を検出するセンサであることから、例えば、車両の進行方向を推定するような場合には、車両の基準方位を検出し、これに角速度センサで検出された方位の変位量を加えて算出する必要がある。車両の基準方位は、通常、衛星からの測位信号に基づいて検出されるが、測位信号の受信環境によっては、基準方位を精度よく検出できないような場合があり、結果的に、算出される車両の走行位置や進行方向に誤差が含まれる場合がある。   However, since the angular velocity sensor and the acceleration sensor are sensors that detect the amount of displacement of the vehicle direction and position, for example, when estimating the traveling direction of the vehicle, the reference direction of the vehicle is detected and this is detected. It is necessary to calculate by adding the displacement amount of the direction detected by the angular velocity sensor. The reference azimuth of a vehicle is usually detected based on a positioning signal from a satellite, but depending on the positioning signal reception environment, the reference azimuth may not be detected accurately, and as a result, the calculated vehicle An error may be included in the traveling position or traveling direction of the vehicle.

例えば、車線変更をしながらトンネルに進入するような場合において、車線変更時の車両の基準方位を正しく検出できなかったような場合には、推定される車両の向きが走行車線と並行とはならず、また、マップマッチング処理により修正が完了するまでの間は、誤差を含んでしまっていた。   For example, when entering a tunnel while changing lanes, if the vehicle's reference direction at the time of changing lanes cannot be detected correctly, the estimated vehicle direction may not be parallel to the driving lane. In addition, an error was included until the correction was completed by the map matching process.

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

このような背景から、衛星からの測位信号を安定して受信できない区間を走行する車両であっても、自車両の進行方向を短時間で正確に判定できる車両位置判定装置の実現が望まれている。   From such a background, it is desired to realize a vehicle position determination device that can accurately determine the traveling direction of the host vehicle in a short time even if the vehicle travels in a section in which a positioning signal from a satellite cannot be stably received. Yes.

本発明の一の態様は、衛星からの信号に基づいて車両位置を検出する第一位置検出手段と、少なくとも車両方位を含む車両の走行パラメータの検出結果に基づいて車両位置を検出する第二位置検出手段と、前記車両位置を少なくともリンクに基づく地図にマッチングさせるマッチング手段と、を有する車両位置判定装置である。前記二位置検出手段は、前記第一位置検出手段の検出精度が低下する区間を走行する場合に、該区間の前記リンクの方向と前記車両方位の検出結果とから該車両の進行方向を推定する。
本発明の他の態様によると、前記第二位置検出手段は、推定された前記車両の進行方向と、前記走行パラメータから推定される前記車両の移動距離と、に基づいて車両位置を検出する。
本発明の他の態様によると、前記リンクの方向は、前記車両が走行する車線の車線リンクの方向、または、前記車両が走行する道路の車道リンクの方向である。
本発明の他の態様によると、前記車両が車線変更を伴って前記区間に進入する場合には、前記リンクの方向は、該車線変更後に走行する車線の車線リンクの方向である。
One aspect of the present invention is a first position detection unit that detects a vehicle position based on a signal from a satellite, and a second position that detects a vehicle position based on a detection result of a travel parameter of the vehicle including at least a vehicle direction. It is a vehicle position determination apparatus which has a detection means and the matching means which matches the said vehicle position with the map based on a link at least. The two-position detection means estimates the traveling direction of the vehicle from the direction of the link in the section and the detection result of the vehicle direction when traveling in a section where the detection accuracy of the first position detection means decreases. .
According to another aspect of the present invention, the second position detecting means detects the vehicle position based on the estimated traveling direction of the vehicle and the travel distance of the vehicle estimated from the travel parameter.
According to another aspect of the present invention, the direction of the link is a direction of a lane link of a lane in which the vehicle travels or a direction of a roadway link of a road on which the vehicle travels.
According to another aspect of the present invention, when the vehicle enters the section with a lane change, the direction of the link is a lane link direction of a lane that travels after the lane change.

本発明の実施形態に係る車両位置判定装置を備えた車両の構成を示すブロック図である。It is a block diagram which shows the structure of the vehicle provided with the vehicle position determination apparatus which concerns on embodiment of this invention. 本発明の実施形態に係る車両位置判定装置を備えた車両が走行する道路の一例を示す図である。It is a figure which shows an example of the road where the vehicle provided with the vehicle position determination apparatus which concerns on embodiment of this invention drive | works. 本発明の実施形態に係る車両位置判定装置が実行する車両位置を判定する処理の手順を示すフロー図である。It is a flowchart which shows the procedure of the process which determines the vehicle position which the vehicle position determination apparatus which concerns on embodiment of this invention performs.

以下、図面を参照して、本発明の実施の形態を説明する。なお、本実施形態では、本発明に従う車両位置判定装置の一例として、車両に搭載される車両位置判定装置を示すが、本発明に係る車両位置判定装置の構成は、これに限らず、広くの一般の移動体に搭載される場合にも適用することができる。   Embodiments of the present invention will be described below with reference to the drawings. In the present embodiment, a vehicle position determination device mounted on a vehicle is shown as an example of a vehicle position determination device according to the present invention. However, the configuration of the vehicle position determination device according to the present invention is not limited to this, and a wide range is provided. The present invention can also be applied when mounted on a general moving body.

まず、本実施形態に係る車両位置判定装置を備えた車両の構成について説明する。図1は、本実施形態に係る車両位置判定装置100を備えた車両10の構成を示すブロック図である。   First, the structure of the vehicle provided with the vehicle position determination apparatus which concerns on this embodiment is demonstrated. FIG. 1 is a block diagram illustrating a configuration of a vehicle 10 including a vehicle position determination device 100 according to the present embodiment.

車両10は、衛星測位装置102及び走行パラメータ検出装置103から出力される信号に基づいて車両の位置を判定する車両位置判定装置100と、当該車両位置判定装置100からの出力信号、及び、車両の周辺環境を検知する検知機器(例えば、撮像装置120、通信装置124、測距装置126、レーダ128など)からの検知信号に基づいて操舵装置130、駆動装置132及び制動装置134を制御する自動走行制御装置112と、を備えている。   The vehicle 10 includes a vehicle position determination device 100 that determines the position of the vehicle based on signals output from the satellite positioning device 102 and the travel parameter detection device 103, an output signal from the vehicle position determination device 100, Automatic travel that controls the steering device 130, the driving device 132, and the braking device 134 based on detection signals from detection devices (for example, the imaging device 120, the communication device 124, the distance measuring device 126, the radar 128, etc.) that detect the surrounding environment. And a control device 112.

撮像装置120は、例えば、レンズ等の光学素子及びCMOS(Complementary Metal Oxide Semiconductor)センサ等の固体撮像素子などから構成されるカメラであって、例えばルームミラーの裏側やフロントガラスの上端近傍などを含む車室内外の複数の箇所に取り付けられて、常時、車両10の周囲の他の車両、障害物、標識、路面などを撮像する。   The imaging device 120 is a camera including, for example, an optical element such as a lens and a solid-state imaging element such as a CMOS (Complementary Metal Oxide Semiconductor) sensor, and includes, for example, the rear side of a rearview mirror and the vicinity of the upper end of a windshield. It is attached to a plurality of locations inside and outside the vehicle interior, and images other vehicles, obstacles, signs, road surfaces, etc. around the vehicle 10 at all times.

通信装置124は、無線通信を行い、インターネットなどを介して外部サーバ142に接続して、外部サーバ142から最新の道路構造マップを受信して道路構造マップを最新の状態に更新したり、最新の交通情報等を受信したりする。また、通信装置124は、無線LAN(Local Area Network)用の通信機能を備え、周辺の公衆無線LANのアクセスポイントなどを介してインターネットなどにアクセスし、例えば駐車場やショッピングセンタなどの車両近隣の施設情報などを入手することもできる。   The communication device 124 performs wireless communication, connects to the external server 142 via the Internet or the like, receives the latest road structure map from the external server 142, updates the road structure map to the latest state, Receive traffic information. In addition, the communication device 124 has a communication function for a wireless local area network (LAN), accesses the Internet via an access point of a nearby public wireless LAN, for example, near a vehicle such as a parking lot or a shopping center. You can also get facility information.

測距装置126は、例えば車両10の前方の障害物や車両などの対象物に対してパルス状のレーザ光を照射し、該レーザ光の散乱光が戻るまでの時間を計測することにより該対象物までの距離を計測するLIDAR(Laser Imaging Detection and Ranging)などで構成される。測距装置126は、例えば車体の前面や側面などの複数箇所に取り付けられている。   The distance measuring device 126 irradiates an object such as an obstacle ahead of the vehicle 10 or an object such as a vehicle with a pulsed laser beam, and measures the time until the scattered light of the laser beam returns. It consists of LIDAR (Laser Imaging Detection and Ranging) that measures the distance to an object. The distance measuring device 126 is attached to a plurality of locations such as the front and side surfaces of the vehicle body, for example.

レーダ128は、例えば、ミリ波の周波数を周波数変調連続波(FMCW:Frequency Modulated Continuous Wave)方式を用いて時間的に変化させて送受信することにより、先行車との距離を測定する。レーダ128は、例えば車体の前面などに取り付けられている。   For example, the radar 128 measures the distance from the preceding vehicle by transmitting and receiving by changing the frequency of the millimeter wave with time using a frequency modulated continuous wave (FMCW) method. The radar 128 is attached to the front surface of the vehicle body, for example.

操舵装置130は、車両10の進行方向を制御し、例えばステアリング軸の一端に設けられたピニオンとステアリングギヤボックスに設けられたラックとにより構成されるラックアンドピニオン式のステアリングギヤ機構を備えると共に、該ピニオンに連接されたモータを備えている。該モータは、自動走行制御装置112により設定された操舵角となるように駆動されて、車両10の操舵が制御されることとなる。   The steering device 130 controls the traveling direction of the vehicle 10, and includes a rack and pinion type steering gear mechanism configured by, for example, a pinion provided at one end of the steering shaft and a rack provided in the steering gear box. A motor connected to the pinion is provided. The motor is driven so as to have a steering angle set by the automatic travel control device 112, and the steering of the vehicle 10 is controlled.

駆動装置132は、例えば、エンジンまたはモータの何れかまたは両方で構成されると共に、該エンジン及び/またはモータを制御するためのECU(Electronic Control Unit)を備えている。該ECUは、自動走行制御装置112が出力する設定値に基づいて該エンジン及び/またはモータの出力を制御することにより、車両10の駆動が制御される。   The drive device 132 includes, for example, either or both of an engine and a motor, and includes an ECU (Electronic Control Unit) for controlling the engine and / or motor. The ECU controls the drive of the vehicle 10 by controlling the output of the engine and / or motor based on the set value output by the automatic travel control device 112.

制動装置134は、車両10の各車輪の制動力を調節する、例えばブレーキアクチュエータなどから構成されており、自動走行制御装置112が出力する設定値に基づいて、各車輪のブレーキアクチュエータが作動し、車両10の制動が制御される。   The braking device 134 includes, for example, a brake actuator that adjusts the braking force of each wheel of the vehicle 10, and the brake actuator for each wheel is operated based on the set value output from the automatic travel control device 112. The braking of the vehicle 10 is controlled.

自動走行制御装置112は、信号処理装置であるCPU(Central Processing Unit)114と、プログラムが書き込まれたROM(Read Only Memory)、高精度地図情報、経路情報などのデータの一時記憶のためのRAM(Random Access Memory)等からなる記憶装置116などを有するコンピュータで構成されており、上述の撮像装置120、通信装置124、測距装置126、及びレーダ128などの検知機器から出力される検知信号や、後述する車両位置判定装置100から出力される車両位置判定結果に基づいて、操舵装置130、駆動装置132及び制動装置134等からなる走行操作機器への出力信号を決定する。   The automatic travel control device 112 includes a CPU (Central Processing Unit) 114 which is a signal processing device, a ROM (Read Only Memory) in which a program is written, a RAM for temporary storage of data such as high-precision map information and route information. (Random Access Memory), etc., and a computer having a storage device 116, etc., and detection signals output from detection devices such as the imaging device 120, communication device 124, distance measuring device 126, and radar 128 described above, Based on the vehicle position determination result output from the vehicle position determination device 100 described later, an output signal to the travel operation device including the steering device 130, the drive device 132, the braking device 134, and the like is determined.

自動走行制御装置112のCPU114は、車両10のユーザが選択した制御モード(例えば、自動運転モードまたは手動運転モード)に応じて、車両10を制御する。例えば、自動運転モードが選択された場合には、自動走行制御装置112のCPU114は、走行時に各検出装置から出力される検出結果及び記憶装置116に記憶されている高精度地図情報である道路構造マップに基づいて、例えば所定区間の該車両10の将来状態を予測して該車両10の走行軌道を最適化すると共に、当該最適化された走行軌道が該所定区間で実行できるように複数の操作処理(例えば、車両の減速/加速、車線の変更/維持)で構成される行動計画を生成し、該行動計画に応じた操作処理を順次実行することにより、車両10を自動走行させる。   The CPU 114 of the automatic travel control device 112 controls the vehicle 10 according to a control mode (for example, an automatic operation mode or a manual operation mode) selected by the user of the vehicle 10. For example, when the automatic driving mode is selected, the CPU 114 of the automatic traveling control device 112 detects the road structure that is the detection result output from each detecting device during traveling and the high-precision map information stored in the storage device 116. Based on the map, for example, the future state of the vehicle 10 in a predetermined section is predicted to optimize the traveling track of the vehicle 10, and a plurality of operations are performed so that the optimized traveling track can be executed in the predetermined section. An action plan composed of processes (for example, deceleration / acceleration of the vehicle, lane change / maintenance) is generated, and the operation process according to the action plan is sequentially executed, so that the vehicle 10 is automatically driven.

なお、CPU114は、自動運転モードが選択されている場合であっても、撮像装置120などの検知機器や操舵装置130などの操作装置に異常または問題を検出したような場合には、自動運転の機能の一部または全部の停止を指示する信号を出力する。該信号を受信した車両10の各機器、例えば車載のカーナビゲーションシステムの場合は、その画面に表示またはスピーカを通じて車両10のドライバに全部または一部の運転操作を移譲する旨報知し、ドライバによる手動運転を促したり、ドライバによる手動運転に移行できない場合は、速やかに車両10を近隣の安全な場所に自動で移動して停止、または、一部の自動運転(例えば、操舵装置130による操舵機能のみ)の自動運転機能を強制的に停止したりする。   Even if the automatic operation mode is selected, the CPU 114 detects the abnormality or problem in the detection device such as the imaging device 120 or the operation device such as the steering device 130. Outputs a signal instructing to stop part or all of the function. In the case of each device of the vehicle 10 that has received the signal, for example, an in-vehicle car navigation system, the driver of the vehicle 10 is informed that all or part of the driving operation is to be transferred through a display on the screen or a speaker, and is manually operated by the driver. When driving cannot be promoted or manual driving by the driver cannot be performed, the vehicle 10 is quickly moved to a nearby safe place automatically and stopped, or some automatic driving (for example, only the steering function by the steering device 130) ) To forcibly stop the automatic operation function.

記憶装置116としては、例えば、NAND型フラッシュメモリなどの半導体メモリ、MRAM(Magnetoresistive Random Access Memory)などの磁気抵抗メモリからなるソリッドステートドライブ(SSD:solid state drive)や、ハードディスクドライブ(HDD:Hard Disk Drive)などの任意の記憶手段を使用することができる。また、用途に応じて複数の記憶手段を併用(例えば、フラッシュメモリとHDDとを併用)することもでき、記憶装置116を構成する筐体内部に複数の該記憶手段を配置して、必要に応じて各記憶手段を使い分けることができる。   Examples of the storage device 116 include a solid state drive (SSD) composed of a semiconductor memory such as a NAND flash memory, and a magnetoresistive memory such as an MRAM (Magnetoresistive Random Access Memory), and a hard disk drive (HDD: Hard Disk). Any storage means such as Drive) can be used. In addition, a plurality of storage means can be used in combination (for example, a flash memory and an HDD are used in combination) according to the application. Each storage means can be used properly accordingly.

また、記憶装置116には、CPU114が実行するプログラムや経路情報などの一時記憶用データのほか、車両の自動運転において使用される道路構造マップが保存されている。道路構造マップは、高精度地図であって、道路を構成する各部の位置、サイズ、形状に関するデータが含まれており、例えば道路の縁石、道路に設けられた物標(例えば、標識、信号、電柱、ポールなど)などの道路を構成する道路各部の位置や形状が数cm程度の誤差で表された数値データと共に、該道路の路面上にペイントされた描画パターン(車線、停止線、横断歩道など)の情報(形状、車線種類、車線の幅員)に関するデータを含んでいる。   The storage device 116 stores a road structure map used in automatic driving of the vehicle, in addition to temporary storage data such as a program executed by the CPU 114 and route information. The road structure map is a high-precision map and includes data on the position, size, and shape of each part constituting the road. For example, a road curb, a target provided on the road (for example, a sign, a signal, Along with numerical data in which the position and shape of each part of the road that constitutes a road such as a power pole or pole is represented by an error of several centimeters, a drawing pattern (lane, stop line, pedestrian crossing) painted on the road surface of the road Etc.) information (shape, lane type, lane width).

また、道路構造マップでは、例えば道路の中心線を示す道路リンクまたは車線の中心線を示す車線リンクなどによって道路形状が表現され、例えば、道路リンクまたは車線リンクの延在方向によって実際の道路または車線の延在する方向が示される。   Further, in the road structure map, the road shape is expressed by, for example, a road link indicating the center line of the road or a lane link indicating the center line of the lane, for example, an actual road or lane depending on the extending direction of the road link or lane link. The extending direction of is shown.

次に、本実施形態に係る車両位置判定装置100の構成について説明する。車両位置判定装置100は、衛星測位装置102から出力される信号に基づいて車両10の位置を衛星航法によって検出する測位信号処理装置107(第一位置検出手段)と、走行パラメータ検出装置103から出力される信号に基づいて車両10の位置を慣性航法によって検出する走行パラメータ処理装置108(第二位置検出手段)と、測位信号処理装置107及び走行パラメータ処理装置108から出力される各々の車両位置の検出結果に基づいて、車両10の現在位置を判定するマップマッチング装置109と、により構成されている。   Next, the configuration of the vehicle position determination device 100 according to the present embodiment will be described. The vehicle position determination device 100 outputs a positioning signal processing device 107 (first position detection means) that detects the position of the vehicle 10 by satellite navigation based on a signal output from the satellite positioning device 102 and a traveling parameter detection device 103. Travel parameter processing device 108 (second position detecting means) for detecting the position of the vehicle 10 by inertial navigation based on the received signal, and each vehicle position output from the positioning signal processing device 107 and the travel parameter processing device 108. And a map matching device 109 that determines the current position of the vehicle 10 based on the detection result.

なお、本実施形態に係る車両位置判定装置100では、測位信号処理装置107、走行パラメータ処理装置108及びマップマッチング装置109の各々を、信号処理装置であるCPU(不図示)及び記憶装置であるROM及びRAM(不図示)で個別に構成したが、これに限らず、例えば車両位置判定装置100を一組のCPU及び記憶装置で構成し、当該一組のCPU及び記憶装置が、測位信号処理装置107、走行パラメータ処理装置108及びマップマッチング装置109の各々の機能を実行させるような構成としてもよい。   In the vehicle position determination device 100 according to the present embodiment, each of the positioning signal processing device 107, the travel parameter processing device 108, and the map matching device 109 is a signal processing device CPU (not shown) and a storage device ROM. However, the present invention is not limited to this. For example, the vehicle position determination device 100 is composed of a set of CPU and storage device, and the set of CPU and storage device is a positioning signal processing device. 107, each function of the travel parameter processing device 108 and the map matching device 109 may be executed.

衛星測位装置102は、GNSS(Global Navigation Satellite System)受信機などで構成され、複数の測位衛星から送信される各衛星の軌道情報及び時間情報など含む測位信号を受信する。受信した測位信号は、車両位置判定装置100の測位信号処理装置107へと出力され、該測位信号に含まれる各衛星の軌道情報と測位信号の受信時刻などに基づいて車両10の車両位置が検出される。   The satellite positioning device 102 is configured by a GNSS (Global Navigation Satellite System) receiver or the like, and receives a positioning signal including orbit information and time information of each satellite transmitted from a plurality of positioning satellites. The received positioning signal is output to the positioning signal processing device 107 of the vehicle position determination device 100, and the vehicle position of the vehicle 10 is detected based on the orbit information of each satellite included in the positioning signal and the reception time of the positioning signal. Is done.

走行パラメータ検出装置103は、車両10の走行パラメータを検出する複数センサから構成されており、例えば車両10の進行方位を検出する方位センサ104、車両10の加速度を検出する加速度センサ105、車両10の速度を検出する車速センサ106等で構成されている。   The travel parameter detection device 103 includes a plurality of sensors that detect travel parameters of the vehicle 10. For example, the travel sensor 104 detects the travel direction of the vehicle 10, the acceleration sensor 105 detects the acceleration of the vehicle 10, and the vehicle 10. The vehicle speed sensor 106 etc. which detect a speed are comprised.

方位センサ104は、例えば、MEMS(Micro Electro Mechanical Systems)ジャイロ、光ファイバジャイロ(FOG:Fiber Optic Gyroscope)などのジャイロセンサで構成され、車両10の直交3軸方向の角速度を検出して、検出された該角速度データを走行パラメータ処理装置108へと出力する。走行パラメータ処理装置108は、入力された角速度データを積分演算して、車両10の方位の変化量を算出し、車両10の進行方向を推定する。なお、方位センサ104は、車両10の方位の相対的な変化量を検出するセンサにすぎないため、走行パラメータ処理装置108において車両10の進行方向を推定するためには、車両10の基準方位を求めることが別途必要となる。   The azimuth sensor 104 is composed of, for example, a gyro sensor such as a micro electro mechanical systems (MEMS) gyroscope or a fiber optic gyroscope (FOG), and detects the angular velocity of the vehicle 10 in three orthogonal axes. The angular velocity data is output to the travel parameter processing device 108. The travel parameter processing device 108 calculates the amount of change in the direction of the vehicle 10 by integrating the input angular velocity data, and estimates the traveling direction of the vehicle 10. Note that the azimuth sensor 104 is merely a sensor that detects a relative change in the azimuth of the vehicle 10, and therefore, in order to estimate the traveling direction of the vehicle 10 in the travel parameter processing device 108, the reference azimuth of the vehicle 10 is set. It is necessary to obtain it separately.

加速度センサ105は、例えば、検出素子部が静電容量検出方式、ピエゾ抵抗方式または熱検知方式のMEMS(Micro Electro Mechanical Systems)加速度センサなどを使用することができ、車両10の直交3軸方向の加速度を検出する。検出されたデータは、走行パラメータ処理装置108に入力され、車両10の加速度、速度、方位及び移動距離などが推定される。   As the acceleration sensor 105, for example, a MEMS (Micro Electro Mechanical Systems) acceleration sensor having a detection element portion of a capacitance detection method, a piezoresistive method, or a heat detection method can be used. Detect acceleration. The detected data is input to the travel parameter processing device 108, and the acceleration, speed, direction, travel distance, and the like of the vehicle 10 are estimated.

車速センサ106は、例えば車速パルスカウンタ等で構成され、車両10の速度や移動距離などを推定する。なお、本実施形態では、車両の速度や位置を推定する手段として、加速度センサ105及び車速センサ106の両方が設けられる構成としたが、このような構成に限らず、例えば加速度センサ105及び車速センサ106の何れか一方が設けられていればよく、当該一方のセンサから出力される走行パラメータに基づいて、車両10の速度や移動距離が推定されるような構成としてもよい。   The vehicle speed sensor 106 is composed of a vehicle speed pulse counter, for example, and estimates the speed and travel distance of the vehicle 10. In this embodiment, both the acceleration sensor 105 and the vehicle speed sensor 106 are provided as means for estimating the speed and position of the vehicle. However, the present invention is not limited to such a configuration. For example, the acceleration sensor 105 and the vehicle speed sensor are used. Any one of 106 may be provided, and the speed and movement distance of the vehicle 10 may be estimated based on the travel parameter output from the one sensor.

走行パラメータ処理装置108は、方位センサ104や加速度センサ105などで構成される走行パラメータ検出装置103から出力されるデータに基づいて、車両10の方位、加速度、速度、移動距離などを算出し、当該算出結果と、別途特定される車両10の基準方位及び基準位置とに基づいて、車両10の車両位置を検出する。   The travel parameter processing device 108 calculates the azimuth, acceleration, speed, travel distance, and the like of the vehicle 10 based on data output from the travel parameter detection device 103 configured by the orientation sensor 104, the acceleration sensor 105, and the like. The vehicle position of the vehicle 10 is detected based on the calculation result and the separately specified reference azimuth and reference position of the vehicle 10.

なお、車両10の上記基準位置及び基準方位は、例えば、衛星測位装置102からの測位信号が安定して受信できるような場合には、衛星航法により検出することができる。すなわち、本実施形態に係る車両位置判定装置100では、衛星航法により特定された当該基準位置及び基準方位に、走行パラメータ検出装置103で検出された車両10の方位及び距離の変位の演算結果を加えて、車両10の車両位置を慣性航法により検出する、いわゆるハイブリッド航法も利用することができる。   The reference position and reference direction of the vehicle 10 can be detected by satellite navigation, for example, when a positioning signal from the satellite positioning device 102 can be stably received. That is, in the vehicle position determination device 100 according to the present embodiment, the calculation result of the displacement of the azimuth and distance of the vehicle 10 detected by the travel parameter detection device 103 is added to the reference position and reference azimuth specified by satellite navigation. Thus, so-called hybrid navigation in which the vehicle position of the vehicle 10 is detected by inertial navigation can also be used.

そして、マップマッチング装置109は、衛星航法、慣性航法及びハイブリッド航法により検出された車両位置の検出結果のうちの少なくとも何れかの検出結果と、記憶装置116に格納されている上記道路構造マップの高精度地図における、例えば車線リンク(または道路リンク)とを比較し、両者の整合性を判断して前記検出結果を適切な位置に修正し、車両10の現在位置を最終的に判定する。   Then, the map matching device 109 detects at least one of the detection results of the vehicle position detected by satellite navigation, inertial navigation, and hybrid navigation, and the height of the road structure map stored in the storage device 116. The accuracy map is compared with, for example, a lane link (or road link), the consistency between the two is determined, the detection result is corrected to an appropriate position, and the current position of the vehicle 10 is finally determined.

また、マップマッチング装置109により最終的に判定された車両10の現在位置は、自動走行制御装置112に出力されて車両10の走行制御に利用されると共に、液晶パネルなどを用いたディスプレイで構成される表示装置110へと出力されて、当該ディスプレイ画面上に表示される地図と共に、車両10の現在位置、方位、現在位置から目的地に至るまでの経路などが表示される。なお、表示装置110としては、例えば車両10に搭載されるナビゲーション装置やユーザの保有するスマートフォンなどの携帯端末装置の表示画面なども使用することができる。   Further, the current position of the vehicle 10 finally determined by the map matching device 109 is output to the automatic travel control device 112 and used for travel control of the vehicle 10, and is configured by a display using a liquid crystal panel or the like. The current position and direction of the vehicle 10, the route from the current position to the destination, and the like are displayed together with the map displayed on the display screen. In addition, as the display apparatus 110, the display screen of portable terminal devices, such as a navigation apparatus mounted in the vehicle 10, a smart phone which a user holds, can be used, for example.

上述のように、本実施形態の車両位置判定装置100は、測位衛星から信号を精度良く受信できる場合には、衛星航法と慣性航法とを組み合わせたハイブリッド航法を利用することができ、例えば、測位信号処理装置107によって検出された車両10の基準方位及び基準位置に、走行パラメータ処理装置108によって推定される方位及び距離の変位を加算することにより、車両10の現在位置を精度良く判定することができる。   As described above, the vehicle position determination apparatus 100 according to the present embodiment can use hybrid navigation in which satellite navigation and inertial navigation are combined when signals can be accurately received from positioning satellites. The current position of the vehicle 10 can be accurately determined by adding the displacement of the azimuth and distance estimated by the travel parameter processing device 108 to the reference azimuth and reference position of the vehicle 10 detected by the signal processing device 107. it can.

一方、測位衛星から信号が精度良く受信できないような場合には、車両10の基準方位及び基準位置を正確に検出できない。例えば、図2のように走行車線205を走行していた車両10が、測位衛星からの信号を安定して受信できないトンネルの入り口付近において、追い越し車線215へと車線変更しながらトンネル203へと進入するような場合には、車線変更をした際の車両10の基準方位が精度良く検出できないことに起因して、車両10の進行方向を正確に推定できない場合がある。なお、図中の破線210及び破線220は、道路構造マップにおける走行車線205及び追い越し車線215の車線リンクを模式的に示したものである。   On the other hand, when the signal cannot be accurately received from the positioning satellite, the reference azimuth and reference position of the vehicle 10 cannot be accurately detected. For example, as shown in FIG. 2, the vehicle 10 traveling in the traveling lane 205 enters the tunnel 203 while changing the lane to the passing lane 215 near the entrance of the tunnel where the signal from the positioning satellite cannot be stably received. In such a case, the traveling direction of the vehicle 10 may not be accurately estimated due to the fact that the reference azimuth of the vehicle 10 cannot be accurately detected when the lane is changed. In addition, the broken line 210 and the broken line 220 in a figure typically show the lane link of the driving lane 205 and the overtaking lane 215 in a road structure map.

ここで、基準方位に誤差が含まれることとなると、当該誤差を含んだ基準方位の設定後に慣性航法によって推定される車両10の方位に誤差が含まれる結果となり、車両10の進行方向を正確に推定することができない。また、トンネル203内の走行中には、衛星からの測位信号を受信できないため、当該誤差を含んで算出された進行方向の推定結果を補正することもできない。そして、マップマッチング装置109において、誤差を含む進行方向の推定結果に基づいて算出された車両10の位置検出結果と、高精度地図とがマップマッチングされるまでの間、誤差を含むこととなる。   Here, if an error is included in the reference azimuth, an error is included in the azimuth of the vehicle 10 estimated by inertial navigation after setting the reference azimuth including the error, and the traveling direction of the vehicle 10 is accurately determined. Cannot be estimated. Further, since the positioning signal from the satellite cannot be received while traveling in the tunnel 203, the estimation result of the traveling direction calculated including the error cannot be corrected. Then, the map matching device 109 includes an error until the position detection result of the vehicle 10 calculated based on the estimation result of the traveling direction including the error and the high-accuracy map are matched.

このような問題を解決すべく本実施形態の車両位置判定装置100では、特に、測位衛星からの信号が精度良く受信できないような場合には、衛星測位装置102から取得したデータを使用することなく、走行道路の道路リンクの方向または車線リンクの方向を車両10の基準方位として利用し、当該基準方位と、方位センサ104や加速度センサ105などの走行パラメータ検出装置103から出力されるデータとに基づいて、車両10の進行方向を特定する構成を有している。   In order to solve such a problem, the vehicle position determination device 100 of the present embodiment does not use the data acquired from the satellite positioning device 102, particularly when the signal from the positioning satellite cannot be received with high accuracy. The direction of the road link or the direction of the lane link of the traveling road is used as the reference azimuth of the vehicle 10, and based on the reference azimuth and data output from the traveling parameter detection device 103 such as the azimuth sensor 104 and the acceleration sensor 105. Thus, the traveling direction of the vehicle 10 is specified.

以下、本実施形態に係る車両位置判定装置100が実行する具体的な車両位置判定処理について、図3に示す処理フロー図に従って説明する。なお、図3に示す処理は、信号処理装置であるCPU(不図示)、記憶装置であるROM及びRAM(不図示)からなるコンピュータで構成された車両位置判定装置100が、当該記憶装置に保存されているプログラムを実行することにより制御される。また、本処理は、例えば、車両10のユーザが該車両のエンジンを始動することにより開始され、エンジンが停止されたと同時に終了する。   Hereinafter, a specific vehicle position determination process executed by the vehicle position determination apparatus 100 according to the present embodiment will be described with reference to a process flowchart shown in FIG. The processing shown in FIG. 3 is stored in the storage device by a vehicle position determination device 100 configured by a computer including a CPU (not shown) as a signal processing device and a ROM and a RAM (not shown) as storage devices. It is controlled by executing the program being executed. Moreover, this process is started, for example, when the user of the vehicle 10 starts the engine of the vehicle, and ends when the engine is stopped.

まず、車両位置判定装置100は、衛星測位装置102及び走行パラメータ検出装置103の各々から、測位信号及び走行パラメータに係るデータを取得する(S302)。ここで、衛星からの測位信号は、例えば、トンネル及びその近傍または高架下、ビル群の間などを走行するような場合には、安定して受信できないような場合があり、その精度は、受信環境に大きな影響を受ける。このことから、本実施形態に係る車両位置判定装置100では、衛星測位装置102から取得した測位信号は、測位衛星から精度良く受信されたものであるか否かが、車両位置判定装置100において判定される(S304)。   First, the vehicle position determination apparatus 100 acquires data related to the positioning signal and the travel parameter from each of the satellite positioning apparatus 102 and the travel parameter detection apparatus 103 (S302). Here, the positioning signal from the satellite may not be able to be received stably, for example, when traveling in the tunnel and its vicinity or under an overpass, between buildings, etc. It is greatly affected by the environment. Therefore, in the vehicle position determination device 100 according to the present embodiment, the vehicle position determination device 100 determines whether or not the positioning signal acquired from the satellite positioning device 102 has been accurately received from the positioning satellite. (S304).

測位信号の受信精度を評価する具体的な指標としては、例えば、周知の精度低下率(DOP:Dilution Of Precision)を使用することができる。DOPは、その数値が大きいほど測位精度が低下している状態を示すものである。DOPとしては、例えば、水平精度低下率(HDOP:Horizontal Dilution Of Precision)、垂直精度低下率(VDOP:Vertical Dilution Of Precision)、幾何学的精度低下率(GDOP:Geometrical Dilution Of Precision)などがあり、これらの中から複数選択して、測位信号の受信精度を評価することもできる。なお、測位精度を評価指標は、DOPに限らず、例えば、衛星航法による位置の推定結果と慣性航法による位置の推定結果との差を算出することで、当該差が所定値以上の場合に測位精度が低下したと判断するように構成することもできる。あるいは、受信している衛星数から判断したり、車両10がトンネル、高架下、ビル群の間を走行中である場合に測位精度が低下したと判断しても良い。   As a specific index for evaluating the receiving accuracy of the positioning signal, for example, a known accuracy of reduction (DOP: Dilution Of Precision) can be used. The DOP indicates a state where the positioning accuracy decreases as the numerical value increases. As DOP, for example, there are Horizontal Dilution Of Precision (HDOP), Vertical Dilution Of Precision (VDOP), Geometric Dilution Of Precision (GDOP), A plurality of these can be selected to evaluate positioning signal reception accuracy. The positioning accuracy evaluation index is not limited to DOP. For example, by calculating the difference between the position estimation result by satellite navigation and the position estimation result by inertial navigation, positioning is performed when the difference is a predetermined value or more. It can also be configured to determine that the accuracy has decreased. Alternatively, it may be determined from the number of received satellites, or it may be determined that the positioning accuracy has decreased when the vehicle 10 is traveling between a tunnel, an underpass, or a group of buildings.

ここで、DOPが所定値よりも小さい場合、すなわち、測位精度の低下が検出されない場合(S304:No)には、例えば、上述したハイブリッド航法により車両10の位置が検出される(S306)。そして、当該検出結果は、マップマッチング装置109へと入力されて、記憶装置116等に格納された道路構造マップの車線リンク等とマップマッチングされることにより、最終的な車両位置が判定されることとなる(S322)。そして、目的地に到着するまでは、このような処理が繰り返されて(S324:NO)、車両の位置が走行中に逐次判定されることとなる。   Here, when the DOP is smaller than the predetermined value, that is, when a decrease in positioning accuracy is not detected (S304: No), for example, the position of the vehicle 10 is detected by the hybrid navigation described above (S306). Then, the detection result is input to the map matching device 109, and the final vehicle position is determined by map matching with the lane link of the road structure map stored in the storage device 116 or the like. (S322). Such processing is repeated until the destination is reached (S324: NO), and the position of the vehicle is sequentially determined while traveling.

一方、DOPが所定値よりも大きいような場合、すなわち、測位精度の低下が検出されたような場合(S304:Yes)には、当該測位精度の低下が検出された時点またはその直前に対応する車両の位置、及び、当該位置における車線リンクの方向(例えば、図2に示す車両10が走行する走行車線205に対応する道路構造マップ上の車線リンク210の方向)が、測位精度の低下が検出された時点における車両10の基準位置、及び、基準方位として、車両位置判定装置100の記憶装置に格納される(S308)。   On the other hand, when the DOP is larger than the predetermined value, that is, when a decrease in positioning accuracy is detected (S304: Yes), this corresponds to the time point when the decrease in positioning accuracy is detected or immediately before that. The position of the vehicle and the direction of the lane link at the position (for example, the direction of the lane link 210 on the road structure map corresponding to the traveling lane 205 on which the vehicle 10 shown in FIG. The reference position and reference azimuth of the vehicle 10 at that time are stored in the storage device of the vehicle position determination device 100 (S308).

次に、衛星測位装置102からの衛星測位データを取得する処理が中断される(S310)。これにより、衛星航法による車両位置の検出が中断されることとなり、衛星の測位精度が回復されない間は、慣性航法のみにより車両10の車両位置が検出されることとなる。   Next, the process of acquiring satellite positioning data from the satellite positioning device 102 is interrupted (S310). Thereby, detection of the vehicle position by satellite navigation is interrupted, and the vehicle position of the vehicle 10 is detected only by inertial navigation while the positioning accuracy of the satellite is not recovered.

さらに、本実施形態に係る車両位置判定装置100では、測位精度の低下が検出された場合(S304:Yes)であって、車両10の車線変更がなされたような場合(S312:Yes)、例えば、図2に示されるように、トンネル203内またはその入口近傍において、走行車線205から追い越し車線215へと車線変更をしたような場合には、車線変更した後の車線215の車線リンク220の方向が基準方位として再設定(S314)される。一方、車両10の車線変更がなされない場合(S312:No)には、S314の処理がスキップされる。   Furthermore, in the vehicle position determination device 100 according to the present embodiment, when a decrease in positioning accuracy is detected (S304: Yes) and the lane of the vehicle 10 is changed (S312: Yes), for example, As shown in FIG. 2, when the lane is changed from the traveling lane 205 to the overtaking lane 215 in the tunnel 203 or in the vicinity of the entrance thereof, the direction of the lane link 220 of the lane 215 after the lane change is made. Is reset as the reference orientation (S314). On the other hand, when the lane of the vehicle 10 is not changed (S312: No), the process of S314 is skipped.

そして、前記基準方位として設定された車線リンクの方向と、方位センサ104からの車両10の変位情報とに基づいて、車両10の進行方向が推定される(S316)。また、加速度センサ105または車速センサ106から、測位精度の低下が検出された前記基準位置からの移動距離が推定される(S318)。さらに、S316及びS318で推定された結果に基づいて、車両位置が慣性航法により検出されることとなる(S320)。   Then, the traveling direction of the vehicle 10 is estimated based on the direction of the lane link set as the reference azimuth and the displacement information of the vehicle 10 from the azimuth sensor 104 (S316). Further, the movement distance from the reference position where the decrease in positioning accuracy is detected is estimated from the acceleration sensor 105 or the vehicle speed sensor 106 (S318). Furthermore, based on the results estimated in S316 and S318, the vehicle position is detected by inertial navigation (S320).

最後に、慣性航法により検出された車両10の車両位置の検出結果は、マップマッチング装置109へと入力されて、道路構造マップの車線リンク等とマップマッチングされることにより、車両10の車両位置が最終的に判定されることとなる(S322)。そして、目的地に到着するまでは、このような処理が繰りかえされて(S324:NO)、車両の位置が逐次判定される。   Finally, the detection result of the vehicle position of the vehicle 10 detected by the inertial navigation is input to the map matching device 109 and map-matched with the lane link of the road structure map, etc., so that the vehicle position of the vehicle 10 is determined. A final determination is made (S322). Such processing is repeated until the destination is reached (S324: NO), and the position of the vehicle is sequentially determined.

なお、本実施形態では、S310において、衛星測定データの取得を中断するように処理したが、このような実施形態に限らず、例えば、衛星測位装置102からの衛星測定データを取得は継続しつつも、測位精度の低下が検出された時点で、衛星測定データの使用を停止するような構成としてもよい。   In the present embodiment, the acquisition of satellite measurement data is interrupted in S310. However, the present invention is not limited to such an embodiment. For example, acquisition of satellite measurement data from the satellite positioning device 102 is continued. Alternatively, the use of the satellite measurement data may be stopped when a decrease in positioning accuracy is detected.

また、S308において、走行車線の車線リンクの方向と共に当該車線リンクの番号を同時に記憶させることもできる。このような構成とすれば、例えば、測位精度の低下が検出された区間において、複数回の車線変更が行われた場合であっても、番号が特定された車線リンクと方位センサ104からの変位情報とに基づいて、現在走行している車線の車線リンクが道路構造マップ上のどれに対応するのかが容易に特定できる。   In S308, the number of the lane link can be stored simultaneously with the direction of the lane link of the traveling lane. With such a configuration, for example, even if a plurality of lane changes are made in a section where a decrease in positioning accuracy is detected, the displacement from the lane link with the specified number and the direction sensor 104 is determined. Based on the information, it can be easily specified which lane link of the currently running lane corresponds to the road structure map.

また、本実施形態の車両位置判定装置100では、S312からS314へと続く処理フローを導入したが、S312からS314の処理フローは、必要に応じて導入または省略することができる。これは、S308において、例えば車線リンク210(図2)の方向が基準方位として設定されていれば、追い越し車線215へと車線変更された場合であっても、方位センサ104から出力される変位データに基づいて、車線変更後の車線を推定することが可能であるためである。   Further, in the vehicle position determination device 100 of the present embodiment, the processing flow from S312 to S314 is introduced, but the processing flow from S312 to S314 can be introduced or omitted as necessary. In S308, for example, if the direction of the lane link 210 (FIG. 2) is set as the reference azimuth, the displacement data output from the direction sensor 104 even if the lane is changed to the overtaking lane 215. This is because the lane after the lane change can be estimated based on the above.

しかしながら、方位センサ104の出力データには、センサの温度ドリフトやノイズなどに起因する検出誤差が含まれるため、方位センサ104からのデータの使用が長時間に亘ると、上述のような検出誤差も積分演算されて誤差が累積されることとなる。例えば、比較的長い時間をかけて車線変更するような場合には、方位演算時の累積誤差も増大する傾向にあるため、上述のような処理フロー(S312〜S314)を導入することにより、方位センサ104の使用を低減することができ、車両位置を正確に検出することができる。   However, since the output data of the azimuth sensor 104 includes detection errors due to sensor temperature drift, noise, and the like, the detection errors as described above also occur when the data from the azimuth sensor 104 is used for a long time. The integration operation is performed and the error is accumulated. For example, when the lane is changed over a relatively long time, the accumulated error at the time of the azimuth calculation also tends to increase. Therefore, by introducing the processing flow (S312 to S314) as described above, the azimuth The use of the sensor 104 can be reduced, and the vehicle position can be accurately detected.

また、本実施例では、S304で精度低下を検出した後に方位を設定したが、このような実施形態に限らず、予め衛星による測位の精度低下が見込まれるような場合、例えば、誘導経路の進行方向にトンネルが存在する場合の様に、精度低下が発生する蓋然性が高い場合には、トンネルに進入する直前に基準方位を設定しても良い。   In the present embodiment, the direction is set after detecting a decrease in accuracy in S304. However, the present invention is not limited to such an embodiment. For example, when a decrease in the accuracy of positioning by a satellite is expected in advance, for example, the progress of a guidance route When there is a high probability that the accuracy will decrease as in the case where a tunnel exists in the direction, the reference orientation may be set immediately before entering the tunnel.

以上、説明したように、本発明の車両位置判定装置は、衛星からの信号に基づいて車両位置を検出する第一位置検出手段107と、少なくとも車両方位を含む車両の走行パラメータの検出結果に基づいて車両位置を検出する第二位置検出手段108と、前記車両位置を少なくともリンクに基づく地図にマッチングさせるマッチング手段109と、を有する車両位置判定装置100であって、前記第二位置検出手段108は、前記第一位置検出手段107の検出精度が低下する区間を走行する場合に、該区間の前記リンクの方向と前記車両方位の検出結果とから該車両の進行方向を推定する。これにより、トンネルなどの衛星からの測位信号を安定して受信できない区間を走行する場合であっても、自車両の進行方向を精度良く推定できるため、マップマッチングの処理時間を大幅に低減すると共に、自車両の位置を精度良く判定することができる。   As described above, the vehicle position determination apparatus according to the present invention is based on the first position detection means 107 that detects the vehicle position based on the signal from the satellite and the detection result of the vehicle travel parameter including at least the vehicle direction. Vehicle position determination apparatus 100 having second position detection means 108 for detecting the vehicle position and matching means 109 for matching the vehicle position to a map based on at least a link, wherein the second position detection means 108 is When traveling in a section where the detection accuracy of the first position detecting means 107 decreases, the traveling direction of the vehicle is estimated from the direction of the link in the section and the detection result of the vehicle direction. This makes it possible to accurately estimate the traveling direction of the host vehicle even when traveling in a section where a positioning signal from a satellite such as a tunnel cannot be stably received, thereby significantly reducing the map matching processing time. The position of the host vehicle can be determined with high accuracy.

なお、本発明は、上述した実施形態に限定されることなく、本発明の趣旨を逸脱しない範囲において改変して用いることができる。   Note that the present invention is not limited to the above-described embodiment, and can be modified and used without departing from the spirit of the present invention.

10・・・車両、100・・・車両位置判定装置、102・・・衛星測位装置、103・・・走行パラメータ検出装置、104・・・方位センサ、105・・・加速度センサ、106・・・車速センサ、107・・・測位信号処理装置、108・・・走行パラメータ処理装置、109・・・マップマッチング装置、112・・・自動走行制御装置、114・・・CPU、116・・・記憶装置、108・・・更新処理用CPU、120・・・撮像装置、124・・・通信装置、126・・・測距装置、128・・・レーダ、130・・・操舵装置、132・・・駆動装置、134・・・制動装置、142・・・外部サーバ。   DESCRIPTION OF SYMBOLS 10 ... Vehicle, 100 ... Vehicle position determination apparatus, 102 ... Satellite positioning apparatus, 103 ... Running parameter detection apparatus, 104 ... Direction sensor, 105 ... Acceleration sensor, 106 ... Vehicle speed sensor, 107 ... Positioning signal processing device, 108 ... Travel parameter processing device, 109 ... Map matching device, 112 ... Automatic travel control device, 114 ... CPU, 116 ... Storage device , 108... CPU for update processing, 120... Imaging device, 124... Communication device, 126. Device, 134... Braking device, 142... External server.

Claims (4)

衛星からの信号に基づいて車両位置を検出する第一位置検出手段と、少なくとも車両方位を含む車両の走行パラメータの検出結果に基づいて車両位置を検出する第二位置検出手段と、前記車両位置を少なくともリンクに基づく地図にマッチングさせるマッチング手段と、を有する車両位置判定装置であって、
前記第二位置検出手段は、前記第一位置検出手段の検出精度が低下する区間を走行する場合に、該区間の前記リンクの方向と前記車両方位の検出結果とから該車両の進行方向を推定する、
車両位置判定装置。
A first position detecting means for detecting a vehicle position based on a signal from a satellite; a second position detecting means for detecting a vehicle position based on a detection result of a travel parameter of the vehicle including at least the vehicle direction; and the vehicle position. A vehicle position determination device having at least matching means for matching a map based on a link,
The second position detecting means estimates the traveling direction of the vehicle from the direction of the link in the section and the detection result of the vehicle direction when traveling in a section where the detection accuracy of the first position detecting means decreases. To
Vehicle position determination device.
前記第二位置検出手段は、推定された前記車両の進行方向と、前記走行パラメータから推定される前記車両の移動距離と、に基づいて車両位置を検出する、
請求項1に記載の車両位置判定装置。
The second position detecting means detects a vehicle position based on the estimated traveling direction of the vehicle and a moving distance of the vehicle estimated from the traveling parameter.
The vehicle position determination apparatus according to claim 1.
前記リンクの方向は、前記車両が走行する車線の車線リンクの方向、または、前記車両が走行する道路の車道リンクの方向である、
請求項1または2に記載の車両位置判定装置。
The direction of the link is the direction of the lane link of the lane in which the vehicle travels, or the direction of the roadway link of the road on which the vehicle travels.
The vehicle position determination apparatus according to claim 1 or 2.
前記車両が車線変更を伴って前記区間に進入する場合には、前記リンクの方向は、該車線変更後に走行する車線の車線リンクの方向である、
請求項1ないし3のいずれか一項に記載の車両位置判定装置。
When the vehicle enters the section with a lane change, the direction of the link is the direction of the lane link of the lane that travels after the lane change.
The vehicle position determination apparatus according to any one of claims 1 to 3.
JP2017116809A 2017-06-14 2017-06-14 Vehicle position determination device Active JP6598122B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017116809A JP6598122B2 (en) 2017-06-14 2017-06-14 Vehicle position determination device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017116809A JP6598122B2 (en) 2017-06-14 2017-06-14 Vehicle position determination device

Publications (2)

Publication Number Publication Date
JP2019002764A true JP2019002764A (en) 2019-01-10
JP6598122B2 JP6598122B2 (en) 2019-10-30

Family

ID=65004837

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017116809A Active JP6598122B2 (en) 2017-06-14 2017-06-14 Vehicle position determination device

Country Status (1)

Country Link
JP (1) JP6598122B2 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021032663A (en) * 2019-08-22 2021-03-01 トヨタ自動車株式会社 Vehicle position estimating device
JP2021081272A (en) * 2019-11-18 2021-05-27 トヨタ自動車株式会社 Position estimating device and computer program for position estimation
WO2022070458A1 (en) * 2020-09-29 2022-04-07 株式会社日立製作所 Vehicle position estimation device and vehicle position estimation method
WO2024071240A1 (en) * 2022-09-28 2024-04-04 トヨタ自動車株式会社 Control device

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06160107A (en) * 1992-11-18 1994-06-07 Pioneer Electron Corp Navigation device
JP2000346663A (en) * 1999-06-01 2000-12-15 Mitsubishi Electric Corp Locator apparatus

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06160107A (en) * 1992-11-18 1994-06-07 Pioneer Electron Corp Navigation device
JP2000346663A (en) * 1999-06-01 2000-12-15 Mitsubishi Electric Corp Locator apparatus

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021032663A (en) * 2019-08-22 2021-03-01 トヨタ自動車株式会社 Vehicle position estimating device
JP2021081272A (en) * 2019-11-18 2021-05-27 トヨタ自動車株式会社 Position estimating device and computer program for position estimation
WO2022070458A1 (en) * 2020-09-29 2022-04-07 株式会社日立製作所 Vehicle position estimation device and vehicle position estimation method
JP2022055979A (en) * 2020-09-29 2022-04-08 株式会社日立製作所 Own vehicle position estimation device and own vehicle position estimation method
JP7414683B2 (en) 2020-09-29 2024-01-16 日立Astemo株式会社 Own vehicle position estimation device and own vehicle position estimation method
WO2024071240A1 (en) * 2022-09-28 2024-04-04 トヨタ自動車株式会社 Control device

Also Published As

Publication number Publication date
JP6598122B2 (en) 2019-10-30

Similar Documents

Publication Publication Date Title
EP2253936B1 (en) Current position determining device and current position determining nethod
KR101018620B1 (en) Object recognition device
JP6598122B2 (en) Vehicle position determination device
JP6646617B2 (en) Automatic driving control device
KR101744781B1 (en) Control Method for Shifting through Recognizing Road Configuration
KR20080037708A (en) Vehicle positioning information update device
JP2011013039A (en) Lane determination device and navigation system
JP2005098853A (en) Map data updating method and map data updating apparatus
CN110998685B (en) Travel obstacle detection device and vehicle navigation system
JP7193572B2 (en) Mobile body control device, mobile body control method, and program for mobile body control device
CN113879307A (en) Lane change planning device, storage medium, and method
JP6943127B2 (en) Position correction method, vehicle control method and position correction device
JP2017003395A (en) Vehicle positioning system
JP2012214123A (en) Vehicle and vehicle control program
JP2018073010A (en) Mobile body control device, mobile body control method, and program for mobile body control device
JP7382782B2 (en) Object recognition method and object recognition system
JP6627135B2 (en) Vehicle position determination device
JP2018205093A (en) Automatic travel control system
JP6996882B2 (en) Map data structure of data for autonomous driving support system, autonomous driving support method, and autonomous driving
JP6587294B2 (en) Lane judgment device
JP2009014555A (en) Navigation device, navigation method, and navigation program
EP3985641B1 (en) Travel assistance method and travel assistance device
CN114397878A (en) Automatic driving system and method for generating detailed map thereof
JP2019196941A (en) Own vehicle position estimating device
JPWO2019003992A1 (en) Information management device

Legal Events

Date Code Title Description
RD03 Notification of appointment of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7423

Effective date: 20170721

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20170728

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20180129

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190205

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20190404

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20190920

R150 Certificate of patent or registration of utility model

Ref document number: 6598122

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150