JPS6042614A - Correcting device of tilt angle sensor - Google Patents

Correcting device of tilt angle sensor

Info

Publication number
JPS6042614A
JPS6042614A JP15109983A JP15109983A JPS6042614A JP S6042614 A JPS6042614 A JP S6042614A JP 15109983 A JP15109983 A JP 15109983A JP 15109983 A JP15109983 A JP 15109983A JP S6042614 A JPS6042614 A JP S6042614A
Authority
JP
Japan
Prior art keywords
tilt angle
vehicle speed
vehicle
sensor
acceleration
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
JP15109983A
Other languages
Japanese (ja)
Inventor
Hisashi Hara
央士 原
Tadashi Matsuura
忠史 松浦
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.)
Suzuki Motor Corp
Original Assignee
Suzuki Motor 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 Suzuki Motor Corp filed Critical Suzuki Motor Corp
Priority to JP15109983A priority Critical patent/JPS6042614A/en
Publication of JPS6042614A publication Critical patent/JPS6042614A/en
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C9/00Measuring inclination, e.g. by clinometers, by levels
    • G01C9/02Details
    • G01C9/08Means for compensating acceleration forces due to movement of instrument

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

PURPOSE:To correct an error due to the acceleration or deceleration of a vehicle by providing a vehicle speed sensor and a correcting arithmetic circuit which corrects the error due to the acceleration or deceleration of the vehicle speed according to a specific expression and outputs a corrected tilt angle. CONSTITUTION:A correcting device corrects a detection error in tilt angle due to the acceleration or deceleration as to a tilt angle sensor 2 which detects and outputs the relative angle to the vehicle body with a weight suspended from the vehicle body. This correcting device consists of the vehicle speed sensor 1 which detects and outputs the actual speed of the vehicle body and the correcting arithmetic circuit which inputs the output G0 of the tilt angle sensor 2 and output (v) of the vehicle speed sensor 1, and outputs the corrected tilt angle G by correcting the error due to the acceleration or deceleration according to the equation of G=G0+arctan{v(dtheta/dt)/g}. For example, the correcting arithmetic circuit consists of an AD converter 3, microcomputer 4, driver 5, a display device 6, etc.

Description

【発明の詳細な説明】 本発明は、傾斜角センサの補正装置、さらに詳しく言え
ば重錘を用いて車両の傾斜角を検出する(1) 傾斜角センサの車両の加速度による誤差を補正する1頃
斜角センサの補正装置に関する。
DETAILED DESCRIPTION OF THE INVENTION The present invention detects the tilt angle of a vehicle using a tilt angle sensor correction device, more specifically, a weight (1) Correcting the error of the tilt angle sensor due to vehicle acceleration 1 The present invention relates to a correction device for a tilt angle sensor.

従来、車両に搭載されている傾斜角センサは振子の原理
が用いられており、振子の重錘に掛かる重力の方向と車
体との相対角度により傾斜角を検出していた。
Conventionally, inclination angle sensors mounted on vehicles have used the principle of a pendulum, and have detected the inclination angle based on the relative angle between the direction of gravity acting on the weight of the pendulum and the vehicle body.

