JP2007322225A - 障害物検出装置および位置特定方法 - Google Patents

障害物検出装置および位置特定方法 Download PDF

Info

Publication number
JP2007322225A
JP2007322225A JP2006152026A JP2006152026A JP2007322225A JP 2007322225 A JP2007322225 A JP 2007322225A JP 2006152026 A JP2006152026 A JP 2006152026A JP 2006152026 A JP2006152026 A JP 2006152026A JP 2007322225 A JP2007322225 A JP 2007322225A
Authority
JP
Japan
Prior art keywords
wave
envelope
obstacle
reflected
time
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.)
Granted
Application number
JP2006152026A
Other languages
English (en)
Other versions
JP5103794B2 (ja
Inventor
Muneyuki Toge
宗志 峠
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 JP2006152026A priority Critical patent/JP5103794B2/ja
Publication of JP2007322225A publication Critical patent/JP2007322225A/ja
Application granted granted Critical
Publication of JP5103794B2 publication Critical patent/JP5103794B2/ja
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/003Bistatic radar systems; Multistatic radar systems
    • 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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • 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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9314Parking operations
    • 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
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/88Radar or analogous systems specially adapted for specific applications
    • G01S13/93Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9317Driving backwards
    • 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/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2015/937Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles sensor installation details
    • G01S2015/939Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles sensor installation details vertical stacking of sensors, e.g. to enable obstacle height determination

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Traffic Control Systems (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

【課題】複数の障害物で反射された反射波から、各障害物の位置を精度良く検出可能とする。
【解決手段】受信部121にて受信された反射波は、アンプ122により増幅され、検波部124により全波整流され、AD入力部127により積分される。このため、センサECU130は、包絡線波を得ることになり、この包絡線波の頂点時刻を判別し、立ち上がり推測値を求めて候補テーブルに格納する。また、センサECU130は、各包絡線波の頂点時刻の関係に基づいて、候補となる包絡線波の組合せを選定する。更に、算定した組合せに対応する立ち上がり推測値に基づいて、候補となる障害物の位置を算定する。そして、センサECU130は、算定した障害物の位置を時系列に保持し、移動平均によって、真の障害物の位置をそれぞれ特定する。
【選択図】図2

Description

本発明は、車両用の障害物検出装置に関し、特に、複数の障害物で反射された反射波から、各障害物の位置を精度良く検出できる障害物検出装置と該障害物検出装置に用いて好適な位置特定方法に関する。
従来から、車両用の障害物検出装置が種々考案されている。これらの障害物検出装置のなかには、複数の障害物で反射された反射波をそれぞれ受信する場合にも、各障害物の位置をそれぞれ検出できるものがある。(例えば、特許文献1参照)
特開2002−372577号公報
特許文献1に開示された障害物検出装置は、障害物の反射率に応じて受信波の振幅が異なることや、障害物の移動速度に応じてドップラーシフトが発生し受信波の周波数が変動すること等に着目し、同じ障害物で反射された反射波の組合せを求めている。
特許文献1に開示された障害物検出装置は、上述したように受信波の振幅や受信波の周波数変動を利用して、同じ障害物で反射された反射波の組合せを求めることを特徴としているが、以下のような課題がある。
この従来の障害物検出装置では、送信波として電波レーダを用いており、その反射波の受信波形の振幅や周波数等を得ている。
しかしながら、電波レーダには、指向性等の問題があるため、角度によって受信部(センサ)の受信感度に違いが生じてしまう。そのため、同じ障害物からの反射波であっても、角度によっては受信波形の振幅が異なってしまい、別の障害物からの反射波と誤認してしまう場合がある。
つまり、反射波の組合せを誤認してしまうと、最終的に各障害物の位置の精度が低下してしまうことになる。
また、ドップラーシフトにより受信波形の周波数変動を検出することは、電波レーダを用いる場合に好適であり(効率がよく)、他に超音波等を用いる場合には、コストや効率の面から適切であるとはいえない。
本発明は上記の問題点に鑑みてなされたものであり、複数の障害物で反射された反射波から、各障害物の位置を精度良く検出可能とすることを目的とする。
上記目的を達成するため、この発明の第1の観点に係る障害物検出装置は、
超音波を測定タイミング毎に送信する送信手段と、
前記送信手段により送信された超音波の反射波を異なる位置にてそれぞれ受信する受信手段と、
前記受信手段が受信した各反射波に基づいて各反射波に対応する包絡線波を得る包絡線波取得手段と、
得られた前記包絡線波の頂点時刻を判別して、各包絡線波の立ち上がり時刻をそれぞれ推測する推測手段と、
前記推測手段が判別した各包絡線波の頂点時刻の関係に基づいて、候補となる包絡線波の組合せを選定する選定手段と、
前記選定手段が選定した組合せにおける、前記推測手段により推測された立ち上がり時刻に基づいて、候補となる障害物の位置情報を算定する位置算定手段と、
前記位置算定手段により算定された位置情報を複数の測定回数分保持する保持手段と、
前記保持手段に保持された位置情報を平均処理して、真の障害物の位置を特定する位置特定手段と、
を備える、ことを特徴とする。
例えば、前記選定手段は、各包絡線波の頂点時刻同士の差分が所定値以内の組みをそれぞれ抽出し、抽出した各組みから全体としての包絡線波の組合せを選択する。
例えば、前記位置算定手段は、実際の障害物より多い数の障害物候補の位置情報を算定し、また、前記位置特定手段は、時系列での移動平均によって、真の障害物の位置を特定する。
例えば、前記包絡線波取得手段は、前記受信手段が受信した各反射波をそれぞれ整流する検波手段と、前記検波手段が整流した各反射波形をそれぞれ積分し、各反射波に対応する包絡線波をそれぞれサンプリングするサンプリング手段と、を有し、
前記推測手段は、前記サンプリング手段がサンプリングした各包絡線波の各頂点時刻を判別して、各包絡線波の立ち上がり時刻をそれぞれ推測する。
また、この発明の第2の観点に係る位置特定方法は、
超音波を送信部から計測タイミング毎に送信し、当該超音波の反射波を異なる受信部にてそれぞれ受信する障害物検出装置における位置特定方法であって、
各受信部にて受信した各反射波に基づいて各反射波に対応する包絡線波を得る包絡線波取得ステップと、
得られた前記包絡線波の頂点時刻を判別して、各包絡線波の立ち上がり時刻をそれぞれ推測する推測ステップと、
前記推測ステップにて判別した各包絡線波の頂点時刻の関係に基づいて、候補となる包絡線波の組合せを選定する選定ステップと、
前記選定ステップにて選定した組合せにおける、前記推測ステップにて推測された立ち上がり時刻に基づいて、候補となる障害物の位置情報を算定する位置算定ステップと、
前記位置算定ステップにて算定された位置情報をテーブルに格納し、複数の測定回数分の位置情報を保持させる格納ステップと、
前記テーブルに格納された位置情報を平均処理して、真の障害物の位置を特定する位置特定ステップと、
を備える、ことを特徴とする。
例えば、前記包絡線波取得ステップは、前記各受信部にて受信した各反射波を検波部によりそれぞれ整流し、AD入力部によりそれぞれ積分し、各反射波に対応する包絡線波をそれぞれサンプリングするサンプリングステップを有し、
前記推測ステップは、前記サンプリングステップにおいてサンプリングした各包絡線波の頂点時刻を判別して、各包絡線波の立ち上がり時刻をそれぞれ推測する。
この発明の障害物検出装置によれば、複数の障害物で反射された反射波から、各障害物の位置を精度良く検出することができる。
また、複数の障害物で反射された反射波から、各障害物の位置を精度良く検出することができる。
以下、本発明の実施形態に係る障害物検出装置100について説明する。
本実施形態に係る障害物検出装置100が適用される車両10は、図1(a),(b)に示すように、跳ね上げ式のPBD(Power Back Door)11を備えた、いわゆるハッチバック車であり、センタユニット110、センサECU(Electronic Control Unit)130、及び、PBD用ECU140等が適宜設置されている。
障害物検出装置100は、図2に示すように、送信部111と、昇圧コイル112と、40kHz発信器113と、バースト発信器114と、タイミング回路115と、受信部121a〜121cと、アンプ122a〜122cと、BPF(Band-Pass Filter)123a〜123cと、検波部124a〜124cと、S/H(Sample and Hold)125a〜125cと、S/Hトリガー制御部126と、AD(Analog to Digital)入力部127a〜127cと、センサECU130と、PBD用ECU140と、モータ150と、操作SW(スイッチ)160とを備える。
送信部111は、カバーを備えた圧電素子等からなり、昇圧コイル112から供給される駆動電圧に応じて発振し、共振器として機能するカバーを介して超音波(発信波)を発信する。
昇圧コイル112は、40kHz発信器113から供給されるパルス電圧を昇圧して、送信部111に駆動電圧を供給する。
40kHz発信器113は、バースト発信器114から供給されるバースト波を、40kHzのパルス波に変換して、昇圧コイル112に供給する。
バースト発信器114は、タイミング回路115に制御され、バースト波を40kHz発信器113に供給する。
タイミング回路115は、センサECU130に制御され、一定タイミング(例えば、0.1秒)毎に、バースト発信器114からバースト波を供給させる。
受信部121(121a〜121c)は、共振器として機能するカバーを備えた圧電素子等からなり、送信部111が送信した超音波の反射波(障害物に反射した反射波)を受信する。そして、反射波の受信により加わった圧力に対応する起電力(信号)を生じさせ、この信号をアンプ122に出力する。
なお、受信部121及び、送信部111等によりセンサユニット110を構成し、上述した図1(b)等に示すように、PBD11における例えば、ライセンスランプの横に設置される。
より詳細には、図3に示すように、受信部121aと受信部121b、及び、送信部111と受信部121cが、鉛直方向(Y軸方向)にそれぞれ並んで配置され、また、受信部121aと送信部111、及び、受信部121bと受信部121cが、水平方向(X軸方向)にそれぞれ並んで配置されている。つまり、受信部121と送信部111は、正方形状に配列されている。
なお、受信部121と送信部111とを別構成とした場合について説明しているが、何れか1つの受信部121が送信部111を兼ねるようにしてもよい。
図2に戻って、アンプ122(122a〜122c)は、受信部121から出力された信号を増幅し、BPF123に供給する。
BPF123(123a〜123c)は、アンプ122から供給された信号のうち、所定周波数範囲の信号だけを通過させて、検波部124に供給する。
検波部124(124a〜124c)は、全波整流回路等からなり、BPF123を通過した信号を全波整流し、S/H125に供給する。
S/H125(125a〜125c)は、S/Hトリガー制御部126に制御され、検波部124により全波整流された信号をサンプリングし、AD入力部127がAD変換を行えるように、一時的に保持する。
S/Hトリガー制御部126は、センサECUに制御され、S/H125が行うサンプル/ホールドに必要なトリガー信号を発生させる。
AD入力部127(127a〜127c)は、積分方式のAD変換器等からなり、アナログの信号電圧をデジタルの電圧カウンタ値に変換し、センサECU130に供給する。
この電圧カウンタ値は、受信部121にて受信した信号が、アンプ122により増幅され、検波部124により全波整流され、AD入力部127により積分されることにより、反射波の包絡線(包絡線波)の値となる。
センサECU130は、タイミング回路115を制御して、一定の測定タイミング(例えば、0.1秒)毎に、送信部111から超音波を発信させる。
また、センサECU130は、内部に備えたタイマ回路等により、超音波の発信時からのタイム計測を開始する。そして、反射波として有効となる、タイマカウンタ値が所定範囲内で、かつ、閾値(例えば、電圧カウンタ値6000)以上の包絡線波の電圧カウンタ値をAD入力部127から順次取得し、包絡線波の頂点を特定すると共に、包絡線波の立ち上がり時刻を推測する。
例えば、図4に示すように、今回の測定タイミングで、受信部121にて5つの反射波を受信し、AD入力部127から包絡線波W1〜W5が得られた場合を一例として説明すると、まず、センサECU130は、各包絡線波の頂点P1〜P5を特定し、各頂点前の所定範囲の電圧カウンタ値を用いて、最小二乗法等により近似直線L1〜L5を求める。そして、各近似直線が電圧カウント値0と交差するタイマカウント値(ゼロクロス時刻)を求める。すなわち、各包絡線波の立ち上がり推測値T1〜T5を特定する。
なお、センサECU130は、このような頂点の特定及び、立ち上がり推測値の特定を、各受信箇所(受信部121a〜121cにて受信した反射波)についてそれぞれ行う。
そして、センサECU130は、頂点のタイマカウンタ値、頂点の電圧カウンタ値、及び、立ち上がり推測値(タイマカウンタ値)を、候補テーブルに格納する。
例えば、センサECU130は、内部のメモリに、図5に示すような候補テーブル200a〜200cの領域を確保し、それぞれに、対応する受信箇所(受信部121a〜121c)について算出した各データ(各包絡線波についての頂点のタイマカウンタ値、頂点の電圧カウンタ値、立ち上がり時刻を推測値)をセットする。
更に、センサECU130は、このような候補テーブル200a〜200cにおける頂点のタイマカウンタ値の関係に従って、同一反射波の候補の組合せを選定する。例えば、頂点の時刻差(タイマカウンタ値の差分)が所定範囲内となる候補の組合せを選定する。
より詳細に説明すると、まず、候補テーブル200a−200b間で、頂点のタイマカウンタ値の差分が任意値α以下である候補の組みを抽出する。また、候補テーブル200b−200c間で、頂点のタイマカウンタ値の差分が任意値β以下である候補の組みを抽出する。そして、候補テーブル200c−200a間で、頂点のタイマカウンタ値の差分が任意値γ以下である候補の組みを抽出する。そして、最終的に、抽出した各組みから全体としての候補の組合せを選定する。
なお、組みを抽出する際に用いられる任意値α〜γは、対応する受信部121同士(121a−121b,121b−121c,121c−121a)の間隔Dをn倍(nは、1〜3)した距離を、音速Cで割って得られた時間(カウント値)とする。
ここで、n倍の値の決め方は、例えば、以下の方法による。
同一反射波の振幅の高さ(つまり、包絡線の頂点)は、障害物が受信部121の正面に位置している状態を基準として、角度が付く(正面からずれる)に従って変化する。そこで、予め必要な反射面積及び反射率を有する校正ターゲット(例えば、ポール、球、人体模型(着衣)や金網など)を使用して、受信部121の正面に校正ターゲットを置いた状態での受信波と、最大角度に校正ターゲットを置いた状態での受信波を得て、両受信波における振幅の高さの比を求める。そして、求めた高さの比の値をn倍の値として決める。例えば、校正ターゲットを使用して求めた両受信波の振幅の高さの比が3であれば、n倍の値を3とする。
以下、頂点のタイマカウンタ値の差分が任意値α〜γ以下である候補の組みを抽出した後に、全体としての候補の組合せを選定する様子について説明する。なお、説明を容易にするために、任意値α〜γを全て150とし、また、図5の候補テーブル200a〜200cにおける各候補1,2だけを対象とした場合について説明する。
まず、図6(a)に示すように、候補テーブル200a−200b間での全ての組み(組み1〜組み4)について、頂点のタイマカウンタ値の差分をそれぞれ求める。そして、求めた差分が150以内となる候補の組みを抽出する。この場合、何れの差分も150以内であるため、全ての組みが抽出される。
同様に、図6(b)に示すように、候補テーブル200b−200c間での全ての組みについて頂点のタイマカウンタ値の差分を求め、求めた差分が150以内となる候補の組みを抽出する。この場合も、全ての組みが抽出される。
更に、図6(c)に示すように、候補テーブル200c−200a間での全ての組みについて頂点のタイマカウンタ値の差分を求め、求めた差分が150以内となる候補の組みを抽出する。この場合は、組み2,3の差分が150より大きいためこれらが除かれ、組み1,4だけが抽出される。
そして、これら抽出した組みから全体としての候補の組合せを選定する。すなわち、抽出した組みだけから構成される候補テーブル200a〜200cにおける組合せを、図6(d)に示すように選定する。このように、これら4つの組合せが最終的な候補の組合せとして選定される。
そして、センサECU130は、選定された候補の組合せに対応して、各波形の各立ち上がり推測値を図6(e)に示すように得ると、これらを反射波の受信時刻として、三角測量の要領で障害物の3次元位置を算出する。
すなわち、図7に示すように、受信部121a及び受信部121bでの受信時刻によって、障害物BのY軸方向の位置y(座標値)とZ軸方向の位置(距離z)を求めることができる。
具体的に説明すると、次式が成立する。
L1=C・T1/2
L2=C・T2−L1
L1:受信部121bと障害物Bとの距離
L2:受信部121aと物体Bとの距離
C:超音波の速度
T1:受信部121aで受信した反射波(包絡線波)の立ち上がり推測値
T2:受信部121bで受信した反射波(包絡線波)の立ち上がり推測値
ここで、Dを受信部121aと受信部121bとの距離とすると、yとzは次式で表される。
y =D/2−(D2+L22−L12)/(2・D)
z =√{L22−((D2+L22−L12)/(2・D)2}
同様に、受信部121b及び受信部121cでの受信時刻によって、障害物BのX軸方向の位置x(座標値)とZ軸方向の位置(距離z)を求めることができる。
このようにして、図6(e)に示す各組合せについて、障害物の三次元位置をそれぞれ求めると、センサECU130は、障害物位置の候補として障害物位置テーブルに格納する。
例えば、センサECU130は、内部のメモリに、図8に示すよう障害物位置テーブル300の領域を確保し、候補となる各障害物の三次元位置(x位置、y位置、z位置)をそれぞれセットする。
なお、これら障害物の候補は、上述したように頂点候補(より詳細には立ち上がり推測値)の組合せに基づいて得られるものであるため、実際の障害物の数よりも多くなることも予想される。つまり、障害物をあたかも画像のエイリアスのように捉えていることになる。そこで、このようなエイリアスを時系列での移動平均(平均化処理)により、除去する必要がある。
そのために、図8に示す障害物位置テーブル300は、測定タイミング毎に求めた候補となる障害物の三次元位置を、時系列に保持する。なお、時系列に保持する数は、移動平均のために必要となる数となっている。
そして、センサECU130は、このような障害物位置テーブル300を使用した時系列での移動平均によって、エイリアスを除去した真の障害物の三次元位置を得る。
例えば、時系列が0.1秒間隔の場合では、秒速5mまでの移動体(障害物)を検出可能とすることが仕様により求められているため、50cm以内を平均化して、座標(三次元位置)を求めることにより、エイリアスを除去する。
この際、複数の障害物が存在している状態でも、それぞれのエイリアスが除去されるため、各障害物について、三次元位置を適切に求めることができる。
このようにして、真の障害物の位置を特定し(複数の障害物の場合にはそれぞれの位置を特定し)、特定した障害物位置(複数の場合には何れかの障害物の位置)がPBD11の近傍(例えば、開閉範囲内)である場合に、センサECU130は、障害物検知信号をPBD用ECU140に供給する。
PBD用ECU140は、操作SW160からの指示信号に応答し、モータ150を駆動させ、上述のPBD11を開閉させる。
なお、PBD用ECU140は、開閉させるPBD11のドア角度信号をセンサECU130に供給する。また、センサECU130から障害物検知信号が供給されると、モータ150を停止させる。
モータ150は、PBD用ECU140に制御されて駆動し、PBD11を開閉させる。
操作SW160は、ユーザに操作され、指示信号をPBD用ECU140に供給する。
次に、上記構成の障害物検出装置100の動作について説明する。
障害物検出装置100は、例えば、車両10の後進時(リバース時)やPBD11の開閉時に、図9のフローチャートに示す障害物検出処理を開始する。なお、この障害物検出処理は、車両10の後進やPBD11の開閉が終了するまで、測定タイミング毎に、繰り返し実行されるものとする。
まず、センサECU130は、タイミング回路115を制御して、送信部111から超音波を発信させる(ステップS11)。そして、これと同時に、センサECU130は、タイム計測を開始する(ステップS12)。つまり、超音波の発信時からのタイムカウンタ値のカウントを始める。
センサECU130は、タイマカウンタ値が所定値以上になるまで、後続処理の実行を待機する(ステップS13)。つまり、有効な反射波が受信可能となるまで待機する。
タイマカウンタ値が所定値以上になると、センサECU130は、閾値(例えば、電圧カウンタ値6000)を超えた波形の頂点を特定し、立ち上がり推測値を求めて、候補テーブル200a〜200cに格納する(ステップS14)。
例えば、包絡線波の頂点を特定すると、その頂点近傍の立ち上がり部分を近似する近似直線を求め、その近似直線が電圧カウンタ値0と交差するゼロクロス時刻を求めることにより、包絡線波の立ち上がり時刻を推測する。
そして、センサECU130は、頂点のタイマカウンタ値、頂点の電圧カウンタ値、及び、立ち上がり推測値(タイマカウンタ値)を、候補テーブル200a〜200cに格納する。
センサECU130は、候補テーブル200a〜200cにおける頂点のタイマカウンタ値の関係に従って、同一反射波の候補を選定する(ステップS15)。
例えば、候補テーブル200a−200b間、候補テーブル200b−200c間、及び、候補テーブル200c−200a間で、頂点のタイマカウンタ値の差分が任意値(任意値α〜γ)以内となる候補の組みをそれぞれ抽出する。そして、最終的に、抽出した各組みから全体としての候補の組合せを選定する。
センサECU130は、選定した候補の立ち上がり推測値に基づいて求めた各三次元位置を障害物位置テーブル300に格納する(ステップS16)。
つまり、各候補の立ち上がり推測値を、受信波の受信時刻として、上述した三角測量の要領で障害物の三次元位置を特定し、上述した図8に示すような障害物位置テーブル300に追加して格納する。
そして、センサECU130は、このような障害物位置テーブル300を使用した時系列での移動平均によって、真の障害物の三次元位置を得る(ステップS17)。つまり、時系列での移動平均によって、エイリアスを除去した真の障害物の三次元位置を得る。
なお、特定した障害物の位置がPBD11の近傍である場合に、センサECU130は、障害物検知信号をPBD用ECU140に供給するなどして、障害物への接触等を防止する。
このような障害物検出処理において、候補テーブル200a〜200cにおける頂点のタイマカウンタ値の差分が所定範囲以内のものを、同一反射波の組合せ候補として選定している。そのため、障害物位置テーブル300における障害物の候補は、実際の障害物の数より多くなり、障害物をエイリアスのように捉えることになる。そして、この障害物位置テーブル300を使用した時系列での移動平均によりエイリアスを除去することで、真の障害物の位置を適切に求めることができる。
この結果、最終的に障害物の位置を精度良く算出することができる。
この発明は上記の実施形態に限定されず、種々の変形及び応用が可能である。
例えば、上記の実施形態では、障害物位置テーブル300を使用して、候補となる障害物の位置を時系列に保持し、移動平均によって、エイリアスを除去した真の障害物の位置を求める場合について説明したが、図6(e)に示すような波形の候補の組合せ(立ち上がり推測値の組合せ)を時系列に保持するようにし、移動平均によって、真の組合せを求めた後に、障害物の位置を算出するようにしてもよい。
この場合も、時系列での移動平均により、不適切な立ち上がり推測値の組合せが除去されるため、最終的に障害物の位置を精度良く算出することができる。
上記の説明では、超音波を用いる場合について説明したが、超音波以外に、レーザ光や電磁波を用いる場合でも適宜適用可能である。
上記の説明では、PBD11の近傍を監視する場合に、この発明を適用したが、センサユニットをドアミラーなどに配置し、各ドアの近傍の障害物を監視するために使用することも可能である。
上記の説明では、受信された反射波を整流したのち、整流された信号を積分することにより包絡線波を得る場合について説明したが、これに代えて、受信された反射波をサンプリングして積分したのちに整流することで包絡線波を得るようにすることも可能である。
上述したシステム構成やフローチャートは一例であり、任意に変更可能である。
(a)と(b)は、本発明の実施形態に係る車両の概略図である。 本発明の実施の形態に係る障害物検出装置の構成図である。 センサユニットの平面図である。 各波形の近似直線により得られる立ち上がり推測値を説明するための図である。 候補テーブルの一例をそれぞれ示す図である。 (a)〜(e)は、同一反射波の候補の組合せを選定する様子を説明するための図である。 障害物の位置を求める手法を説明するための図である。 障害物位置テーブルの一例を示す図である。 障害物検出処理を説明するためのフローチャートである。
符号の説明
10 車両
11 PBD
111 送信部(送信手段)
121a〜121c 受信部(受信手段)
124a〜124c 検波部(検波手段、包絡線波取得手段)
127a〜127c AD入力部(サンプリング手段、包絡線波取得手段)
130 センサECU(推測手段、選定手段、位置算定手段、保持手段、位置特定手段)

Claims (6)

  1. 超音波を測定タイミング毎に送信する送信手段と、
    前記送信手段により送信された超音波の反射波を異なる位置にてそれぞれ受信する受信手段と、
    前記受信手段が受信した各反射波に基づいて各反射波に対応する包絡線波を得る包絡線波取得手段と、
    得られた前記包絡線波の頂点時刻を判別して、各包絡線波の立ち上がり時刻をそれぞれ推測する推測手段と、
    前記推測手段が判別した各包絡線波の頂点時刻の関係に基づいて、候補となる包絡線波の組合せを選定する選定手段と、
    前記選定手段が選定した組合せにおける、前記推測手段により推測された立ち上がり時刻に基づいて、候補となる障害物の位置情報を算定する位置算定手段と、
    前記位置算定手段により算定された位置情報を複数の測定回数分保持する保持手段と、
    前記保持手段に保持された位置情報を平均処理して、真の障害物の位置を特定する位置特定手段と、
    を備える、ことを特徴とする障害物検出装置。
  2. 前記選定手段は、各包絡線波の頂点時刻同士の差分が所定値以内の組みをそれぞれ抽出し、抽出した各組みから全体としての包絡線波の組合せを選択する、ことを特徴とする請求項1に記載の障害物検出装置。
  3. 前記位置算定手段は、実際の障害物より多い数の障害物候補の位置情報を算定し、
    前記位置特定手段は、時系列での移動平均によって、真の障害物の位置を特定する、ことを特徴とする請求項1に記載の障害物検出装置。
  4. 前記包絡線波取得手段は、前記受信手段が受信した各反射波をそれぞれ整流する検波手段と、前記検波手段が整流した各反射波形をそれぞれ積分し、各反射波に対応する包絡線波をそれぞれサンプリングするサンプリング手段と、を有し、
    前記推測手段は、前記サンプリング手段がサンプリングした各包絡線波の各頂点時刻を判別して、各包絡線波の立ち上がり時刻をそれぞれ推測するものであることを特徴とする請求項1ないし3のいずれか1項に記載の障害物検出装置。
  5. 超音波を送信部から計測タイミング毎に送信し、当該超音波の反射波を異なる受信部にてそれぞれ受信する障害物検出装置における位置特定方法であって、
    各受信部にて受信した各反射波に基づいて各反射波に対応する包絡線波を得る包絡線波取得ステップと、
    得られた前記包絡線波の頂点時刻を判別して、各包絡線波の立ち上がり時刻をそれぞれ推測する推測ステップと、
    前記推測ステップにて判別した各包絡線波の頂点時刻の関係に基づいて、候補となる包絡線波の組合せを選定する選定ステップと、
    前記選定ステップにて選定した組合せにおける、前記推測ステップにて推測された立ち上がり時刻に基づいて、候補となる障害物の位置情報を算定する位置算定ステップと、
    前記位置算定ステップにて算定された位置情報をテーブルに格納し、複数の測定回数分の位置情報を保持させる格納ステップと、
    前記テーブルに格納された位置情報を平均処理して、真の障害物の位置を特定する位置特定ステップと、
    を備える、ことを特徴とする位置特定方法。
  6. 前記包絡線波取得ステップは、前記各受信部にて受信した各反射波を検波部によりそれぞれ整流し、AD入力部によりそれぞれ積分し、各反射波に対応する包絡線波をそれぞれサンプリングするサンプリングステップを有し、
    前記推測ステップは、前記サンプリングステップにおいてサンプリングした各包絡線波の頂点時刻を判別して、各包絡線波の立ち上がり時刻をそれぞれ推測するものであることを特徴とする請求項5に記載の位置特定方法。
JP2006152026A 2006-05-31 2006-05-31 障害物検出装置および位置特定方法 Expired - Fee Related JP5103794B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2006152026A JP5103794B2 (ja) 2006-05-31 2006-05-31 障害物検出装置および位置特定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2006152026A JP5103794B2 (ja) 2006-05-31 2006-05-31 障害物検出装置および位置特定方法

Publications (2)

Publication Number Publication Date
JP2007322225A true JP2007322225A (ja) 2007-12-13
JP5103794B2 JP5103794B2 (ja) 2012-12-19

Family

ID=38855184

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2006152026A Expired - Fee Related JP5103794B2 (ja) 2006-05-31 2006-05-31 障害物検出装置および位置特定方法

Country Status (1)

Country Link
JP (1) JP5103794B2 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009236775A (ja) * 2008-03-27 2009-10-15 Aisin Seiki Co Ltd 物体検出装置及び当該物体検出装置を用いた車両の開閉制御システム、並びに包絡線の立ち上がり検出方法
JPWO2013088951A1 (ja) * 2011-12-12 2015-04-27 株式会社村田製作所 位置測定装置
JP2016504897A (ja) * 2012-11-12 2016-02-12 オークランド ユニサービシズ リミテッドAuckland Uniservices Limited 車両または移動物体の検出

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60211383A (ja) * 1984-03-16 1985-10-23 シーメンス、アクチエンゲゼルシヤフト 超音波エコー信号の評価方法
JPS62161072A (ja) * 1986-01-10 1987-07-17 Mitsubishi Heavy Ind Ltd 障害物検出センサ
JPH07280952A (ja) * 1994-04-13 1995-10-27 Nippon Giken:Kk 積雪深計測装置
JPH09184716A (ja) * 1995-10-31 1997-07-15 Sanyo Electric Co Ltd 超音波センサ及びこれを用いた分注装置
JPH09211097A (ja) * 1996-01-29 1997-08-15 Hitachi Ltd 水上/水中移動物体運動認識方法とその装置
JP2000121719A (ja) * 1998-10-20 2000-04-28 Oki Systec Tokai:Kk 音源位置標定装置
JP2005030838A (ja) * 2003-07-09 2005-02-03 Sumitomo Osaka Cement Co Ltd 監視装置及び監視方法
WO2005106530A1 (ja) * 2004-04-28 2005-11-10 Matsushita Electric Industrial Co., Ltd. 超音波測距装置

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60211383A (ja) * 1984-03-16 1985-10-23 シーメンス、アクチエンゲゼルシヤフト 超音波エコー信号の評価方法
JPS62161072A (ja) * 1986-01-10 1987-07-17 Mitsubishi Heavy Ind Ltd 障害物検出センサ
JPH07280952A (ja) * 1994-04-13 1995-10-27 Nippon Giken:Kk 積雪深計測装置
JPH09184716A (ja) * 1995-10-31 1997-07-15 Sanyo Electric Co Ltd 超音波センサ及びこれを用いた分注装置
JPH09211097A (ja) * 1996-01-29 1997-08-15 Hitachi Ltd 水上/水中移動物体運動認識方法とその装置
JP2000121719A (ja) * 1998-10-20 2000-04-28 Oki Systec Tokai:Kk 音源位置標定装置
JP2005030838A (ja) * 2003-07-09 2005-02-03 Sumitomo Osaka Cement Co Ltd 監視装置及び監視方法
WO2005106530A1 (ja) * 2004-04-28 2005-11-10 Matsushita Electric Industrial Co., Ltd. 超音波測距装置

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009236775A (ja) * 2008-03-27 2009-10-15 Aisin Seiki Co Ltd 物体検出装置及び当該物体検出装置を用いた車両の開閉制御システム、並びに包絡線の立ち上がり検出方法
JPWO2013088951A1 (ja) * 2011-12-12 2015-04-27 株式会社村田製作所 位置測定装置
US9494684B2 (en) 2011-12-12 2016-11-15 Murata Manufacturing Co., Inc. Position measurement device
JP2016504897A (ja) * 2012-11-12 2016-02-12 オークランド ユニサービシズ リミテッドAuckland Uniservices Limited 車両または移動物体の検出

Also Published As

Publication number Publication date
JP5103794B2 (ja) 2012-12-19

Similar Documents

Publication Publication Date Title
JP7382107B2 (ja) コード化された超音波送信に対する飛行時間及びコードシグネチャ検出
US8000169B2 (en) Object detecting apparatus, opening and closing control system for vehicle using object detecting apparatus, and method of detecting upstroke of envelope
US9354314B2 (en) Underwater detection device
KR101839157B1 (ko) 초음파 측정 장치 및 초음파 신호의 평가 방법
CN1997911B (zh) 使用超声波的距离测量方法与装置
KR100561855B1 (ko) 로봇용 로컬라이제이션 시스템
EP2462464A1 (en) Relative location determination of mobile sensor nodes
US11353568B2 (en) Ultrasonic object detection device
KR20110012584A (ko) 초음파 기반 3차원 위치 추정 장치 및 방법
JP5103793B2 (ja) 障害物検出装置および位置特定方法
CN105172713A (zh) 停车区域识别装置及其控制方法
JP2010032442A (ja) 測位システム及び処理装置
JP2007315892A (ja) 障害物検出装置および受信時刻推測方法
JP2021026557A (ja) 障害物検知装置
EP3324208B1 (en) Positioning device and positioning method
JP5103794B2 (ja) 障害物検出装置および位置特定方法
CN109791197A (zh) 检测装置、检测方法以及检测程序
TW201038959A (en) Ultrasound-receiving module, application and detecting method thereof
JP2005292129A (ja) 超音波位置計測装置
KR20160057533A (ko) 차량 초음파센서의 노이즈 감지장치 및 이의 노이즈 감지방법
JP6716621B2 (ja) 物体判定装置及びセンサ装置
KR20200076967A (ko) 초음파 센서 장치와 초음파 센서 제어 장치 및 방법
JP3646493B2 (ja) 超音波センサ装置
JPH02232580A (ja) 物体検知装置
EP4369038A1 (en) Object detection system and object detection device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20090427

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20110706

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20110809

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20111011

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20120904

A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20120917

R151 Written notification of patent or utility model registration

Ref document number: 5103794

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20151012

Year of fee payment: 3

LAPS Cancellation because of no payment of annual fees