JP2010038889A - Current location calculation device - Google Patents

Current location calculation device Download PDF

Info

Publication number
JP2010038889A
JP2010038889A JP2008205859A JP2008205859A JP2010038889A JP 2010038889 A JP2010038889 A JP 2010038889A JP 2008205859 A JP2008205859 A JP 2008205859A JP 2008205859 A JP2008205859 A JP 2008205859A JP 2010038889 A JP2010038889 A JP 2010038889A
Authority
JP
Japan
Prior art keywords
vehicle
turning
angle
output
turning angle
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.)
Pending
Application number
JP2008205859A
Other languages
Japanese (ja)
Inventor
Hiroyuki Sato
裕幸 佐藤
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.)
Hitachi Ltd
Faurecia Clarion Electronics Co Ltd
Original Assignee
Clarion Co Ltd
Hitachi 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 Clarion Co Ltd, Hitachi Ltd filed Critical Clarion Co Ltd
Priority to JP2008205859A priority Critical patent/JP2010038889A/en
Publication of JP2010038889A publication Critical patent/JP2010038889A/en
Pending legal-status Critical Current

Links

Images

Abstract

<P>PROBLEM TO BE SOLVED: To provide a current location calculation device capable of calculating a correct current location of a vehicle. <P>SOLUTION: The device is configured to calculate a horizontal direction circulating angular acceleration azc of the vehicle 10 by compensating an output of a gyroscope sensor 11a, whenever fulfilling with a condition in which the vehicle is circulating by a predetermined angle and the condition in which GPS signal can not be received by a GPS sensor 11c. Thereby, the position and the direction (travelling direction) of the vehicle can be calculated accurately, because the output value of the detected signal of the gyroscope sensor 11a can be compensated when the vehicle approaches into parking lot which has spiral slopes. <P>COPYRIGHT: (C)2010,JPO&INPIT

Description

本発明は、現在位置を算出する現在位置算出装置に関する。   The present invention relates to a current position calculation device that calculates a current position.

車両に搭載され、車両の現在位置を算出して周辺地図とともに表示するカーナビゲーション装置が知られている。このカーナビゲーション装置では、自走式立体駐車場を走行して旋回を繰り返したために生じる方位データの累積誤差を、自走式立体駐車場から出場する際に修正している(特許文献1参照)。   2. Description of the Related Art A car navigation device is known that is mounted on a vehicle, calculates the current position of the vehicle, and displays it together with a surrounding map. In this car navigation device, the accumulated error of the azimuth data generated when the self-propelled multistory parking lot travels and repeats turning is corrected when entering the self-propelled multistory parking lot (see Patent Document 1). .

特開2003−14479号公報JP 2003-14479 A

しかし、従来のカーナビゲーション装置では、自走式立体駐車場内を走行している間は、方位データの修正(補正)が行われないため、駐車場内では車両の進行方位を正しく算出できない恐れがあった。   However, in the conventional car navigation device, since the direction data is not corrected (corrected) while traveling in the self-propelled multilevel parking lot, there is a possibility that the traveling direction of the vehicle cannot be calculated correctly in the parking lot. It was.

本発明による現在位置算出装置は、車両の旋回状態を検出する旋回状態検出手段と、旋回状態検出手段の出力に基づいて、車両の旋回角度を算出する旋回角度算出手段と、車両の外部から送信される送信波を受信する受信手段とを備え、旋回角度算出手段は、算出した車両の旋回角度が所定の角度以上であり、かつ、受信手段で送信波を受信できない場合、旋回状態検出手段の出力を補正して車両の旋回角度を算出することを特徴とする。   A current position calculation device according to the present invention includes a turning state detection unit that detects a turning state of a vehicle, a turning angle calculation unit that calculates a turning angle of the vehicle based on an output of the turning state detection unit, and a transmission from the outside of the vehicle. Receiving means for receiving the transmitted wave, and the turning angle calculating means has a turn state detecting means when the calculated turning angle of the vehicle is not less than a predetermined angle and the receiving means cannot receive the transmitted wave. The output angle is corrected to calculate the turning angle of the vehicle.

本発明によれば、車両の位置を正確に算出できる。   According to the present invention, the position of the vehicle can be accurately calculated.

図1〜5を参照して、本発明による現在位置算出装置をカーナビゲーション装置に適用した一実施の形態を説明する。図1は、本実施の形態のカーナビゲーション装置の全体構成を示す図である。カーナビゲーション装置1は、車両位置周辺の道路地図を表示する機能、出発地から目的地までの推奨経路を演算する機能、演算された推奨経路に基づいて経路誘導を行う機能など、車両の走行に関する情報を提示する機能を兼ね備えている。カーナビゲーション装置1は、いわゆるナビゲーションあるいは道路案内などを行う装置である。   With reference to FIGS. 1 to 5, an embodiment in which a current position calculation device according to the present invention is applied to a car navigation device will be described. FIG. 1 is a diagram showing an overall configuration of the car navigation apparatus according to the present embodiment. The car navigation device 1 relates to vehicle travel, such as a function for displaying a road map around a vehicle position, a function for calculating a recommended route from a departure place to a destination, and a function for performing route guidance based on the calculated recommended route. It also has a function to present information. The car navigation device 1 is a device that performs so-called navigation or road guidance.

図1において、11は車両の現在地(現在位置)を検出する現在地検出装置であり、たとえば車両の進行方位の変化(旋回状態)を検出するためのジャイロセンサ11a、GPS(Global Positioning System)衛星からのGPS信号を検出するGPSセンサ11c、車速を検出する車速センサ11d等から成る。12は車両のイグニッションスイッチである。   In FIG. 1, reference numeral 11 denotes a current position detection device that detects the current position (current position) of a vehicle. For example, a gyro sensor 11 a for detecting a change in the traveling direction (turning state) of the vehicle, a GPS (Global Positioning System) satellite. The GPS sensor 11c for detecting the GPS signal, the vehicle speed sensor 11d for detecting the vehicle speed, and the like. Reference numeral 12 denotes an ignition switch for the vehicle.

100は制御装置であり、CPU101およびその周辺回路から成る。CPU101およびその周辺回路は互いにバスで接続されている。周辺回路は、メモリ102、パラレルI/O103、A/D変換器104、シリアルI/O105、カウンタ106、グラフィックコントローラ107、画像メモリ108、地図記憶装置109、インターフェース(I/F)110等から成る。14は車室内の乗員が視認可能な位置に配設されて、地図や各種情報を表示する表示モニタである。15は乗員が車両の目的地等の入力など、各種操作入力を行うためのスイッチである。スイッチ15は、表示モニタ14の画面上に設けられたタッチパネルスイッチや、カーソルの移動や画面のスクロールを指示するジョイスティックなどを含む。スイッチ15は、リモコンスイッチであってもよく、表示画面周辺に設けられたスイッチであってもよい。   Reference numeral 100 denotes a control device, which includes a CPU 101 and its peripheral circuits. The CPU 101 and its peripheral circuits are connected to each other via a bus. The peripheral circuit includes a memory 102, a parallel I / O 103, an A / D converter 104, a serial I / O 105, a counter 106, a graphic controller 107, an image memory 108, a map storage device 109, an interface (I / F) 110, and the like. . Reference numeral 14 denotes a display monitor which is disposed at a position where a passenger in the vehicle can visually recognize and displays a map and various types of information. Reference numeral 15 denotes a switch for an occupant to input various operations such as input of a destination of the vehicle. The switch 15 includes a touch panel switch provided on the screen of the display monitor 14 and a joystick for instructing movement of the cursor or scrolling of the screen. The switch 15 may be a remote control switch or a switch provided around the display screen.

