JP4173934B2

JP4173934B2 - Speed measuring device

Info

Publication number: JP4173934B2
Application number: JP34422698A
Authority: JP
Inventors: 正吉田中
Original assignee: Japan Radio Co Ltd
Current assignee: Japan Radio Co Ltd
Priority date: 1998-12-03
Filing date: 1998-12-03
Publication date: 2008-10-29
Anticipated expiration: 2018-12-03
Also published as: JP2000171558A

Description

【０００１】
【発明の属する技術分野】
この発明は、移動体、例えば、車両等の速度を計測するための速度計測装置、または、移動体、例えば、船舶等の対地速度を計測するためのドップラソナー等の速度計測装置に関し、一層詳細には、前記車両等または前記船舶等から送信された超音波が路面または水底（海底）に反射して帰来するエコー波のドップラ周波数成分を計測し、このドップラ周波数成分に基づいて、前記車両等または前記船舶等の速度を得る速度計測装置に関する。
【０００２】
【従来の技術】
従来から、移動体である車両には、該車両に搭載されたナビゲーションシステム、ＡＢＳ装置、サスペンション制御装置等の外部装置において利用される前記車両の速度を計測するための装置（以下、第１の車速計測装置と記す。）が搭載されている。この第１の車速計測装置は、一般に、車両の各車輪に装着された車輪速センサで計測された前記車輪の回転速度に基づいて、車両の速度を求めるように構成されている。
【０００３】
ところで、第１の車速計測装置によって求められた車両の速度には、車輪の空気圧の変化、車両の積み荷重量の変化、車輪のサイズ、車輪に生じるスリップ等の影響により誤差が生じる場合がある。従って、前記第１の車速計測装置においては、高い計測精度を得ることが困難な場合が生じていた。
【０００４】
そこで、近時、車速計測装置の計測精度をさらに向上させる目的で、超音波ドップラ法を用いて車両の速度を計測する装置（以下、第２の車速計測装置と記す。）の開発・実用化が進められている。
【０００５】
図５に、第２の車速計測装置１の構成を示す。この第２の車速計測装置１は、速度ｖで走行する車両３に装着された超音波送受波器５を有する。この超音波送受波器５は、演算回路７からの信号に基づいて、車両３が走行している路面Ａに対して周波数（以下、基準周波数と記す。）ｆａのトーンバースト波Ｔｗを、前記車両３の前方に所定の俯角θで送信する。
【０００６】
また、超音波送受波器５は、トーンバースト波Ｔｗが前記路面Ａに反射して帰来する反射エコーＲｗを受信する。なお、超音波送受波器５における受波ビームは、メインローブＭＬが俯角θに一致するように設定されている。そして、超音波送受波器５で得られた反射エコーＲｗに基づく受信信号は演算回路７に供給される。演算回路７は、反射エコーＲｗの周波数（以下、標的周波数と記す。）ｆｂを求めるとともに、この標的周波数ｆｂと前記基準周波数ｆａとから、車両３の速度ｖを求める。なお、標的周波数ｆｂと基準周波数ｆａとの差（ｆｂ−ｆａ）をドップラ周波数成分Δｆとも記す。
【０００７】
ここで、車両３の速度ｖは、音速Ｃおよび基準周波数ｆａを用いて、標的周波数ｆｂ（すなわち、ドップラ周波数成分Δｆ）の関数として表される。従って、標的周波数ｆｂを得ることにより、前記関数に基づいて車両３の速度ｖを求めることができる。
【０００８】
なお、船舶の対地速度を計測するための装置であるドップラソナーは、第２の車速計測装置１と同様に構成することができる。すなわち、ドップラソナーは、例えば、船底に装着された超音波送受波器を有し、この超音波送受波器から水底（海底）に向けて送信された超音波（トーンバースト波）が前記海底に反射して帰来した反射エコーを受信する。そして、この反射エコーのドップラ周波数成分に基づいて、船舶の対地速度を計測する。
【０００９】
【発明が解決しようとする課題】
しかしながら、上述の第２の車速計測装置１においては、雨天時等に使用された場合、計測された速度ｖに誤差が生じるおそれがある。これは、雨天時等のように路面Ａが濡れている状況下では、前記路面Ａが超音波に対して鏡面に近い状態となるためである。この場合、超音波送受波器５から所定の俯角θで送信されたトーンバースト波Ｔｗの大半は路面Ａで正反射してしまい、受波ビームのメインローブＭＬによって前記超音波送受波器５に受信される反射エコーＲｗのレベルが低くなってしまう。従って、超音波送受波器５において反射エコーＲｗを確実に受信することは困難となる。
【００１０】
このような、雨天時等に発生する問題を回避するためには、低いレベルの反射エコーＲｗをも確実に受信すべく、演算回路７を構成する受信回路（図示せず）の利得を大きくする方法が考えられる。
【００１１】
ところで、超音波送受波器５においては、該超音波送受波器５から略真下方向に送信されたトーンバースト波Ｔｗの反射エコーＲｗが、受波ビームのサイドローブＳＬによっても受信されている。従って、受信回路の利得を大きくした場合、サイドローブＳＬによって受信された反射エコーＲｗの影響が受信信号の中で支配的となる。このような受信信号に基づいて車両３の速度ｖが求められた場合には、速度ｖの計測精度が低下してしまう不都合があった。
【００１２】
また、雨天時等に計測された速度ｖに誤差が生じる原因として、車両３の前方を走行している他の車両によって巻き上げられる水飛沫の影響があげられる。車両が、例えば、数１０ｋｍ／ｈ以上の速度で走行した場合、該車両の後方には、大量の水飛沫が巻き上げられることとなる。このように、車両３の前方に大量の水飛沫が存在する状況で速度ｖの計測が行われた場合、上述した濡れた路面Ａによって生じる計測誤差の要因（超音波送受波器５において、メインローブＭＬによって受信される反射エコーＲｗのレベルの低下や、サイドローブＳＬによって受信される反射エコーＲｗの受信信号中における影響の増大）に加えて、さらに、水飛沫に反射して帰来する反射エコーＲｗによる誤差要因が重畳される。
【００１３】
水飛沫からの反射エコーＲｗの周波数は、トーンバースト波Ｔｗの基準周波数ｆａに対して、広い帯域にほぼ均一に分布することが実験的に判っている。このような分布を有する周波数から、路面Ａに反射して帰来し、超音波送受波器５においてメインローブＭＬによって受信された反射エコーＲｗの標的周波数ｆｂを得るための方法としては、超音波送受波器５で受信される反射エコーＲｗの周波数の平均値を標的周波数ｆｂとして算出するゼロクス法や、複素自己相関法等が採用可能であるが、このような方法を用いて速度ｖを求めた場合、計測精度の低下をもたらすおそれがあった。
【００１４】
また、上述のドップラソナーがプランクトンなどの海中浮遊物が多い海域で使用された場合、前記第２の車速計測装置１における水飛沫等による影響と同様に、前記プランクトンに反射して帰来する反射エコーの影響によって、計測される船舶の対地速度に誤差が生じるおそれがあった。
【００１５】
この発明はこのような課題を考慮してなされたものであり、計測誤差の要因が存在する様々な条件下においても移動体の速度を安定かつ正確に計測することが可能な速度計測装置を提供することを目的とする。
【００１６】
【課題を解決するための手段】
この発明に係る速度計測装置は、超音波を用いて移動体である車両又は船舶の速度を計測する速度計測装置であって、
前記移動体の前方に所定の俯角で超音波を送信する送信手段と、
前記超音波がターゲットである路面又は水底に反射して帰来する超音波エコーを受信して受信情報を得る受信手段と、
前記俯角、前記ターゲットまでの鉛直距離及び音速に基づき前記受信手段からの前記受信情報をサンプリングするタイミングを検出するタイミング検出手段と、
前記タイミングに基づいて前記受信情報をサンプリングし、該受信情報にＦＦＴ演算を施すことによりスペクトラム分布を得る第１演算手段と、
前記スペクトラム分布から前記移動体の速度に対応するドップラ周波数成分を抽出する際、大きさが上位２番目までのピークに対応する２つの周波数を求め、高い方の周波数を用いて前記ドップラ周波数成分を抽出する第２演算手段と、
前記ドップラ周波数成分に基づいて、前記移動体の前記ターゲットに対する速度を求める第３演算手段と、
を有することを特徴とする（請求項１記載の発明）。
【００１７】
この場合、前記第３演算手段においては、前記ドップラ周波数成分に基づいて新しい速度を求められ、この新しい速度と、同様の処理において前回求められていた古い速度との差が所定値より小さい場合に、前記新しい速度が前記移動体の現在の速度として採用される（請求項２記載の発明）。
【００１８】
このため、計測誤差の要因が発生する状況下においても、ターゲットからの超音波エコーに基づいて、移動体の速度を正確に求めることが可能である。従って、計測精度および安定性の大幅な向上が図られる。
【００１９】
なお、前記移動体から後方に所定の俯角で超音波を送信する他の送信手段と、該超音波がターゲットに反射して帰来する超音波エコーを受信して受信情報を得る他の受信手段と、をさらに設け、前記前方及び前記後方に所定の俯角でそれぞれ送信した前記超音波のそれぞれの前記超音波エコーに基づいて、前記移動体の前記ターゲットに対するそれぞれの速度を求め、求めたそれぞれの速度の平均値を、前記ターゲットに対する速度とする速度計測装置を構成するようにしてもよい（請求項３記載の発明）。
【００２０】
【発明の実施の形態】
以下、この発明の一実施の形態について図面を参照して説明する。
【００２１】
図１は、この発明の一実施の形態が適用された速度計測装置２０の構成を示している。なお、この実施の形態においては、主に、速度計測装置２０が車両に搭載されている場合について説明する。
【００２２】
速度計測装置２０は、該速度計測装置２０全体を制御するとともに、後述する速度ｖを算出する処理を行う中央演算処理部（演算手段）２２と、制御用のプログラムが記憶される記憶手段（メモリ）であるＲＯＭ２４とを有する。中央演算処理部２２は、例えば、ＤＳＰ（デジタルシグナルプロセッサ）等により構成されている。また、速度計測装置２０は、振動子等を用いて構成された、超音波を送受信するための送受波器ＴＤ１と、該送受波器ＴＤ１を介して、単一周波数の超音波であるトーンバースト波Ｔｗを送信する処理を行う送信系２６と、前記送受波器ＴＤ１を介して、前記トーンバースト波Ｔｗがターゲット｛例えば、車両が走行する路面Ａ（図５参照）｝に反射して帰来する反射エコー（超音波エコー）Ｒｗを受信する処理を行う受信系２８とを有する。送受波器ＴＤ１における送受信の切り換えは、送受切換器３０によって行われる。
【００２３】
この場合、送信系２６と送受波器ＴＤ１とによって、トーンバースト波Ｔｗの送信手段が構成され、受信系２８と前記送受波器ＴＤ１とによって、反射エコーＲｗの受信手段が構成されている。
【００２４】
送受波器ＴＤ１は、前記した第２の車速計測装置１（図５参照）と同様に、移動体である、例えば、車両等に、トーンバースト波Ｔｗの送信方向および受波ビームのメインローブＭＬが、所定の俯角θ（０＜θ＜π／２）で前記車両等の前方を指向するように装着されている。また、送受波器ＴＤ１の路面Ａからの高さをＨとする。
【００２５】
送信系２６は、駆動信号発生回路３２および電力増幅回路３４を備えている。
【００２６】
駆動信号発生回路３２は、カウンタ（図示せず）を内蔵しており、中央演算処理部２２から供給される、例えば、１０ＭＨｚの基準信号Ｓｒを所定の分周比で分周することにより、送信用駆動信号Ｐ１を生成する（図２Ａ参照）。具体的には、駆動信号発生回路３２は、中央演算処理部２２からコントロール信号Ｓｃ１として供給される分周比に基づいて周波数（基準周波数）ｆａ（例えば、ｆａ＝２００ｋＨｚ）の信号を生成し、この信号を基準信号Ｓｒに同期してパルス変調することにより、パルス幅Ｔａ（例えば、Ｔａ＝１ｍｓ）、繰り返し周期Ｔ０（例えば、Ｔ０＝１０ｍｓ）の送信用駆動信号Ｐ１を生成する。なお、繰り返し周期Ｔ０は、中央演算処理部２２からコントロール信号Ｓｃ１が出力されるタイミングに基づいて決定される。
【００２７】
電力増幅回路３４は、駆動信号発生回路３２からの送信用駆動信号Ｐ１を電力増幅して電気信号Ｔｘを生成し、送受切換器３０を介して送受波器ＴＤ１に供給する。送受波器ＴＤ１は、この電気信号Ｔｘによって駆動され、路面Ａ（図５参照）に対してトーンバースト波Ｔｗを送信する。
【００２８】
一方、受信系２８は、図１に示すように、帯域フィルタ４０、増幅回路４２、検波回路４４、レベル比較回路４６およびＡ／Ｄコンバータ４８を備えている。
【００２９】
送受波器ＴＤ１において、路面Ａ（図５参照）に反射して帰来した反射エコーＲｗが受信されると、この送受波器ＴＤ１からは、前記反射エコーＲｗに応じた電気信号Ｒｘが出力される。帯域フィルタ４０は、この電気信号Ｒｘから所定の周波数帯域に属する成分を取り出し（濾波し）、受信信号Ｅ１として出力する（例えば、晴天時における受信信号Ｅ１を示す図２Ｂ参照）。なお、受信信号Ｅ１には、路面Ａ（図５参照）から反射し、送受波器ＴＤ１に受波ビームのメインローブＭＬによって受信された反射エコーＲｗの成分ａとともに、電気信号Ｔｘのもれによる成分ｂが含まれている。受信信号Ｅ１は増幅回路４２で増幅された後、それぞれ、検波回路４４およびＡ／Ｄコンバータ４８に供給される（図１参照）。
【００３０】
検波回路４４は、増幅回路４２からの受信信号Ｅ１を全波整流することにより、直流検波信号Ｓｄに変換する。レベル比較回路４６は、検波回路４４からの直流検波信号Ｓｄの電圧値Ｖ（Ｓｄ）を所定の基準電圧Ｖｒｅｆと比較し、前記電圧値Ｖ（Ｓｄ）が前記基準電圧Ｖｒｅｆを上回っている間のみハイレベルとなる受波検出ゲート信号Ｇ１（図２Ｃ参照）を中央演算処理部２２に対して出力する。中央演算処理部２２は、コントロール信号Ｓｃ１を出力した時点から受波検出ゲート信号Ｇ１の立ち上がり時点までの時間を計測することにより、送受波器ＴＤ１からトーンバースト波Ｔｗが送信されてから反射エコーＲｗが受信されるまでの時間Ｔ１を求める。なお、受波検出ゲート信号Ｇ１は、受信信号Ｅ１に電気信号Ｔｘのもれによる成分ｂが含まれている場合にもハイレベルとなるが、中央演算処理部２２は、この電気信号Ｔｘのもれに基づく受波検出ゲート信号Ｇ１の変化をコントロール信号Ｓｃ１の出力時点に基づいて予測し、時間Ｔ１を求める処理においては考慮しないようにする。
【００３１】
Ａ／Ｄコンバータ４８は、中央演算処理部２２から供給されるコントロール信号Ｓｃ２に従って、増幅回路４２からの受信信号Ｅ１をデジタルのデータである受信データ（受信情報）Ｄ（Ｅ１）に変換し、中央演算処理部２２に供給する。このコントロール信号Ｓｃ２によって、中央演算処理部２２において受信データＤ（Ｅ１）のサンプリングを開始するタイミングＴ２が指示される（図２Ｄ参照）。すなわち、中央演算処理部２２は、タイミングＴ２を検出するためのタイミング検出手段として機能する。
【００３２】
この場合、タイミングＴ２は、送受波器ＴＤ１の路面Ａからの高さＨと、トーンバースト波Ｔｗを送信する俯角θとに基づいて求められた時間に、送受波器ＴＤ１が装着される、例えば、車両等の上下動の影響による前記時間の変動を考慮した値を加算することにより求められる（図５参照）。
【００３３】
具体的には、タイミングＴ２は、次の（１）式に基づいて求められる。
【００３４】
Ｔ２＝２×Ｈ／（Ｃ×ｓｉｎθ）−０．２５×１０^-3［ｓｅｃ］ …（１）
ただし、Ｃは音速であり、送受波器ＴＤ１の周囲温度ｔを用いて次の（２）式に基づいて求められる。
【００３５】
Ｃ＝３３１．６＋０．６１×ｔ［ｍ／ｓ］ …（２）
なお、周囲温度ｔは、送受波器ＴＤ１の近傍に設けられたサーミスタ５０によって計測される（図１参照）。具体的には、サーミスタ５０で得られた周囲温度ｔに基づく温度信号（電圧）Ｓｔは、Ａ／Ｄコンバータ５２を介して温度データＤ（ｔ）として中央演算処理部２２に供給される。なお、サーミスタ５０の一方の端子は、該サーミスタ５０にバイアスを与えるための抵抗器Ｒを介して電源に接続されており、他方の端子は接地されている。
【００３６】
中央演算処理部２２は、温度データＤ（ｔ）に基づいて周囲温度ｔを求める。この場合、中央演算処理部２２に温度データＤ（ｔ）を取り込むタイミングは、該中央演算処理部２２からＡ／Ｄコンバータ５２に供給されるコントロール信号Ｓｃ３によって指示される。
【００３７】
また、中央演算処理部２２からＡ／Ｄコンバータ４８に供給されるコントロール信号Ｓｃ２によって、前記中央演算処理部２２における受信データＤ（Ｅ１）のサンプリング間隔ΔＴ（この実施の形態においては、ΔＴ＝１．５μｓ）と、サンプリングポイント数Ｎ（例えば、Ｎ＝１０２４ポイント）が指示される（図２Ｄ参照）。サンプリングポイント数Ｎは、サンプリング間隔ΔＴに基づいて設定される。
【００３８】
中央演算処理部２２は、これらタイミングＴ２、サンプリング間隔ΔＴおよびサンプリングポイント数Ｎに基づいて、受信データＤ（Ｅ１）のサンプリングを行う。このようにタイミングＴ２、サンプリング間隔ΔＴおよびサンプリングポイント数Ｎを設定することにより、送受波器ＴＤ１に受波ビームのメインローブＭＬによって受信される路面Ａからの反射エコーＲｗを、受信データＤ（Ｅ１）として確実にサンプリングすることができる（図２Ｂおよび図２Ｄ参照）。
【００３９】
中央演算処理部２２は、サンプリングした受信データＤ（Ｅ１）にＦＦＴ（高速フーリエ変換）処理（ＦＦＴ演算とも記す。）を施すことにより、図３Ａに示すスペクトラム分布を求める。このスペクトラム分布は、０．６５１ｋＨｚ｛＝１／（１０２４×１．５×１０^-6）ｋＨｚ｝の間隔で、０〜３３３ｋＨｚ（＝５１２×０．６５１ｋＨｚ）の周波数帯域にわたって分布するように設定される。
【００４０】
例えば、晴天時におけるスペクトラム分布には、受信信号Ｅ１の成分ａ（図２Ｂ参照）に対応するピークＰａが存在する。このため、このピークＰａにおける周波数ｆ１を求めることにより、路面Ａ（図５参照）から反射し、送受波器ＴＤ１に受波ビームのメインローブＭＬによって受信された反射エコーＲｗの周波数（標的周波数）ｆｂがｆｂ＝ｆ１として得られる。
【００４１】
ところで、雨天時等の路面Ａが濡れている状況下では、トーンバースト波Ｔｗの大半は前記路面Ａで正反射してしまう（図５参照）。このため、図２Ｅに示すように、受信信号Ｅ１に含まれる、路面Ａ（図５参照）から反射し、送受波器ＴＤ１に受波ビームのメインローブＭＬ（図５参照）によって受信された反射エコーＲｗの成分ａのレベルが低下してしまう。また、これとは相対的に、送受波器ＴＤ１に受波ビームのサイドローブＳＬ（図５参照）によって受信される反射エコーＲｗの成分ｃのレベルが上昇する。
【００４２】
この場合、反射エコーＲｗのスペクトラム分布には、図３Ｂに示すように、成分ａ（図２Ｅ参照）に対応するピークＰａに加えて、成分ｃ（図２Ｅ参照）に対応するピークＰｃが存在する。ピークＰｃにおける周波数ｆ０は、トーンバースト波Ｔｗの基準周波数ｆａとほぼ同じ値（ｆ０＝ｆａ）となる。このように、スペクトラム分布に複数のピークＰａ、Ｐｃが存在する場合には、大きさが最大のピークＰａまたはＰｃに基づいて標的周波数ｆｂを得ることは困難である。
【００４３】
また、送受波器ＴＤ１の前方を走行する車両によって水飛沫が巻き上げられている状況下では、トーンバースト波Ｔｗは前記水飛沫によって反射されてしまう。このため、受信信号Ｅ１には、前記水飛沫に反射して帰来する反射エコーＲｗの成分ｄが含まれる（図２Ｆ参照）。水飛沫に反射して帰来する反射エコーＲｗの周波数は広い帯域に分布するため、図３Ｃに示す反射エコーＲｗのスペクトラム分布には、成分ｄ（図２Ｆ参照）に対応する複数のピークＰｄ１、Ｐｄ２等が存在する。この場合にも、大きさが最大のピークＰａ、ＰｃまたはＰｄ１、Ｐｄ２等に基づいて標的周波数ｆｂを得ることは困難である。
【００４４】
以下、中央演算処理部２２において、図３Ａ（晴天時）、図３Ｂまたは図３Ｃ（雨天時）に示したスペクトラム分布から、標的周波数ｆｂとしてピークＰａにおける周波数ｆ１を抽出するとともに、この標的周波数ｆｂに基づいて移動体（車両）の速度ｖを算出するための処理方法について、図４のフローチャートを参照して説明する。
【００４５】
まず、ステップＳ１において、コントロール信号Ｓｃ２で設定したタイミングＴ２、サンプリング間隔ΔＴおよびサンプリングポイント数Ｎに基づいて、受信データＤ（Ｅ１）のサンプリングが行われる。続いて、ステップＳ２において、サンプリングした受信データＤ（Ｅ１）に対してＦＦＴ演算を施すことにより、反射エコーＲｗのスペクトラム分布（図３Ａ〜図３Ｃ参照）が得られる。
【００４６】
次いで、ステップＳ３において、スペクトラム分布から、大きさが上位２番目までのピークＰａ、Ｐｃ等が抽出され、このピークＰａ、Ｐｃ等における周波数ｆ１、ｆ０等が求められる。そして、ステップＳ４において、このうち、値が大きい（高い）方の周波数（この場合、ｆ１）を標的周波数ｆｂの第１候補と判定し（ｆｂ＝ｆ１）、次の（３）式に基づいて、速度計測装置２０が搭載される車両等の推定速度ｖ０を算出する。
【００４７】
ｖ０＝Δｆ×Ｃ／｛（２×ｆａ＋Δｆ）×ｃｏｓθ｝ …（３）
ここで、Δｆはドップラ周波数成分を示し、Δｆ＝ｆａ−ｆｂで求められる。また、Ｃは音速であり、前記（２）式に基づいて求められる。
【００４８】
前記ステップＳ４で求められた推定速度ｖ０は、ステップＳ５において、新しい速度ｖ（ｎｅｗ）として中央演算処理部２２の、例えば、図示しないメモリに格納される｛ｖ（ｎｅｗ）←ｖ０｝。これに先だって、前回の処理において求められていた新しい速度ｖ（ｎｅｗ）は、古い速度ｖ（ｏｌｄ）としてメモリに格納される｛ｖ（ｏｌｄ）←ｖ（ｎｅｗ）｝。
【００４９】
次に、ステップＳ６において、新しい速度ｖ（ｎｅｗ）と古い速度ｖ（ｏｌｄ）との差Δｖ｛Δｖ＝ｖ（ｎｅｗ）−ｖ（ｏｌｄ）｝が求められる。続いて、ステップＳ７において、ステップＳ６で求められた差Δｖと所定値ｖｒ（例えば、ｖｒ＝５ｋｍ／ｈ）との比較を行い、Δｖ＜ｖｒである場合には、ステップＳ８において、新しい速度ｖ（ｎｅｗ）が移動体（車両）の現在の速度ｖとして採用される｛ｖ←ｖ（ｎｅｗ）｝。ステップＳ７において、Δｖ≧ｖｒであると判定された場合には、新しい速度ｖ（ｎｅｗ）を現在の速度ｖとしては採用せず、ステップＳ１の処理に戻る。
【００５０】
上記のステップＳ１〜Ｓ８で求められた速度ｖは、図１に示すように、速度データＤ（ｖ）として中央演算処理部２２から出力され、車両に搭載されたナビゲーションシステム、ＡＢＳ装置、サスペンション制御装置等の外部装置に供給される。
【００５１】
上記したように、この実施の形態においては、速度ｖを得るためのステップＳ１〜Ｓ８の処理は、スペクトラム分布から、車両の速度ｖに対応する標的周波数ｆｂ（すなわち、ドップラ周波数成分Δｆ）を抽出するための、一種の周波数フィルタとして機能している。従って、ドップラ周波数成分Δｆに基づいて、車両の速度ｖを正確に求めることができる。
【００５２】
特に、雨天時等のように計測誤差の要因が発生する状況下においても、速度ｖを正確に求めることが可能であるため、ゼロクス法や、複素自己相関法等の計測方法を用いた場合に比べて、計測精度および安定性の大幅な向上が図られる。
【００５３】
なお、この発明は、上述の実施の形態に限らず、この発明の要旨を逸脱することなく、種々の構成を採用することができる。
【００５４】
例えば、車両の前方に対して超音波（トーンバースト波Ｔｗ、反射エコーＲｗ）を送受信する送受波器ＴＤ１に加えて、車両の後方に対して超音波を送受信する他の送受波器を設けるようにした、いわゆる、２ビーム方式を採用するようにしてもよい。前記他の送受波器は、車両の後方に所定の俯角（例えば、θ）でトーンバースト波を送信するとともに、該トーンバースト波が路面に反射して帰来する反射エコーを受信する。
【００５５】
そして、送受波器ＴＤ１および他の送受波器のそれぞれにおいて受信された反射エコーＲｗに基づいて速度ｖ１、ｖ２を求め、これら速度ｖ１、ｖ２の平均値を算出することにより、車両の速度ｖが得られる。この場合、車両の傾きや上下動により発生する計測誤差の要因を大幅に削減することができる。このような効果は、後述するように、速度計測装置２０が船舶等に搭載されている場合にも同様に得ることができる。
【００５６】
また、送受波器ＴＤ１の路面Ａからの高さＨ（図５参照）が既知でない場合には、中央演算処理部２２において、受波検出ゲート信号Ｇ１に基づいて求められた時間Ｔ１を用いて学習処理を行うことにより、前記高さＨを求めるようにしてもよい。なお、学習処理を行うにあたっては、路面Ａが乾燥したアスファルトである場合に求められた時間Ｔ１を用いることが好ましい。
【００５７】
さらに、前記ステップＳ７、Ｓ８において、（３）式で求められた推定速度ｖ０の新しい値｛新しい速度ｖ（ｎｅｗ）｝と古い値｛古い速度ｖ（ｏｌｄ）｝との差Δｖに基づいて現在の速度ｖを得る処理に代えて、車両の車輪に設けられた車輪速センサで計測された車両の速度ｖ′と、前記（３）式で求められた推定速度ｖ０との差分Δｖ′をとり、この差分Δｖ′が前記速度ｖ′または前記推定速度ｖ０に対して１５％以内である場合に、前記推定速度ｖ０を現在の速度ｖと判定する処理を行うようにしてもよい。この場合、速度計測装置２０には、前記車輪速センサからの信号を入力するための手段が設けられる。
【００５８】
なお、前記ステップＳ７、Ｓ８における処理に加えて、現在の速度ｖの確定／非確定を前記速度ｖ′に基づいて選択する処理を行うようにしてもよい。
【００５９】
さらにまた、ステップＳ３における処理、すなわち、スペクトラム分布から大きさが上位２番目までのピークを抽出し、これらのピークにおける周波数を求める処理に代えて、大きさが上位ｎ番目（ｎ≧３、ｎ：整数）までのピークを抽出し、これらのピークにおける周波数を求める処理を行うようにしてもよい。この場合、ステップＳ４においては、各ピークにおける周波数のうち、値が大きい（高い）方の周波数を標的周波数ｆｂの第１候補として求め、推定速度ｖ０を算出する処理に代えて、前記各ピークにおける周波数を標的周波数ｆｂの第１〜第ｎの候補として算出された候補としての推定速度ｖ０のうち、例えば、車輪速センサで計測された前記速度ｖ′に最も近いものを該ステップＳ４で求めるべき推定速度ｖ０として選択する処理が行われる。
【００６０】
この実施の形態では、主に、速度計測装置２０が車両に搭載されている場合について説明しているが、この車両としては、自動車の他、鉄道車両等も含まれる。また、この速度計測装置２０は、船舶等に搭載することも可能である。
【００６１】
この場合、送受波器ＴＤ１から送信されたトーンバースト波Ｔｗは、水底（海底）に反射して反射エコーＲｗとして帰来し、前記送受波器ＴＤ１に受信される。すなわち、速度計測装置２０においては、速度ｖとして、該速度計測装置２０が搭載される船舶等の対地速度が求められる。
【００６２】
また、海中にプランクトンなどの浮遊物が多い海域で対地速度の計測が行われた場合には、帯域フィルタ４０からの受信信号Ｅ１の波形は、図２Ｅに示した波形に類似する。さらに、スペクトラム分布は、図３Ｃに示した分布に類似する。すなわち、速度計測装置２０においては、プランクトンなどの海中浮遊物を路面Ａ上の水飛沫と同様に計測誤差の要因として処理し、船舶等の対地速度を正確に計測することが可能である。
【００６３】
【発明の効果】
本発明に係る速度計測装置によれば、超音波エコーを受信して得られた受信情報にＦＦＴ演算を施すことによって得られたスペクトラム分布から、移動体の速度に対応するピークにおける周波数を抽出し、この周波数に基づいて前記速度を求めるようにしている。従って、計測誤差の要因が存在する様々な条件下においても移動体の速度を安定かつ正確に計測することが可能な速度計測装置を得ることができる。
【図面の簡単な説明】
【図１】この発明の一実施の形態が適用された速度計測装置を示すブロック図である。
【図２】図２Ａは、図１に示した速度計測装置を構成する送受波器から送信されるトーンバースト波に対応する送信用駆動信号を示す波形図であり、
図２Ｂは、前記送受波器で受信された反射エコーに対応する受信信号を示す波形図であり、
図２Ｃは、前記送受波器において反射エコーが受信されたことを表す受波検出ゲート信号を示す波形図であり、
図２Ｄは、前記速度計測装置を構成する中央演算処理部において、受信データをサンプリングするタイミングを示す波形図であり、
図２Ｅは、路面が濡れている状況下における前記受信信号を示す波形図であり、
図２Ｆは、トーンバースト波の送信方向に水飛沫が存在する状況下における前記受信信号を示す波形図である。
【図３】図３Ａは、図２Ｂに示した受信信号に対応するスペクトラム分布を示す図であり、
図３Ｂは、図２Ｅに示した受信信号に対応するスペクトラム分布を示す図であり、
図３Ｃは、図２Ｆに示した受信信号に対応するスペクトラム分布を示す図である。
【図４】図１に示した速度計測装置を構成する中央演算処理部において、送受波器で受信された反射エコーの受信データに基づいて移動体の速度を求めるための処理を示すフローチャートである。
【図５】従来の技術に係る第２の車速計測装置の構成を示す図である。
【符号の説明】
２０…速度計測装置２２…中央演算処理部（演算手段）
３０…送受切換器３２…駆動信号発生回路
３４…電力増幅回路４０…帯域フィルタ
４２…増幅回路４４…検波回路
４６…レベル比較回路４８、５２…Ａ／Ｄコンバータ
ＴＤ１…送受波器Ｔｗ…トーンバースト波
Ｒｗ…反射エコーＰ１…送信用駆動信号
Ｅ１…受信信号[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a speed measuring device for measuring the speed of a moving body, for example, a vehicle, or a speed measuring device, such as a Doppler sonar, for measuring a ground speed of a moving body, for example, a ship. The ultrasonic wave transmitted from the vehicle or the like or the ship or the like reflects the Doppler frequency component of the echo wave that is reflected on the road surface or the bottom of the water (the sea bottom), and based on the Doppler frequency component, the vehicle or the like is measured. Alternatively, the present invention relates to a speed measuring device that obtains the speed of the ship or the like.
[0002]
[Prior art]
2. Description of the Related Art Conventionally, a vehicle that is a moving body includes a device (hereinafter referred to as a first device) for measuring the speed of the vehicle used in an external device such as a navigation system, an ABS device, or a suspension control device mounted on the vehicle. It is written as a vehicle speed measuring device.) This first vehicle speed measuring device is generally configured to obtain the vehicle speed based on the rotational speed of the wheel measured by a wheel speed sensor mounted on each wheel of the vehicle.
[0003]
By the way, an error may occur in the vehicle speed obtained by the first vehicle speed measuring device due to the influence of the change in the air pressure of the wheel, the change in the load amount of the vehicle, the size of the wheel, the slip generated in the wheel, and the like. Therefore, in the first vehicle speed measurement device, there are cases where it is difficult to obtain high measurement accuracy.
[0004]
Therefore, recently, for the purpose of further improving the measurement accuracy of the vehicle speed measurement device, development and practical application of a device for measuring the vehicle speed using the ultrasonic Doppler method (hereinafter referred to as a second vehicle speed measurement device). Is underway.
[0005]
FIG. 5 shows a configuration of the second vehicle speed measuring device 1. The second vehicle speed measuring device 1 includes an ultrasonic transducer 5 mounted on a vehicle 3 that travels at a speed v. The ultrasonic transducer 5 generates a tone burst wave Tw having a frequency fa (hereinafter referred to as a reference frequency) fa with respect to the road surface A on which the vehicle 3 is traveling based on a signal from the arithmetic circuit 7. Transmission is performed at a predetermined depression angle θ in front of the vehicle 3.
[0006]
The ultrasonic transducer 5 receives the reflected echo Rw that is returned when the tone burst wave Tw is reflected by the road surface A. Note that the received beam in the ultrasonic transducer 5 is set so that the main lobe ML coincides with the depression angle θ. The received signal based on the reflected echo Rw obtained by the ultrasonic transducer 5 is supplied to the arithmetic circuit 7. The arithmetic circuit 7 calculates the frequency (hereinafter referred to as target frequency) fb of the reflected echo Rw, and calculates the speed v of the vehicle 3 from the target frequency fb and the reference frequency fa. Note that a difference (fb−fa) between the target frequency fb and the reference frequency fa is also referred to as a Doppler frequency component Δf.
[0007]
Here, the speed v of the vehicle 3 is expressed as a function of the target frequency fb (that is, the Doppler frequency component Δf) using the sound speed C and the reference frequency fa. Therefore, by obtaining the target frequency fb, the speed v of the vehicle 3 can be obtained based on the function.
[0008]
The Doppler sonar that is a device for measuring the ground speed of the ship can be configured in the same manner as the second vehicle speed measuring device 1. That is, the Doppler sonar has, for example, an ultrasonic transducer mounted on the bottom of the ship, and an ultrasonic wave (tone burst wave) transmitted from the ultrasonic transducer toward the bottom of the water (the sea floor) Receives the reflected echo that is reflected and returned. Then, based on the Doppler frequency component of the reflected echo, the ground speed of the ship is measured.
[0009]
[Problems to be solved by the invention]
However, in the second vehicle speed measurement device 1 described above, there is a possibility that an error may occur in the measured speed v when used in rainy weather. This is because the road surface A is close to a mirror surface with respect to the ultrasonic waves when the road surface A is wet, such as in rainy weather. In this case, most of the tone burst wave Tw transmitted from the ultrasonic transducer 5 at a predetermined depression angle θ is specularly reflected on the road surface A, and is transmitted to the ultrasonic transducer 5 by the main lobe ML of the received beam. The level of the reflected echo Rw received is lowered. Therefore, it is difficult for the ultrasonic transducer 5 to reliably receive the reflected echo Rw.
[0010]
In order to avoid such a problem that occurs in rainy weather or the like, the gain of a receiving circuit (not shown) constituting the arithmetic circuit 7 is increased in order to reliably receive a low level reflected echo Rw. A method is conceivable.
[0011]
By the way, in the ultrasonic transducer 5, the reflected echo Rw of the tone burst wave Tw transmitted from the ultrasonic transducer 5 substantially downward is also received by the side lobe SL of the received beam. Therefore, when the gain of the receiving circuit is increased, the influence of the reflected echo Rw received by the side lobe SL becomes dominant in the received signal. When the speed v of the vehicle 3 is obtained based on such a received signal, there is a problem that the measurement accuracy of the speed v is lowered.
[0012]
In addition, the cause of an error in the speed v measured during rainy weather or the like is the influence of water droplets rolled up by another vehicle traveling in front of the vehicle 3. For example, when the vehicle travels at a speed of several tens km / h or more, a large amount of water splashes are wound up behind the vehicle. As described above, when the speed v is measured in a situation where a large amount of water droplets are present in front of the vehicle 3, the measurement error caused by the wet road surface A described above (in the ultrasonic transducer 5, the main In addition to a decrease in the level of the reflected echo Rw received by the lobe ML and an increase in the influence of the reflected echo Rw received by the side lobe SL in the received signal), the reflected echo is reflected back to the water splash and returned. An error factor due to Rw is superimposed.
[0013]
It has been experimentally found that the frequency of the reflected echo Rw from the water splash is almost uniformly distributed over a wide band with respect to the reference frequency fa of the tone burst wave Tw. As a method for obtaining the target frequency fb of the reflected echo Rw reflected by the main lobe ML from the frequency having such a distribution and reflected on the road surface A, the ultrasonic transmission / reception is performed. The Xerox method for calculating the average value of the frequency of the reflected echo Rw received by the waver 5 as the target frequency fb, the complex autocorrelation method, etc. can be adopted. The velocity v was obtained using such a method. In such a case, there is a possibility that measurement accuracy may be lowered.
[0014]
In addition, when the above Doppler sonar is used in a sea area where there are many floating matters such as plankton, the reflected echo that is reflected and returned to the plankton is the same as the influence of water droplets in the second vehicle speed measuring device 1 As a result, there is a risk of errors in the ground speed of the ship being measured.
[0015]
The present invention has been made in consideration of such problems, and provides a speed measuring device capable of stably and accurately measuring the speed of a moving object even under various conditions in which factors of measurement errors exist. The purpose is to do.
[0016]
[Means for Solving the Problems]
A velocity measuring apparatus according to the present invention uses a ultrasonic wave to move a moving body. Vehicle or ship Measure the speed of Speed measurement A device,
The moving body At a certain depression in front of A transmission means for transmitting ultrasonic waves;
The ultrasonic wave is the target Road surface or bottom Receiving means for receiving the ultrasonic echoes reflected and returning to obtain received information;
Based on the depression angle, vertical distance to the target and sound speed From the receiving means Above Timing detection means for detecting timing for sampling received information;
Sampling the received information based on the timing, and performing a FFT operation on the received information to obtain a spectrum distribution;
Extracting a Doppler frequency component corresponding to the speed of the moving object from the spectrum distribution In this case, two frequencies corresponding to the peaks with the second highest magnitude are obtained, and the Doppler frequency component is extracted using the higher frequency. A second computing means;
Based on the Doppler frequency component, a third computing means for obtaining a speed of the moving body relative to the target;
(Invention of Claim 1).
[0017]
in this case ,in front In the third calculating means, a new speed is obtained based on the Doppler frequency component, and when the difference between the new speed and the old speed obtained in the same process last time is smaller than a predetermined value, the new speed is obtained. The speed is adopted as the current speed of the moving body (the invention according to claim 2).
[0018]
For this reason, it is possible to accurately obtain the speed of the moving body based on the ultrasonic echo from the target even under the circumstances where the cause of the measurement error occurs. Therefore, the measurement accuracy and stability can be greatly improved.
[0019]
The moving body And further transmitting means for transmitting ultrasonic waves at a predetermined depression angle from the rear, and other receiving means for receiving the ultrasonic echoes that are reflected back to the target and obtaining reception information, and Based on the ultrasonic echoes of the ultrasonic waves respectively transmitted at a predetermined depression angle to the front and the rear, the respective speeds of the moving body with respect to the target are obtained, and the average values of the obtained speeds are obtained. The speed for the target A speed measuring device may be configured. 3 Described invention).
[0020]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, an embodiment of the present invention will be described with reference to the drawings.
[0021]
FIG. 1 shows a configuration of a speed measuring device 20 to which an embodiment of the present invention is applied. In this embodiment, the case where the speed measuring device 20 is mounted on a vehicle will be mainly described.
[0022]
The speed measuring device 20 controls the entire speed measuring device 20, and also performs a central processing unit (calculating means) 22 for performing processing for calculating a speed v, which will be described later, and a storing means (memory) for storing a control program. ) ROM 24. The central processing unit 22 is constituted by, for example, a DSP (digital signal processor). Further, the velocity measuring device 20 includes a transducer TD1 configured to transmit and receive ultrasonic waves, and a tone burst that is a single-frequency ultrasonic wave via the transducer TD1. The tone burst wave Tw returns to the target {for example, the road surface A (see FIG. 5) on which the vehicle travels) via the transmission system 26 that performs processing for transmitting the wave Tw and the transmitter / receiver TD1. And a receiving system 28 that performs processing for receiving the reflected echo (ultrasonic echo) Rw. Transmission / reception switching in the transceiver TD1 is performed by the transmission / reception switch 30.
[0023]
In this case, the transmission system 26 and the transducer TD1 constitute a transmission means for the tone burst wave Tw, and the reception system 28 and the transducer TD1 constitute a reception means for the reflected echo Rw.
[0024]
Similarly to the second vehicle speed measuring device 1 (see FIG. 5), the transmitter / receiver TD1 is a moving body, for example, a vehicle or the like, which transmits the tone burst wave Tw in the transmission direction and the main lobe ML of the received beam. However, it is mounted so as to face the front of the vehicle or the like at a predetermined depression angle θ (0 <θ <π / 2). Further, the height of the transducer TD1 from the road surface A is H.
[0025]
The transmission system 26 includes a drive signal generation circuit 32 and a power amplification circuit 34.
[0026]
The drive signal generation circuit 32 has a built-in counter (not shown), for example, by dividing the 10 MHz reference signal Sr supplied from the central processing unit 22 by a predetermined frequency division ratio. A trust driving signal P1 is generated (see FIG. 2A). Specifically, the drive signal generation circuit 32 generates a signal having a frequency (reference frequency) fa (for example, fa = 200 kHz) based on the frequency division ratio supplied as the control signal Sc1 from the central processing unit 22. By performing pulse modulation on this signal in synchronization with the reference signal Sr, a transmission drive signal P1 having a pulse width Ta (for example, Ta = 1 ms) and a repetition period T0 (for example, T0 = 10 ms) is generated. Note that the repetition period T0 is determined based on the timing at which the control signal Sc1 is output from the central processing unit 22.
[0027]
The power amplifier circuit 34 amplifies the power of the transmission drive signal P1 from the drive signal generation circuit 32 to generate an electric signal Tx, and supplies the electric signal Tx to the transmitter / receiver TD1 through the transmission / reception switch 30. The transducer TD1 is driven by this electrical signal Tx and transmits a tone burst wave Tw to the road surface A (see FIG. 5).
[0028]
On the other hand, the reception system 28 includes a band filter 40, an amplifier circuit 42, a detection circuit 44, a level comparison circuit 46, and an A / D converter 48, as shown in FIG.
[0029]
When the reflected echo Rw reflected and returned from the road surface A (see FIG. 5) is received by the transducer TD1, the electrical signal Rx corresponding to the reflected echo Rw is output from the transducer TD1. . The band filter 40 extracts (filters) a component belonging to a predetermined frequency band from the electric signal Rx and outputs it as a received signal E1 (for example, see FIG. 2B showing the received signal E1 in fine weather). The received signal E1 is reflected from the road surface A (see FIG. 5), and is reflected by the leak of the electrical signal Tx together with the component a of the reflected echo Rw received by the transmitter / receiver TD1 by the main lobe ML of the received beam. Ingredient b is included. The reception signal E1 is amplified by the amplification circuit 42 and then supplied to the detection circuit 44 and the A / D converter 48 (see FIG. 1).
[0030]
The detection circuit 44 converts the received signal E1 from the amplification circuit 42 into a DC detection signal Sd by full-wave rectification. The level comparison circuit 46 compares the voltage value V (Sd) of the DC detection signal Sd from the detection circuit 44 with a predetermined reference voltage Vref, and only while the voltage value V (Sd) exceeds the reference voltage Vref. A high-level received wave detection gate signal G1 (see FIG. 2C) is output to the central processing unit 22. The central processing unit 22 measures the time from when the control signal Sc1 is output to when the reception detection gate signal G1 rises, so that the reflected echo Rw is transmitted after the tone burst wave Tw is transmitted from the transmitter / receiver TD1. The time T1 until is received is obtained. The received wave detection gate signal G1 is at a high level even when the received signal E1 includes the component b due to the leakage of the electric signal Tx. However, the central processing unit 22 detects the electric signal Tx. The change of the received wave detection gate signal G1 based on this is predicted based on the output time point of the control signal Sc1, and is not taken into consideration in the process of obtaining the time T1.
[0031]
The A / D converter 48 converts the received signal E1 from the amplifier circuit 42 into received data (received information) D (E1) which is digital data in accordance with the control signal Sc2 supplied from the central processing unit 22, This is supplied to the arithmetic processing unit 22. The control signal Sc2 instructs the timing T2 at which the central processing unit 22 starts sampling the received data D (E1) (see FIG. 2D). That is, the central processing unit 22 functions as a timing detection unit for detecting the timing T2.
[0032]
In this case, the transmitter / receiver TD1 is mounted at the timing T2 at a time determined based on the height H of the transmitter / receiver TD1 from the road surface A and the depression angle θ for transmitting the tone burst wave Tw. It is obtained by adding a value that takes into account the time variation due to the vertical movement of the vehicle or the like (see FIG. 5).
[0033]
Specifically, the timing T2 is obtained based on the following equation (1).
[0034]
T2 = 2 × H / (C × sin θ) −0.25 × 10 ^-3 [Sec] (1)
However, C is the speed of sound and is obtained based on the following equation (2) using the ambient temperature t of the transducer TD1.
[0035]
C = 331.6 + 0.61 × t [m / s] (2)
The ambient temperature t is measured by a thermistor 50 provided in the vicinity of the transducer TD1 (see FIG. 1). Specifically, the temperature signal (voltage) St based on the ambient temperature t obtained by the thermistor 50 is supplied to the central processing unit 22 as temperature data D (t) via the A / D converter 52. One terminal of the thermistor 50 is connected to a power source via a resistor R for applying a bias to the thermistor 50, and the other terminal is grounded.
[0036]
The central processing unit 22 obtains the ambient temperature t based on the temperature data D (t). In this case, the timing at which the temperature data D (t) is taken into the central processing unit 22 is instructed by the control signal Sc3 supplied from the central processing unit 22 to the A / D converter 52.
[0037]
In addition, the control signal Sc2 supplied from the central processing unit 22 to the A / D converter 48 causes the sampling interval ΔT of the received data D (E1) in the central processing unit 22 (in this embodiment, ΔT = 1). 5 μs) and the sampling point number N (for example, N = 1024 points) is indicated (see FIG. 2D). The sampling point number N is set based on the sampling interval ΔT.
[0038]
The central processing unit 22 samples the received data D (E1) based on the timing T2, the sampling interval ΔT, and the sampling point number N. By setting the timing T2, the sampling interval ΔT, and the number N of sampling points in this way, the reflected echo Rw from the road surface A received by the main lobe ML of the received beam is received by the transmitter / receiver TD1, and the received data D (E1 ) Can be reliably sampled (see FIGS. 2B and 2D).
[0039]
The central processing unit 22 obtains the spectrum distribution shown in FIG. 3A by performing FFT (fast Fourier transform) processing (also referred to as FFT processing) on the sampled received data D (E1). This spectrum distribution is 0.651 kHz {= 1 / (1024 × 1.5 × 10 ^-6 ) KHz} at intervals of 0 to 333 kHz (= 512 × 0.651 kHz).
[0040]
For example, the peak distribution Pa corresponding to the component a (see FIG. 2B) of the reception signal E1 exists in the spectrum distribution in fine weather. Therefore, by obtaining the frequency f1 at this peak Pa, the frequency (target frequency) of the reflected echo Rw reflected from the road surface A (see FIG. 5) and received by the transmitter / receiver TD1 by the main lobe ML of the received beam. fb is obtained as fb = f1.
[0041]
By the way, when the road surface A is wet, such as in rainy weather, most of the tone burst wave Tw is regularly reflected on the road surface A (see FIG. 5). Therefore, as shown in FIG. 2E, the reflection reflected from the road surface A (see FIG. 5) included in the received signal E1 and received by the transmitter / receiver TD1 by the main lobe ML (see FIG. 5) of the received beam. The level of the component a of the echo Rw is lowered. In comparison with this, the level of the component c of the reflected echo Rw received by the wave transceiver TD1 by the side lobe SL (see FIG. 5) of the received beam rises.
[0042]
In this case, the spectrum distribution of the reflected echo Rw includes a peak Pc corresponding to the component c (see FIG. 2E) in addition to the peak Pa corresponding to the component a (see FIG. 2E), as shown in FIG. 3B. . The frequency f0 at the peak Pc is almost the same value (f0 = fa) as the reference frequency fa of the tone burst wave Tw. Thus, when there are a plurality of peaks Pa and Pc in the spectrum distribution, it is difficult to obtain the target frequency fb based on the peak Pa or Pc having the maximum magnitude.
[0043]
Moreover, the tone burst wave Tw will be reflected by the said water splash under the condition where the water splash is wound up by the vehicle which drive | moves ahead of the transmitter / receiver TD1. For this reason, the received signal E1 includes the component d of the reflected echo Rw that returns after being reflected by the water droplets (see FIG. 2F). Since the frequency of the reflected echo Rw that is reflected back to the water splash is distributed over a wide band, the spectrum distribution of the reflected echo Rw shown in FIG. 3C has a plurality of peaks Pd1, Pd2 corresponding to the component d (see FIG. 2F). Etc. exist. Also in this case, it is difficult to obtain the target frequency fb based on the largest peaks Pa, Pc or Pd1, Pd2, etc.
[0044]
Hereinafter, the central processing unit 22 extracts the frequency f1 at the peak Pa as the target frequency fb from the spectrum distribution shown in FIG. 3A (when clear), FIG. 3B or 3C (when rainy), and this target frequency fb A processing method for calculating the speed v of the moving body (vehicle) based on the above will be described with reference to the flowchart of FIG.
[0045]
First, in step S1, the received data D (E1) is sampled based on the timing T2, the sampling interval ΔT, and the sampling point number N set by the control signal Sc2. Subsequently, in step S2, the spectrum distribution of the reflected echo Rw (see FIGS. 3A to 3C) is obtained by performing an FFT operation on the sampled received data D (E1).
[0046]
Next, in step S3, peaks Pa, Pc and the like having the second highest magnitude are extracted from the spectrum distribution, and the frequencies f1, f0, etc. at the peaks Pa, Pc, etc. are obtained. In step S4, the frequency having the larger (higher) value (in this case, f1) is determined as the first candidate of the target frequency fb (fb = f1), and based on the following equation (3): Then, an estimated speed v0 of a vehicle or the like on which the speed measuring device 20 is mounted is calculated.
[0047]
v0 = Δf × C / {(2 × fa + Δf) × cos θ} (3)
Here, Δf represents a Doppler frequency component and is obtained by Δf = fa−fb. C is the speed of sound and is obtained based on the equation (2).
[0048]
The estimated speed v0 obtained in step S4 is stored as a new speed v (new) in step S5, for example, in a memory (not shown) of the central processing unit 22 {v (new) ← v0}. Prior to this, the new speed v (new) obtained in the previous process is stored in the memory as the old speed v (old) {v (old) ← v (new)}.
[0049]
Next, in step S6, a difference Δv {Δv = v (new) −v (old)} between the new speed v (new) and the old speed v (old) is obtained. Subsequently, in step S7, the difference Δv obtained in step S6 is compared with a predetermined value vr (for example, vr = 5 km / h). If Δv <vr, a new speed v is determined in step S8. (New) is adopted as the current speed v of the moving body (vehicle) {v ← v (new)}. If it is determined in step S7 that Δv ≧ vr, the new speed v (new) is not adopted as the current speed v, and the process returns to step S1.
[0050]
As shown in FIG. 1, the speed v obtained in the above steps S1 to S8 is output from the central processing unit 22 as speed data D (v), and is mounted on the vehicle, such as a navigation system, an ABS device, and suspension control. Supplied to an external device such as a device.
[0051]
As described above, in this embodiment, the processing in steps S1 to S8 for obtaining the speed v extracts the target frequency fb (that is, the Doppler frequency component Δf) corresponding to the vehicle speed v from the spectrum distribution. To function as a kind of frequency filter. Therefore, the vehicle speed v can be accurately obtained based on the Doppler frequency component Δf.
[0052]
In particular, the speed v can be obtained accurately even under conditions where measurement error factors occur, such as in the case of rainy weather. Therefore, when measuring methods such as the Xerox method or the complex autocorrelation method are used. In comparison, the measurement accuracy and stability can be greatly improved.
[0053]
The present invention is not limited to the above-described embodiment, and various configurations can be adopted without departing from the gist of the present invention.
[0054]
For example, in addition to the transmitter / receiver TD1 that transmits / receives ultrasonic waves (tone burst wave Tw, reflected echo Rw) to the front of the vehicle, another transmitter / receiver that transmits / receives ultrasonic waves to the rear of the vehicle is provided. A so-called two-beam method may be employed. The other transmitter / receiver transmits a tone burst wave at a predetermined depression angle (for example, θ) to the rear of the vehicle, and receives a reflected echo that is returned from the tone burst wave reflected on the road surface.
[0055]
Then, speeds v1 and v2 are obtained based on the reflected echo Rw received in each of the transducer TD1 and the other transducers, and the average value of these speeds v1 and v2 is calculated, so that the speed v of the vehicle is obtained. can get. In this case, it is possible to greatly reduce the cause of measurement errors caused by the inclination or vertical movement of the vehicle. Such an effect can be similarly obtained when the speed measuring device 20 is mounted on a ship or the like, as will be described later.
[0056]
When the height H (see FIG. 5) of the transducer TD1 from the road surface A is not known, the central processing unit 22 uses the time T1 obtained based on the received wave detection gate signal G1. The height H may be obtained by performing a learning process. In performing the learning process, it is preferable to use the time T1 obtained when the road surface A is dry asphalt.
[0057]
Further, in steps S7 and S8, based on the difference Δv between the new value {new speed v (new)} and the old value {old speed v (old)} of the estimated speed v0 obtained by the equation (3), In this case, the difference Δv ′ between the vehicle speed v ′ measured by the wheel speed sensor provided on the vehicle wheel and the estimated speed v0 obtained by the above equation (3) is used. When the difference Δv ′ is within 15% of the speed v ′ or the estimated speed v0, a process for determining the estimated speed v0 as the current speed v may be performed. In this case, the speed measuring device 20 is provided with means for inputting a signal from the wheel speed sensor.
[0058]
In addition to the processes in steps S7 and S8, a process of selecting whether the current speed v is confirmed or not based on the speed v ′ may be performed.
[0059]
Furthermore, instead of the processing in step S3, that is, the processing of extracting the peaks having the top two magnitudes from the spectrum distribution and obtaining the frequencies at these peaks, the magnitudes are the top nth (n ≧ 3, n : Integer) peaks may be extracted, and the frequency at these peaks may be obtained. In this case, in step S4, instead of the process of calculating the estimated speed v0 by obtaining the higher (higher) frequency among the frequencies at each peak as the first candidate of the target frequency fb, Of the estimated speeds v0 calculated as the first to nth candidates of the target frequency fb, for example, the speed closest to the speed v ′ measured by the wheel speed sensor should be obtained in step S4. A process of selecting as the estimated speed v0 is performed.
[0060]
In this embodiment, the case where the speed measuring device 20 is mounted on a vehicle is mainly described. However, this vehicle includes a railway vehicle and the like in addition to an automobile. The speed measuring device 20 can be mounted on a ship or the like.
[0061]
In this case, the tone burst wave Tw transmitted from the transmitter / receiver TD1 is reflected to the bottom of the water (the seabed) and returned as a reflected echo Rw and received by the transmitter / receiver TD1. That is, in the speed measuring device 20, the ground speed of a ship or the like on which the speed measuring device 20 is mounted is obtained as the speed v.
[0062]
Further, when the ground speed is measured in a sea area where there are many floating substances such as plankton in the sea, the waveform of the reception signal E1 from the band filter 40 is similar to the waveform shown in FIG. 2E. Furthermore, the spectrum distribution is similar to the distribution shown in FIG. 3C. That is, in the speed measuring device 20, it is possible to process underwater suspended matters such as plankton as a factor of measurement error in the same manner as water splashes on the road surface A, and accurately measure the ground speed of a ship or the like.
[0063]
【The invention's effect】
According to the velocity measuring device of the present invention, the frequency at the peak corresponding to the velocity of the moving object is extracted from the spectrum distribution obtained by performing the FFT operation on the reception information obtained by receiving the ultrasonic echo. The speed is obtained based on this frequency. Therefore, it is possible to obtain a speed measuring device that can stably and accurately measure the speed of the moving body even under various conditions in which a factor of measurement error exists.
[Brief description of the drawings]
FIG. 1 is a block diagram showing a speed measuring device to which an embodiment of the present invention is applied.
FIG. 2A is a waveform diagram showing a driving signal for transmission corresponding to a tone burst wave transmitted from a transducer constituting the speed measuring device shown in FIG. 1;
FIG. 2B is a waveform diagram showing a received signal corresponding to a reflected echo received by the transducer;
FIG. 2C is a waveform diagram showing a reception detection gate signal indicating that a reflected echo has been received in the transducer.
FIG. 2D is a waveform diagram showing the timing of sampling received data in the central processing unit that constitutes the speed measuring device;
FIG. 2E is a waveform diagram showing the received signal in a situation where the road surface is wet;
FIG. 2F is a waveform diagram showing the received signal in a situation where water splashes exist in the transmission direction of the tone burst wave.
FIG. 3A is a diagram showing a spectrum distribution corresponding to the received signal shown in FIG. 2B;
FIG. 3B is a diagram showing a spectrum distribution corresponding to the received signal shown in FIG. 2E.
FIG. 3C is a diagram showing a spectrum distribution corresponding to the received signal shown in FIG. 2F.
4 is a flowchart showing a process for obtaining the velocity of a moving body based on the received data of the reflected echo received by the transducer in the central processing unit constituting the velocity measuring apparatus shown in FIG. .
FIG. 5 is a diagram showing a configuration of a second vehicle speed measuring device according to a conventional technique.
[Explanation of symbols]
20 ... Speed measuring device 22 ... Central processing unit (calculation means)
30 ... Transmission / reception switch 32 ... Drive signal generation circuit
34 ... Power amplifier circuit 40 ... Band filter
42 ... Amplifier circuit 44 ... Detector circuit
46 ... Level comparison circuit 48, 52 ... A / D converter
TD1 ... Transmitter Tw ... Tone burst wave
Rw ... reflection echo P1 ... drive signal for transmission
E1 ... Received signal