このような傾斜角センサでは加減速時のような車速変化
時には、車両が前後方向に傾斜していなくとも、車両が
傾斜している旨の表示をしてしまうことがあった。これ
は、傾斜角センサを構成する重錘が重力の方向を検出し
ているので、この重錘に車両の前後方向の加減速による
力が働くため、その力による重錘の振れを車体の(頃斜
として判断してしまうためである。このように、機械式
の傾斜角センサでは補正のしようがなくダンパを強くす
る程度の対策しか取れなかった。
In such a tilt angle sensor, when the vehicle speed changes such as during acceleration or deceleration, an indication that the vehicle is tilted may be displayed even if the vehicle is not tilted in the longitudinal direction. This is because the weight that makes up the tilt angle sensor detects the direction of gravity, and the force due to acceleration and deceleration in the longitudinal direction of the vehicle acts on this weight. This is because it is determined to be tilted.In this way, there is no way to correct it with a mechanical tilt angle sensor, and the only countermeasure that can be taken is to strengthen the damper.

そこで、本発明の目的は、重錘の振れ角により傾斜角を
電気的に検出する傾斜角センサの車両の加減速による誤
差を補正することのできる傾斜角センサの補正装置を提
供することにある。
SUMMARY OF THE INVENTION Accordingly, an object of the present invention is to provide a correction device for a tilt angle sensor that can correct errors caused by acceleration and deceleration of a vehicle in a tilt angle sensor that electrically detects a tilt angle based on a deflection angle of a weight. .

(2) 前記目的を達成するために本発明による傾斜角センサの
補正装置は、車体に吊り下げた重錘により前記車体との
相対角度を検出して出力する傾斜角センサの加減速によ
る傾斜角検出誤差を補正する11!斜角センサの補正装
置において、前記車両の実車速を検出して出力する車速
センサと、前記傾斜角センサの出力(CO)と前記車速
センサの出力(V)とが接続されておりG = Go 
+ arctan (< dv/dt) /g)の式か
ら車両の加減速による誤差補正を行って補正された傾斜
角(G)を出力する補正演算回路とから構成されている
(2) In order to achieve the above object, the tilt angle sensor correction device according to the present invention detects and outputs the relative angle with the vehicle body using a weight suspended from the vehicle body. 11 to correct detection errors! In the tilt angle sensor correction device, a vehicle speed sensor that detects and outputs the actual vehicle speed of the vehicle, an output (CO) of the tilt angle sensor, and an output (V) of the vehicle speed sensor are connected, and G = Go.
+ arctan (< dv/dt) /g), and a correction calculation circuit that corrects errors due to acceleration and deceleration of the vehicle and outputs the corrected tilt angle (G).

前記構成によれば本発明の目的は完全に達成できる。According to the above structure, the object of the present invention can be completely achieved.

まず、本発明の基本原理を説明する。第1図は本発明に
よる傾斜角センサの補正装置の基本原理を説明するため
の図である。
First, the basic principle of the present invention will be explained. FIG. 1 is a diagram for explaining the basic principle of a correction device for a tilt angle sensor according to the present invention.

質量mの重錘が加減速時に受ける力Faは、F a =
 m (dv / dt) ・・−(1)である。ここ
で、加減速時に力Faが加えられたときにFaとFが等
しくなるような角度αが誤差(3) として傾斜角の測定値に含まれている。この方Fは、 F=mg tanα−121 である。Fa =Fであるから、式(1)と(2)によ
り、m (dv/dt) =mg tanα、’、 t
anα= (dv / dt) / g、・、α−ar
ctan ((dv/dt) / g) −+3)とな
る。
The force Fa that a weight of mass m receives during acceleration/deceleration is F a =
m (dv/dt)...-(1). Here, an angle α such that Fa becomes equal to F when force Fa is applied during acceleration and deceleration is included in the measured value of the inclination angle as an error (3). This F is F=mg tanα-121. Since Fa = F, by equations (1) and (2), m (dv/dt) = mg tanα,', t
anα= (dv/dt)/g,・,α−ar
ctan ((dv/dt)/g) -+3).