制御装置100のメモリ102は、制御プログラムを格納するROMおよび作業エリアのRAM、および、各種設定値などを記憶する不揮発メモリを含むメモリである。CPU101は、メモリ102にアクセスして制御プログラムを実行し、各種の制御を行う。パラレルI/O103は、スイッチ15を構成する個別のスイッチ等が接続されるパラレルI/Oポートである。A/D変換器104は、ジャイロセンサ11aのアナログ信号をA/D変換する変換器である。シリアルI/O105は、GPSセンサ11cからのシリアル信号を受信するシリアルI/Oポートである。カウンタ106は、たとえば車軸の回転に伴って車速センサ11dから出力されるパルス信号をカウントするカウンタである。   The memory 102 of the control device 100 is a memory including a ROM for storing a control program, a RAM for a work area, and a nonvolatile memory for storing various setting values. The CPU 101 accesses the memory 102, executes a control program, and performs various controls. The parallel I / O 103 is a parallel I / O port to which individual switches constituting the switch 15 are connected. The A / D converter 104 is a converter that performs A / D conversion on the analog signal of the gyro sensor 11a. The serial I / O 105 is a serial I / O port that receives a serial signal from the GPS sensor 11c. The counter 106 is, for example, a counter that counts pulse signals output from the vehicle speed sensor 11d as the axle rotates.

グラフィックコントローラ107は、CPU101から出力される表示データを、画像データとして画像メモリ(ビデオRAM)であるメモリ108に格納し、メモリ108に格納された画像データを表示モニタ14に表示するための制御を行う。CPU101から出力される表示データは、各種の文字データや道路地図などの各種の図形データなどから成る。制御装置100は、表示モニタ14の表示制御装置として機能する。   The graphic controller 107 stores display data output from the CPU 101 as image data in a memory 108 that is an image memory (video RAM), and performs control for displaying the image data stored in the memory 108 on the display monitor 14. Do. The display data output from the CPU 101 includes various character data and various graphic data such as a road map. The control device 100 functions as a display control device for the display monitor 14.

地図記憶装置109は、ナビゲーション処理に使用する道路地図データやPOI情報(Point of Interest 観光地や各種施設の情報)など各種の情報を格納する地図記憶装置であり、ハードディスク装置が用いられている。なお、地図記憶装置109は、ハードディスク装置以外にも、道路地図データが格納されたCD−ROMやDVD、その他の記録媒体、および、その読み出し装置であってもよい。I/F110は、車両のイグニッションスイッチ12のオンオフ状態を表す信号を受信するインターフェースである。   The map storage device 109 is a map storage device that stores various types of information such as road map data and POI information (point of interest sightseeing spots and various facilities information) used for navigation processing, and uses a hard disk device. In addition to the hard disk device, the map storage device 109 may be a CD-ROM or DVD storing road map data, other recording media, and a reading device thereof. The I / F 110 is an interface that receives a signal indicating the on / off state of the ignition switch 12 of the vehicle.

−−−データ構成−−−
道路地図データは、地図に関する情報であり、地図表示用データ、経路探索用データ、誘導データ(交差点名称・道路名称・方面名称・方向ガイド・施設情報など)などから成る。地図表示用データは道路や道路地図の背景を表示するためのデータである。経路探索用データは、道路形状とは直接関係しない分岐情報などから成るデータであり、主に推奨経路を演算(経路探索)する際に用いられる。誘導データは、交差点の名称などから成るデータであり、演算された推奨経路に基づき運転者等に推奨経路を誘導する際に用いられる。
--- Data structure ---
The road map data is information related to the map, and includes map display data, route search data, guidance data (intersection name / road name / direction name / direction guide / facility information, etc.) and the like. The map display data is data for displaying the road and the background of the road map. The route search data is data including branch information that is not directly related to the road shape, and is mainly used when calculating (route search) a recommended route. The guidance data is data including names of intersections and the like, and is used when the recommended route is guided to the driver or the like based on the calculated recommended route.

このように構成されるカーナビゲーション装置1は、現在地検出装置11により取得した情報および地図記憶装置109に格納されている道路地図データに基づいて、車両の現在位置を算出するとともに各種のナビゲーションを行う。たとえば、制御装置100のCPU101は、車両の現在位置近辺の道路地図および車両の現在位置を表示モニタ14に表示し、経路探索によって得られた経路(推奨経路)に沿ってドライバーを誘導するように各部を制御する。CPU101は、現在位置の算出処理を所定周期毎に繰り返して実行し、前回の演算時から今回の演算時までの車両10の移動量を算出し、前回の演算時に算出した現在位置から今回算出した移動量だけ移動させた後の位置を、車両10の現在位置として算出する。なお、CPU101は、公知のマップマッチング処理も行っている。   The car navigation device 1 configured as described above calculates the current position of the vehicle and performs various navigations based on the information acquired by the current location detection device 11 and the road map data stored in the map storage device 109. . For example, the CPU 101 of the control device 100 displays the road map near the current position of the vehicle and the current position of the vehicle on the display monitor 14 so as to guide the driver along the route (recommended route) obtained by the route search. Control each part. The CPU 101 repeatedly executes the current position calculation process every predetermined period, calculates the movement amount of the vehicle 10 from the previous calculation time to the current calculation time, and calculated this time from the current position calculated at the previous calculation time. The position after being moved by the moving amount is calculated as the current position of the vehicle 10. Note that the CPU 101 also performs a known map matching process.

−−−自走式立体駐車場走行時のジャイロセンサ11aの誤差について−−−
たとえば、自走式の地下駐車場や自走式立体駐車場などでは、駐車場入口が設けられた階層(通常1階)から駐車スペースが設けられた他の階層(駐車フロア)に到達するまで、スロープを走行して移動する必要がある。自走式の地下駐車場は、たとえばフランスのパリのように街の景観を重視する都市や、地上に新たな駐車場を設置することが困難な都市などに多く見られる。車両10がスロープを走行する際、車両10がスロープの傾斜角度と略同じ角度に前後方向に傾斜するため、車両10に搭載されたジャイロセンサ11aも車両10とともに傾斜する。一般的に、ジャイロセンサ11aは、設置角度が水平に保たれていないと出力値の誤差が大きくなるため、たとえば、図2に示すような螺旋状に設けられたスロープを走行する場合のように、車両10が傾斜した状態で旋回すると、算出される車両10の旋回角度の誤差も大きくなってしまう。また、図2に示すように地下の駐車場へ向かうためのスロープでは、GPS衛星からのGPS信号が遮られてしまってGPSセンサ11cで受信できないため、GPS信号に基づいて車両10の正確な位置、進行方位を検出できない。
--- About the error of the gyro sensor 11a when traveling on a self-propelled multistory parking lot ---
For example, in a self-propelled underground parking lot or a self-propelled multistory parking lot, from the level (usually the first floor) where the parking lot entrance is provided to the other level (parking floor) where the parking space is provided Need to travel on the slope. Self-propelled underground parking lots are often found in cities such as Paris, France, where importance is placed on the cityscape, and where it is difficult to install new parking lots on the ground. When the vehicle 10 travels on the slope, the vehicle 10 is inclined in the front-rear direction at substantially the same angle as the inclination angle of the slope. Therefore, the gyro sensor 11 a mounted on the vehicle 10 is also inclined together with the vehicle 10. Generally, the gyro sensor 11a has a large output value error unless the installation angle is kept horizontal. For example, the gyro sensor 11a travels on a spiral slope as shown in FIG. If the vehicle 10 turns with the vehicle inclined, an error in the calculated turning angle of the vehicle 10 also increases. Further, as shown in FIG. 2, in the slope for going to the underground parking lot, the GPS signal from the GPS satellite is blocked and cannot be received by the GPS sensor 11c. , The direction of travel cannot be detected.

たとえば、車両10の前後方向の傾斜角度を検出する加速度センサなどをカーナビゲーション装置1に設け、この加速度センサで検出した車両10の前後方向の傾斜角度に基づいて、ジャイロセンサ11aの検出信号の出力値を補正することで、車両10の旋回角度を正しく算出することができる。しかし、加速度センサの設置により、カーナビゲーション装置1の製造コストが高くなってしまう。   For example, an acceleration sensor that detects the tilt angle of the vehicle 10 in the front-rear direction is provided in the car navigation device 1, and the detection signal output from the gyro sensor 11 a is output based on the tilt angle in the front-rear direction of the vehicle 10 detected by the acceleration sensor. By correcting the value, the turning angle of the vehicle 10 can be calculated correctly. However, the production cost of the car navigation device 1 increases due to the installation of the acceleration sensor.