Claims

超音波を用いて移動体である車両又は船舶の速度を計測する速度計測装置であって、
前記移動体の前方に所定の俯角で超音波を送信する送信手段と、
前記超音波がターゲットである路面又は水底に反射して帰来する超音波エコーを受信して受信情報を得る受信手段と、
前記俯角、前記ターゲットまでの鉛直距離及び音速に基づき前記受信手段からの前記受信情報をサンプリングするタイミングを検出するタイミング検出手段と、
前記タイミングに基づいて前記受信情報をサンプリングし、該受信情報にＦＦＴ演算を施すことによりスペクトラム分布を得る第１演算手段と、
前記スペクトラム分布から前記移動体の速度に対応するドップラ周波数成分を抽出する際、大きさが上位２番目までのピークに対応する２つの周波数を求め、高い方の周波数を用いて前記ドップラ周波数成分を抽出する第２演算手段と、
前記ドップラ周波数成分に基づいて、前記移動体の前記ターゲットに対する速度を求める第３演算手段と、
を有することを特徴とする速度計測装置。A speed measuring device that measures the speed of a vehicle or ship as a moving body using ultrasonic waves,
Transmitting means for transmitting ultrasonic waves at a predetermined depression angle in front of the moving body;
Receiving means for receiving reception information by receiving ultrasonic echoes reflected and reflected on the road surface or bottom of the water as the target; and
A timing detection means for detecting a timing for sampling the received information from said depression, said receiving means based on the vertical distance and the speed of sound to said target,
Sampling the received information based on the timing, and performing a FFT operation on the received information to obtain a spectrum distribution;
When extracting the Doppler frequency component corresponding to the speed of the moving object from the spectrum distribution, two frequencies corresponding to the peaks up to the second highest magnitude are obtained, and the Doppler frequency component is calculated using the higher frequency. Second calculating means for extracting ;
Based on the Doppler frequency component, a third computing means for obtaining a speed of the moving body relative to the target;
A speed measuring device comprising:

請求項１記載の装置において、
前記第３演算手段は、前記ドップラ周波数成分に基づいて新しい速度を求め、この新しい速度と、同様の処理において前回求められていた古い速度との差が所定値より小さい場合に、前記新しい速度を前記移動体の現在の速度として採用することを特徴とする速度計測装置。The apparatus of claim 1 .
Before Symbol third arithmetic means, on the basis of the Doppler frequency component for a new rate, if the difference between the old rate has been previously obtained in a new rate, the same processing is smaller than a predetermined value, the new speed Is adopted as the current speed of the moving body.

請求項１または２記載の装置において、
前記移動体から後方に所定の俯角で超音波を送信する他の送信手段と、該超音波がターゲットに反射して帰来する超音波エコーを受信して受信情報を得る他の受信手段と、をさらに設け、
前記前方及び前記後方に所定の俯角でそれぞれ送信した前記超音波のそれぞれの前記超音波エコーに基づいて、前記移動体の前記ターゲットに対するそれぞれの速度を求め、求めたそれぞれの速度の平均値を、前記ターゲットに対する速度とする
ことを特徴とする速度計測装置。The apparatus according to claim 1 or 2,
Other transmitting means for transmitting ultrasonic waves at a predetermined depression angle backward from the moving body, and other receiving means for receiving ultrasonic echoes that are reflected back from the ultrasonic waves and obtaining reception information, In addition,
Based on the ultrasonic echoes of the ultrasonic waves respectively transmitted at a predetermined depression angle to the front and the rear, the respective speeds of the moving body with respect to the target are obtained, and the average values of the obtained speeds are obtained. velocity measuring device, characterized in that shall be the speed with respect to the target.