JPH06230126A - 車載用超音波計測装置 - Google Patents

車載用超音波計測装置

Info

Publication number
JPH06230126A
JPH06230126A JP5014246A JP1424693A JPH06230126A JP H06230126 A JPH06230126 A JP H06230126A JP 5014246 A JP5014246 A JP 5014246A JP 1424693 A JP1424693 A JP 1424693A JP H06230126 A JPH06230126 A JP H06230126A
Authority
JP
Japan
Prior art keywords
vehicle
ultrasonic
ultrasonic wave
receiver
wave transmitter
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
JP5014246A
Other languages
English (en)
Inventor
Keiji Kuzutani
啓司 葛谷
Naoji Nakahara
直司 中原
Yasuyuki Aoki
康幸 青木
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.)
Aisin Corp
Original Assignee
Aisin Seiki Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Aisin Seiki Co Ltd filed Critical Aisin Seiki Co Ltd
Priority to JP5014246A priority Critical patent/JPH06230126A/ja
Priority to US08/187,507 priority patent/US5491648A/en
Publication of JPH06230126A publication Critical patent/JPH06230126A/ja
Pending legal-status Critical Current

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/02Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • G01S15/50Systems of measurement, based on relative movement of the target
    • G01S15/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S15/588Velocity or trajectory determination systems; Sense-of-movement determination systems measuring the velocity vector
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/02Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • G01S15/50Systems of measurement, based on relative movement of the target
    • G01S15/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • G01S15/60Velocity or trajectory determination systems; Sense-of-movement determination systems wherein the transmitter and receiver are mounted on the moving object, e.g. for determining ground speed, drift angle, ground track
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/87Combinations of sonar systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Acoustics & Sound (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
  • Vehicle Body Suspensions (AREA)

Abstract

(57)【要約】 【目的】 超音波を使用して車速以外の車輌の状態を検
出できること。 【構成】 超音波送受波器TR1により直接車輌100
の速度を得る。車輌100の回転中心Zo を通り後方
に、その進行方向に平行する直線に対して直角方向と
し、路面に対して所定の俯角傾度を持って超音波を送波
し、その反射波を受波する超音波送受波器TR2と、回
転中心Zo から前に所定距離L2 だけ離れて配設し、車
輌100の進行方向に平行する直線に対して直角方向と
し、路面に対して所定の俯角傾度を持って超音波を送波
し、その反射波を受波する超音波送受波器TR3とで得
られた速度から車輌の二次元速度を演算するものであ
る。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、自動車に積載されて、
ナビゲーションシステム、車速検出装置、横滑り防止装
置、ABS装置、サスペンション装置、遠心力検出装
置、ヨー角、ヨーレート検出装置等の各種速度情報を使
用する計測装置に関するもので、特に、車輌に積載した
超音波を利用する車載用超音波計測装置に関するもので
ある。
【0002】
【従来の技術】この種の超音波を使用した速度計測装置
としては、実開昭57−68574号公報に掲載の技術
がある。この公報に掲載の技術は、別体となった送波器
から連続的に超音波を送波し、反射体から反射して得ら
れる受波を連続受信し、送波と受波の差分でドプラー周
波数を検出するものであり、現在では周知の技術となっ
ている。
【0003】また、この種の超音波を使用した速度計測
装置としては、特開昭59−203973号公報に掲載
の技術がある。この公報に掲載の技術は、前記公報の技
術と同様、別体となった送波器と受波器とを有し、特
に、受波器を2台とし、車体の上下振動、ノーズアッ
プ、ノーズダウンによる誤差を軽減するものである。
【0004】そして、この種の超音波を使用した速度計
測装置としては、特開昭58−39971号公報に掲載
の技術がある。この公報に掲載の技術は、超音波をパル
ス状に送波し、反射して受波される時点でパルス幅に対
応した受信ゲートを開き、受信波の所定波長分の時間を
計測することで、ドプラーシフト量を求め、車速を計測
するものである。
【0005】更に、この種の車載用超音波計測装置とし
ては、特開平3−269388号公報に掲載の技術があ
る。
【0006】この技術は、送受波器から車輌の前方向或
いは前後方向の路面に所定の俯角度で超音波が放射さ
れ、放射された超音波と路面の突起の反射波の受信信号
から突起までの時間を計測し、また、路面の突起の反射
波の信号レベルと所定の閾値とを比較し、車輌前方の路
面の突起等の有無及びその大きさを検出している。そし
て、反射波が路面から帰来する時間における直線距離と
超音波の放射角度とから車高を検出し、得られたドプラ
ー周波数をもとに車速を検出している。
【0007】即ち、図9の車載用超音波計測装置の1個
の超音波送受波器TRで送波及び受波する場合の動作原
理図に示すように、超音波を放射して路面に到達するま
での距離をL[m]、その高さをH[m]、その放射角
度をφ度とすれば、 L=H/sinφ ・・・・・・(1) となる。
【0008】このときの伝搬距離に起因する損失Loos
は、 Loos =(拡散損)+(伝搬損) =20・log(2・L)+2・L・α [dB]・・・・(2) 但し、α:減衰定数 例えば、α100KHz=2.1[dB/m] α200KHz=8.5[dB/m] で求められる。
【0009】一方、超音波ビーム幅θ度は狭くした場合
には、送波はエネルギーが集中するため信号成分Sが増
加する。また、受波では等方向性雑音に対するS/Nが
向上する。
【0010】送受波総合の利得Gは、 G=(送波利得)×(受波利得) ={10・log(γ/θ2 )}×2 ・・・・・・(3) 但し、γは、ビームが回転対称の場合、γ=3.4×1
4 である。
【0011】なお、図9の車載用超音波計測装置の動作
原理図で、間歇的に周波数f[Hz]の超音波を路面に放
射して、受波した周波数fo =f− df[Hz]からその
ドプラー周波数 df[Hz]を算出すると、 df=2f(V/3.6)cosφ/C [Hz]・・・・・・(4) 但し、V:車速 [Km/h] C:音速 [m/s ] となる。
【0012】特に、前記公報に掲載の技術は、車体の前
後方向に等しい放射角度を有して超音波が放射され、そ
れぞれの反射波の受信信号のドプラー周波数を検出し、
その差のドプラー周波数を求めて、車体の垂直速度成分
が打消された車速を検出している。また、垂直成分のみ
を検出して車高としている。
【0013】このようにして、超音波を用いて車輌の走
行時の前方路面の突起等が検出され、かつ、車高、車速
を検出している。
【0014】
【発明が解決しようとする課題】ところが、上記公報に
掲載の技術は、反射波が路面から帰来する時間における
直線距離と超音波の放射角度とから車高を検出し、得ら
れたドプラー周波数をもとに車速を検出するか、また
は、車体の前後方向に等しい放射角度を有して超音波が
放射され、それぞれの反射波の受信信号のドプラー周波
数を検出し、その差のドプラー周波数を求めて、車体の
垂直速度成分が打ち消された車速を検出するものであ
る。
【0015】しかし、この種の超音波を使用して車輌の
動きを測定する車載用超音波計測装置は、車速、車高等
を測定することができるものの、その車速成分を測定し
ているにもかかわらず、その使途が車速、車高等に限ら
れていた。
【0016】そこで、超音波を使用して車輌の二次元速
度を検出できる車載用超音波計測装置の提供を課題とす
るものである。
【0017】
【課題を解決するための手段】この発明にかかる車載用
超音波計測装置は、車輌の進行方向に平行し、路面に対
して所定の俯角傾度を持って超音波を送波し、その反射
波を受波する第1超音波送受波器と、前記車輌の回転中
心から前後に所定距離離れて配設し、前記車輌の進行方
向に平行する直線に対して直角方向とし、路面に対して
所定の俯角傾度を持って超音波を送波し、その反射波を
受波する第2超音波送受波器及び第3超音波送受波器か
ら、演算手段で車輌の進行方向の速度と横方向速度、回
転角度またはその回転角速度等の二次元速度を演算す
る。
【0018】
【作用】この発明においては、第1超音波送受波器によ
って車輌の進行方向の速度、即ち、車速またはその加速
度を得る。また、第2超音波送受波器及び第3超音波送
受波器によって車速の直角方向の車輌の横車速またはそ
の加速度を検出し、それらの車輌の回転中心から前後に
所定距離離れた各速度から車輌の進行方向の速度と横方
向速度、回転角度またはその回転角速度等の二次元速度
を得る。
【0019】
【実施例】以下、本発明の実施例の車載用超音波計測装
置について説明する。
【0020】〈基本的原理〉図1は本発明の実施例の車
載用超音波計測装置の基本原理説明図である。
【0021】図1において、車輌100の進行方向に平
行し、水平面に対して俯角を45度に設定して車輌10
0に取付けた超音波送受波器TR1は、200[KHz ]
の超音波振動を所定の超音波ビーム幅で路面に送波し、
その反射波を受波するものであり、車輌100の進行方
向に対して平行する速度ベクトルV1 を得るものであ
る。具体的には、超音波送受波器TR1は車輌100の
前方中央に配設している。超音波送受波器TR2は、超
音波送受波器TR1と同一特性を持ち、俯角45度で所
定の超音波ビーム幅で超音波を路面に送波し、その反射
波を受波するものであり、図1(a)に示すように、車
輌100の進行方向に対して平行して配設した超音波送
受波器TR1の前記車輌100の進行方向に平行する直
線の延長線上に対して、90度角変位した位置に配設さ
れており、速度ベクトルV2 を得るものである。この超
音波送受波器TR2は車輌100の後方に配設され、車
輌100の回転中心Zo からL2 [m]だけ離れてい
る。また、超音波送受波器TR3も超音波送受波器TR
1と同一特性を持ち、所定の超音波ビーム幅で超音波を
路面に送波し、その反射波を受波するものであり、車輌
100の進行方向に対して平行して配設した超音波送受
波器TR1の前記車輌100の進行方向に平行する直線
の延長線上に対して、90度角変位した位置に配設され
ており、速度ベクトルV3 を得るものである。この超音
波送受波器TR3は車輌100の前方に配設され、車輌
100の回転中心Zo からL1 [m]だけ離れている。
【0022】これら超音波送受波器TR1、超音波送受
波器TR2、超音波送受波器TR3はそれらを取付台と
しての合成樹脂製の各ベース部材Bにモールドしてい
る。そして、図1(b)に示すように、ベース部材Bは
車輌100の前方または後方の下面に取付けられてい
る。なお、この実施例の車輌100の回転中心Zo から
超音波送受波器TR3までの距離はL1 [m]、車輌1
00の回転中心Zo から超音波送受波器TR2までの距
離はL2 [m]で、超音波送受波器TR2と超音波送受
波器TR3の相対距離はL[m]となっている。
【0023】ここで、車輌100の二次元速度として、
進行方向に対して平行する速度ベクトルVx 、その垂直
方向(横方向)の後部横方向速度ベクトルVyr、前部横
方向速度ベクトルVyfを得ると、例えば、車輌100の
車速となる速度ベクトルVx は、 速度ベクトルVx =V1 ・・・・・・・・(5) 車輌100の横方向速度の後部横方向速度ベクトルVy
r、前部横方向速度ベクトルVyfは、 後部横方向速度ベクトルVyr=V2 ・・・・・・・・(6) 前部横方向速度ベクトルVyf=V3 ・・・・・・・・(7) 更に、車輌100のヨーレートωは、車輌100の横方
向から ω=(V2 +V3 )/L ・・・・・・(8) となる。
【0024】同様に、式(5)乃至式(8)の速度ベク
トルの積分、微分を行なうことにより、それらの距離、
加速度が演算でき、車輌100の重心を通る回転軸(回
転中心Zo )を中心に回転するヨー角(回転角)、その
角速度であるヨーレート等を演算することもできる。
【0025】〈実施例の回路構成〉図2は本発明の実施
例の車載用超音波計測装置の回路構成図である。
【0026】図2において、内部に8chのA/Dコン
バータを有するマイクロコンピュータ1は、内部に演算
制御に必要なRAM及びROM及び演算部等を有してい
る公知のものであり、その内部機能説明は後述する。超
音波送受波器TR1は200[KHz ]の超音波振動を所
定の超音波ビーム幅で送波及び受波するものである。ま
た、送受切替回路3は超音波送受波器TR1から超音波
振動で出力したり、受波したりする際の切替を行なうも
のである。また、送受切替回路3はツェナーダイオード
ZD1 がオンしたとき、コンデンサC1 を介してツェナ
ーダイオードZD2 がオンし、超音波送受波器TR1か
ら信号が出力され、ツェナーダイオードZD1 がオフの
とき、信号が小さくなるからツェナーダイオードZD2
がオフし、コンデンサC1 とコイルL1 の直列共振回路
を介して信号がプリアンプ4に出力される。
【0027】送受切替回路3のツェナーダイオードZD
1 はトランス5の二次側に直列接続されており、そのト
ランス5の一次側はスイッチングトランジスタ6によっ
て、電源を供給するように接続されている。スイッチン
グトランジスタ6は10[MHz ]の外部発振周波数出力
を入力する分周回路7の出力による矩形波の100[KH
z ]を入力し、間歇的に100[KHz ]の信号でスイッ
チングトランジスタ6を開閉している。
【0028】したがって、マイクロコンピュータ1が間
歇的な出力P1 を“1”とすると、分周回路7の出力は
スイッチングトランジスタ6をオン・オフし、トランス
5の二次側には高電圧の200[KHz ]が発生し、それ
によって、超音波送受波器TR1は超音波を発生する。
【0029】送受切替回路3を介して検出された超音波
送受波器TR1からの信号は、プリアンプ4で増幅さ
れ、車速等の速度変化に対応するバンドパスフィルタ8
を介して放射した超音波の反射のみを検出し、それを更
にアンプ9で増幅してコンパレータ10に入力して2値
化する。このコンパレータ10の入力の一部は、受信レ
ベル検出回路11に入力され、それをマイクロコンピュ
ータ1のA/Dコンバータに入力している。
【0030】コンパレータ10の出力信号は周波数検出
用PLL回路12に入力し、その出力信号としてコンパ
レータ10の出力に比例した繰返しパルス数を出力す
る。
【0031】詳しくは、コンパレータ10の出力は非常
に低く、数10[KHz ]程度の周波数であるから、これ
を車速として使用でき、短時間で得られる分解能とする
ために、周波数を逓倍する回路として使用している。ま
た、コンパレータ10の出力は受信ゲートが開いている
時間だけ意味を持つものであるから、その間の時間信号
でもって周波数をサンプリングホールドするものであ
る。受信ゲートが閉じており、有効でないときにはPL
L回路としての機能を停止させ、サンプリングホールド
した電圧を保持する。
【0032】具体的には、出力を8分の1に分周したパ
ルスとコンパレータ10の出力を位相差検出回路PDで
比較し、その位相差をローパスフィルターLPFを介し
てアナログスイッチング回路ASに導き、その出力をサ
ンプリングホールド用の抵抗R及びコンデンサCに入力
し、また、電圧制御発振回路VCOを介してマイクロコ
ンピュータ1に入力している。電圧制御発振回路VCO
の出力は8分の1に分周する分周回路DEMを介して位
相差検出回路PDに入力している。結果的に、電圧制御
発振回路VCOからは8倍したパルス繰返し周波数がマ
イクロコンピュータ1に入力される。
【0033】外気温度はサーミスタ15により検出さ
れ、マイクロコンピュータ1の内蔵するA/Dコンバー
タの端子に入力されている。
【0034】この種の超音波送受波器TR1、送受切替
回路3、トランス5、スイッチングトランジスタ6、分
周回路7からなり超音波を送波する送信回路系と、超音
波送受波器TR1、送受切替回路3、プリアンプ4、バ
ンドパスフィルタ8、アンプ9、コンパレータ10、受
信レベル検出回路11、周波数検出用PLL回路12か
らなり超音波を受波する受信回路系とからなり、超音波
送受信回路20TRを構成している。
【0035】また、他の超音波送受波器TR2を用いた
超音波送受信回路30TR、超音波送受波器TR3を用
いた超音波送受信回路40TRについても同様の回路構
成からなっている。なお、具体的回路構成の説明は重複
するので、ここではその説明を省略する。
【0036】図3は本発明の実施例の車載用超音波計測
装置の回路構成で使用したマイクロコンピュータ1の機
能構成図である。
【0037】図3において、クロック発振器105によ
って駆動されている主演算制御回路(MCU)101
は、このマイクロコンピュータ1を駆動制御するプログ
ラムを格納したPROM102、及び主演算制御回路1
01の演算制御に必要なデータを格納するSRAM10
3、タイマ及びカウンタとして計数機能を有するタイマ
・カウンタ104、外部アナログ入力となる8chのA
/Dコンバータ106、外部ディジタル入力となるパラ
レルポート107、割込み制御を行なう割込みコントロ
ーラ108、車速演算結果をシリアルに出力するシリア
ルコミュニケーションインターフェース109等を有し
ており、これらはデータ・アドレス・コントロールバス
110でバス結合されている。
【0038】〈回路構成の全体基本的動作〉超音波送受
信回路20TR及び超音波送受信回路30TR、超音波
送受信回路40TRは、次のように動作する。なお、基
本的動作は超音波送受信回路20TRと超音波送受信回
路30TR、超音波送受信回路40TRは同一であるの
で、ここでは超音波送受信回路20TRを中心に説明す
るが、当然、超音波送受信回路30TR、超音波送受信
回路40TRも同様に共通に制御されたり、独立に制御
されたりする。
【0039】超音波送受波器TR1、超音波送受波器T
R2、超音波送受波器TR3からは周波数200[KHz
]、継続時間1[msec]のバースト波を10[msec]
毎に送信するマイクロコンピュータ1のパラレルポート
107の端子P1 よりバースト波出力のためのゲート信
号を出力する。分周回路7の出力によりスイッチングト
ランジスタ6をオン・オフ制御し、昇圧させた200
[KHz ]の出力によって超音波送受波器TR1、超音波
送受波器TR2、超音波送受波器TR3から超音波を発
生させる。このとき、送受切替回路3は送信動作中に受
信側のプリアンプ4の入力に過大信号が加わらないよう
にしている。
【0040】この際、超音波送受波器TR1と超音波送
受波器TR2、超音波送受波器TR3の超音波出力は、
同時に行なう場合と時分割で行なう場合がある。本実施
例の場合は、相互干渉の可能性が低いことから、同時に
超音波送受波器TR1と超音波送受波器TR2、超音波
送受波器TR3から出力する。
【0041】また、超音波送受波器TR1、超音波送受
波器TR2、超音波送受波器TR3が路面からの反射波
を受波すると、プリアンプ4で80[dB]程度に増幅し
た後、バンドパスフィルタ8により略200±50[KH
z ]の信号のみを取出し、更に、増幅した後、コンパレ
ータ10によって2値化し、周波数検出用PLL回路1
2に入力して、その路面からの反射波の周波数を検出す
る。コンパレータ10の出力は周波数検出用PLL回路
12によって、路面からの特定の反射波を検出する時間
だけサンプリングホールドし、その電圧を保持すること
によって、路面からの反射波の特定の検出周波数を保持
する。電圧制御発振回路VCOの出力は8分の1に分周
してフィードバックさせて位相差検出回路PDに入力し
ており、これによって超音波送受波器TR1、超音波送
受波器TR2、超音波送受波器TR3に入力される反射
周波数の8倍の周波数にロックされるようになってい
る。したがって、マイクロコンピュータ1で電圧制御発
振回路VCOの出力をカウントすれば、放射した超音波
周波数及び反射してきた超音波周波数を基にドプラー周
波数を検出できる。なお、本実施例においては、車速換
算で約0.5[Km/h]以上の分解能が得られた。
【0042】〈マイクロコンピュータによるメイン制御
動作〉図4及び図5は本発明の実施例の車載用超音波計
測装置のマイクロコンピュータ1が実行するメインプロ
グラムのフローチャートである。また、図6は本発明の
実施例の車載用超音波計測装置のマイクロコンピュータ
1が実行する割込みルーチンのフローチャート、図7は
本発明の実施例の車載用超音波計測装置のマイクロコン
ピュータ1が実行するゲート位置演算制御のフローチャ
ートである。
【0043】また、図8は本発明の実施例の車載用超音
波計測装置の制御のタイミングチャートである。なお、
基本的動作は超音波送受信回路20TRと超音波送受信
回路30TRと超音波送受信回路40TRの動作は同一
であるので、ここでは超音波送受信回路20TRを中心
に動作説明するが、当然、超音波送受信回路30TRと
超音波送受信回路40TRも同様に制御される。
【0044】図示しない電源の投入によって、パワーオ
ンリセット回路の働きによって主演算制御回路101に
リセットパルスが入力され、このリセットによってPR
OM102に格納されている図4及び図5のメインプロ
グラムの処理を開始する。
【0045】ステップS1で超音波送受信回路20TR
と超音波送受信回路30TRと超音波送受信回路40T
Rで使用する各種メモリ及びカウンタ、タイマをクリア
或いは所定の値に設定し、各出力ポート等を初期設定す
るイニシャライズ処理を行なう。特に、受信ゲートスタ
ート時間TG 及びサンプリングスタート時間Ts を設定
する。この受信ゲートスタート時間TG は、既定値とし
て標準状態での車輌100の取付け高さに対応する超音
波信号の受信時間を設定する。例えば、取付高さを28
0[mm]とし、超音波の放射角度を45度、音速C=3
45[m/s ]とした場合、 TG =2×0.28/sin45×1/345+0.3×10-3 =2.6[msec] として設定される。ここで、0.3[msec]が加算され
ているのは、送波パルス幅1[msec]に対して受信ゲー
ト幅0.5[msec]の位置を受波のほぼ中央に設定する
ためである。
【0046】ステップS2で10[msec]のシーケンス
の終了を判断する10msecシーケンス終了フラグF10及
びサンプリング許可フラグFs 、メインタイマTをクリ
アする。ステップS3で100[μsec ]毎に割込みを
行なう100μsec タイマ割込みを許可し、ステップS
4で10msecシーケンス終了フラグF10が降りているか
判断し、10msecシーケンス終了フラグF10が降りるま
で待機し、以降の処理を10[msec]毎に行なう。10
msecシーケンス終了フラグF10が降りると、ステップS
5でスイッチングトランジスタ6をオンとして超音波送
受信回路20TR、超音波送受信回路30TR、超音波
送受信回路40TRの送信ゲートを開き、ステップS6
でメインタイマTで1msecの経過を判断し、ステップS
7で超音波送受信回路20TR、超音波送受信回路30
TR、超音波送受信回路40TRの送信ゲートを閉じ
る。これにより、1[msec]の超音波のバースト信号を
出力することになる。即ち、図8に示すように、ステッ
プS4からステップS7は、送信ゲートの開をマイクロ
コンピュータ1の出力端子P1 の10[msec]毎に1
[msec]間の“1”によって行ない、その間、分周回路
2の出力e1 に示すバースト信号となり、超音波送受波
器TR1及び超音波送受波器TR2及び超音波送受波器
TR3の送波入力は出力e2 のようになる。また、その
反射波は超音波送受波器TR1または超音波送受波器T
R2または超音波送受波器TR3を介して出力e3 のよ
うになる。
【0047】なお、ここまでは、同時に超音波を送波す
る場合、超音波送受信回路20TR、超音波送受信回路
30TR、超音波送受信回路40TRが同時に制御され
る。しかし、以降は、超音波送受信回路20TR、超音
波送受信回路30TR、超音波送受信回路40TR毎に
反射波を入力する予測されたサンプリングスタート時間
Ts が異なることから、超音波送受信回路20TR、超
音波送受信回路30TR、超音波送受信回路40TRが
個々に制御されるものであるが、本実施例では説明が煩
雑になるのを防止するため、共通事項の説明を省略す
る。
【0048】ステップS8で超音波送受信回路20TR
(超音波送受信回路30TR、超音波送受信回路40T
R)に反射波の受波信号を入力する予測されたサンプリ
ングスタート時間Ts を判断し、サンプリングスタート
時間Ts が到来したときステップS9でサンプリング許
可フラグFs を立て、初期設定した値またはゲート位置
演算処理ルーチンで得た各受信ゲートスタート時間TG
の到来をステップS10で待つ。各受信ゲートスタート
時間TG が到来したとき、ステップS11で超音波送受
信回路20TR(超音波送受信回路30TR、超音波送
受信回路40TR)の受信ゲートを開とし、ステップS
12で0.5[msec]だけ受信ゲートをオンとした後、
ステップS13で受信ゲートをオフとし、ステップS1
4の処理に入る。即ち、ステップS8からステップS1
3では、各超音波送受信回路20TR(超音波送受信回
路30TR、超音波送受信回路40TR)の受信ゲート
スタート時間TG の到来を判断し、各超音波送受信回路
20TR(超音波送受信回路30TR、超音波送受信回
路40TR)に対応して、反射してくる超音波を通過さ
せる受信ゲートを開閉するものである。
【0049】そして、ステップS14で主演算制御回路
101が内蔵するカウンタCOUNT1(カウンタCOUNT2、カ
ウンタCOUNT3)のゲートを開とし、ステップS15でサ
ンプリングスタート時間Ts から3[msec]の経過を判
断する。即ち、サンプリングスタート時間Ts は受信ゲ
ートのオン時間の中心から±1.5[msec]だけ、マイ
クロコンピュータ1の内蔵するA/Dコンバータの端子
Aoin (A/Dコンバータの端子A1in 、A/Dコンバ
ータの端子A2in )に超音波送受信回路20TR(超音
波送受信回路30TR、超音波送受信回路40TR)の
信号を入力し、到来する信号のサンプリングを行なう。
各サンプリングスタート時間Ts から3[msec]経過し
たとき、ステップS16でサンプリング許可フラグFs
を降ろす。ステップS17においてメインタイマTでカ
ウンタのゲートの開の時間が、各超音波送受信回路20
TR(超音波送受信回路30TR、超音波送受信回路4
0TR)毎の受信ゲートスタート時間TG から2.5ms
ecの経過を判断して、カウンタの計数値をステップS1
8で読込み及びカウンタのゲートを閉じ、ステップS1
9で二次元速度の演算等を行なう。
【0050】即ち、速度V[Km/h]の演算は、各速度V
1 ,V2 を V1 =K・countX1 V2 =K・countX2 V3 =K・countX3 但し、countX1 ,X2 ,X3 :カウンタの係数値 K:大気温度によって決定される係数 として行ない、前記式(5)乃至式(7)等の必要な式
の演算を行なう。また、前記式から速度ベクトルの積
分、微分を行なうことにより、距離、加速度が演算で
き、車輌100の後部横方向速度ベクトルVyr、前部横
方向速度ベクトルVyfを得ると、車輌100に加わる遠
心力等を演算できる。当然、車輌100の重心を通る中
心軸を中心とする回転角速度、即ち、ヨーレートを演算
することもできる。
【0051】ステップS20でゲート位置演算処理ルー
チンをコールする。そして、ステップS21でサンプリ
ングスタート時間Ts に受信ゲートスタート時間TG か
ら1.2[msec]だけ先にサンプリング時刻を設定す
る。即ち、ゲート位置演算処理ルーチンは次回の受信ゲ
ートスタート時間TG を決定する。そして、ステップS
22で10msecシーケンス終了フラグF10を立て、ステ
ップS23で大気温度を読込み、次の車速演算に使用す
る比例定数のKの値を決定し、ステップS4以降のルー
チンを繰返し、実行する。
【0052】〈マイクロコンピュータのタイマ割込み動
作〉ステップS31でメインタイマTに「+1」インク
リメントし、ステップS32でメインタイマTによって
100[μsec ]毎の割込みのタイミングであるか判断
し、ステップS32で割込みのタイミングであると判断
されたとき、ステップS33及びステップS34で10
[msec]のシーケンスの終了を判断する10msecシーケ
ンス終了フラグF10を降ろし、メインタイマTをクリア
する。割込みのタイミングでないと判断されたとき、ス
テップS33及びステップS34の処理を回避する。
【0053】また、ステップS35でサンプリング許可
フラグFs が立っているか判断し、サンプリング許可フ
ラグFs が立っているとき、ステップS36で受信レベ
ル検出回路11の出力によりA/D変換をスタートし、
ステップS37でそれをバッファに書込み、このルーチ
ンを脱する。また、ステップS35でサンプリング許可
フラグFs が立っていないと判断されたとき、このルー
チンを脱する。
【0054】即ち、このルーチンでは、メインタイマT
によって0.1[msec]毎に信号レベル検出回路11を
介して信号レベルをサンプリングし、その信号レベルを
主演算制御回路101が内蔵するバッファに格納するも
のである。
【0055】〈マイクロコンピュータによるゲート位置
制御動作〉0.1[msec]毎の割込みによるサンプリン
グによってサンプルされた受信レベルデータは、中央の
サンプルデータの前後に15サンプル、即ち、計31個
のサンプルデータが存在する。まず、ステップS51に
おいて全レベルデータの単純平均により平均値Xを算出
し、ステップS52で受信レベルデータは中央のサンプ
ルデータのレベル値をサンプル中心データ格納メモリX
c に格納する。ステップS53でこれが前後に15サン
プルのレベル値よりも平均値Xに所定量nだけ加算した
値より大きいか判断し、中央のサンプルデータのレベル
値と前後に15サンプルのレベル値が所定の平均値Xに
所定量nだけ加算した値より大きいとき、目的とする反
射波が整然と反射されているデータを意味することか
ら、これを採用すべくステップS54の処理に入る。し
かし、中央のサンプルデータのレベル値と前後に15サ
ンプルのレベル値が所定の平均値Xに所定量nだけ加算
した値より大きくないとき、受信波形がランダムな干渉
によって歪んでしまったデータを意味することから、こ
のデータの採用を防止する。ステップS54で前記全レ
ベルデータの平均値Xに所定量nだけ加算した値を上回
るデータ期間を前後に探してその前時間T1 と後時間T
2 を求める。ステップS55でT2 −T1 の幅が1[ms
ec]で、受信レベルデータを得るタイミングを十分にカ
バーできているか否か判断する。この判断も受信波形が
ランダムな干渉によって歪んでしまったデータを採用す
るのを防止するものである。そして、ステップS56で
(T2+T1 )/2を受信ゲートスタート時間TG とし
て設定する。ステップS53で中央のサンプルレベル値
よりも平均値に所定量nだけ加算した値より大きくない
とき、また、ステップS55でT2 −T1 の幅が1[ms
ec]以上でなくて、受信レベルデータを得るタイミング
を十分にカバーできていないとき、このルーチンを脱す
る。
【0056】このように、本実施例の車載用超音波計測
装置は、進行方向に対して俯角を45度に設定し、そこ
から超音波を送波し、また、路面からの反射波を受波す
る超音波送受波器TR1は、車輌の進行方向に対する速
度V1 を得て、それを直接、車輌100の車速とする。
即ち、超音波送受波器TR1は、車輌100の進行方向
に平行し、路面に対して所定の俯角傾度を持って超音波
を送波し、路面からの反射波を受波する車速検出用の第
1超音波送受波器とすることができる。
【0057】そして、車輌100の回転中心Zo から後
に所定距離L2 だけ離れて配設し、車輌100の進行方
向に平行する直線に対して直角方向とし、路面に対して
所定の俯角傾度を持って超音波を送波し、その反射波を
受波する超音波送受波器TR2からなる第2超音波送受
波器と、また、車輌100の回転中心Zo から前に所定
距離L1 だけ離れて配設し、車輌100の進行方向に平
行する直線に対して直角方向とし、路面に対して所定の
俯角傾度を持って超音波を送波し、その反射波を受波す
る超音波送受波器TR3からなる第3超音波送受波器
と、車輌100に取付けられた前記第1超音波送受波器
及び第2超音波送受波器及び第3超音波送受波器で得ら
れた速度から車輌の二次元速度を演算するステップS1
9からなる演算手段とを具備するものである。
【0058】ここで、車輌100の回転中心Zo から所
定距離L1 だけ前方に離れて配設した第3超音波送受波
器としての超音波送受波器TR3は車速V1 に対して9
0度ずれた方向の速度V3 を得ることになる。また、車
輌100の回転中心Zo から所定距離L2 だけ後方に離
れて配設した第3超音波送受波器としての超音波送受波
器TR2は車速Vに対して90度ずれた方向の速度V2
を得ることになる。
【0059】この速度V2 は、超音波送受波器TR1で
得られる車速としての速度V1 をX軸速度成分とすれ
ば、車輌100の進行方向に平行する直線に対して垂直
方向のY軸速度成分、即ち、このY軸速度成分は車輌1
00の横方向の速度を得ることになる。また、車輌10
0の回転中心Zo から第2超音波送受波器としての超音
波送受波器TR2の間に所定の間隔Lを持たせること
は、車輌100の左右の車輪の回転速度差が速度V2 の
車速となって現われる。
【0060】したがって、前記実施例の演算手段として
のステップS19の速度演算の際に、このX軸速度成分
及びY軸速度成分の二次元速度成分によって、車輌10
0の進行方向の速度Vx 及び車輌100の進行方向に対
する垂直方向の後部横方向速度ベクトルVyr、前部横方
向速度ベクトルVyfを得ることができる。また、これに
よってヨー角、その角の変化速度を求めることによりヨ
ーレート、速度ベクトルの積分、微分を行なうことによ
り、距離、加速度が演算できる。
【0061】よって、得られた二次元速度成分を使用す
ることにより、ナビゲーションシステムの移動距離及び
移動方向の補正、車輌速度及び横方向の速度等の速度検
出装置、横滑り防止装置、ヨーレート補正したり左右の
車輪の回転差を補正したABS装置、ヨーレート補正し
たり左右の車輪側の路面と車輌との車高を調整するサス
ペンション装置等の各種速度情報を使用する計測装置及
び制御装置に使用できる。
【0062】特に、本実施例のように、車輌100の回
転中心Zo から前に所定距離L1 だけ離れて第3超音波
送受波器を配設し、また、車輌100の回転中心Zo か
ら後に所定距離L2 だけ離れて第2超音波送受波器を配
設したものであるから、ヨー角を演算する場合には、超
音波送受波器TR2の車速V2 と超音波送受波器TR3
の車速V3 の和で表現される式(7)となり、精度良く
車輌100の進行方向に対する垂直方向の横方向速度を
演算できる。
【0063】ところで、上記実施例では、超音波送受波
器TR1、超音波送受波器TR2、超音波送受波器TR
3によって二次元的な車輌速度を検出しているが、本発
明を実施する場合、音速は車速に対して無視できる程度
に速くないため、送受波総合の利得を上げようとして超
音波ビーム幅を狭くした場合には、送波時のビームと受
波時のビームにずれが生じるから、このときには、低速
走行時の速度の測定用に超音波送受波器、また、高速走
行時の速度の測定用に超音波受波器で反射波を受波する
ようにしてもよく、また、超音波送受信回路20TR、
超音波送受信回路30TR、超音波送受信回路40TR
が各々2個の超音波送受波器を使用してもよいし、その
うちの1個のみを超音波受波専用としてもよい。特に、
車輌100の走行方向に平行する速度を検出する超音波
送受信回路20TRを、2個の超音波送受波器と超音波
送受波器または超音波送受波器と超音波受波器とし、車
速に応じて反射波を受波する位置を変えると、信頼性の
高い速度が得られる。
【0064】そして、本発明の実施例では、車輌100
の前方に超音波送受波器TR1を配設し、車輌100の
後方に超音波送受波器TR2を配設しているが、本発明
を実施する場合には、超音波送受波器TR1は車輌10
0の進行方向に対して平行に配設できる位置であればよ
く、また、超音波送受波器TR2と超音波送受波器TR
3は、車輌100の回転中心Zo を通り所定距離Lだけ
離れておればよく、その所定距離Lの大小を問うもので
ないが、所定距離Lが大きいと検出できる速度が大きく
なり、それだけ検出精度を高くすることができる。ま
た、超音波送受波器TR1を車輌100の中間に配設す
ると、最も、車速の信頼性が高くなる。
【0065】なお、上記発明の実施例では、車速の測定
について説明したが、本発明の車載用超音波計測装置
は、速度成分を使用することにより、ナビゲーションシ
ステム、速度検出装置、横滑り防止装置、ABS装置、
サスペンション装置等の各種速度情報を使用する計測装
置及び制御装置に使用できる。
【0066】
【発明の効果】以上のように、この発明の車載用超音波
計測装置は、車輌の進行方向に平行し、路面に対して所
定の俯角傾度を持って超音波を送波し、その反射波を受
波する車速検出用の第1超音波送受波器と、前記車輌の
回転中心から前後に所定距離離れて配設し、前記車輌の
進行方向に平行する直線に対して直角方向とし、路面に
対して所定の俯角傾度を持って超音波を送波し、その反
射波を受波する2個の第2超音波送受波器及び第3超音
波送受波器を有し、それらの第1超音波送受波器、第2
超音波送受波器、第3超音波送受波器から得た速度ベク
トルによって、車輌の進行方向の速度と横方向速度、回
転角度またはその回転角速度等の二次元速度を演算する
ものである。
【0067】したがって、第1超音波送受波器は、直
接、車速を検出し、第2超音波送受波器及び第3超音波
送受波器は車速に対して直角にずれた方向の横方向の速
度を得ることになり、車輌の回転中心と第3超音波送受
波器との間に所定の間隔を持たせることになり、車輌の
左右の車輪の回転速度差速度に相当する横方向速度を用
いてヨー角、ヨーレートの演算ができる。更に、これら
速度ベクトルの積分、微分を行なうことにより、距離、
加速度が演算でき、また、その軌跡をトレースすること
ができ、計測装置及び制御装置に使用できる。
【図面の簡単な説明】
【図1】図1は本発明の実施例の車載用超音波計測装置
の基本原理説明図である。
【図2】図2は本発明の実施例の車載用超音波計測装置
の回路構成図である。
【図3】図3は本発明の実施例の車載用超音波計測装置
の回路構成で使用したマイクロコンピュータの機能構成
図である。
【図4】図4は本発明の実施例の車載用超音波計測装置
のマイクロコンピュータが実行するメインプログラムの
一部のフローチャートである。
【図5】図5は本発明の実施例の車載用超音波計測装置
のマイクロコンピュータが実行するメインプログラムの
他の一部のフローチャートである。
【図6】図6は本発明の実施例の車載用超音波計測装置
のマイクロコンピュータが実行する割込みルーチンのフ
ローチャートである。
【図7】図7は本発明の実施例の車載用超音波計測装置
のマイクロコンピュータが実行するゲート位置演算制御
のフローチャートである。
【図8】図8は本発明の実施例の車載用超音波計測装置
の制御のタイミングチャートである。
【図9】図9は車載用超音波計測装置の1個の超音波送
受波器で送波及び受波する場合の動作原理図である。
【符号の説明】
TR1,TR2,TR3 超音波送受波器 11 受信レベル検出回路 12 周波数検出用PLL回路 20TR 超音波送受信回路 30TR 超音波送受信回路 40TR 超音波送受信回路 100 車輌 Zo 回転中心

Claims (1)

    【特許請求の範囲】
  1. 【請求項1】 車輌の進行方向に平行し、路面に対して
    所定の俯角傾度を持って超音波を送波し、その反射波を
    受波する第1超音波送受波器と、 前記車輌の回転中心の前後に所定距離離れて配設し、前
    記車輌の進行方向に平行する直線に対して直角方向と
    し、路面に対して所定の俯角傾度を持って超音波を送波
    し、その反射波を受波する2個の第2超音波送受波器及
    び第3超音波送受波器と、 前記第1超音波送受波器及び第2超音波送受波器及び第
    3超音波送受波器で得られた速度から車輌の二次元速度
    を演算する演算手段とを具備することを特徴とする車載
    用超音波計測装置。
JP5014246A 1993-01-29 1993-01-29 車載用超音波計測装置 Pending JPH06230126A (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP5014246A JPH06230126A (ja) 1993-01-29 1993-01-29 車載用超音波計測装置
US08/187,507 US5491648A (en) 1993-01-29 1994-01-28 Ultrasonic measuring system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP5014246A JPH06230126A (ja) 1993-01-29 1993-01-29 車載用超音波計測装置

Publications (1)

Publication Number Publication Date
JPH06230126A true JPH06230126A (ja) 1994-08-19

Family

ID=11855735

Family Applications (1)

Application Number Title Priority Date Filing Date
JP5014246A Pending JPH06230126A (ja) 1993-01-29 1993-01-29 車載用超音波計測装置

Country Status (2)

Country Link
US (1) US5491648A (ja)
JP (1) JPH06230126A (ja)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6885968B2 (en) * 2000-05-08 2005-04-26 Automotive Technologies International, Inc. Vehicular exterior identification and monitoring system-agricultural product distribution
US6338028B1 (en) * 1998-06-11 2002-01-08 Trw Inc. Ultrasonic sensor system and method having input capture for echo processing
DE102007035270B4 (de) * 2007-07-27 2011-12-08 Continental Automotive Gmbh Vorrichtung zum Betreiben eines Schallwandlers
CN203588540U (zh) * 2013-03-22 2014-05-07 柳州铁道职业技术学院 城市轨道交通车载雷达测速实验装置

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE2133524C3 (de) * 1971-07-06 1974-06-12 Siemens Ag, 1000 Berlin Und 8000 Muenchen Verfahren zur Bestimmung der Geschwindigkeit eines Fahrzeugs
JPS5768574A (en) * 1980-10-16 1982-04-26 Hiroshi Shimoda Method of pumping up water in power plant utilizing wind and water power
US4414548A (en) * 1981-03-30 1983-11-08 Trw Inc. Doppler speed sensing apparatus
JPS5839971A (ja) * 1981-09-03 1983-03-08 Japan Radio Co Ltd 超音波ドップラ速度検出方法
JPS59203973A (ja) * 1983-05-06 1984-11-19 Nissan Motor Co Ltd 相対速度検出器
JPH06104455B2 (ja) * 1985-03-15 1994-12-21 日産自動車株式会社 車両運動状態推定装置
US4698775A (en) * 1985-05-17 1987-10-06 Flexible Manufacturing Systems, Inc. Self-contained mobile reprogrammable automation device
US5075864A (en) * 1988-10-03 1991-12-24 Lucas Industries Public Limited Company Speed and direction sensing apparatus for a vehicle
US4933864A (en) * 1988-10-04 1990-06-12 Transitions Research Corporation Mobile robot navigation employing ceiling light fixtures
JPH02307087A (ja) * 1989-05-23 1990-12-20 Mazda Motor Corp 対地速度検出装置
JPH0769421B2 (ja) * 1990-03-20 1995-07-31 日本無線株式会社 車載用多目的超音波計測装置
US5373446A (en) * 1991-09-20 1994-12-13 Toyota Jidosha Kabushiki Kaisha Vehicle ground-speed detecting apparatus
US5339259A (en) * 1992-07-10 1994-08-16 Northrop Grumman Corporation High speed high resolution ultrasonic position and orientation tracker

Also Published As

Publication number Publication date
US5491648A (en) 1996-02-13

Similar Documents

Publication Publication Date Title
US6279396B1 (en) Ultrasonic-wave distance measuring method and apparatus of separate transmission and reception type reflection system
JP3237034B2 (ja) 車載用超音波計測装置
JPH06230126A (ja) 車載用超音波計測装置
JPH06230122A (ja) 車載用超音波計測装置
JPH03269388A (ja) 車載用多目的超音波計測装置
JP3530982B2 (ja) 車載用車速計測装置
JPH06230123A (ja) 車載用超音波計測装置
JPH06230125A (ja) 車載用超音波計測装置
JP2932210B2 (ja) 自動車のレーダシステム
JPH06230124A (ja) 車載用超音波計測装置
JPH07181257A (ja) 車載用超音波計測装置
JPH0792264A (ja) 車載用車速計測装置
JPH06230121A (ja) 車載用超音波計測装置
JPH07128444A (ja) 車両用距離測定装置
JPH0755932A (ja) 車載用超音波計測装置
JPH0763849A (ja) 車載用超音波車速計測装置
JPH0126120B2 (ja)
JPH06342068A (ja) 車載用超音波計測装置
JPH07181258A (ja) 車載用超音波計測装置
JPH0772247A (ja) 車載用車速計測装置
JPH0798322A (ja) 車載用車速計測装置
JPH0763850A (ja) 車載用車速計測装置
JPH0755933A (ja) 車載用超音波計測装置
JP2958013B2 (ja) 車両用衝突警報装置
JP3522561B2 (ja) 障害物検知装置