そこで、本実施の形態のカーナビゲーション装置1では、たとえば、螺旋状のスロープを地下に向かって走行していると推定される場合には、次のようにして車両の進行方位を補正する。   Therefore, in the car navigation device 1 according to the present embodiment, for example, when it is estimated that the vehicle is traveling on a spiral slope toward the basement, the traveling direction of the vehicle is corrected as follows.

なお、以下の説明では、図2に示すような螺旋状のスロープが設けられた地下駐車場に進入する場合を例として説明する。CPU101は、算出した自車位置と、道路地図データに含まれる駐車場の設置位置と、ジャイロセンサ11aからの出力に基づいて、車両10が道路から外れたか否かを判断する。たとえば、CPU101は、道路地図データに含まれる道路に関する情報やジャイロセンサ11aからの出力などに基づいて、車両10が道路の延在方向とは異なる方向を向いたことを検出する(この条件を条件(a)とする)と、さらに、たとえば以下の条件(b)〜(d)を満足するか否かを判断する。
(b) 車速が所定の速度(たとえば30km/hr)以下である
(c) 車両が所定の角度(たとえば360度)以上旋回した
(d) GPSセンサ11cでGPS信号を受信できない
In the following description, a case where the vehicle enters an underground parking lot provided with a spiral slope as shown in FIG. 2 will be described as an example. The CPU 101 determines whether or not the vehicle 10 is off the road based on the calculated own vehicle position, the parking lot installation position included in the road map data, and the output from the gyro sensor 11a. For example, the CPU 101 detects that the vehicle 10 is directed in a direction different from the extending direction of the road based on information about the road included in the road map data, an output from the gyro sensor 11a, and the like (this condition is a condition. Further, for example, it is determined whether or not the following conditions (b) to (d) are satisfied.
(B) The vehicle speed is equal to or lower than a predetermined speed (for example, 30 km / hr) (c) The vehicle turns more than a predetermined angle (for example, 360 degrees) (d) GPS signal cannot be received by the GPS sensor 11c

すなわち、上述した各条件(a)〜(d)を満たすことで、車両10が螺旋状のスロープが設けられた地下駐車場に進入するものと推定する。一般的に、地下駐車場のスロープの傾斜角度はたとえば5度程度とされていることが多い。そこで、本実施の形態のカーナビゲーション装置1では、上述した各条件を満たすことで、車両10が車両10の前側が下になるように所定角度θ1(たとえば5度)だけ傾斜したものとして、すなわち、ジャイロセンサ11aが車両10の前側が下になるように所定角度θ1だけ傾斜したものとして、ジャイロセンサ11aの出力を補正(下り勾配補正)する。   That is, it is estimated that the vehicle 10 enters the underground parking lot provided with the spiral slope by satisfying the above-described conditions (a) to (d). In general, the slope of the slope of the underground parking lot is often set to about 5 degrees, for example. Therefore, in the car navigation device 1 according to the present embodiment, the vehicle 10 is inclined by a predetermined angle θ1 (for example, 5 degrees) so that the front side of the vehicle 10 is down by satisfying the above-described conditions. Assuming that the gyro sensor 11a is inclined by the predetermined angle θ1 so that the front side of the vehicle 10 is down, the output of the gyro sensor 11a is corrected (down slope correction).

ジャイロセンサ11aからは、ジャイロセンサ11aに与えられた角加速度の大きさに応じた電圧が出力される。たとえば、ジャイロセンサ11aが図3に示すようにZ軸を回転中心とする角加速度を検出するセンサであるものとする。ここで、ジャイロセンサ11aの傾きが0度、すなわち、ジャイロセンサ11aの図3におけるZ軸が鉛直方向上側を向いている場合に、ジャイロセンサ11aから出力される電圧の大きさで表される角加速度(ジャイロ出力角加速度)をazjする。また、図4(a)に示すように、カーナビゲーション装置1が車両10に搭載された状態で、車両10が水平な路面に置かれているときのジャイロセンサ11aのZ軸と鉛直方向との角度差、すなわち、車両10に対するジャイロセンサ11aの取付角度をθoffとする。図4(b)に示すように、車両10の進行方向に対して道路が水平面から傾斜する角度をθrとすると、車両10の水平方向の旋回角加速度azcは、次の(1)式で表される。
azc = azj×(cos(θr+θoff)) ・・・(1)
ここで、θrおよびθoffについては、図4における図示反時計方向に(車両10の前側が下になるように)傾斜したときに正の値となるものとする。
The gyro sensor 11a outputs a voltage corresponding to the magnitude of angular acceleration given to the gyro sensor 11a. For example, it is assumed that the gyro sensor 11a is a sensor that detects angular acceleration with the Z axis as the rotation center as shown in FIG. Here, when the inclination of the gyro sensor 11a is 0 degree, that is, when the Z axis of the gyro sensor 11a in FIG. 3 is directed upward in the vertical direction, an angle represented by the magnitude of the voltage output from the gyro sensor 11a. Accelerate the acceleration (gyro output angular acceleration). Further, as shown in FIG. 4A, the Z axis of the gyro sensor 11a and the vertical direction when the vehicle 10 is placed on a horizontal road surface with the car navigation device 1 mounted on the vehicle 10 An angle difference, that is, an attachment angle of the gyro sensor 11a with respect to the vehicle 10 is defined as θoff. As shown in FIG. 4B, when the angle at which the road is inclined from the horizontal plane with respect to the traveling direction of the vehicle 10 is θr, the turning angular acceleration azc in the horizontal direction of the vehicle 10 is expressed by the following equation (1). Is done.
azc = azj × (cos (θr + θoff)) (1)
Here, θr and θoff assume positive values when tilted counterclockwise in FIG. 4 (so that the front side of the vehicle 10 is down).

すなわち、本実施の形態のカーナビゲーション装置1では、CPU101は、上述した各条件(a)〜(d)を満たすと、(1)式におけるθrを所定角度θ1として(θoffにθ1を加算して)、ジャイロセンサ11aの出力を下り勾配補正することで車両10の水平方向の旋回角加速度azcを算出する。そして、算出した旋回角加速度azcを時間積分することで、前回の演算時から今回の演算時までの間の車両10の水平方向の旋回角度θcを算出する。そして、CPU101は、このように算出した車両10の水平方向の旋回角度θcや、車速センサ11dの出力に基づいて算出される車両10の走行距離、前回の演算時における車両10の現在位置および車両10の向きなどから、今回の演算時における車両10の現在位置および車両10の向きを算出する。CPU101は、車両10の現在の位置および車両10の向きを算出すると、車両10の現在位置を示すマーク(カーマーク)を道路地図とともに表示モニタ14に表示する。   That is, in the car navigation device 1 of the present embodiment, the CPU 101 satisfies the above-described conditions (a) to (d), sets θr in the equation (1) to a predetermined angle θ1 (adds θ1 to θoff) ), The turning angular acceleration azc in the horizontal direction of the vehicle 10 is calculated by correcting the output of the gyro sensor 11a with a downward gradient. Then, by integrating the calculated turning angular acceleration azc with time, the turning angle θc in the horizontal direction of the vehicle 10 from the previous calculation time to the current calculation time is calculated. Then, the CPU 101 calculates the turning angle θc in the horizontal direction of the vehicle 10 calculated in this way, the travel distance of the vehicle 10 calculated based on the output of the vehicle speed sensor 11d, the current position of the vehicle 10 at the time of the previous calculation, and the vehicle The current position of the vehicle 10 and the direction of the vehicle 10 at the time of the current calculation are calculated from the direction of 10 and the like. After calculating the current position of the vehicle 10 and the direction of the vehicle 10, the CPU 101 displays a mark (car mark) indicating the current position of the vehicle 10 on the display monitor 14 together with the road map.

なお、CPU101は、イグニッションスイッチ12がオンされた後に、上述した各条件(a)〜(d)を初めて満たしたときには、車両10が旋回を開始したと判断される時点に遡ってジャイロセンサ11aの出力を下り勾配補正したものとして車両10の水平方向の旋回角度θcを算出する。そして、フラグ(下り勾配フラグ)に1をセットする。下り勾配フラグは、前回の演算時に車両10の旋回開始時点まで遡った下り勾配補正がすでに行われているか否かを表すフラグである。   Note that, when the conditions (a) to (d) described above are satisfied for the first time after the ignition switch 12 is turned on, the CPU 101 goes back to the time when it is determined that the vehicle 10 has started turning. The horizontal turning angle θc of the vehicle 10 is calculated with the output corrected for downward gradient. Then, 1 is set in the flag (downhill gradient flag). The downward gradient flag is a flag that indicates whether or not downward gradient correction that has been traced back to the turning start time of the vehicle 10 at the time of the previous calculation has already been performed.