傾斜角センサの測定値がGoであるとして、真の11J
i斜角Gは、 (、−Go−arctan ((dv /dt) / 
gl −+41でめられる。ここで、Gば車両の進行方
向に傾斜上方のとき正とする。
Assuming that the measured value of the tilt angle sensor is Go, the true 11J
The i oblique angle G is (, -Go-arctan ((dv /dt) /
gl −+41. Here, G is positive when it is inclined upward in the direction of travel of the vehicle.

つぎに、実施例に基づいて本発明をさらに詳しく説明す
る。
Next, the present invention will be explained in more detail based on examples.

第2図は本発明による傾斜角センサの補正装置の実施例
を示したブロック図である。
FIG. 2 is a block diagram showing an embodiment of the tilt angle sensor correction device according to the present invention.

本発明による傾斜角センサの補正装置は、車速センサ1
、傾斜角セン+2、ADコンバータ3、マイクロコンピ
ュータ4、ドライバ5、表示装置(4) 6とから構成されている。
The tilt angle sensor correction device according to the present invention includes a vehicle speed sensor 1
, a tilt angle sensor +2, an AD converter 3, a microcomputer 4, a driver 5, and a display device (4) 6.

第3図は本発明の実施例装置に用いられている車速セン
サを説明するための図である。車速センサ1ば車両の実
車速を検出するセンサであって、その出力はマイクロコ
ンピュータ4に接続されている。
FIG. 3 is a diagram for explaining a vehicle speed sensor used in the embodiment of the present invention. The vehicle speed sensor 1 is a sensor for detecting the actual vehicle speed of the vehicle, and its output is connected to the microcomputer 4.

車速センサ1は車軸と同一回転をする軸11と、軸11
に設けられ多数の光通過窓12aを有する薄い鉄板12
と、鉄板12の一方側に設けられた発光素子13と、鉄
板12の他方側に設けられ発光素子13の発する光を光
通過窓12aを通して受光する受光素子14とから構成
されている。
The vehicle speed sensor 1 has a shaft 11 that rotates at the same time as the axle;
A thin iron plate 12 provided with a large number of light passing windows 12a.
, a light emitting element 13 provided on one side of the iron plate 12, and a light receiving element 14 provided on the other side of the iron plate 12 and receiving light emitted by the light emitting element 13 through a light passing window 12a.

受光素子14では最初に光を受けてから次に光を受ける
までの時間差から速度をめている。すなわち、軸11が
1回転する間に進む距離をl、光通過窓12aの数をN
、光を受ける時間間隔をtとすると、車速Vは、 v−N/(I!、t) によりめられる。
The speed of the light receiving element 14 is determined from the time difference between when it first receives light and when it receives the next light. That is, the distance traveled by the shaft 11 during one rotation is l, and the number of light passing windows 12a is N.
, where the time interval of receiving light is t, the vehicle speed V is determined by v-N/(I!, t).

第4図は本発明の実施例装置に用いられている(5) 傾斜角センサを説明するための図である。傾斜角センサ
2は重錘と車体との相対角度から車両の傾斜を検出して
出力するセンサであって、その出力はADコンバータ3
を介してマイクロコンピュータ4に接続されている。
FIG. 4 is a diagram for explaining the tilt angle sensor (5) used in the embodiment of the present invention. The tilt angle sensor 2 is a sensor that detects and outputs the tilt of the vehicle from the relative angle between the weight and the vehicle body, and its output is sent to the AD converter 3.
It is connected to the microcomputer 4 via.

傾斜角センサ2は、第4図に示すように重錘21と可変
抵抗器22とからなり、重錘21の振れ角に比例して可
変抵抗器22の抵抗を変化させることによりまる電圧に
より傾斜角を検出するセンサである。
The tilt angle sensor 2 consists of a weight 21 and a variable resistor 22, as shown in FIG. This is a sensor that detects corners.

。第5図は本発明の実施例装置に用いられているマイク
ロコンピュータの動作を説明するための流れ図である。
. FIG. 5 is a flowchart for explaining the operation of the microcomputer used in the embodiment of the present invention.

マイクロコンピュータ4は、車速センサ1で検出された
車速v、11斜角センサ2で検出せれた傾斜角Goを入
力する(41)。
The microcomputer 4 inputs the vehicle speed v detected by the vehicle speed sensor 1 and the tilt angle Go detected by the tilt angle sensor 2 (41).

ステップ41で入力された車速vnと前回記憶された車
速vn−1との差Δv=vn−vn−1を演算して、ル
ープタイムtで除算し、加速度dv/dtをめる(42
)。なお、ループタイムとはプロ(6) ダラムの一周に要する時間をいう。
Calculate the difference Δv=vn-vn-1 between the vehicle speed vn input in step 41 and the previously stored vehicle speed vn-1, divide it by the loop time t, and calculate the acceleration dv/dt (42
). Note that loop time refers to the time required to go around Pro (6) Durham.

ステップ42でめたdv/dtおよび既知の重力加速度
gとから前記式(3)すなわちα−arctan ((
dV/dt)/g)から傾斜角の誤差αを演算する(4
3)。
From the dv/dt determined in step 42 and the known gravitational acceleration g, the equation (3), that is, α-arctan ((
Calculate the tilt angle error α from dV/dt)/g) (4
3).

ステップ41で入力した傾斜角Goとステップ43で演
算した誤差αとから真の傾斜角Gを前記式(4)のG−
Go−αから演算しく44)、その結果Gを出力する(
45)。
From the inclination angle Go input in step 41 and the error α calculated in step 43, the true inclination angle G is determined by the G-
Calculate from Go-α44) and output the result G (
45).

マイクロコンピュータ4の出力はドライバ5を介して表
示装置6で表示される。
The output of the microcomputer 4 is displayed on a display device 6 via a driver 5.

以上詳しく説明したように、本発明によれば、加減速時
の傾斜角の誤差を補正することができるので、正しい車
両の傾斜角を表示することができる。
As described in detail above, according to the present invention, it is possible to correct the error in the tilt angle during acceleration and deceleration, so that the correct tilt angle of the vehicle can be displayed.

なお、ナビゲーションシステムに本発明による傾斜角セ
ンサの補正装置で補正した傾斜角を用いれば、山岳部等
の走行でも誤差を減少させることができる。
Note that if the navigation system uses the tilt angle corrected by the tilt angle sensor correction device according to the present invention, errors can be reduced even when driving in mountainous areas.

【図面の簡単な説明】[Brief explanation of the drawing]

(7) 第1図は本発明による傾斜角センサの補正装置の基本原
理を説明するための図、第2図は本発明による傾斜角セ
ンサの補正装置の実施例を示したブロック図、第3図は
本発明の実施例装置に用いられている車速センサを説明
するための図、第4図は本発明の実施例装置に用いられ
ている傾斜角センサを説明するための図、第5図は本発
明の実施例装置に用いられているマイクロコンピュータ
の動作を説明するための流れ図である。 1・・・車速センサ 2・・・傾斜角センサ3・・・A
Dコンバータ 4・・・マイクロコンピュータ 5・・・ドライバ 6・・・表示装置 特許出願人 鈴木自動車工業株式会社 代理人 弁理士 井 ノ ロ 壽 (8) −8! 才5図 −90−
(7) FIG. 1 is a diagram for explaining the basic principle of the tilt angle sensor correction device according to the present invention, FIG. 2 is a block diagram showing an embodiment of the tilt angle sensor compensation device according to the present invention, and FIG. The figures are for explaining the vehicle speed sensor used in the embodiment device of the present invention, FIG. 4 is a diagram for explaining the tilt angle sensor used in the embodiment device of the present invention, and FIG. is a flowchart for explaining the operation of the microcomputer used in the embodiment device of the present invention. 1...Vehicle speed sensor 2...Inclination angle sensor 3...A
D converter 4...Microcomputer 5...Driver 6...Display device Patent applicant Suzuki Motor Co., Ltd. agent Patent attorney Hisashi Inoro (8) -8! 5th figure -90-

Claims (1)

【特許請求の範囲】 車体に吊り下げた重錘により前記車体との相対角度を検
出して出力する傾斜角センサの加減速による傾斜角検出
誤差を補正する傾斜角センサの補正装置において、前記
車両の実車速を検出して出力する車速センサと、前記傾
斜角センサの出力(CO)と前記車速センサの出力(v
)とが接続されており下記の式から車両の加減速による
誤差補正を行って補正された傾斜角(G)を出力する補
正演算回路とから構成したことを特徴とする傾斜角セン
サの補正装置。 記 G=GO+arctan ((dv/dt) / g)
但し、g;重力加速度 以」二
[Scope of Claims] A tilt angle sensor correction device that corrects a tilt angle detection error due to acceleration/deceleration of a tilt angle sensor that detects and outputs a relative angle with the vehicle body using a weight suspended from the vehicle body. a vehicle speed sensor that detects and outputs the actual vehicle speed, an output (CO) of the tilt angle sensor, and an output (v) of the vehicle speed sensor.
) is connected to a correction calculation circuit which performs error correction due to acceleration and deceleration of the vehicle from the following formula and outputs the corrected inclination angle (G). . Note G=GO+arctan ((dv/dt)/g)
However, g: gravitational acceleration or less
JP15109983A 1983-08-19 1983-08-19 Correcting device of tilt angle sensor Pending JPS6042614A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP15109983A JPS6042614A (en) 1983-08-19 1983-08-19 Correcting device of tilt angle sensor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP15109983A JPS6042614A (en) 1983-08-19 1983-08-19 Correcting device of tilt angle sensor

Publications (1)

Publication Number Publication Date
JPS6042614A true JPS6042614A (en) 1985-03-06

Family

ID=15511309

Family Applications (1)

Application Number Title Priority Date Filing Date
JP15109983A Pending JPS6042614A (en) 1983-08-19 1983-08-19 Correcting device of tilt angle sensor

Country Status (1)

Country Link
JP (1) JPS6042614A (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6189513A (en) * 1984-10-08 1986-05-07 Daihatsu Motor Co Ltd Detection of inclined angle of automobile and detector thereof
JPS63117211A (en) * 1986-11-05 1988-05-21 Tokyo Keiki Co Ltd Clinometer
JPH03143782A (en) * 1989-10-27 1991-06-19 Iseki & Co Ltd Horizontal control device for vehicle body

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6189513A (en) * 1984-10-08 1986-05-07 Daihatsu Motor Co Ltd Detection of inclined angle of automobile and detector thereof
JPS63117211A (en) * 1986-11-05 1988-05-21 Tokyo Keiki Co Ltd Clinometer
JPH03143782A (en) * 1989-10-27 1991-06-19 Iseki & Co Ltd Horizontal control device for vehicle body

Similar Documents

Publication Publication Date Title
US4725957A (en) Process for correcting angle errors in an electronic compass in vehicles
US4470124A (en) Method of adjusting the zero-point of rate type sensor
EP0362389B1 (en) Vehicle navigation system
EP0366249A2 (en) Method for correcting zero point of gyro and apparatus therefor
KR970707429A (en) MOVEMENT DETECTING DEVICE
FI930819A (en) SYSTEM FOER CONTROL AV ETT JAERNVAEGSFORDONS ROTATION KRING DENNES LAENGDAXEL
US20050137761A1 (en) Two-axis accelerometer used for train speed measurement and system using the same
JP2004125689A (en) Position calculation system for self-contained navigation
WO2002103288B1 (en) Integrated inertial vms navigation with inertial odometer correction
JPS6042614A (en) Correcting device of tilt angle sensor
JP2843905B2 (en) Inertial navigation system for vehicles
JPH10253352A (en) Movement judging apparatus and navigator
JP2843904B2 (en) Inertial navigation system for vehicles
JPH0772165A (en) Rotation sensor using linear accelerometer
JP2626003B2 (en) Road surface inclination angle detection device
JP2843903B2 (en) Inertial navigation device
JP3292319B2 (en) Track shape measuring device and measuring method
JPH0643516U (en) Position detector
JPH05272974A (en) Surface grade detector for automobile
JPH11211745A (en) Speed distance meter
JPS61278413A (en) Measuring device for pitching and rolling of vehicle
JPS5883210A (en) Inclinometer
JPH0620091Y2 (en) Locator device for mobile
JPS6042613A (en) Correcting device of tilt angle sensor
JP2004020207A (en) Method for detecting vehicle pitch angle by car navigation system, and car navigation system