Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP5862437B2 - Vehicle position detection device - Google Patents
[go: Go Back, main page]

JP5862437B2 - Vehicle position detection device - Google Patents

Vehicle position detection device Download PDF

Info

Publication number
JP5862437B2
JP5862437B2 JP2012099848A JP2012099848A JP5862437B2 JP 5862437 B2 JP5862437 B2 JP 5862437B2 JP 2012099848 A JP2012099848 A JP 2012099848A JP 2012099848 A JP2012099848 A JP 2012099848A JP 5862437 B2 JP5862437 B2 JP 5862437B2
Authority
JP
Japan
Prior art keywords
vehicle
angular velocity
speed information
speed
vehicle speed
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.)
Expired - Fee Related
Application number
JP2012099848A
Other languages
Japanese (ja)
Other versions
JP2013228252A (en
Inventor
武藤 勝彦
勝彦 武藤
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 JP2012099848A priority Critical patent/JP5862437B2/en
Publication of JP2013228252A publication Critical patent/JP2013228252A/en
Application granted granted Critical
Publication of JP5862437B2 publication Critical patent/JP5862437B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Navigation (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Description

本発明は、車両用位置検出装置に関する。   The present invention relates to a vehicle position detection device.

従来より、この種の装置、例えばナビゲーション装置においては、車輪速センサによって検出される車両の速度、角速度センサによって検出される車両の角速度などに基づいて車両の位置を検出している。ここで、より精度の良い位置検出を実現すべく、車輪速センサによって検出される車両の速度情報と角速度センサによって検出される車両の角速度情報とは同期していることが望ましい。しかしながら、特に車両においては、車輪速センサによって検出される車両の速度情報は車載LANを介して取得されている。そのため、車載LANによる通信遅延に起因して車両の速度情報にも遅延が生じ、車両の速度情報と車両の角速度情報との同期が困難となって車両の位置を精度良く検出できないという課題がある。   Conventionally, in this type of device, for example, a navigation device, the position of the vehicle is detected based on the vehicle speed detected by the wheel speed sensor, the angular velocity of the vehicle detected by the angular velocity sensor, and the like. Here, in order to realize more accurate position detection, it is desirable that the vehicle speed information detected by the wheel speed sensor and the vehicle angular speed information detected by the angular speed sensor be synchronized. However, particularly in a vehicle, vehicle speed information detected by a wheel speed sensor is acquired via an in-vehicle LAN. Therefore, there is a problem that the vehicle speed information is also delayed due to the communication delay by the in-vehicle LAN, and the vehicle speed information and the angular velocity information of the vehicle are difficult to synchronize, so that the position of the vehicle cannot be detected accurately. .

このような事情を背景として、近年では、測位用衛星から受信する電波に基づいて検出される車両の速度情報を利用して、車両の速度情報と車両の角速度情報との同期を試みる技術が考えられている。例えば特許文献1に開示の技術によれば、車載LANを経由して得られた複数の速度情報のうち測位用衛星から受信する電波に基づいて検出された速度情報に最も近似する速度情報を特定し、その特定した速度情報に基づいて位置検出における同期を試みている。   Against this background, in recent years, there has been a technology that attempts to synchronize vehicle speed information and vehicle angular velocity information using vehicle speed information detected based on radio waves received from positioning satellites. It has been. For example, according to the technique disclosed in Patent Document 1, the speed information closest to the speed information detected based on the radio wave received from the positioning satellite among the plurality of speed information obtained via the in-vehicle LAN is specified. Then, synchronization in position detection is attempted based on the identified speed information.

特開2009−222438号公報JP 2009-222438 A

ところで、一般的に、車載LANを経由して得られる車両速度、つまり、車輪速センサによって検出される車両速度は、車輪の単位時間当たりの回転量(車輪の回転速度)に基づいて算出されている。従って、同一の車輪速センサであっても、車輪の径寸法が異なれば検出される車両速度に変動が生じるし、また、車両の高速走行時に検出される車両速度と低速走行時に検出される車両速度との間で検出精度に差が生じてしまう。そのため、上記の特許文献1の技術では、車載LANを経由して得られた速度情報そのものが信頼性の低い情報となることから、このような速度情報と測位用衛星から受信する電波に基づいて検出された速度情報との絶対値の比較結果に基づく技術では、正確な同期を実現することが困難である。   By the way, in general, the vehicle speed obtained via the in-vehicle LAN, that is, the vehicle speed detected by the wheel speed sensor is calculated based on the rotation amount of the wheel per unit time (wheel rotation speed). Yes. Therefore, even if the wheel speed sensors are the same, if the wheel diameters are different, the detected vehicle speed fluctuates, and the vehicle speed detected when the vehicle travels at high speed and the vehicle detected at low speed travel There will be a difference in detection accuracy with the speed. For this reason, in the technique of Patent Document 1 described above, the speed information obtained via the vehicle-mounted LAN itself becomes information with low reliability. Therefore, based on such speed information and radio waves received from the positioning satellite. With the technology based on the comparison result of the absolute value with the detected speed information, it is difficult to realize accurate synchronization.

本発明は、上記した事情に鑑みてなされたものであり、その目的は、車輪の回転速度に基づいて検出される速度情報と車両の角速度情報とを正確に同期させ、これら速度情報と角速度情報とに基づく車両の位置検出を精度良く実現することができる車両用位置検出装置を提供することにある。   The present invention has been made in view of the above-described circumstances, and an object thereof is to accurately synchronize the speed information detected based on the rotational speed of the wheel and the angular speed information of the vehicle, and the speed information and the angular speed information. Another object of the present invention is to provide a vehicle position detection device that can accurately detect the position of a vehicle based on the above.

本発明の車両用位置検出装置によれば、第1車両速度検出手段は、車輪の回転速度に基づいて車両の速度を第1車両速度として検出し、角速度検出手段は、車両の角速度を検出し、第2車両速度検出手段は、角速度検出手段による角速度の検出処理と同期しながら、測位用衛星から受信する電波に基づいて車両の速度を第2車両速度として検出する。そして、ずれ量特定手段は、第1車両速度検出手段によって検出された第1車両速度と第2車両速度検出手段によって検出された第2車両速度との遅延度合いを特定し、補正手段は、ずれ量特定手段によって特定された遅延度合いに基づいて、第1車両速度を角速度検出手段によって検出された角速度に同期するように補正する。そして、位置検出手段は、補正手段によって補正された第1車両速度と角速度検出手段によって検出された角速度とに基づいて車両の位置を検出する。
According to the vehicle position detection apparatus of the present invention, the first vehicle speed detection means detects the vehicle speed as the first vehicle speed based on the rotational speed of the wheel, and the angular speed detection means detects the angular speed of the vehicle. The second vehicle speed detection means detects the vehicle speed as the second vehicle speed based on the radio wave received from the positioning satellite while synchronizing with the angular velocity detection processing by the angular velocity detection means. The deviation amount specifying means specifies the degree of delay between the first vehicle speed detected by the first vehicle speed detection means and the second vehicle speed detected by the second vehicle speed detection means, and the correction means Based on the degree of delay specified by the quantity specifying means, the first vehicle speed is corrected so as to be synchronized with the angular speed detected by the angular speed detecting means. Then, the position detection means detects the position of the vehicle based on the first vehicle speed corrected by the correction means and the angular speed detected by the angular speed detection means.

即ち、車輪の回転速度に基づいて検出される第1車両速度を、車両の角速度情報に同期しながら検出される第2車両速度、つまり、測位用衛星から受信する電波に基づいて検出される速度に基づいて補正するように構成した。これにより、車輪の回転速度に基づいて検出される速度情報、つまり、補正後の第1車両速度と車両の角速度情報とを正確に同期させることができ、これら速度情報と角速度情報とに基づく車両の位置検出を精度良く実現することができる。   That is, the first vehicle speed detected based on the rotation speed of the wheels is synchronized with the angular speed information of the vehicle, the second vehicle speed is detected, that is, the speed is detected based on the radio wave received from the positioning satellite. It was configured to correct based on. Thereby, the speed information detected based on the rotation speed of the wheel, that is, the corrected first vehicle speed and the angular speed information of the vehicle can be accurately synchronized, and the vehicle based on the speed information and the angular speed information can be synchronized. The position detection can be realized with high accuracy.

一実施形態に係るナビゲーション装置を概略的に示す機能ブロック図1 is a functional block diagram schematically showing a navigation device according to one embodiment. 車載LANシステム速度情報、角速度情報、測位システム速度情報の関係の一例を示す図The figure which shows an example of the relationship between vehicle-mounted LAN system speed information, angular velocity information, and positioning system speed information 測位システム速度情報と車載LANシステム速度情報との相関関係の算出方法を説明するための図The figure for demonstrating the calculation method of the correlation of positioning system speed information and vehicle-mounted LAN system speed information 測位システム速度情報と車載LANシステム速度情報とのずれ量の特定方法を説明するための図The figure for demonstrating the identification method of the deviation | shift amount of positioning system speed information and vehicle-mounted LAN system speed information メイン制御の内容を示すフローチャートFlow chart showing contents of main control ずれ量算出処理の内容を示すフローチャートFlow chart showing contents of deviation amount calculation processing 測位システム速度情報取得制御の内容を示すフローチャートFlow chart showing contents of positioning system speed information acquisition control 角速度情報取得制御の内容を示すフローチャートFlow chart showing contents of angular velocity information acquisition control 車載LANシステム速度情報取得制御の内容を示すフローチャートThe flowchart which shows the contents of in-vehicle LAN system speed information acquisition control 車両の進行方位を算出するための式を示す図The figure which shows the formula for calculating the advancing direction of vehicles 車両の位置を算出するための式を示す図The figure which shows the formula for calculating the position of the vehicle

以下、本発明の一実施形態について図面を参照しながら説明する。図1に示すように、車両の経路案内機能などを有するナビゲーション装置10は、特許請求の範囲に記載の車両用位置検出装置に相当するものであり、制御部11、角速度検出部12、測位部13、記憶部14などを備える。また、このナビゲーション装置10は、車載LAN20を介して、外部の走行制御装置21、ステアリング制御装置22、メータ制御装置23など各種の車両用制御装置に接続されている。また、このナビゲーション装置10は、通信制御部24を介して、図示しない他車両に搭載されている車両用通信装置、情報センターに設定されているサーバなどとの間に無線の通信回線を確立して、これら外部の装置類との間で各種のデータ通信が可能となっている。   Hereinafter, an embodiment of the present invention will be described with reference to the drawings. As shown in FIG. 1, a navigation device 10 having a vehicle route guidance function or the like corresponds to the vehicle position detection device described in the claims, and includes a control unit 11, an angular velocity detection unit 12, and a positioning unit. 13 and a storage unit 14 are provided. The navigation device 10 is connected to various vehicle control devices such as an external travel control device 21, a steering control device 22, and a meter control device 23 via an in-vehicle LAN 20. Further, the navigation device 10 establishes a wireless communication line with a vehicle communication device mounted on another vehicle (not shown), a server set in the information center, and the like via the communication control unit 24. Various data communications are possible with these external devices.

この場合、走行制御装置21は、特許請求の範囲に記載の第1車両速度検出手段に相当するものであり、例えばABS制御装置(ABS:Antilocked Braking System)などで構成される。この走行制御装置21は、図示しない車輪速センサによって検出される車両の速度を車載LANシステム速度として検出する。そして、走行制御装置21は、検出した車載LANシステム速度を示す情報を車載LANシステム速度情報として車載LAN20を介して制御部11やメータ制御装置23などの他の装置類に送信する。ここで、車輪速センサは、車両の各車輪に対応付けて設けられており、これにより、走行制御装置21は、各車輪の回転速度をそれぞれ検出する。この場合、走行制御装置21は、各車輪の回転速度の平均値を車載LANシステム速度として検出するように設定されている。なお、この車載LANシステム速度は、特許請求の範囲に記載の第1車両速度に相当する。また、この場合、ナビゲーション装置10は、第1車両速度検出手段である走行制御装置21を装置外部に備えた構成である。
ステアリング制御装置22は、ドライバーによるステアリングの操作角度を検出し、検出した操作角度を示す操作角度情報を車載LAN20を介して他の装置類に送信する。メータ制御装置23は、走行制御装置21から受信した車載LANシステム速度情報に基づいて車両の速度を特定し、特定した速度を図示しないメータに表示する。
In this case, the travel control device 21 corresponds to the first vehicle speed detection means described in the claims, and is configured by, for example, an ABS control device (ABS: Antilocked Braking System). The travel control device 21 detects the vehicle speed detected by a wheel speed sensor (not shown) as the in-vehicle LAN system speed. Then, the traveling control device 21 transmits information indicating the detected in-vehicle LAN system speed as in-vehicle LAN system speed information to other devices such as the control unit 11 and the meter control device 23 through the in-vehicle LAN 20. Here, the wheel speed sensor is provided in association with each wheel of the vehicle, whereby the travel control device 21 detects the rotational speed of each wheel. In this case, the traveling control device 21 is set to detect the average value of the rotational speeds of the wheels as the in-vehicle LAN system speed. The in-vehicle LAN system speed corresponds to the first vehicle speed described in the claims. Further, in this case, the navigation device 10 has a configuration in which a travel control device 21 that is first vehicle speed detection means is provided outside the device.
The steering control device 22 detects the operation angle of the steering by the driver, and transmits operation angle information indicating the detected operation angle to other devices via the in-vehicle LAN 20. The meter control device 23 specifies the speed of the vehicle based on the in-vehicle LAN system speed information received from the travel control device 21 and displays the specified speed on a meter (not shown).

続いて、ナビゲーション装置10が備える各構成要素について説明する。制御部11は、特許請求の範囲に記載の同期制御手段に相当するものであり、図示しないCPU、ROMおよびRAMを有するマイクロコンピュータを主体として構成され、ナビゲーション装置10の動作全般を制御する。また、この制御部11は、CPUにおいて制御プログラムを実行することにより、ずれ量特定処理部31、補正処理部32、位置検出処理部33をソフトウェアによって仮想的に実現する。なお、ずれ量特定処理部31は、特許請求の範囲に記載のずれ量特定手段に相当し、補正処理部32は、特許請求の範囲に記載の補正手段に相当し、位置検出処理部33は、特許請求の範囲に記載の位置検出手段に相当する。   Then, each component with which the navigation apparatus 10 is provided is demonstrated. The control unit 11 corresponds to the synchronization control means described in the claims, and is configured mainly by a microcomputer having a CPU, a ROM, and a RAM (not shown), and controls the overall operation of the navigation device 10. Further, the control unit 11 virtually implements the deviation amount specifying processing unit 31, the correction processing unit 32, and the position detection processing unit 33 by software by executing a control program in the CPU. The deviation amount identification processing unit 31 corresponds to the deviation amount identification unit described in the claims, the correction processing unit 32 corresponds to the correction unit described in the claims, and the position detection processing unit 33 This corresponds to the position detecting means described in the claims.

角速度検出部12は、特許請求の範囲に記載の角速度検出手段に相当するものであり、例えばジャイロセンサで構成される。この角速度検出部12は、車両の角速度を検出し、検出した角速度を示す情報を角速度情報として車載LAN20を介することなく制御部11に直接的に出力する。角速度検出部12をアナログジャイロセンサで構成した場合、検出される角速度に応じた電圧値が当該角速度検出部12から出力され、制御部11に内蔵される図示しないAD変換器でデジタル値に変換されて用いられる。一方、角速度検出部12をデジタルジャイロセンサで構成した場合、検出される角速度を外部から入力されるクロック信号に基づいて内部でAD変換し、シリアル通信によって制御部11に出力する。   The angular velocity detection unit 12 corresponds to the angular velocity detection means described in the claims, and is constituted by, for example, a gyro sensor. The angular velocity detection unit 12 detects the angular velocity of the vehicle, and directly outputs information indicating the detected angular velocity to the control unit 11 as angular velocity information without passing through the in-vehicle LAN 20. When the angular velocity detection unit 12 is composed of an analog gyro sensor, a voltage value corresponding to the detected angular velocity is output from the angular velocity detection unit 12 and converted into a digital value by an AD converter (not shown) built in the control unit 11. Used. On the other hand, when the angular velocity detection unit 12 is configured by a digital gyro sensor, the detected angular velocity is AD-converted internally based on a clock signal input from the outside, and is output to the control unit 11 by serial communication.

測位部13は、特許請求の範囲に記載の第2車両速度検出手段に相当するものであり、図示しない測位用衛星から送信される測位用の電波を受信する衛星電波受信器を備え、角速度検出部12による角速度の検出処理と同期しながら、測位用衛星から受信する電波に基づいて車両の位置および速度を検出する。この測位部13は、検出される車両の位置を示す情報を位置情報として車載LAN20を介することなく制御部11に直接的に出力する。また、この測位部13は、検出される車両の速度を測位システム速度として検出し、検出した測位システム速度を示す情報を測位システム速度情報として車載LAN20を介することなく制御部11に直接的に出力する。この場合、測位部13は、クロック131を備えており、このクロック131から入力されるクロック信号に基づいて動作する。   The positioning unit 13 corresponds to the second vehicle speed detecting means described in the claims, and includes a satellite radio wave receiver that receives a positioning radio wave transmitted from a positioning satellite (not shown), and detects an angular velocity. The position and speed of the vehicle are detected based on the radio wave received from the positioning satellite while being synchronized with the angular velocity detection process by the unit 12. The positioning unit 13 directly outputs information indicating the detected position of the vehicle as position information to the control unit 11 without passing through the in-vehicle LAN 20. Further, the positioning unit 13 detects the detected vehicle speed as a positioning system speed, and directly outputs information indicating the detected positioning system speed as positioning system speed information to the control unit 11 without using the in-vehicle LAN 20. To do. In this case, the positioning unit 13 includes a clock 131 and operates based on a clock signal input from the clock 131.

ここで、これら角速度検出部12および測位部13は、何れも車載LAN20を介することなく制御部11に直接的に接続されている。よって、角速度検出部12から制御部11への角速度情報の出力および測位部13から制御部11への測位システム速度情報の出力は遅延し難く、従って、制御部11は、角速度検出部12からの角速度情報と測位部13からの測位システム速度情報とを同期して取得することができる。また、仮に、角速度検出部12からの角速度情報の出力あるいは測位部13からの測位システム速度情報の出力に遅延が生じたとしても、制御部11は、CPUにて動作させているオペレーティングシステムのシステムタイムを用いて遅延が生じた情報を補正することで、角速度検出部12からの角速度情報と測位部13からの測位システム速度情報とを同期させる同期制御機能を有している。   Here, both the angular velocity detection unit 12 and the positioning unit 13 are directly connected to the control unit 11 without using the in-vehicle LAN 20. Therefore, the output of the angular velocity information from the angular velocity detection unit 12 to the control unit 11 and the output of the positioning system speed information from the positioning unit 13 to the control unit 11 are difficult to delay. Therefore, the control unit 11 receives the signal from the angular velocity detection unit 12. The angular velocity information and the positioning system speed information from the positioning unit 13 can be acquired in synchronization. Even if a delay occurs in the output of the angular velocity information from the angular velocity detection unit 12 or the output of the positioning system speed information from the positioning unit 13, the control unit 11 is a system of the operating system operated by the CPU. It has a synchronization control function that synchronizes the angular velocity information from the angular velocity detection unit 12 and the positioning system velocity information from the positioning unit 13 by correcting the information in which the delay has occurred using the time.

記憶部14は、例えばハードディスクドライブやメモリなどの不揮発性の記憶媒体で構成されており、各種のコンピュータプログラムや各プログラムで使用されるデータなどを記憶している。また、この記憶部14は、制御部11に入力される各種のデータや情報を一時的に格納する図示しないバッファを有している。このバッファは、いわゆるFIFO(First In First Out)構成、即ち、先入れ先出し構成であり、最新のM秒分(例えば30秒分)のデータや情報が格納されるようになっている。   The storage unit 14 is configured by a non-volatile storage medium such as a hard disk drive or a memory, for example, and stores various computer programs, data used in each program, and the like. In addition, the storage unit 14 has a buffer (not shown) that temporarily stores various data and information input to the control unit 11. This buffer has a so-called FIFO (First In First Out) structure, that is, a first-in first-out structure, and stores data and information for the latest M seconds (for example, 30 seconds).

ずれ量特定処理部31は、詳しくは後述するようにして、走行制御装置21によって検出された車載LANシステム速度と測位部13によって検出された測位システム速度とのずれ量を特定する。
補正処理部32は、詳しくは後述するようにして、ずれ量特定処理部31によって特定されたずれ量に基づいて、車載LANシステム速度を角速度検出部12によって検出された角速度に同期するように補正する。
位置検出処理部33は、補正処理部32によって補正された車載LANシステム速度情報、角速度検出部12によって検出された角速度情報、測位部13から出力される車両の位置情報、さらには必要に応じて他のセンサ類(例えば、地磁気センサ、加速度センサなど)によって検出された検出データに基づいて車両の位置を高精度で検出する。
The deviation amount specifying processing unit 31 specifies a deviation amount between the in-vehicle LAN system speed detected by the travel control device 21 and the positioning system speed detected by the positioning unit 13 as will be described in detail later.
As will be described in detail later, the correction processing unit 32 corrects the in-vehicle LAN system speed to be synchronized with the angular velocity detected by the angular velocity detection unit 12 based on the deviation amount specified by the deviation amount specification processing unit 31. To do.
The position detection processing unit 33 includes the in-vehicle LAN system speed information corrected by the correction processing unit 32, the angular velocity information detected by the angular velocity detection unit 12, the vehicle position information output from the positioning unit 13, and as necessary. Based on detection data detected by other sensors (for example, a geomagnetic sensor, an acceleration sensor, etc.), the position of the vehicle is detected with high accuracy.

次に、上記した構成のナビゲーション装置10による位置検出処理について説明する。
上述したように、角速度検出部12からの角速度情報と測位部13からの測位システム速度情報は、相互に同期しながら制御部11に出力される。一方で、走行制御装置21からの車載LANシステム速度情報は、車載LAN20を経由して制御部11に出力される。そのため、図2に示すように、車載LANシステム速度情報v1(t)に遅延が発生して、角速度検出部12からの角速度情報ω(t)および測位部13からの測位システム速度情報v2(t)と非同期となる場合がある。
そこで、ナビゲーション装置10の制御部11は、ずれ量特定処理部31によって、角速度情報ω(t)と同期する測位システム速度情報v2(t)に対する車載LANシステム速度情報v1(t)のずれ量T、即ち、遅延度合いを、次のようにして特定する。
Next, position detection processing by the navigation device 10 having the above-described configuration will be described.
As described above, the angular velocity information from the angular velocity detection unit 12 and the positioning system speed information from the positioning unit 13 are output to the control unit 11 in synchronization with each other. On the other hand, the in-vehicle LAN system speed information from the travel control device 21 is output to the control unit 11 via the in-vehicle LAN 20. Therefore, as shown in FIG. 2, a delay occurs in the in-vehicle LAN system speed information v1 (t), and the angular speed information ω (t) from the angular speed detection unit 12 and the positioning system speed information v2 (t from the positioning unit 13 ) And may be asynchronous.
Therefore, the control unit 11 of the navigation apparatus 10 uses the deviation amount specifying processing unit 31 to obtain the deviation amount T of the in-vehicle LAN system speed information v1 (t) with respect to the positioning system speed information v2 (t) synchronized with the angular velocity information ω (t). That is, the degree of delay is specified as follows.

即ち、図3に示すように、制御部11は、車載LANシステム速度情報v1(t)および測位システム速度情報v2(t)のうち何れか一方の情報(検出データ)、この場合、図3に破線で示す測位システム速度情報v2(t)を、図3中矢印Aで示すように、他方の情報、この場合、図3に実線で示す車載LANシステム速度情報v1(t)に重ねるようにずらしながら、両速度情報v1(t),v2(t)が相互に重なる部分の面積を相関値Cとして算出する。即ち、この場合、制御部11は、いわゆる畳込み積分処理によって2つの速度情報v1(t),v2(t)の相関値Cを算出する。そして、図4に示すように、制御部11は、算出した相関値Cが最大となるまでに他方の情報(この場合、測位システム速度情報v2(t))をずらした量(時間オフセット)をずれ量Tとして特定する。   That is, as shown in FIG. 3, the control unit 11 is one of information (detection data) in the in-vehicle LAN system speed information v1 (t) and the positioning system speed information v2 (t), in this case, in FIG. The positioning system speed information v2 (t) indicated by the broken line is shifted so as to overlap the other information, in this case, the in-vehicle LAN system speed information v1 (t) indicated by the solid line in FIG. 3, as indicated by an arrow A in FIG. However, the area of the portion where both the speed information v1 (t) and v2 (t) overlap is calculated as the correlation value C. That is, in this case, the control unit 11 calculates a correlation value C between the two pieces of speed information v1 (t) and v2 (t) by so-called convolution integration processing. Then, as shown in FIG. 4, the control unit 11 sets the amount (time offset) by which the other information (in this case, the positioning system speed information v2 (t)) is shifted until the calculated correlation value C becomes the maximum. It is specified as a deviation amount T.

制御部11は、ずれ量Tを特定すると、そのずれ量Tに基づいて、車載LANシステム速度情報v1(t)を角速度検出部12によって検出された角速度情報ω(t)に同期するように補正する。即ち、制御部11は、遅延した車載LANシステム速度情報v1(t)をずれ量Tだけ早めたデータに変換することにより、車載LANシステム速度情報v1(t)を角速度情報ω(t)に同期させる。そして、制御部11は、補正後の車載LANシステム速度情報v1(t)と角速度情報ω(t)とに基づいて車両の位置を検出する。   When the deviation amount T is specified, the control unit 11 corrects the in-vehicle LAN system speed information v1 (t) to be synchronized with the angular velocity information ω (t) detected by the angular velocity detection unit 12 based on the deviation amount T. To do. That is, the control unit 11 synchronizes the in-vehicle LAN system speed information v1 (t) with the angular speed information ω (t) by converting the delayed in-vehicle LAN system speed information v1 (t) into data that is advanced by the shift amount T. Let And the control part 11 detects the position of a vehicle based on the vehicle-mounted LAN system speed information v1 (t) and angular velocity information (omega) (t) after correction | amendment.

次に、上記したナビゲーション装置10が実行するメイン制御の内容について図5に示すフローチャートを参照しながら説明する。なお、以下に説明する処理は、ナビゲーション装置10の制御部11が実行する処理であるが、説明の簡略化のため、「ナビゲーション装置10」を主体にして説明する。
即ち、図5に示すように、ナビゲーション装置10は、起動されると、バッファに格納される車載LANシステム速度情報、測位システム速度、角速度情報の何れかが更新されたか否かを監視している(ステップA1)。そして、ナビゲーション装置10は、何れかの情報が更新されると(ステップA1:YES)、ずれ量Tを算出する(ステップA2)。そして、ナビゲーション装置10は、図10に示す式(1)により、算出したずれ量Tに基づいて車両の進行方位θ(t)を算出する(ステップA3)。そして、ナビゲーション装置10は、図11に示す式(2),(3)により、算出した進行方位θ(t)に基づいて、車両の位置座標x(t),y(t)を算出する(ステップA4)。ナビゲーション装置10は、電源がオフされるまで、この処理を繰り返し実行する。
Next, the contents of the main control executed by the navigation device 10 will be described with reference to the flowchart shown in FIG. In addition, although the process demonstrated below is a process which the control part 11 of the navigation apparatus 10 performs, it demonstrates focusing on the "navigation apparatus 10" for the simplification of description.
That is, as shown in FIG. 5, when the navigation apparatus 10 is activated, it monitors whether any of the in-vehicle LAN system speed information, positioning system speed, or angular speed information stored in the buffer has been updated. (Step A1). Then, when any information is updated (step A1: YES), the navigation device 10 calculates a deviation amount T (step A2). Then, the navigation device 10 calculates the traveling direction θ (t) of the vehicle based on the calculated shift amount T using the equation (1) shown in FIG. 10 (step A3). Then, the navigation device 10 calculates the vehicle position coordinates x (t), y (t) based on the calculated traveling azimuth θ (t) using the equations (2) and (3) shown in FIG. Step A4). The navigation device 10 repeatedly executes this process until the power is turned off.

次に、上記したステップS2の処理(ずれ量Tの算出処理)についてさらに詳細に説明する。即ち、図6に示すように、ナビゲーション装置10は、バッファに格納されている最新のデータ群から、過去N秒分(例えば10秒分)の測位システム速度情報を抽出する(ステップB1)。また、ナビゲーション装置10は、バッファに格納されている最新のデータ群から、過去N秒分(例えば10秒分)の車載LANシステム速度情報を抽出する(ステップB2)。   Next, the above-described processing in step S2 (processing for calculating the deviation amount T) will be described in more detail. That is, as shown in FIG. 6, the navigation apparatus 10 extracts positioning system speed information for the past N seconds (for example, 10 seconds) from the latest data group stored in the buffer (step B1). Further, the navigation device 10 extracts vehicle LAN system speed information for the past N seconds (for example, 10 seconds) from the latest data group stored in the buffer (step B2).

ここで、ステップB1にて抽出する測位システム速度情報の数とステップB2にて抽出する車載LANシステム速度情報の数は異なっていても構わない。そのため、ナビゲーション装置10は、これら2つの速度情報の数が異なっているか否かに関わらず、測位システム速度情報の数と車載LANシステム速度情報の数とを一致させるリサンプリング処理を実行する(ステップB3)。このリサンプリング処理では、これら2つの速度情報のうちサンプル数が多い方の数を適宜削減する削除処理を実行することで2つの速度情報の数をサンプル数が少ない方の数に合わせるように設定してもよいし、これら2つの速度情報のうちサンプル数が少ない方の数を適宜増加する補間処理を実行することで2つの速度情報の数をサンプル数が多い方の数に合わせるように設定してもよい。なお、ナビゲーション装置10は、測位システム速度情報の数と車載LANシステム速度情報の数とが異なっている場合にのみリサンプリング処理(ステップB3)を実行するように設定してもよい。   Here, the number of positioning system speed information extracted in step B1 and the number of in-vehicle LAN system speed information extracted in step B2 may be different. Therefore, the navigation device 10 executes a resampling process for matching the number of positioning system speed information and the number of in-vehicle LAN system speed information regardless of whether the numbers of these two speed information are different (step B3). In this resampling process, a deletion process is performed to appropriately reduce the number of the two pieces of speed information having the larger number of samples, so that the number of the two pieces of speed information is matched with the number of the smaller number of samples. It is also possible to set the number of the two pieces of speed information to match the number of the larger number of samples by executing an interpolation process that appropriately increases the number of the two pieces of speed information having the smaller number of samples. May be. The navigation device 10 may be set to execute the resampling process (step B3) only when the number of positioning system speed information and the number of in-vehicle LAN system speed information are different.

ナビゲーション装置10は、リサンプリング処理を経由して2つの速度情報の数を一致させると、これら2つの速度情報の相関値Cを畳込み積分処理によって算出する(ステップB4)。そして、ナビゲーション装置10は、算出した相関値Cが最大となるポイントを特定し、そのポイントから、車載LANシステム速度情報と測位システム速度情報とのずれ量Tを特定する(ステップB5)。   When the navigation apparatus 10 matches the number of two pieces of speed information via the resampling process, the navigation apparatus 10 calculates a correlation value C between the two pieces of speed information by a convolution integration process (step B4). And the navigation apparatus 10 specifies the point where the calculated correlation value C becomes the maximum, and specifies the deviation | shift amount T of vehicle-mounted LAN system speed information and positioning system speed information from the point (step B5).

次に、ナビゲーション装置10が上述のメイン制御に並列してマルチタスク処理によって実行する測位システム速度情報取得制御、角速度情報取得制御、車載LANシステム速度情報取得制御について説明する。
図7に示す測位システム速度情報取得制御では、ナビゲーション装置10は、測位部13から測位システム速度情報を受信すると(ステップC1:YES)、同期処理を可能とすべく、その情報を取得したときのシステムタイムを取得する(ステップC2)。この測位システム速度情報には、車両の位置情報および測位システム速度情報のほか、クロック131のクロック信号に基づく時刻情報、測位フラグ、精度劣化指数情報などが含まれる。そして、ナビゲーション装置10は、受信した測位システム速度情報に含まれる測位フラグや精度劣化指数情報などに基づいて、測位部13による測位状態が良好か否かを判定する(ステップC3)。
Next, positioning system speed information acquisition control, angular speed information acquisition control, and in-vehicle LAN system speed information acquisition control executed by the navigation apparatus 10 by multitask processing in parallel with the above-described main control will be described.
In the positioning system speed information acquisition control shown in FIG. 7, when the navigation apparatus 10 receives the positioning system speed information from the positioning unit 13 (step C1: YES), the navigation apparatus 10 acquires the information to enable synchronization processing. System time is acquired (step C2). This positioning system speed information includes time information based on the clock signal of the clock 131, a positioning flag, accuracy deterioration index information, and the like, in addition to vehicle position information and positioning system speed information. And the navigation apparatus 10 determines whether the positioning state by the positioning part 13 is favorable based on the positioning flag contained in the received positioning system speed information, accuracy degradation index information, etc. (step C3).

ナビゲーション装置10は、測位状態が良好である場合(ステップC3:YES)には、受信した測位システム速度情報を取得したシステムタイムを示すシステムタイム情報とともにバッファに格納して(ステップC4)、上記のステップC1に移行する。一方、ナビゲーション装置10は、測位状態が良好でない場合(ステップC4:NO)には、受信した測位システム速度情報およびシステムタイム情報を破棄して、上記のステップC1に移行する。ナビゲーション装置10は、電源がオフされるまで、この処理を繰り返し実行する。   When the positioning state is good (step C3: YES), the navigation device 10 stores the received positioning system speed information in the buffer together with the system time information indicating the acquired system time (step C4). The process proceeds to step C1. On the other hand, when the positioning state is not good (step C4: NO), the navigation device 10 discards the received positioning system speed information and system time information, and proceeds to the above step C1. The navigation device 10 repeatedly executes this process until the power is turned off.

図8に示す角速度情報取得制御では、ナビゲーション装置10は、定期的な角速度情報のサンプリングを可能とすべく、図示しないタイマーによる所定時間(例えば20ミリ秒)のカウントダウンを開始する(ステップD1)。そして、ナビゲーション装置10は、所定時間のカウントダウンが完了すると、つまり、所定時間が経過すると(ステップD2:YES)、同期処理を可能とすべく、カウントダウンが完了したときのシステムタイムを取得する(ステップD3)。そして、ナビゲーション装置10は、角速度検出部12から角速度情報を受信すると(ステップD4:YES)、受信した角速度情報を取得したシステムタイムを示すシステムタイム情報とともにバッファに格納する(ステップD5)。ナビゲーション装置10は、電源がオフされるまで、この処理を繰り返し実行する。   In the angular velocity information acquisition control shown in FIG. 8, the navigation apparatus 10 starts a countdown of a predetermined time (for example, 20 milliseconds) by a timer (not shown) so as to enable periodic sampling of angular velocity information (step D1). Then, when the countdown of the predetermined time is completed, that is, when the predetermined time has elapsed (step D2: YES), the navigation device 10 acquires the system time when the countdown is completed in order to enable the synchronization process (step D3). When the navigation device 10 receives the angular velocity information from the angular velocity detector 12 (step D4: YES), the navigation device 10 stores the received angular velocity information in the buffer together with the system time information indicating the acquired system time (step D5). The navigation device 10 repeatedly executes this process until the power is turned off.

図9に示す車載LANシステム速度情報取得制御では、ナビゲーション装置10は、走行制御装置21から車載LANシステム速度情報を受信すると(ステップE1:YES)、同期処理を可能とすべく、その情報を取得したときのシステムタイムを取得する(ステップE2)。そして、ナビゲーション装置10は、受信した車載LANシステム速度情報を取得したシステムタイムを示すシステムタイム情報とともにバッファに格納する(ステップE3)。ナビゲーション装置10は、電源がオフされるまで、この処理を繰り返し実行する。   In the in-vehicle LAN system speed information acquisition control shown in FIG. 9, when the navigation apparatus 10 receives the in-vehicle LAN system speed information from the travel control apparatus 21 (step E1: YES), the navigation apparatus 10 acquires that information to enable synchronization processing. The system time is acquired (step E2). The navigation apparatus 10 stores the received in-vehicle LAN system speed information in the buffer together with system time information indicating the system time at which the acquired in-vehicle LAN system speed information is acquired (step E3). The navigation device 10 repeatedly executes this process until the power is turned off.

以上に説明したように本実施形態に係るナビゲーション装置10によれば、車輪の回転速度に基づいて検出される車載LANシステム速度情報を、車両の角速度情報に同期しながら検出される測位システム速度情報、つまり、測位用衛星から受信する電波に基づいて検出される速度情報に基づいて補正するように構成した。これにより、車輪の回転速度に基づいて検出される速度情報、つまり、補正後の車載LANシステム速度情報と車両の角速度情報とを正確に同期させることができ、これら車載LANシステム速度情報と角速度情報とに基づく車両の位置検出を精度良く実現することができる。
また、ナビゲーション装置10は、いわゆる畳込み積分処理によって、車載LANシステム速度情報と測位システム速度情報との相関関係(相関値C)を算出し、その相関関係が最も大きくなるポイントから、車載LANシステム速度情報と測位システム速度情報とのずれ量Tを特定する。このような具体的な処理により、ずれ量Tを精度良く特定することができる。
As described above, according to the navigation device 10 according to the present embodiment, the positioning system speed information detected while synchronizing the in-vehicle LAN system speed information detected based on the rotational speed of the wheel with the angular speed information of the vehicle. In other words, the correction is made based on the speed information detected based on the radio wave received from the positioning satellite. Thereby, the speed information detected based on the rotation speed of the wheel, that is, the corrected in-vehicle LAN system speed information and the angular speed information of the vehicle can be accurately synchronized, and the in-vehicle LAN system speed information and the angular speed information can be synchronized. The position detection of the vehicle based on the above can be realized with high accuracy.
Further, the navigation device 10 calculates the correlation (correlation value C) between the in-vehicle LAN system speed information and the positioning system speed information by so-called convolution integration processing, and from the point where the correlation becomes the largest, the in-vehicle LAN system A deviation amount T between the speed information and the positioning system speed information is specified. Through such specific processing, the shift amount T can be specified with high accuracy.

また、ナビゲーション装置10は、角速度検出部12および測位部13が車載LAN20を介することなく制御部11に直接的に接続された構成であり、角速度情報と測位システム速度情報とが非同期となり難い構成である。さらに、ナビゲーション装置10は、角速度情報と測位システム速度情報とを同期させる同期制御機能を備えており、仮に角速度情報と測位システム速度情報とが非同期になったとしても、当該機能によって、これら角速度情報と測位システム速度情報とを同期させるように修正することができる。従って、測位システム速度情報が角速度情報に同期していることの信頼性を格段に高くすることができ、ひいては、この測位システム速度情報を利用した車載LANシステム速度情報の補正処理の信頼性を格段に向上させることができる。   Further, the navigation device 10 has a configuration in which the angular velocity detection unit 12 and the positioning unit 13 are directly connected to the control unit 11 without using the in-vehicle LAN 20, and the angular velocity information and the positioning system speed information are unlikely to be asynchronous. is there. Further, the navigation device 10 has a synchronous control function for synchronizing the angular velocity information and the positioning system speed information. Even if the angular velocity information and the positioning system speed information become asynchronous, the angular velocity information is obtained by the function. And positioning system speed information can be modified to be synchronized. Therefore, the reliability that the positioning system speed information is synchronized with the angular speed information can be remarkably increased. As a result, the reliability of the correction processing of the in-vehicle LAN system speed information using the positioning system speed information is remarkably improved. Can be improved.

なお、本発明は、上述した一実施形態のみに限定されるものではなく、その要旨を逸脱しない範囲で種々の実施形態に適用可能であり、例えば、以下のように変形または拡張することができる。
測位システム速度は、電波の受信状況などに応じて計測誤差が発生する場合がある。そのため、ナビゲーション装置10は、測位システム速度情報のうち誤差が発生している可能性のあるものを除外した上で、相関値Cの算出処理を実行するように構成するとよい。測位システム速度情報に誤差が発生しているか否かの判定は、例えば次のような処理によって実現することができる。
In addition, this invention is not limited only to one embodiment mentioned above, It can apply to various embodiment in the range which does not deviate from the summary, For example, it can deform | transform or expand as follows. .
The positioning system speed may cause a measurement error depending on the reception status of radio waves. Therefore, the navigation apparatus 10 may be configured to execute the calculation process of the correlation value C after excluding the positioning system speed information that may cause an error. The determination of whether or not an error has occurred in the positioning system speed information can be realized by, for example, the following processing.

即ち、例えば、測位部13から受信した測位システム速度情報に含まれる精度劣化指数情報が所定の閾値以上である場合に、測位システム速度情報に誤差が発生していると判定するように設定することができる。また、測位部13が電波を受信可能な測位用衛星の数が所定数未満である場合に、測位システム速度情報に誤差が発生していると判定するように設定することができる。また、測位部13が測位用衛星から受信する電波の受信レベルが所定の閾値未満である場合に、測位システム速度情報に誤差が発生していると判定するように設定することができる。このとき、電波を受信可能な測位用衛星が複数存在する状況であれば、受信レベルが所定の閾値未満である衛星が1つでも存在する場合に、測位システム速度情報に誤差が発生していると判定するように設定することができる。また、各衛星からの受信レベルの平均値が所定の閾値未満である場合に、測位システム速度情報に誤差が発生していると判定するように設定することができる。   That is, for example, when the accuracy degradation index information included in the positioning system speed information received from the positioning unit 13 is equal to or greater than a predetermined threshold, it is determined to determine that an error has occurred in the positioning system speed information. Can do. The positioning unit 13 can be set to determine that an error has occurred in the positioning system speed information when the number of positioning satellites capable of receiving radio waves is less than a predetermined number. Further, when the reception level of the radio wave received from the positioning satellite by the positioning unit 13 is less than a predetermined threshold, it can be set to determine that an error has occurred in the positioning system speed information. At this time, if there are a plurality of positioning satellites capable of receiving radio waves, there is an error in the positioning system speed information when there is even one satellite whose reception level is less than a predetermined threshold. Can be determined. Further, it can be set to determine that an error has occurred in the positioning system speed information when the average value of the reception level from each satellite is less than a predetermined threshold.

また、測位システム速度は、移動体、この場合、ナビゲーション装置10を搭載した車両の前後方向に存在する測位用衛星からの電波の影響を受け易い。そのため、測位システム速度は、移動体の前後方向において所定の範囲内、例えば可視範囲内に存在する測位用衛星から受信する電波に基づいて検出するように設定するとよい。この場合も、例えば可視範囲内に存在する測位用衛星からの受信レベルが所定の閾値未満である場合に、測位システム速度情報に誤差が発生していると判定するように設定するとよい。
また、ナビゲーション装置10は、測位システム速度に誤差が発生する可能性が高いと考えられる区間を車両が走行する場合には、測位システム速度に誤差が発生しているか否かに関わらず、相関値Cの算出処理を実行しないように設定することもできる。このような区間は、例えば、外部のデータベースやプローブ車両から取得した情報に基づいて、測位システム速度に誤差が発生する可能性が高いと統計的に求められる区間、あるいは、いわゆるマルチパス現象が発生し易い区間などを設定することができる。
In addition, the positioning system speed is easily affected by radio waves from a positioning satellite existing in the front-rear direction of a mobile object, in this case, a vehicle on which the navigation device 10 is mounted. Therefore, the positioning system speed may be set so as to be detected based on radio waves received from a positioning satellite existing within a predetermined range, for example, a visible range in the longitudinal direction of the moving body. In this case as well, for example, when the reception level from the positioning satellite existing in the visible range is less than a predetermined threshold, it may be set to determine that an error has occurred in the positioning system speed information.
Further, when the vehicle travels in a section where it is considered that an error is likely to occur in the positioning system speed, the navigation device 10 has a correlation value regardless of whether or not an error has occurred in the positioning system speed. It can also be set not to execute the calculation process of C. Such a section is, for example, a section that is statistically determined that there is a high possibility of an error in the positioning system speed based on information obtained from an external database or probe vehicle, or a so-called multipath phenomenon occurs. It is possible to set a section that is easy to perform.

車載LANシステム速度は、例えば摩擦係数が低い道路でのスリップやドリフトなど車両の走行状況に応じて計測誤差が発生する場合がある。そのため、ナビゲーション装置10は、車載LANシステム速度情報のうち誤差が発生している可能性のあるものを除外した上で、相関値Cの算出処理を実行するように構成するとよい。車載LANシステム速度情報に誤差が発生しているか否かの判定は、例えば次のような処理によって実現することができる。
即ち、例えば、車両の各車輪の回転速度のうち最大値と最小値との差分が所定の閾値以上である場合に、車載LANシステム速度情報に誤差が発生していると判定するように設定することができる。また、測位システム速度を角速度で除算することによって車両の回転半径を算出し、算出した回転半径が所定の閾値未満の場合に、車載LANシステム速度情報に誤差が発生していると判定するように設定することができる。
The vehicle-mounted LAN system speed may cause a measurement error depending on the traveling state of the vehicle such as slip or drift on a road with a low friction coefficient. For this reason, the navigation apparatus 10 may be configured to execute the calculation process of the correlation value C after excluding the in-vehicle LAN system speed information that may cause an error. The determination as to whether or not an error has occurred in the in-vehicle LAN system speed information can be realized, for example, by the following processing.
That is, for example, when the difference between the maximum value and the minimum value of the rotational speeds of the wheels of the vehicle is greater than or equal to a predetermined threshold, it is set to determine that an error has occurred in the in-vehicle LAN system speed information. be able to. Further, the turning radius of the vehicle is calculated by dividing the positioning system speed by the angular speed, and when the calculated turning radius is less than a predetermined threshold, it is determined that an error has occurred in the in-vehicle LAN system speed information. Can be set.

また、ナビゲーション装置10は、車載LANシステム速度に誤差が発生する可能性が高いと考えられる区間を車両が走行する場合には、車載LANシステム速度に誤差が発生しているか否かに関わらず、相関値Cの算出処理を実行しないように設定することもできる。このような区間は、例えば、車両の走行データ、具体的には速度情報、角速度情報、ブレーキ操作情報などを記憶部14などにデータベース化しておき、その走行データに基づいて特定される車両が過去にドリフトやスリップをした区間を設定することができる。また、外部のデータベースやプローブ車両から取得した情報に基づいて、自車両と似た運転特性で走行する他車両を特定し、その他車両が過去にドリフトやスリップをした区間を設定することができる。   Further, when the vehicle travels in a section where it is considered that an error is likely to occur in the in-vehicle LAN system speed, the navigation device 10 regardless of whether the in-vehicle LAN system speed has an error or not. It is also possible to set so that the calculation process of the correlation value C is not executed. In such a section, for example, vehicle travel data, specifically, speed information, angular speed information, brake operation information, and the like are stored in a database in the storage unit 14 and the vehicle specified based on the travel data is stored in the past. It is possible to set a section where drift or slip has occurred. Moreover, based on the information acquired from an external database or a probe vehicle, the other vehicle which drive | works with the driving characteristic similar to the own vehicle can be specified, and the area where the other vehicle drifted or slipped in the past can be set.

また、ナビゲーション装置10は、過去に車両がドリフトやスリップをしたときの状況を示す各種の情報、例えば、天候、日時、交通の混雑度合い、車両の速度などを示す情報を記憶部14などにデータベース化しておき、その状況が再度満たされる場合、つまり、過去にドリフトやスリップをしたときの状況が再現される場合に、相関値Cの算出処理を実行しないように設定することもできる。
ナビゲーション装置10は、車載LANシステム速度情報v1(t)および測位システム速度情報v2(t)のうち車載LANシステム速度情報v1(t)を測位システム速度情報v2(t)に重ねるようにずらしながら相関値Cを算出するように設定してもよい。
車両用位置検出装置は、ナビゲーション装置10に適用した構成に限られるものではなく、車両に搭載される車両用装置全般に適用することができる。
第1車両速度検出手段は、車両用位置検出装置外部に設けられた走行制御装置21ではなく車両用位置検出装置に備える構成としてもよい。
The navigation device 10 also stores various information indicating the situation when the vehicle has drifted or slipped in the past, such as information indicating the weather, date and time, degree of traffic congestion, vehicle speed, and the like in the storage unit 14 and the like. In other words, when the situation is satisfied again, that is, when the situation at the time of drift or slip in the past is reproduced, it is possible to set so as not to execute the calculation process of the correlation value C.
The navigation device 10 correlates while shifting the in-vehicle LAN system speed information v1 (t) from the in-vehicle LAN system speed information v1 (t) and the positioning system speed information v2 (t) so as to overlap the positioning system speed information v2 (t). The value C may be set to be calculated.
The vehicle position detection device is not limited to the configuration applied to the navigation device 10, and can be applied to all vehicle devices mounted on the vehicle.
The first vehicle speed detection means may be provided in the vehicle position detection device instead of the travel control device 21 provided outside the vehicle position detection device.

図面中、10はナビゲーション装置(車両用位置検出装置)、11は制御部(同期制御手段)、12は角速度検出部(角速度検出手段)、13は測位部(第2車両速度検出手段)、21は走行制御装置(第1車両速度検出手段)、31はずれ量特定処理部(ずれ量特定手段)、32は補正処理部(補正手段)、33は位置検出処理部(位置検出手段)を示す。
In the drawings, 10 is a navigation device (vehicle position detection device), 11 is a control unit (synchronous control unit), 12 is an angular velocity detection unit (angular velocity detection unit), 13 is a positioning unit (second vehicle speed detection unit), 21 Denotes a travel control device (first vehicle speed detecting means), 31 denotes a deviation amount specifying processing section (deviation amount specifying means), 32 denotes a correction processing section (correcting means), and 33 denotes a position detection processing section (position detecting means).

Claims (3)

車輪の回転速度に基づいて車両の速度を第1車両速度として検出する第1車両速度検出手段(21)と、
車両の角速度を検出する角速度検出手段(12)と、
前記角速度検出手段による前記角速度の検出処理と同期しながら、測位用衛星から受信する電波に基づいて車両の速度を第2車両速度として検出する第2車両速度検出手段(13)と、
前記第1車両速度検出手段によって検出された前記第1車両速度と前記第2車両速度検出手段によって検出された前記第2車両速度との遅延度合いを特定するずれ量特定手段(31)と、
前記ずれ量特定手段によって特定された前記遅延度合いに基づいて、前記第1車両速度を前記角速度検出手段によって検出された前記角速度に同期するように補正する補正手段(32)と、
前記補正手段によって補正された前記第1車両速度と前記角速度検出手段によって検出された前記角速度とに基づいて車両の位置を検出する位置検出手段(33)と、
を備える車両用位置検出装置。
First vehicle speed detecting means (21) for detecting the speed of the vehicle as the first vehicle speed based on the rotational speed of the wheels;
Angular velocity detection means (12) for detecting the angular velocity of the vehicle;
Second vehicle speed detection means (13) for detecting a vehicle speed as a second vehicle speed based on radio waves received from a positioning satellite in synchronization with the angular velocity detection processing by the angular velocity detection means;
A deviation amount specifying means (31) for specifying a degree of delay between the first vehicle speed detected by the first vehicle speed detecting means and the second vehicle speed detected by the second vehicle speed detecting means;
Correction means (32) for correcting the first vehicle speed so as to be synchronized with the angular velocity detected by the angular velocity detecting means based on the degree of delay specified by the deviation amount specifying means;
Position detecting means (33) for detecting the position of the vehicle based on the first vehicle speed corrected by the correcting means and the angular speed detected by the angular speed detecting means;
A vehicle position detecting device.
前記ずれ量特定手段は、前記第1車両速度を示す検出データおよび前記第2車両速度を示す検出データのうち何れか一方の検出データを他方の検出データに重ねるようにずらしながら両検出データが相互に重なる部分の面積を相関値として算出し、算出した相関値が最大となるまでに前記一方の検出データをずらした量を前記遅延度合いとして特定する請求項1に記載の車両用位置検出装置。
The deviation amount specifying means shifts the detection data so that one of the detection data indicating the first vehicle speed and the detection data indicating the second vehicle speed is superimposed on the other detection data. The vehicle position detection device according to claim 1, wherein an area of a portion overlapping with is calculated as a correlation value, and an amount of shifting the one detection data until the calculated correlation value becomes maximum is specified as the delay degree .
前記角速度検出手段および前記第2車両速度検出手段が接続され、前記角速度検出手段によって検出される前記角速度と前記第2車両速度検出手段によって検出される前記第2車両速度とを同期させる同期制御手段(11)をさらに備える請求項1または2に記載の車両用位置検出装置。   The angular velocity detection means and the second vehicle speed detection means are connected to synchronize the angular velocity detected by the angular velocity detection means with the second vehicle speed detected by the second vehicle speed detection means. The vehicle position detection device according to claim 1, further comprising (11).
JP2012099848A 2012-04-25 2012-04-25 Vehicle position detection device Expired - Fee Related JP5862437B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2012099848A JP5862437B2 (en) 2012-04-25 2012-04-25 Vehicle position detection device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012099848A JP5862437B2 (en) 2012-04-25 2012-04-25 Vehicle position detection device

Publications (2)

Publication Number Publication Date
JP2013228252A JP2013228252A (en) 2013-11-07
JP5862437B2 true JP5862437B2 (en) 2016-02-16

Family

ID=49676022

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012099848A Expired - Fee Related JP5862437B2 (en) 2012-04-25 2012-04-25 Vehicle position detection device

Country Status (1)

Country Link
JP (1) JP5862437B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110793514B (en) * 2018-08-02 2024-03-01 菜鸟智能物流控股有限公司 Position measuring method and position measuring device

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3572828B2 (en) * 1996-11-06 2004-10-06 松下電器産業株式会社 Navigation device
JP2001324560A (en) * 2000-05-16 2001-11-22 Sony Corp Navigation device and GPS receiver
JP4612675B2 (en) * 2005-03-25 2011-01-12 パイオニア株式会社 Current position calculation device, current position calculation method, current position calculation program, and computer-readable recording medium
JP4650248B2 (en) * 2005-12-09 2011-03-16 株式会社デンソー Vehicle network system and network node
US20110257882A1 (en) * 2010-04-15 2011-10-20 Mcburney Paul W Road map feedback server for tightly coupled gps and dead reckoning vehicle navigation

Also Published As

Publication number Publication date
JP2013228252A (en) 2013-11-07

Similar Documents

Publication Publication Date Title
US9405016B2 (en) System and method for complex navigation using dead reckoning and GPS
JP4780174B2 (en) Angular velocity sensor correction device, angular velocity calculation device, angular velocity sensor correction method, angular velocity calculation method
JP4780168B2 (en) Angular velocity sensor correction apparatus and angular velocity sensor correction method
JP5643334B2 (en) Angular velocity detection device, angular velocity detection method, moving state detection device, and navigation device
US8798925B2 (en) System and method of determining an unambiguous heading direction of a vehicle
JPH10132843A (en) Velocity operating equipment
WO2011065066A1 (en) Navigation system and vehicle-mounted device
EP0844463A1 (en) Vehicle heading calculating apparatus
JP6531768B2 (en) Sensor error correction apparatus and method
JP5686703B2 (en) Moving body turning radius measuring apparatus and method
JP5892845B2 (en) Calibration quality determination apparatus and method
JP5273127B2 (en) Angular velocity sensor correction apparatus and angular velocity sensor correction method
JP5862437B2 (en) Vehicle position detection device
JP5365606B2 (en) Angular velocity sensor correction apparatus and angular velocity sensor correction method
JP2010073028A (en) Traffic information generation system, traffic information generation device, information collection device, and traffic jam degree generation method
KR20160129147A (en) Apparatus and method for calculating location information of vehicle
JP6463551B2 (en) Traveling direction estimation device
JPH07167871A (en) Angular velocity sensor output correction device
JP2014153106A (en) Attitude reference apparatus
JP2006010657A (en) Navigation device
JP2014215271A (en) Positioning device, positioning method and positioning program
JP5446603B2 (en) In-vehicle device and program
JP2007108071A (en) In-vehicle device
JP6372339B2 (en) Angular velocity sensor correction apparatus and angular velocity sensor correction method
JP5183050B2 (en) In-vehicle navigation device and navigation method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20141117

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20150729

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20150804

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20150917

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20151214

R151 Written notification of patent or utility model registration

Ref document number: 5862437

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

LAPS Cancellation because of no payment of annual fees