車両10が旋回を中止したと判断される場合には、CPU101は、上述した下り勾配補正を中止する。すなわち、(1)式におけるθrを0度として、車両10の水平方向の旋回角加速度azc、および車両10の水平方向の旋回角度θcを算出する。また、車両10が旋回を中止したと判断される場合には、CPU101は、下り勾配フラグに0をセットする。   When it is determined that the vehicle 10 has stopped turning, the CPU 101 stops the downward gradient correction described above. That is, θr in equation (1) is set to 0 degree, and the turning angular acceleration azc in the horizontal direction of the vehicle 10 and the turning angle θc in the horizontal direction of the vehicle 10 are calculated. In addition, when it is determined that the vehicle 10 has stopped turning, the CPU 101 sets 0 to the downward gradient flag.

車両10が地下駐車場から地上の道路に戻る際には、逆に螺旋状のスロープを上っていかなければならないが、この場合にも、ジャイロセンサ11aの出力を補正する必要がある。そこで本実施の形態のカーナビゲーション装置1では、たとえば以下の条件(e)〜(g)を満足すると、上述の場合とは逆に、車両10が螺旋状のスロープが設けられた地下駐車場から出場しようとしているものと推定する。そして、ジャイロセンサ11aが車両10の前側が上になるように所定角度θ1だけ傾斜したものとして、ジャイロセンサ11aの出力を補正(上り勾配補正)する。
(e) 車両10のイグニッションスイッチ12がオンされた
(f) その後、上述した条件(b)〜(d)を満たした
(g) 前回イグニッションスイッチ12がオンされていたときに(イグニッションスイッチ12がオフされる前に)、下り勾配補正を行っており、その後、車両10が直進していた
When the vehicle 10 returns from the underground parking lot to the ground road, it is necessary to go up the spiral slope, but in this case as well, it is necessary to correct the output of the gyro sensor 11a. Therefore, in the car navigation device 1 of the present embodiment, for example, when the following conditions (e) to (g) are satisfied, the vehicle 10 is reversed from the underground parking lot provided with the spiral slope, contrary to the above case. Presume that you are going to participate. Then, assuming that the gyro sensor 11a is inclined by the predetermined angle θ1 so that the front side of the vehicle 10 is on the upper side, the output of the gyro sensor 11a is corrected (uphill correction).
(E) The ignition switch 12 of the vehicle 10 is turned on (f) After that, the conditions (b) to (d) described above are satisfied (g) When the ignition switch 12 was previously turned on (the ignition switch 12 is Before turning off), the slope was corrected, and then the vehicle 10 was going straight

すなわち、上述した各条件(e)〜(g)を満たす場合、CPU101は、(1)式におけるθoffからθ1を減算して、ジャイロセンサ11aの出力を上り勾配補正することで車両10の水平方向の旋回角加速度azcを算出する。そして、算出した旋回角加速度azcを時間積分することで、車両10の水平方向の旋回角度θcを算出する。そして、CPU101は、このように算出した車両10の水平方向の旋回角度θcや、車速センサ11dの出力に基づいて算出される車両10の走行距離、前回の演算時における車両10の現在位置および車両10の向きなどから、今回の演算時における車両10の現在の位置および車両10の向きを算出する。CPU101は、車両10の現在の位置および車両10の向きを算出すると、車両10の現在位置を示すマーク(カーマーク)を道路地図とともに表示モニタ14に表示する。   That is, when the above-described conditions (e) to (g) are satisfied, the CPU 101 subtracts θ1 from θoff in the equation (1) and corrects the output of the gyro sensor 11a in the horizontal direction by correcting the upward gradient. The turning angular acceleration azc is calculated. Then, the turning angle θc in the horizontal direction of the vehicle 10 is calculated by time integration of the calculated turning angular acceleration azc. Then, the CPU 101 calculates the turning angle θc in the horizontal direction of the vehicle 10 calculated in this way, the travel distance of the vehicle 10 calculated based on the output of the vehicle speed sensor 11d, the current position of the vehicle 10 at the time of the previous calculation, and the vehicle The current position of the vehicle 10 and the direction of the vehicle 10 at the time of the current calculation are calculated from the direction of the ten. After calculating the current position of the vehicle 10 and the direction of the vehicle 10, the CPU 101 displays a mark (car mark) indicating the current position of the vehicle 10 on the display monitor 14 together with the road map.

なお、CPU101は、イグニッションスイッチ12がオンされた後に、上述した各条件(e)〜(g)を初めて満たしたときには、車両10が旋回を開始したと判断される時点に遡ってジャイロセンサ11aの出力を上り勾配補正したものとして車両10の水平方向の旋回角度θcを算出する。そして、フラグ(上り勾配フラグ)に1をセットする。上り勾配フラグは、前回の演算時に車両10の旋回開始時点まで遡った上り勾配補正がすでに行われているか否かを表すフラグである。   It should be noted that when the CPU 101 satisfies the above-described conditions (e) to (g) for the first time after the ignition switch 12 is turned on, the CPU 101 goes back to the time when the vehicle 10 is determined to start turning. The horizontal turning angle θc of the vehicle 10 is calculated with the output corrected ascending. Then, 1 is set in the flag (uphill gradient flag). The upslope flag is a flag that indicates whether or not the upslope correction that has been traced back to the turning start time of the vehicle 10 at the time of the previous calculation has already been performed.

車両10が旋回を中止したと判断される場合には、CPU101は、上述した上り勾配補正を中止する。すなわち、(1)式におけるθrを0度として、車両10の水平方向の旋回角加速度azc、および車両10の水平方向の旋回角度θcを算出する。また、車両10が旋回を中止したと判断される場合には、CPU101は、上り勾配フラグに0をセットする。なお、GPSセンサ11cでGPS信号を受信できたと判断される場合には、車両10が地上に出場したものとして、CPU101が上述した上り勾配補正を中止するようにしてもよい。   When it is determined that the vehicle 10 has stopped turning, the CPU 101 stops the upward gradient correction described above. That is, θr in equation (1) is set to 0 degree, and the turning angular acceleration azc in the horizontal direction of the vehicle 10 and the turning angle θc in the horizontal direction of the vehicle 10 are calculated. In addition, when it is determined that the vehicle 10 has stopped turning, the CPU 101 sets 0 to the ascending gradient flag. When it is determined that the GPS signal can be received by the GPS sensor 11c, the CPU 101 may stop the above-described upward gradient correction, assuming that the vehicle 10 has entered the ground.

−−−フローチャート−−−
図5は、車両10の現在位置を算出して表示モニタ14上に表示する処理の動作を示したフローチャートである。車両の不図示のイグニッションキーにより不図示のアクセサリスイッチがオン(ACC ON)されると、カーナビゲーション装置1の電源がオンされて、図5に示す処理を行うプログラムが起動されてCPU101で実行される。ステップS1において、下り勾配フラグおよび上り勾配フラグに0をセットしてステップS2へ進む。ステップS2において、現在地検出装置11からの各情報や、道路地図データなどを読み込んでステップS3へ進む。ステップS3において、下り勾配フラグに1がセットされているか否かを判断する。なお、アクセサリスイッチがオンされた後の初回の演算時には、下り勾配フラグに0がセットされているので、ステップS3は否定判断される。
--- Flow chart ---
FIG. 5 is a flowchart showing the operation of the process of calculating the current position of the vehicle 10 and displaying it on the display monitor 14. When an accessory switch (not shown) is turned on (ACC ON) by an ignition key (not shown) of the vehicle, the power of the car navigation device 1 is turned on, and a program for performing the processing shown in FIG. The In step S1, 0 is set in the downward gradient flag and the upward gradient flag, and the process proceeds to step S2. In step S2, each information from the current location detection device 11, road map data, and the like are read, and the process proceeds to step S3. In step S3, it is determined whether or not 1 is set in the downward gradient flag. At the time of the first calculation after the accessory switch is turned on, 0 is set in the downward gradient flag, so a negative determination is made in step S3.

ステップS3が否定判断されるとステップS5へ進み、上り勾配フラグに1がセットされているか否かを判断する。なお、アクセサリスイッチがオンされた後の初回の演算時には、上り勾配フラグに0がセットされているので、ステップS5は否定判断される。ステップS5が否定判断されるとステップS7へ進み、ステップS2で読み込んだ現在地検出装置11からの各情報に基づいて車両10の現在位置を算出する。なお、ステップS7における車両10の現在位置算出処理は、従来の現在位置算出処理と同様であり公知であるため、説明を省略する。   If a negative determination is made in step S3, the process proceeds to step S5, and it is determined whether or not 1 is set in the upslope flag. At the time of the first calculation after the accessory switch is turned on, 0 is set in the upslope flag, so a negative determination is made in step S5. If a negative determination is made in step S5, the process proceeds to step S7, and the current position of the vehicle 10 is calculated based on each information from the current position detection device 11 read in step S2. Note that the current position calculation process of the vehicle 10 in step S7 is similar to the conventional current position calculation process and is well known, and thus the description thereof is omitted.

ステップS9において、上り勾配補正が必要か否かを判断する。すなわち、ステップS9において、上述した各条件(e)〜(g)を満たすか否かを判断する。ステップS9が否定判断されるとステップS11へ進み、下り勾配補正が必要か否かを判断する。すなわち、ステップS11において、上述した各条件(a)〜(d)を満たすか否かを判断する。ステップS11が否定判断されるとステップS13へ進み、算出された車両10の現在位置に基づいて、表示モニタ14に表示された地図上に車両10の現在位置を示すカーマークを重畳表示するよう各部を制御してステップS15へ進む。ステップS15において、イグニッションスイッチ12がオフされたか否かを判断する。ステップS15が肯定判断されると、本プログラムを終了する。ステップS15が否定判断されると、ステップS2へ戻る。   In step S9, it is determined whether upward gradient correction is necessary. That is, in step S9, it is determined whether or not the above-described conditions (e) to (g) are satisfied. If a negative determination is made in step S9, the process proceeds to step S11, and it is determined whether or not a downward gradient correction is necessary. That is, in step S11, it is determined whether or not the above-described conditions (a) to (d) are satisfied. If a negative determination is made in step S11, the process proceeds to step S13, and each part is displayed so as to superimpose a car mark indicating the current position of the vehicle 10 on the map displayed on the display monitor 14 based on the calculated current position of the vehicle 10. The process proceeds to step S15. In step S15, it is determined whether or not the ignition switch 12 is turned off. If a positive determination is made in step S15, the program ends. If a negative determination is made in step S15, the process returns to step S2.

ステップS11が肯定判断されると、ステップS21へ進み、車両10が旋回を開始したと判断される時点に遡ってジャイロセンサ11aの出力を下り勾配補正したものとして車両10の水平方向の旋回角度θcを算出してステップS23へ進む。ステップS23において、下り勾配フラグに1をセットしてステップS25へ進む。ステップS25において、補正後の旋回角度θcを用いて車両10の現在位置を算出してステップS13へ進む。   If the determination in step S11 is affirmative, the process proceeds to step S21, and the turning angle θc in the horizontal direction of the vehicle 10 is assumed to be obtained by correcting the downward gradient of the output of the gyro sensor 11a retroactively to the time point when the vehicle 10 is determined to start turning. Is calculated and the process proceeds to step S23. In step S23, the downward gradient flag is set to 1, and the process proceeds to step S25. In step S25, the current position of the vehicle 10 is calculated using the corrected turning angle θc, and the process proceeds to step S13.

ステップS9が肯定判断されると、ステップS41へ進み、車両10が旋回を開始したと判断される時点に遡ってジャイロセンサ11aの出力を上り勾配補正したものとして車両10の水平方向の旋回角度θcを算出してステップS43へ進む。ステップS43において、上り勾配フラグに1をセットしてステップS25へ進む。   If an affirmative determination is made in step S9, the process proceeds to step S41 and the turning angle θc in the horizontal direction of the vehicle 10 is assumed to be obtained by correcting the upward gradient of the output of the gyro sensor 11a retroactively to the time point when the vehicle 10 is determined to start turning. Is calculated and the process proceeds to step S43. In step S43, 1 is set in the upslope flag, and the process proceeds to step S25.

ステップS5が肯定判断されると、ステップS51へ進み、上り勾配補正の継続が必要であるか否かを判断する。ステップS51では、車両10が旋回を中止したと判断される場合には上り勾配補正の継続が必要でないと判断され、車両10が旋回を継続していると判断される場合には上り勾配補正の継続が必要であると判断される。ステップS51が肯定判断されるとステップS53へ進み、前回の演算時から今回の演算時までの間の旋回角度θcの算出に関して上り勾配補正を行ってステップS39へ進む。ステップS39において、算出された旋回角度θcを用いて車両10の現在位置を算出してステップS13へ進む。   If an affirmative determination is made in step S5, the process proceeds to step S51, and it is determined whether it is necessary to continue ascending slope correction. In step S51, when it is determined that the vehicle 10 has stopped turning, it is determined that continuation of the upward gradient correction is not necessary, and when it is determined that the vehicle 10 continues to turn, the upward gradient correction is performed. It is determined that continuation is necessary. If an affirmative determination is made in step S51, the process proceeds to step S53, and ascending slope correction is performed for the calculation of the turning angle θc between the previous calculation and the current calculation, and the process proceeds to step S39. In step S39, the current position of the vehicle 10 is calculated using the calculated turning angle θc, and the process proceeds to step S13.

ステップS51が否定判断されるとステップS55へ進み、上り勾配補正を行わずに前回の演算時から今回の演算時までの間の旋回角度θcを算出してステップS57へ進む。ステップS57において、上り勾配フラグに0をセットして、ステップS39へ進む。   If a negative determination is made in step S51, the process proceeds to step S55, the turning angle θc from the previous calculation time to the current calculation time is calculated without performing upward gradient correction, and the process proceeds to step S57. In step S57, 0 is set in the upward gradient flag, and the process proceeds to step S39.

ステップS3が肯定判断されると、ステップS31へ進み、下り勾配補正の継続が必要であるか否かを判断する。ステップS31では、車両10が旋回を中止したと判断される場合には下り勾配補正の継続が必要でないと判断され、車両10が旋回を継続していると判断される場合には下り勾配補正の継続が必要であると判断される。ステップS31が肯定判断されるとステップS33へ進み、前回の演算時から今回の演算時までの間の旋回角度θcの算出に関して下り勾配補正を行ってステップS39へ進む。   If an affirmative determination is made in step S3, the process proceeds to step S31 to determine whether or not it is necessary to continue the downward gradient correction. In step S31, when it is determined that the vehicle 10 has stopped turning, it is determined that continuation of the downward gradient correction is not necessary, and when it is determined that the vehicle 10 continues to turn, the downward gradient correction is performed. It is determined that continuation is necessary. If an affirmative determination is made in step S31, the process proceeds to step S33, and a downward gradient correction is performed for the calculation of the turning angle θc between the previous calculation and the current calculation, and the process proceeds to step S39.

ステップS31が否定判断されるとステップS35へ進み、下り勾配補正を行わずに前回の演算時から今回の演算時までの間の旋回角度θcを算出してステップS37へ進む。ステップS37において、下り勾配フラグに0をセットして、ステップS39へ進む。   If a negative determination is made in step S31, the process proceeds to step S35, and the turning angle θc between the previous calculation and the current calculation is calculated without performing downward gradient correction, and the process proceeds to step S37. In step S37, the downward gradient flag is set to 0, and the process proceeds to step S39.

上述したカーナビゲーション装置1では次の作用効果を奏する。
(1) 上述した各条件を満たすと、ジャイロセンサ11aの出力を補正するように構成した。これにより、螺旋状のスロープを有する駐車場などに進入した際に、ジャイロセンサ11aの出力を補正できるので、車両の位置や向き(進行方位)を正確に算出できる。また、車両10の前後方向の傾斜角度を検出する加速度センサなどをカーナビゲーション装置1に設けなくてもよいので、カーナビゲーション装置1の製造コストを低減できる。さらに、駐車場を出場(出庫)する際の車両10の現在位置、進行方位が正しく算出されることで、出庫後の経路誘導を的確に実施できる。
The car navigation device 1 described above has the following operational effects.
(1) When the above-described conditions are satisfied, the output of the gyro sensor 11a is corrected. Thus, when the vehicle enters a parking lot having a spiral slope, the output of the gyro sensor 11a can be corrected, so that the position and orientation (traveling direction) of the vehicle can be accurately calculated. Moreover, since it is not necessary to provide the car navigation apparatus 1 with an acceleration sensor or the like that detects the tilt angle of the vehicle 10 in the front-rear direction, the manufacturing cost of the car navigation apparatus 1 can be reduced. Furthermore, the route guidance after leaving the vehicle can be accurately performed by correctly calculating the current position and the traveling direction of the vehicle 10 when the parking lot appears (leaves).

(2) 上述した各条件(a)〜(d)を満たすことで、車両10が螺旋状のスロープが設けられた地下駐車場に進入するものと推定し、ジャイロセンサ11aが車両10の前側が下になるように所定角度θ1だけ傾斜したものとして、ジャイロセンサ11aの出力を補正するように構成した。これにより、車両10の前後方向の傾斜角度を検出する加速度センサなどをカーナビゲーション装置1に設けなくても、螺旋状のスロープを有する地下駐車場に進入した際の車両の位置や進行方位を正確に算出できる。したがって、特に、螺旋状のスロープを有する地下駐車場が多く設けられている地域で用いられるカーナビゲーション装置1で上述した効果が高い。 (2) By satisfying the above-described conditions (a) to (d), it is estimated that the vehicle 10 enters an underground parking lot provided with a spiral slope, and the gyro sensor 11a is It is configured to correct the output of the gyro sensor 11a assuming that it is inclined by a predetermined angle θ1 so as to be downward. This makes it possible to accurately determine the position and traveling direction of the vehicle when entering the underground parking lot having a spiral slope without providing an acceleration sensor or the like for detecting the tilt angle in the front-rear direction of the vehicle 10 in the car navigation device 1. Can be calculated. Therefore, the above-described effect is particularly high in the car navigation device 1 used in an area where many underground parking lots having a spiral slope are provided.

(3) 上述した各条件(a)〜(d)を満たすことで、車両10が旋回を開始したと判断される時点に遡ってジャイロセンサ11aの出力を下り勾配補正したものとして車両10の水平方向の旋回角度θcを算出するように構成した。これにより、螺旋状のスロープを有する地下駐車場に進入した際の車両の位置や進行方位の算出精度をより一層向上できる。 (3) By satisfying the above-described conditions (a) to (d), it is assumed that the output of the gyro sensor 11a has been subjected to the downward gradient correction from the time point when it is determined that the vehicle 10 has started to turn. The turning angle θc in the direction is calculated. Thereby, the calculation accuracy of the position and traveling direction of the vehicle when entering an underground parking lot having a spiral slope can be further improved.

(4) 上述した各条件(e)〜(g)を満たすことで、車両10が螺旋状のスロープが設けられた地下駐車場から出場しようとしているものと推定して、ジャイロセンサ11aが車両10の前側が上になるように所定角度θ1だけ傾斜したものとして、ジャイロセンサ11aの出力を補正するように構成した。これにより、螺旋状のスロープを有する地下駐車場から出庫する際にも車両の位置や進行方位を正確に算出できる。 (4) By satisfying the above-described conditions (e) to (g), it is estimated that the vehicle 10 is going to enter the underground parking lot provided with the spiral slope, and the gyro sensor 11a is The output of the gyro sensor 11a is corrected on the assumption that it is inclined by a predetermined angle θ1 so that the front side of the gyro sensor is on the upper side. Thereby, even when leaving from an underground parking lot having a spiral slope, the position and traveling direction of the vehicle can be accurately calculated.

(5) 上述した各条件(e)〜(g)を満たすことで、車両10が旋回を開始したと判断される時点に遡ってジャイロセンサ11aの出力を上り勾配補正したものとして車両10の水平方向の旋回角度θcを算出するように構成した。これにより、螺旋状のスロープを有する地下駐車場から出庫する際の車両の位置や進行方位の算出精度をより一層向上できる。 (5) By satisfying the above-described conditions (e) to (g), it is assumed that the output of the gyro sensor 11a has been corrected for the upward gradient retroactively to the time point when the vehicle 10 is determined to start turning. The turning angle θc in the direction is calculated. Thereby, the calculation accuracy of the position and traveling direction of the vehicle when leaving from an underground parking lot having a spiral slope can be further improved.

−−−変形例−−−
(1) 上述の説明では、条件(a)〜(d)を満たしたときに下り勾配補正を行い、条件(e)〜(g)を満たしたときに上り勾配補正を行うように構成したが、本発明はこれに限定されない。たとえば、上述した条件(a)〜(d)のうち、少なくとも条件(c),(d)が満たされれば、下り勾配補正をするように構成してもよい。また、上述した条件(e)〜(g)のうち、少なくとも条件(e),(g)および条件(c)が満たされれば、上り勾配補正をするように構成してもよい。
---- Modified example ---
(1) In the above description, the configuration is such that the downward gradient correction is performed when the conditions (a) to (d) are satisfied, and the upward gradient correction is performed when the conditions (e) to (g) are satisfied. However, the present invention is not limited to this. For example, you may comprise so that downward gradient correction | amendment may be performed, if at least conditions (c) and (d) are satisfy | filled among conditions (a)-(d) mentioned above. Moreover, you may comprise so that an upslope correction may be performed if conditions (e), (g) and conditions (c) are satisfy | filled among conditions (e)-(g) mentioned above.

(2) 上述の説明では、車両10が地下の駐車場を利用する際のカーナビゲーション装置1の動作について説明したが、地上に設けられた上層階へ向かう螺旋状のスロープに進入する場合であっても、本発明を適用できる。また、上述の説明では、図2におけるスロープが、平面図で表すと略円形となるようなスロープであったが、本発明はこれに限定されない。たとえば、平面図で表すと略方形となるようなスロープであってもよく、運動場のトラックのように半円と直線とを組み合わせた形状となるようなスロープなどであってもよい。 (2) In the above description, the operation of the car navigation device 1 when the vehicle 10 uses an underground parking lot has been described. However, this is a case where the vehicle 10 enters a spiral slope toward the upper floor provided on the ground. However, the present invention can be applied. In the above description, the slope in FIG. 2 is a slope that is substantially circular when represented in plan view, but the present invention is not limited to this. For example, the slope may be a substantially square when represented by a plan view, or may be a slope that is a combination of a semicircle and a straight line, such as a track in a sports field.

(3) 上述の説明では、条件(a)〜(d)を満たしたときに下り勾配補正を行い、条件(e)〜(g)を満たしたときに上り勾配補正を行うように構成したが、本発明はこれに限定されない。たとえば、道路地図データに駐車場が地下に設けられた立体駐車場であるのか、地上に設けられた立体駐車場であるのかを示す情報があるのであれば、この情報を利用して、駐車場へ入場または出場する際に下り勾配補正を行うのか上り勾配補正を行うのかを決定するようにしてもよい。 (3) In the above description, the configuration is such that the downward gradient correction is performed when the conditions (a) to (d) are satisfied, and the upward gradient correction is performed when the conditions (e) to (g) are satisfied. However, the present invention is not limited to this. For example, if the road map data includes information indicating whether the parking lot is a multilevel parking lot located underground or a multilevel parking lot provided on the ground, this information can be used to When entering or exiting, it may be determined whether to perform downward gradient correction or upward gradient correction.

(4) 上述の説明では、螺旋状のスロープが設けられた駐車場へ入場または出場する場合について説明したが、本発明は、これに限定されない。たとえば、駐車場のスロープ以外にも、ループ状の通路を走行する場合にも本発明を適用できる。なお、ループ状の通路であれば、一般道路や高速道路などの道路であってもよく、建物や施設内の通路であってもよい。また、車両10を上方から見たときに車両10が略同一の軌跡を描くような螺旋状のスロープ、道路に限らず、つづら折りの傾斜路(山岳路)を走行する場合であっても本発明を適用できる。この場合には、たとえば、傾斜路に対する車両の進行方向から下り勾配補正を行うのか上り勾配補正を行うのかを決定してもよい。また、道路地図データに当該傾斜路の標高の情報があれば、その標高のデータから傾斜路の傾斜角度を算出し、上述した(1)式におけるθrを標高のデータから算出した傾斜角度として、ジャイロセンサ11aの出力を補正するようにしてもよい。 (4) In the above description, the case of entering or exiting a parking lot provided with a spiral slope has been described, but the present invention is not limited to this. For example, the present invention can be applied to a case where the vehicle travels in a loop path other than the slope of the parking lot. In addition, if it is a loop-shaped passage, it may be a road such as a general road or an expressway, or may be a passage in a building or facility. Further, the present invention is not limited to a spiral slope or road in which the vehicle 10 draws substantially the same trajectory when viewed from above, but also when the vehicle 10 travels on a sloping road (mountain road). Can be applied. In this case, for example, it may be determined whether to perform the downward gradient correction or the upward gradient correction from the traveling direction of the vehicle with respect to the slope. In addition, if the road map data includes elevation information of the slope, the slope angle of the slope is calculated from the elevation data, and θr in the above-described equation (1) is calculated as the slope angle calculated from the elevation data. The output of the gyro sensor 11a may be corrected.

(5) 上述の説明では、各条件(e)〜(g)を満たすとジャイロセンサ11aの出力を上り勾配補正するように構成したが、本発明はこれに限定されない。たとえば、車両10の走行中にGPSセンサ11cでGPS信号を受信したら、車両が地上に向かっているものとして、上述した上り勾配補正を行うように構成してもよい。このとき、車両10の旋回開始時点に遡って補正を行えば、車両10が地上に出てきたときには車両10の現在位置、進行方位が正しく算出されることになるので、出庫後の経路誘導を的確に実施できる。 (5) In the above description, when the conditions (e) to (g) are satisfied, the output of the gyro sensor 11a is corrected for upward gradient, but the present invention is not limited to this. For example, when the GPS signal is received by the GPS sensor 11c while the vehicle 10 is traveling, the above-described upward gradient correction may be performed on the assumption that the vehicle is moving toward the ground. At this time, if correction is performed retroactively to the turning start time of the vehicle 10, the current position and traveling direction of the vehicle 10 are correctly calculated when the vehicle 10 comes out on the ground. Can be implemented accurately.

(6) 上述の説明では、ジャイロセンサ11aの出力を補正するか否かを決定するための条件の1つとして、GPSセンサ11cによるGPS信号の受信の有無を挙げているが、本発明はこれに限定されない。車両10が、GPS信号を受信できないような場所(たとえば地下)に進入したか否かを検出できるのであれば、GPS信号の受信の有無の代わりに、または、GPS信号の受信の有無とともに、たとえば、テレビやラジオなどの放送波のような、車両10の外部から送信される送信波の受信の有無をジャイロセンサ11aの出力を補正するか否かを決定するための条件としてもよい。
(7) 上述した各実施の形態および変形例は、それぞれ組み合わせてもよい。
(6) In the above description, as one of the conditions for determining whether or not to correct the output of the gyro sensor 11a, the presence or absence of reception of a GPS signal by the GPS sensor 11c is cited. It is not limited to. If it is possible to detect whether or not the vehicle 10 has entered a place where the GPS signal cannot be received (for example, underground), instead of the presence or absence of the reception of the GPS signal, The presence or absence of a transmission wave transmitted from the outside of the vehicle 10, such as a broadcast wave of a television or radio, may be used as a condition for determining whether to correct the output of the gyro sensor 11a.
(7) You may combine each embodiment and modification which were mentioned above, respectively.

なお、本発明は、上述した実施の形態のものに何ら限定されず、車両の旋回状態を検出する旋回状態検出手段と、旋回状態検出手段の出力に基づいて、車両の旋回角度を算出する旋回角度算出手段と、車両の外部から送信される送信波を受信する受信手段とを備え、旋回角度算出手段は、算出した車両の旋回角度が所定の角度以上であり、かつ、受信手段で送信波を受信できない場合、旋回状態検出手段の出力を補正して車両の旋回角度を算出することを特徴とする各種構造の現在位置算出装置を含むものである。   Note that the present invention is not limited to the above-described embodiment, and a turning state detection unit that detects the turning state of the vehicle and a turn that calculates the turning angle of the vehicle based on the output of the turning state detection unit. An angle calculating means and a receiving means for receiving a transmission wave transmitted from the outside of the vehicle, wherein the turning angle calculating means has a calculated turning angle of the vehicle equal to or greater than a predetermined angle, and the receiving means transmits the transmitted wave. In this case, the present invention includes a current position calculation device of various structures, wherein the vehicle turning angle is calculated by correcting the output of the turning state detection means.

カーナビゲーション装置1の全体構成を示す図である。1 is a diagram illustrating an overall configuration of a car navigation device 1. FIG. 地下駐車場に至る螺旋状のスロープの一例を模式的に示す図である。It is a figure which shows typically an example of the spiral slope which reaches an underground parking lot. ジャイロセンサ11aで検出する角加速度について説明する図である。It is a figure explaining the angular acceleration detected by the gyro sensor 11a. ジャイロセンサ11aの車両10への搭載状態を説明する図である。It is a figure explaining the mounting state to the vehicle 10 of the gyro sensor 11a. 車両10の現在位置を算出して表示モニタ14上に表示する処理の動作を示したフローチャートである。5 is a flowchart showing an operation of processing for calculating a current position of the vehicle 10 and displaying it on the display monitor 14.

符号の説明Explanation of symbols

1 カーナビゲーション装置 10 車両
11 現在地検出装置 11a ジャイロセンサ
11c GPSセンサ 11d 車速センサ
12 イグニッションスイッチ 14 表示モニタ
100 制御装置 101 CPU
102 メモリ 109 地図記憶装置
DESCRIPTION OF SYMBOLS 1 Car navigation apparatus 10 Vehicle 11 Present location detection apparatus 11a Gyro sensor 11c GPS sensor 11d Vehicle speed sensor 12 Ignition switch 14 Display monitor 100 Control apparatus 101 CPU
102 memory 109 map storage device

Claims (6)

車両の旋回状態を検出する旋回状態検出手段と、
前記旋回状態検出手段の出力に基づいて、前記車両の旋回角度を算出する旋回角度算出手段と、
前記車両の外部から送信される送信波を受信する受信手段とを備え、
前記旋回角度算出手段は、算出した前記車両の旋回角度が所定の角度以上であり、かつ、前記受信手段で前記送信波を受信できない場合、前記旋回状態検出手段の出力を補正して前記車両の旋回角度を算出することを特徴とする現在位置算出装置。
A turning state detecting means for detecting a turning state of the vehicle;
A turning angle calculating means for calculating a turning angle of the vehicle based on an output of the turning state detecting means;
Receiving means for receiving a transmission wave transmitted from the outside of the vehicle,
The turning angle calculation means corrects the output of the turning state detection means and corrects the output of the vehicle when the calculated turning angle of the vehicle is not less than a predetermined angle and the receiving means cannot receive the transmission wave. A current position calculation device that calculates a turning angle.
請求項1に記載の現在位置算出装置において、
前記旋回角度算出手段は、算出した前記車両の旋回角度が所定の角度以上であり、かつ、前記受信手段で前記送信波を受信できない場合、前記車両が前記所定の傾斜角度の道路を下っているものとして、前記旋回状態検出手段の出力を補正して前記車両の旋回角度を算出することを特徴とする現在位置算出装置。
In the present position calculation device according to claim 1,
When the calculated turning angle of the vehicle is equal to or greater than a predetermined angle and the receiving means cannot receive the transmission wave, the vehicle is going down the road having the predetermined inclination angle. As a thing, the present position calculation apparatus characterized by calculating the turning angle of the vehicle by correcting the output of the turning state detecting means.
請求項2に記載の現在位置算出装置において、
前記旋回角度算出手段は、算出した前記車両の旋回角度が所定の角度以上であり、かつ、前記受信手段で前記送信波を受信できない場合、前記車両が前記所定の傾斜角度の道路を下っているものとして、前記車両の旋回開始の時点に遡って前記旋回状態検出手段の出力を補正して前記車両の旋回角度を算出することを特徴とする現在位置算出装置。
In the present position calculation device according to claim 2,
When the calculated turning angle of the vehicle is equal to or greater than a predetermined angle and the receiving means cannot receive the transmission wave, the vehicle is going down the road having the predetermined inclination angle. As a thing, the present position calculation apparatus characterized by calculating the turning angle of the said vehicle by correcting the output of the said turning state detection means retroactively to the time of the turning start of the said vehicle.
請求項2または請求項3のいずれか一項に記載の現在位置算出装置において、
前記車両のイグニッションスイッチのオンオフ状態を検出するイグニッションスイッチオンオフ状態検出手段をさらに備え、
前記旋回角度算出手段は、前記車両が前記所定の傾斜角度の道路を下っているものとして前記旋回状態検出手段の出力を補正して前記車両の旋回角度を算出した場合、その後、前記旋回状態検出手段の出力に基づいて前記車両が直進したと判断し、その後、前記イグニッションスイッチオンオフ状態検出手段で前記イグニッションスイッチがオフされてさらにオンされたことを検出し、その後に算出した前記車両の旋回角度が所定の角度以上であれば、前記旋回状態検出手段の出力を補正して前記車両の旋回角度を算出することを特徴とする現在位置算出装置。
In the present position calculation apparatus as described in any one of Claim 2 or Claim 3,
An ignition switch on / off state detecting means for detecting an on / off state of the ignition switch of the vehicle;
When the turning angle calculation unit calculates the turning angle of the vehicle by correcting the output of the turning state detection unit on the assumption that the vehicle is going down the road having the predetermined inclination angle, the turning state detection is performed thereafter. Based on the output of the means, it is determined that the vehicle has traveled straight, and then the ignition switch on / off state detection means detects that the ignition switch is turned off and is further turned on, and then calculates the turning angle of the vehicle If the angle is equal to or greater than a predetermined angle, the current position calculation device calculates the turning angle of the vehicle by correcting the output of the turning state detecting means.
請求項4に記載の現在位置算出装置において、
前記旋回角度算出手段は、前記車両が前記所定の傾斜角度の道路を下っているものとして前記旋回状態検出手段の出力を補正して前記車両の旋回角度を算出した場合、その後、前記旋回状態検出手段の出力に基づいて前記車両が直進したと判断し、その後、前記イグニッションスイッチオンオフ状態検出手段で前記イグニッションスイッチがオフされてさらにオンされたことを検出し、その後に算出した前記車両の旋回角度が所定の角度以上であれば、前記車両が前記所定の傾斜角度の道路を上っているものとして、前記旋回状態検出手段の出力を補正して前記車両の旋回角度を算出することを特徴とする現在位置算出装置。
In the present position calculation device according to claim 4,
When the turning angle calculation unit calculates the turning angle of the vehicle by correcting the output of the turning state detection unit on the assumption that the vehicle is going down the road having the predetermined inclination angle, the turning state detection is performed thereafter. Based on the output of the means, it is determined that the vehicle has traveled straight, and then the ignition switch on / off state detection means detects that the ignition switch is turned off and is further turned on, and then calculates the turning angle of the vehicle If the vehicle is equal to or greater than a predetermined angle, it is assumed that the vehicle is going up the road having the predetermined inclination angle, and the turning angle of the vehicle is calculated by correcting the output of the turning state detecting means. Current position calculation device.
請求項5に記載の現在位置算出装置において、
前記旋回角度算出手段は、前記車両が前記所定の傾斜角度の道路を下っているものとして前記旋回状態検出手段の出力を補正して前記車両の旋回角度を算出した場合、その後、前記旋回状態検出手段の出力に基づいて前記車両が直進したと判断し、その後、前記イグニッションスイッチオンオフ状態検出手段で前記イグニッションスイッチがオフされてさらにオンされたことを検出し、その後に算出した前記車両の旋回角度が所定の角度以上であれば、前記イグニッションスイッチがオフされてさらにオンされた後の前記車両の旋回開始時点に遡って前記車両が前記所定の傾斜角度の道路を上っているものとして、前記旋回状態検出手段の出力を補正して前記車両の旋回角度を算出することを特徴とする現在位置算出装置。
In the present position calculation device according to claim 5,
When the turning angle calculation unit calculates the turning angle of the vehicle by correcting the output of the turning state detection unit on the assumption that the vehicle is going down the road having the predetermined inclination angle, the turning state detection is performed thereafter. Based on the output of the means, it is determined that the vehicle has traveled straight, and then the ignition switch on / off state detection means detects that the ignition switch is turned off and is further turned on, and then calculates the turning angle of the vehicle If the vehicle is above a predetermined angle, the vehicle goes up the road with the predetermined inclination angle retroactively to the turning start time of the vehicle after the ignition switch is turned off and turned on. A current position calculating device, wherein the turning angle of the vehicle is calculated by correcting the output of the turning state detecting means.
JP2008205859A 2008-08-08 2008-08-08 Current location calculation device Pending JP2010038889A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2008205859A JP2010038889A (en) 2008-08-08 2008-08-08 Current location calculation device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2008205859A JP2010038889A (en) 2008-08-08 2008-08-08 Current location calculation device

Publications (1)

Publication Number Publication Date
JP2010038889A true JP2010038889A (en) 2010-02-18

Family

ID=42011581

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2008205859A Pending JP2010038889A (en) 2008-08-08 2008-08-08 Current location calculation device

Country Status (1)

Country Link
JP (1) JP2010038889A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013072781A (en) * 2011-09-28 2013-04-22 Aisin Aw Co Ltd System, device, and method for detecting location of traveling object, and computer program
DE102013215960A1 (en) * 2013-08-13 2015-03-05 Volkswagen Aktiengesellschaft Determining a position information of a vehicle
DE102014217849A1 (en) * 2014-09-08 2016-03-10 Conti Temic Microelectronic Gmbh Control device, vehicle and structure control device

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2013072781A (en) * 2011-09-28 2013-04-22 Aisin Aw Co Ltd System, device, and method for detecting location of traveling object, and computer program
DE102013215960A1 (en) * 2013-08-13 2015-03-05 Volkswagen Aktiengesellschaft Determining a position information of a vehicle
DE102014217849A1 (en) * 2014-09-08 2016-03-10 Conti Temic Microelectronic Gmbh Control device, vehicle and structure control device

Similar Documents

Publication Publication Date Title
US8571789B2 (en) Navigation system
JP4643436B2 (en) Own vehicle position determination device
JP2826086B2 (en) Navigation device
US5043902A (en) Vehicular navigation apparatus
JP4568782B2 (en) Location registration device, navigation device, route search device, location registration method, location registration program, and recording medium
JP4683380B2 (en) Lane change guidance device
JP2007024833A (en) On-vehicle navigation apparatus
JP4561802B2 (en) Map display device and program
JP2002333333A (en) Navigation device
US7346450B2 (en) Vehicle navigation apparatus for controlling map-matching areas
US20070150182A1 (en) Navigation system
JP4791316B2 (en) On-vehicle navigation device and vehicle traveling direction detection method
JP2010038889A (en) Current location calculation device
JP4822938B2 (en) Navigation device
JP2010276527A (en) Navigation device
JP2009042155A (en) Navigation apparatus
JP5028100B2 (en) Current position calculation device
JP5276922B2 (en) Current position calculation device
JP2006227018A (en) Processor using acceleration
JP4809105B2 (en) Self-vehicle position / orientation correcting apparatus and method
JP5891120B2 (en) Speed calculation device, speed calculation method, speed calculation program, and recording medium
JP2004504619A (en) Navigation device for position correction and method for position correction
JP5445287B2 (en) Car navigation system
JPH04213019A (en) Position-detecting-accuracy judging method and vehicle guiding apparatus using method thereof
JP2008202941A (en) Navigation device