JP2020042012A - 障害物の絶対速度の推定方法、システム、コンピュータ装置及び記憶媒体 - Google Patents

障害物の絶対速度の推定方法、システム、コンピュータ装置及び記憶媒体 Download PDF

Info

Publication number
JP2020042012A
JP2020042012A JP2019128860A JP2019128860A JP2020042012A JP 2020042012 A JP2020042012 A JP 2020042012A JP 2019128860 A JP2019128860 A JP 2019128860A JP 2019128860 A JP2019128860 A JP 2019128860A JP 2020042012 A JP2020042012 A JP 2020042012A
Authority
JP
Japan
Prior art keywords
obstacle
current time
obstacles
time
absolute
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
JP2019128860A
Other languages
English (en)
Other versions
JP6786676B2 (ja
Inventor
リー,チョンチョン
Chongchong Li
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.)
Baidu Online Network Technology Beijing Co Ltd
Original Assignee
Baidu Online Network Technology Beijing 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 Baidu Online Network Technology Beijing Co Ltd filed Critical Baidu Online Network Technology Beijing Co Ltd
Publication of JP2020042012A publication Critical patent/JP2020042012A/ja
Application granted granted Critical
Publication of JP6786676B2 publication Critical patent/JP6786676B2/ja
Active 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/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/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination 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/86Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
    • 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/66Radar-tracking systems; Analogous systems
    • G01S13/72Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • G01S13/723Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
    • G01S13/726Multiple target tracking
    • 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/932Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles using own vehicle data, e.g. ground speed, steering wheel direction

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)
  • Radar Systems Or Details Thereof (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

【課題】障害物の速度測定がより精確になる、障害物の絶対速度の推定方法、システム、コンピュータ装置及びコンピュータ記憶媒体を提供する。【解決手段】障害物の絶対速度の推定方法は、統合ナビゲーション装置を用いて、自動車の現在時刻t1での絶対速度を測定し、且つデータテーブルに格納するステップと、ミリ波レーダーを用いて、自動車に対する障害物の第二時刻t2での相対速度を取得するステップと、障害物の第二時刻t2での相対速度を現在時刻t1での相対速度に修正するステップと、自動車の現在時刻t1における絶対速度と修正後の障害物の現在時刻t1での相対速度とを加算して、障害物の現在時刻t1での絶対速度を得るステップと、を含む。【選択図】図1

Description

本発明は、自動車運転の分野に関し、特に障害物の絶対速度の推定方法、障害物の絶対速度の推定システム、コンピュータ装置及びコンピュータ記憶媒体に関する。
従来技術では、通常、統合ナビゲーション装置を用いて、自動運転車の絶対速度を測定し、ミリ波レーダーを用いて、障害物の相対速度を測定し、障害物の絶対速度は、ミリ波測定結果と統合ナビゲーション結果とを加算して得られる。
統合ナビゲーション装置は、GPSの精確なタイムスタンプを有するが、ミリ波レーダーは、ホストがデータを受信する時刻のタイムスタンプのみを有するため、時間遅延が生じ、2つの異なる時刻データの重ね合わせを招き、障害物の速度測定が不精確である。
本発明の実施例は、従来技術の1つ又は複数の技術的問題を解決するために、障害物の絶対速度の推定方法、システム、コンピュータ装置、コンピュータ記憶媒体を提供する。
本発明の第一態様によれば、障害物の絶対速度の推定方法を提供し、該方法は、
統合ナビゲーション装置を用いて、自動車の現在時刻t1での絶対速度を測定し、且つデータテーブルに格納するステップと、
ミリ波レーダーを用いて、前記自動車に対する前記障害物の第二時刻t2での相対速度を取得するステップと、
前記障害物の第二時刻t2での相対速度を前記障害物の現在時刻t1での相対速度に修正するステップと、
前記自動車の現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るステップとを含む。
本発明の第一態様の一実施例では、前記障害物の第二時刻t2での相対速度を前記障害物の現在時刻t1での相対速度に修正することは、
障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得るステップと、
複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近く且つ数量が最も多い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得るステップと、
第二時刻t2に測定される前記障害物の相対速度から前記平均誤差量を減算し、修正後の前記障害物の現在時刻t1での相対速度を得るステップと、を含む。
本発明の第一態様の別の実施例では、前記自動車の前記現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得ることは、
クラスタリング後の同類障害物の数が第一閾値より大きく、及び/又は前記平均誤差量が第二閾値未満である場合、前記自動車の現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るステップを含む。
本発明の第一態様のさらに別の実施例では、前記自動車の前記現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得ることは、
障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得るステップと、
複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得るステップと、
クラスタリング後の同類障害物の数が第一閾値未満で、及び/又は前記平均誤差量が第二閾値より大きい場合、前記ミリ波レーダーにより検出される各種の同類障害物の数及び前記ミリ波レーダーの隣接する検出の間の検出周期を記録ステップと、
各種の同類障害物の障害物数、検出周期、及び第二時刻t2と現在時刻t1との時間差t2−t1の関数関係を得るステップとを含む。
本発明の第一態様のまたさらに別の実施例では、前記ミリ波レーダーにより検出される障害物の数と検出周期に基づき、前記ミリ波レーダーの第二時刻t2での時間データを現在時刻t1での時間データに修正して、修正後の前記障害物の現在時刻t1での相対速度を得るステップと、
前記データテーブルにおいて、前記自動車の現在時刻t1での絶対速度を検索し、検索された自動車の絶対速度と修正後の複数種の前記同類障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るステップとをさらに含む。
本発明の第二態様によれば、障害物の絶対速度の推定システムを提供し、該システムは、
自動車の現在時刻t1での絶対速度を測定し、且つ前記現在時刻t1と前記絶対速度に対応するデータテーブルを格納する統合ナビゲーション装置と、
前記自動車に対する前記障害物の第二時刻t2での相対速度を取得するミリ波レーダーと、
前記障害物の第二時刻t2での相対速度を前記障害物の現在時刻t1での相対速度に修正する修正装置と、
前記自動車の現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得る加算器と、を備える。
本発明の第二態様の一実施例では、修正装置は、
障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得て、
複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近く且つ数量が最も多い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得て、
第二時刻t2に測定される前記障害物の相対速度から前記平均誤差量を減算し、修正後の前記障害物の現在時刻t1での相対速度を得るために用いられる。
本発明の第二態様の別の実施例では、加算器は、クラスタリング後の同類障害物の数が第一閾値より大きく、及び/又は前記平均誤差量が第二閾値未満である場合、前記自動車の現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るために用いられる。
本発明の第二態様のさらに別の実施例では、修正装置は、
障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得、
複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得、
クラスタリング後の同類障害物の数が第一閾値未満で、及び/又は前記平均誤差量が第二閾値より大きい場合、前記ミリ波レーダーにより検出される各種の同類障害物の数及び前記ミリ波レーダーの隣接する検出の間の検出周期を記録し、
各種の同類障害物の障害物数、検出周期、及び第二時刻t2と現在時刻t1との時間差t2−t1の関数関係を得るためにさらに用いられる。
本発明の第二態様のまたさらに別の実施例では、修正装置は、
前記ミリ波レーダーにより検出される障害物の数と検出周期に基づき、前記ミリ波レーダーの第二時刻t2での時間データを現在時刻t1での時間データに修正して、修正後の前記障害物の現在時刻t1での相対速度を得、
前記データテーブルにおいて、前記自動車の現在時刻t1での絶対速度を検索し、前記加算器は、検索された自動車の絶対速度と修正後の複数種の前記同類障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るために用いられる。
本発明の第三態様によれば、コンピュータ装置を提供し、1つ又は複数のプロセッサと、1つ又は複数のプログラムを記憶するメモリと、を備え、1つ又は複数のプログラムが1つ又は複数のプロセッサにより実行されると、1つ又は複数のプロセッサが上記方法を実現する。
本発明の第四態様によれば、コンピュータ可読記憶媒体を提供し、コンピュータプログラムが記憶され、該プログラムがプロセッサにより実行されると、上記方法を実現する。
本発明の技術案によれば、ミリ波レーダーにより測定される障害物の修正後の相対速度がより精確になり、その修正後の相対速度とGPSの精確なタイムスタンプ特徴を有する統合ナビゲーション装置により測定される自動車の絶対速度とを加算して、特定の時刻に測定される障害物の絶対速度を得て、従来技術における時間遅延を解消し、それにより、障害物の速度測定がより精確になる。
以上、明細書の目的のために発明の概要を説明したが、何らかの形態に限定されるものではない。上記説明された例示的な態様、実施形態及び特徴に加えて、本発明のさらなる態様、実施形態及び特徴は図面及び以下の詳細説明によって容易に明らかになる。
図面において、特に断らない限り、同一符号は同一又は類似の部材又は要素を示す。これらの図面は必ずしも縮尺に応じて作成されるものではない。なお、これらの図面は本発明に開示されているいくつかの実施形態を示しているが、本発明の範囲を限定するものではない。
本発明の第一態様の一実施例に係る障害物の絶対速度の推定方法を模式的に示すフローチャートである。 本発明の第一態様の別の実施例に係る障害物の第二時刻t2での相対速度を現在時刻t1での相対速度に修正することを模式的に示すフローチャートである。 本発明の第一態様のさらに別の実施例に係る自動車の現在時刻t1での絶対速度と修正後の障害物の現在時刻t1での相対速度とを加算して障害物の現在時刻t1での絶対速度を得ることを模式的に示すフローチャートである。 本発明の第二態様の一実施例に係る障害物の絶対速度の推定システムを模式的に示すブロック図である。 本発明の第三態様に係るコンピュータ装置の一実施例を模式的に示す図である。
以下、いくつかの例示的な実施例を説明する。当業者が理解できるように、本発明の趣旨又は範囲を逸脱せずに、説明された実施例を様々な形態で変更することができる。従って、図面及び説明は本質的に限定的ではなく例示的なものである。
図1は、本発明の実施例に係る障害物の絶対速度の推定方法100を示し、該方法100は、
統合ナビゲーション装置を用いて、自動車の現在時刻t1での絶対速度v_c(t1)を測定し、且つデータテーブルに格納するステップ102と、ミリ波レーダーを用いて、自動車に対する障害物の第二時刻t2での相対速度v_r(t2)を取得するステップ104と、障害物の第二時刻t2での相対速度v_r(t2)を現在時刻t1での相対速度v_r(t1)に修正するステップ106と、自動車の現在時刻t1での絶対速度v_c(t1)と修正後の障害物の現在時刻t1での相対速度v_r(t1)とを加算して、障害物の現在時刻t1での絶対速度、すなわち、v_a(t1)=v_r(t1)+v_c(t1)を得るステップ108と、を含む。
本発明の明細書の各実施例において言及される用語「障害物」は、広義に理解され、例えば、自動車の周囲の通行人、自転車、自転電動車、ほかの非自動車又は自動車は、自車(自動車)に対して、障害物であると見なされても良い。
本発明の各実施例において言及される用語「自動車」は、広義に理解され、例えば、自動運転車、無人車、有人車、電気自動車など動力特性を有する車両を含んでもよい。
本発明の各実施例において言及される用語「絶対速度」とは、地面等の静止物体に対する速度である。
本発明の各実施例において言及される「相対速度」の用語とは、障害物の自動車(自車)に対する速度であり、例えば、障害物が通行人である場合、「相対速度」の用語とは、通行人である障害物の自動車に対する速度であり、障害物が自転車である場合、「相対速度」の用語とは自転車である障害物の自動車に対する速度であるなどが挙げられる。
本発明の各実施例では、後述する統合ナビゲーション装置、ミリ波レーダー、修正装置、加算器等は自動車(自車)に搭載されてもよく、場合によっては、自動車(自車)に搭載しなくてもよい。
本発明の各実施例において言及される用語「自動車」とは自車であり、「ほかの自動車」とは自車に対するほかの車両である。
ステップ102では、統合ナビゲーション装置を用いて、自動車の現在時刻t1での絶対速度v_c(t1)を測定し、且つデータテーブルに格納する。なお、統合ナビゲーション装置は、精確なタイムスタンプを有し、例えば、特定の時刻、例えば、地面等の静止物体に対する自動車(自車)の現在時刻t1での絶対速度v_c(t1)をリアルタイムに測定できる。多くの場合、地面に対する自動車の絶対速度は、経時変化し、精確なタイムスタンプを有する統合ナビゲーション装置によって自動車の現在時刻t1での絶対速度を精確に測定できる。特定の時刻に対応する絶対速度をデータテーブルに格納し、後続の使用に備える。
ステップ104では、ミリ波レーダーを用いて、自動車に対する障害物の第二時刻t2での相対速度v_r(t2)を取得する。ミリ波レーダーの各回の検出の間に、時間差があり、即ち、時間遅延がある。例えば、障害物の現在時刻t1での相対速度を検出する必要があるが、得られる測定結果は次の時刻例えば第二時刻t2にミリ波レーダーが受信する測定結果であることが多く、このような時間遅延があるため、測定結果が不精確で、自動車に対する障害物の測定時刻での実際相対速度を真に反映できない。換言すれば、ミリ波レーダーにより受信される障害物の相対速度のタイムスタンプが第二時刻t2であるが、実際の測定結果(障害物の相対速度)は、前の時刻、すなわち現在時刻t1に測定される障害物の相対速度である。現在時刻t1での測定結果が第二時刻t2に受信される時間遅延があるため、後続の修正ステップを行う必要があり、すなわち、名目上第二時刻t2のタイムスタンプに受信される測定結果を現在時刻t1のタイムスタンプに受信される測定結果に修正し、それにより精確なタイムスタンプでの測定結果(障害物の相対速度)を真に反映する。
この場合に、ステップ106によって、障害物の第二時刻t2での相対速度v_r(t2)を現在時刻t1での相対速度v_r(t1)に修正する必要がある。修正の目的は、障害物の現在時刻t1での実際相対速度を真に反映することである。障害物の第二時刻t2での相対速度v_r(t2)を現在時刻t1での相対速度v_r(t1)に修正するステップ106は、図2に示されるステップ110を含んでもよい。
ステップ110では、障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度v_r1(t2)、v_r2(t2)、v_r3(t2)…v_rn(t2)等と自動車の現在時刻t1での絶対速度v_c(t1)とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得て、例えば、v_a1(t1)=v_r1(t2)+v_c(t1)、v_a2(t1)=v_r2(t2)+v_c(t1)、v_a3(t1)=v_r3(t2)+v_c(t1)…v_an(t1)=v_r3(t2)+v_c(t1)等である。得られる想定絶対速度は、後続の実際の処理に基礎を築くためのものである。ここで、複数の想定絶対速度を得ることとは、例えば、障害物が通行人である場合、通行人である障害物の想定絶対速度v_a1(t1)を得て、障害物が自転車である場合、自転車である障害物の想定絶対速度v_a2(t1)を得て、障害物がほかの自動車である場合、ほかの自動車である障害物の想定絶対速度v_a3(t1)を得ることなどである。
さらに、複数種の障害物の現在時刻t1での複数の想定絶対速度v_a1(t1)、v_a2(t1)、v_a3(t1)…v_an(t1)等のうち数値が近く且つ数量が最も多い障害物を同類障害物としてクラスタリングするステップ112を含んでもよく、例えば、複数の障害物が存在するシーンにおいて大部分の障害物の走行速度が同じであり、すなわち速度が0であり、それは、自動車の走行中に、シーンにおける多くの障害物が静止障害物、例えば、木、家屋、橋、道路等であるからであり、これらの静止障害物は、ちょうど統計と仮定の基礎となる。現在時刻t1での複数の想定絶対速度v_a1(t1)、v_a2(t1)、v_a3(t1)…v_an(t1)のうち数値が近く且つ数量が最も多い障害物を同類障害物としてクラスタリングし、例えば、v_a1(t1)、v_a3(t1)、v_a5(t1)、v_a7(t1)…v_an(t1)を含み、これらの同類障害物を静止障害物とみなすことは、後続の修正処理の基礎となる。同類障害物の複数の想定絶対速度v_a1(t1)、v_a3(t1)、v_a5(t1)、v_a7(t1)…v_an(t1)を誤差量として平均値を求め、平均誤差量を得て、すなわちΔv_a=(v_a1(t1)+v_a3(t1)+v_a5(t1)+v_a7(t1)+…+v_an(t1))/m、ここで、Mは、同類障害物としてクラスタリングされる障害物の数である。それにより、平均誤差量Δv_aを得る。
本発明の第一態様の一実施例では、第二時刻t2に測定される障害物の相対速度v_r1(t2)、v_r2(t2)、v_r3(t2)…v_rn(t2)から平均誤差量Δv_aを減算し、修正後の障害物の現在時刻t1での相対速度v_r1(t1)、v_r2(t1)、v_r3(t1)…v_rn(t1)を得るステップ114をさらに含む。例えば、障害物が通行人である場合、第二時刻t2に測定される障害物の相対速度v_r1(t2)から平均誤差量Δv_aを減算し、修正後の通行人である障害物の現在時刻t1での相対速度v_r1(t1)を得て、すなわちv_r1(t1)=v_r1(t2)−Δv_aであり、障害物が自転車である場合、第二時刻t2に測定される障害物の相対速度v_r2(t2)から平均誤差量Δv_aを減算し、修正後の自転車である障害物の現在時刻t1での相対速度v_r2(t1)を得て、すなわちv_r2(t1)=v_r2(t2)−Δv_aであり、障害物がほかの自動車である場合、第二時刻t2に測定される障害物の相対速度v_r3(t2)から平均誤差量Δv_aを減算し、修正後の自動車である障害物の現在時刻t1でのほかの相対速度v_r3(t1)を得て、すなわちv_r3(t1)=v_r3(t2)−Δv_aであるなどが挙げられる。
本発明の第一態様の一実施例では、ステップ108では、自動車の現在時刻t1での絶対速度v_c(t1)と修正後の障害物の現在時刻t1での相対速度v_r(t1)とを加算して、障害物の現在時刻t1での絶対速度、すなわちv_a(t1)=v_r(t1)+v_c(t1)を得ることは、クラスタリング後の同類障害物の数mが第一閾値より大きく、及び/又は平均誤差量が第二閾値未満である場合、自動車の現在時刻t1での絶対速度v_c(t1)と修正後の障害物の現在時刻t1での相対速度v_r(t1)とを加算して、障害物の現在時刻t1での絶対速度v_a(t1)、すなわちv_a(t1)=v_r(t1)+v_c(t1)を得るステップ116を含む。これは、第一種の形態である。
なお、クラスタリング後の同類障害物の数mが第一閾値より大きいとは、1つのシーンにおける80%の障害物は静止障害物であり、残りの20%の障害物は移動速度が異なる移動障害物であると仮定してもよいことを意味する。1つのシーンにおける70%の障害物は静止障害物であり、残りの30%の障害物は移動速度が異なる移動障害物であると仮定してもよいなどである。1つのシーンにおいて想定される静止障害物の百分率は、本発明の科学的価値を左右するものではなく、それは特殊の場合を除き、実際には1つのシーンにおけるほとんどの障害物が静止障害物である可能性があるからである。1つのシーンにおいて、クラスタリング後の同類障害物の数mが10よりも大きい場合、クラスタリング後の同類障害物の数mが第一閾値より大きい標準を満たすと判断でき、また、第一閾値の数値は、状況に応じてそれぞれ15、20、25又は30等に設定されてもよい。誤差量とは、測定される障害物の絶対速度v_aであり、平均誤差量が第二閾値未満であるとは、測定される障害物の絶対速度v_aが例えば0.5km/h、0.4km/h、0.3km/h等未満であることを意味する。ここで、仮定される第二閾値の0.5km/h、0.4km/h、0.3km/h等も状況に応じて具体的に設定される。クラスタリング後の同類障害物の数mが第一閾値より大きく、及び/又は平均誤差量が第二閾値未満である場合、第一標準又は上記第一種の形態を満たすと判断し、直接に自動車の現在時刻t1での絶対速度v_c(t1)と修正後の障害物の現在時刻t1での相対速度v_r(t1)とを加算して、障害物の現在時刻t1での絶対速度v_a(t1)=v_c(t1)+v_r(t1)(v_r(t1)=v_r(t2)−Δv_a)を得る。
本発明の別の実施例では、自動車の現在時刻t1での絶対速度v_c(t1)と修正後の障害物の現在時刻t1での相対速度v_r(t1)とを加算して、障害物の現在時刻t1での絶対速度v_a(t1)=v_c(t1)+v_r(t1)を得ることは、第二種の形態を含んでよい。
障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得て、複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得る。
図3のステップ118に示すように、クラスタリング後の同類障害物の数mが第一閾値未満で、及び/又は平均誤差量が第二閾値より大きい場合、修正後の複数種の同類障害物の現在時刻t1での相対速度を得るとともに、ミリ波レーダーにより検出される各種の同類障害物の数及び2回の隣接する検出の間のミリ波レーダーの検出周期を記録し、それにより各種の同類障害物の障害物数、検出周期、及び第二時刻t2と現在時刻t1との時間差t2−t1の関数関係を得る。
なお、クラスタリング後の同類障害物の数mが第一閾値未満であるとは、同類障害物の数mが10、15、20、25又は30等未満であることを意味する。平均誤差量が第二閾値より大きいとは、測定される障害物の絶対速度v_aが、例えば、0.5km/h、0.4km/h、0.3km/h等より大きいことを意味する。クラスタリング後の同類障害物の数mが第一閾値未満で、及び/又は平均誤差量が第二閾値より大きい場合、上記第一種の形態のように直接に自動車の現在時刻t1での絶対速度v_c(t1)と修正後の障害物の現在時刻t1での相対速度v_r(t1)とを加算して、障害物の現在時刻t1での絶対速度v_a(t1)=v_c(t1)+v_r(t1)(v_r(t1)=v_r(t2)−Δv_a)を得るのではなく、第二種の処理方式を採用する必要がある。すなわち、ミリ波レーダーにより検出される各種の同類障害物の障害物数Nと2回の隣接する検出の間のミリ波レーダーの検出周期Tを記録し、それにより各種の同類障害物の障害物数N、検出周期T、及び第二時刻t2と現在時刻t1との時間差Δt=t2−t1の関数関係を得る。
例えば、同類障害物(路面の障害物)の障害物数NをN1と記録する場合、2回の隣接する検出の間のミリ波レーダーの検出周期をT1、対応する第二時刻t2と現在時刻t1との時間差をΔt1=t2−t1、すなわちΔt1=f(N1,T1)とし、
同類障害物(家の障害物)の障害物数NをN2とする場合、2回の隣接する検出の間のミリ波レーダーの検出周期をT2、対応する第二時刻t2’と現在時刻t1’との時間差Δt1’=t2’−t1’、すなわちΔt1’=f(N2,T2)とし、
同類障害物(木の障害物)の障害物数NをN3とする場合、2回の隣接する検出の間のミリ波レーダーの検出周期をT3、対応する第二時刻t2”と現在時刻t1”との時間差Δt1”=t2”−t1”、すなわちΔt1”=f(N3,T3)とするなどであり、最終的にフィッティングして得る関数式は、Δt1=f(N1,T1)である。いくつかの特殊の関数関係、例えばΔt1=f(N1,T1)、Δt1’=f(N2,T2)、Δt1”=f(N3,T3)、…Δt1n=f(Nn,Tn)に基づき如何にフィッティングして最終的な関数関係式Δt=f(N,T)を得るかについて、当業者は、数学におけるフィッティング技術に従って簡単に解決でき、例えば、一般的に使用されるフィッティング方法として、最小二乗曲線フィッティング法等が挙げられ、これらは、本発明の発明点ではないため、ここで詳細説明をしない。
本発明の第一態様の一実施例では、図3中のステップ120に示すように、ミリ波レーダーにより検出される障害物数、例えばN1’と検出周期T1’に基づき、ミリ波レーダーの第二時刻t2での時間データを現在時刻t1での時間データに修正し、上記データテーブルにおいて現在時刻t1に統合ナビゲーション装置により測定される自動車の絶対速度v_c(t1)を検索し、検索された自動車の絶対速度v_c(t1)と修正後の障害物の現在時刻t1での相対速度v_r(t1)とを加算し、障害物の現在時刻t1での絶対速度v_a(t1)=v_c(t1)+v_r(t1)を得る。
第二種の形態で障害物の現在時刻t1での絶対速度v_a(t1)=v_c(t1)+v_r(t1)を得る方式について、まず、多くのデータの訓練によって、例えば、最初の段階で得られた二項関数関係式Δt1=f(N1,T1)、Δt1’=f(N2,T2)、Δt1”=f(N3,T3)、…Δt1n=f(Nn,Tn)に基づき、フィッティングして関数関係式Δt=f(N,T)を得て、この関数関係式に基づき、具体的には、クラスタリング後の同類障害物の数mが第一閾値未満、及び/又は平均誤差量が第二閾値より大きい場合、障害物数N1’と検出周期T1’が既知であるとすると、Δt=f(N,T)に基づき対応する時間遅延Δtを得て、ミリ波レーダーのデータのタイムスタンプを修正し、第二時刻t2のタイムスタンプを現在時刻t1に修正し、さらに該タイムスタンプt1に応じて最も近い統合ナビゲーションデータに対応する障害物の相対速度v_r(t1)を検索し、統合ナビゲーション装置により測定される自動車の絶対速度v_c(t1)と修正後の障害物の現在時刻t1での相対速度v_r(t1)とを加算し、障害物の現在時刻t1での絶対速度v_a(t1)=v_c(t1)+v_r(t1)を得る。
本発明の技術案によれば、修正後のミリ波レーダーにより測定される障害物の相対速度がより精確になり、GPSの精確なタイムスタンプ特徴を有する統合ナビゲーション装置により測定される自動車の絶対速度と前記障害物の相対速度とを加算して、特定の時刻に測定される障害物の絶対速度を得て、従来技術の時間遅延を解消し、それにより障害物の速度測定がより精確になる。
本発明の第二態様によれば、障害物の絶対速度の推定システム200を提供し、図4に示すように、該推定システム200は、自動車の現在時刻t1での絶対速度を測定し、且つ現在時刻t1と絶対速度に対応するデータテーブルを格納する統合ナビゲーション装置202と、自動車に対する障害物の第二時刻t2での相対速度を取得するミリ波レーダー204と、障害物の第二時刻t2での相対速度を現在時刻t1での相対速度に修正する修正装置206と、自動車の現在時刻t1での絶対速度と修正後の障害物の現在時刻t1での相対速度とを加算して、障害物の現在時刻t1での絶対速度を得る加算器208と、を備える。
本発明の第二態様の一実施例では、修正装置206は、障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物のそれぞれの現在時刻t1での複数の想定絶対速度を得て、複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近く且つ数量が最も多いものを同類障害物としてクラスタリングし、同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得て、第二時刻t2に測定される障害物の相対速度から平均誤差量を減算し、障害物の修正後の現在時刻t1での相対速度を得るために用いられる。
本発明の第二態様の一実施例では、加算器は、クラスタリング後の同類障害物の数が第一閾値より大きく、及び/又は平均誤差量が第二閾値未満である場合、自動車の現在時刻t1での絶対速度と障害物の修正後の現在時刻t1での相対速度とを加算して、障害物の現在時刻t1での絶対速度を得るために用いられる。
本発明の第二態様の一実施例では、修正装置は、
障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得て、
複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得て、
クラスタリング後の同類障害物の数が第一閾値未満で、及び/又は平均誤差量が第二閾値より大きい場合、ミリ波レーダーにより検出される各種の同類障害物の数及び2回の隣接する検出の間のミリ波レーダーの検出周期を記録し、それにより各種の同類障害物の障害物数、検出周期、及び第二時刻t2と現在時刻t1との時間差t2−t1の関数関係を得る。
本発明の第二態様の一実施例では、修正装置は、ミリ波レーダーにより検出される障害物の数と検出周期に基づき、ミリ波レーダーの第二時刻t2での時間データを現在時刻t1での時間データに修正し、修正後の前記障害物の現在時刻t1での相対速度を得て、
データテーブルにおいて統合ナビゲーション装置により、現在時刻t1に測定される自動車の絶対速度を検索し、加算器は、検索された自動車の絶対速度と修正後の障害物の現在時刻t1での相対速度とを加算して、障害物の現在時刻t1での絶対速度を得る。
本発明の第三態様の実施例によれば、コンピュータ装置を提供し、1つ又は複数のプロセッサと、1つ又は複数のプログラムを記憶する記憶装置と、を備え、1つ又は複数のプログラムが1つ又は複数のプロセッサにより実行されると、1つ又は複数のプロセッサが上記方法を実現する。
本発明の第4態様の実施例によれば、コンピュータプログラムを記憶しているコンピュータ可読記憶媒体を提供し、当該プログラムは、プロセッサにより実行される時、上記した方法を実現することを特徴とする。
例えば、図5には本開示の実施例を実施するための例示的なコンピュータ装置300の模式ブロック図を示している。また、理解すべきものは、コンピュータ装置300は、本開示に記述された障害物の検知方法100を実現するために用いられることである。図面に示すように、コンピュータ装置300は、中央処理ユニット(CPU)302を備え、当該CPU302は、読み出し専用メモリ(ROM)304に記憶されたコンピュータプログラム命令又は記憶手段316からランダムアクセスメモリ(RAM)306にロードされたコンピュータプログラム命令に応じて、様々な適切な動作及び処理を実行することができる。RAM306には、コンピュータ装置300の操作に必要な各種のプログラム及びデータが記憶されてもよい。CPU302、ROM304及びRAM306はバス308を介して互いに接続される。入力/出力(I/O)インタフェース310もバス308に接続されている。
コンピュータ装置300における複数の部材は、I/Oインタフェース310に接続され、その複数の部材は、例えばキーボードや、マウス等の入力手段312と、例えば各種タイプのディスプレイや、スピーカー等の出力手段314と、例えば磁気ディスクや、光ディスク等の記憶手段316と、例えばネットワークカードや、モデム、無線通信送受信機等の通信手段318と、を備える。コンピュータ装置300は、通信手段318により、インターネットのようなコンピュータネットワーク及び/又は各種の電気通信ネットワークを介して、他の装置と情報/データを交換することができる。
処理手段302は上述した各方法及びプロセス、例えば方法100を実行する。例えば、一部の実施例において、方法100は、コンピュータソフトウェアプログラムとして実現されることができ、プログラムが物理的に例えば記憶手段316のような機械可読媒体に含まれる。一部の実施例において、コンピュータプログラムの一部又は全部は、ROM304及び/又は通信手段318を介してコンピュータ装置300にロード及び/又はインストールされることができる。コンピュータプログラムがRAM306にロードされてCPU62により実行される時、上記した方法100の一つ又は複数の動作又はステップを実行することができる。好ましくは、他の実施例において、CPU302はいずれか他の適切な方式(例えば、ファームウェアを介して)により方法100を実行するように配置されることができる。
以上、本明細書で説明した機能は、一つ又は複数のハードウェア論理部材により少なくとも一部が実行される。例えば、限定的ではないが、使用可能な模範タイプのハードウェア論理部材として、フィールド・プログラマブル・ゲート・アレイ(FPGA)、専用集積回路(ASIC)、専用標準製品(ASSP)、システム・オン・チップのシステム(SOC)、ロード・プログラマブル・ロジック・デバイス(CPLD)等を含む。
本明細書の説明において、用語「一実施例」、「いくつかの実施例」、「例」、「具体例」、又は「いくつかの例」等の説明とは、該実施例又は例を参照すると説明した具体的な特徴、構造、材料又は特性が本発明の少なくとも1つの実施例又は例に含まれることを意味する。且つ、説明される具体的な特徴、構造、材料又は特性はいずれか1つ又は複数の実施例又は例で適切な方式で結合してもよい。また、矛盾しない限り、当業者は本明細書に説明される様々な実施例又は例、及び様々な実施例又は例の特徴を結合及び組み合わせすることができる。
また、用語の「第1」、「第2」は説明のためのものに過ぎず、相対重要性を指示又は示唆し、又は指示された技術的特徴の数を暗示すると理解すべきではない。従って、「第1」、「第2」で制限された特徴は少なくとも1つの該特徴を明示的又は暗示的に含んでもよい。本発明の説明において、特に明確且つ具体的に制限しない限り、「複数」の意味は2つ又は2つ以上である。
当業者であれば、フローチャートにおける、又はここでほかの方式で説明されるいかなる過程又は方法についての説明は、確定の論理機能又は過程を実現するための1つ又は複数のステップの実行可能命令のコードを含むモジュール、セグメント又は部分を示すと理解されてもよく、且つ本発明の好適な実施形態の範囲はほかの実現を含み、指示又は検討される順序通りでなくてもよく、関わる機能に基づいて、ほぼ同時に、又は逆順序で機能を実行してもよいと理解すべきである。
フローチャートに示す、又はここでほかの方式で説明される論理及び/又はステップは、例えば、論理機能を実現するための実行可能命令の順序付けリストであると見なされてもよく、具体的にいかなるコンピュータ可読媒体に実現されてもよく、命令実行システム、装置又はデバイス(例えばコンピュータに基づくシステム、プロセッサを含むシステム又は命令実行システム、装置又はデバイスから命令を受信し且つ命令を実行するシステム)の使用に備え、又はこれらの命令実行システム、装置又はデバイスと組み合わせて使用される。本明細書については、「コンピュータ可読媒体」はプログラムを包含、記憶、通信、伝播又は伝送することにより、命令実行システム、装置又はデバイス、又はこれらの命令実行システム、装置又はデバイスと組み合わせて使用されるいかなる装置であってもよい。コンピュータ可読媒体のさらなる具体例(非網羅的リスト)は、1つ又は複数の配線を有する電気接続部(電子装置)、ポータブルコンピュータケース(磁気装置)、ランダムアクセスメモリ(RAM)、読み出し専用メモリ(ROM)、電気的消去再書込み可能な読出し専用メモリ(EPROM又はフラッシュメモリー)、光ファイバー装置、及び携帯型読み出し専用メモリー(CDROM)を含む。また、コンピュータ可読媒体は更にその上に前記プログラムを印刷できる用紙又はほかの適切な媒体であってもよい理由は、例えば用紙又はほかの媒体を光学的に走査し、次に編集、解釈し、又は必要な時にほかの適切な方式で処理して、電子方式で前記プログラムを取得し、次にそれをコンピュータメモリに記憶することができるためである。
本発明の各部分はハードウェア、ソフトウェア、ファームウェア又はそれらの組み合わせで実現されてもよいと理解すべきである。上記実施形態において、複数のステップ又は方法は、メモリに記憶される、且つ適切な命令実行システムで実行するソフトウェア又はファームウェアで実現されてもよい。例えば、ハードウェアで実現する場合は、別の実施形態と同様に、データ信号に対して論理機能を実現する論理ゲート回路を有する離散論理回路、適切な組み合わせ論理ゲート回路を有する確定用途向け集積回路、プログラマブルゲートアレイ(PGA)、フィールドプログラマブルゲートアレイ(FPGA)等の本分野での公知技術のうちのいずれか1つ又はそれらの組み合わせで実現してもよい。
当業者であれば、上記実施例方法におけるステップの全部又は一部の実現がプログラムによって関連するハードウェアを命令して完了させてもよく、前記プログラムがコンピュータ可読記憶媒体に記憶されてもよく、実行時に、該プログラムは方法実施例のステップの1つ又はそれらの組み合わせを含むと理解される。
また、本発明の各実施例における各機能ユニットが1つの処理モジュールに統合されてもよく、各ユニットが独立して物理的に存在してもよく、2つ又は2つ以上のユニットが1つのモジュールに統合されてもよい。上記統合モジュールはハードウェアのタイプで実現されてもよいし、ソフトウェア機能モジュールのタイプで実現されてもよい。前記統合モジュールはソフトウェア機能モジュールのタイプで実現され、且つ独立した製品として販売又は使用される時、1つのコンピュータ可読記憶媒体に記憶されてもよい。前記記憶媒体は読み出し専用メモリ、磁気ディスク又は光ディスク等であってもよい。
以上の説明は、本発明の具体的な実施形態に過ぎず、本発明の保護範囲を制限するためのものではなく、当業者が本発明に開示される技術的範囲内に容易に想到し得る種々の変更又は置換は、いずれも本発明の保護範囲内に含まれるべきである。従って、本発明の保護範囲は特許請求の範囲に準じるべきである。

Claims (12)

  1. 障害物の絶対速度の推定方法であって、
    統合ナビゲーション装置を用いて、自動車の現在時刻t1での絶対速度を測定し、且つデータテーブルに格納するステップと、
    ミリ波レーダーを用いて、前記自動車に対する前記障害物の第二時刻t2での相対速度を取得するステップと、
    前記障害物の第二時刻t2での相対速度を前記障害物の現在時刻t1での相対速度に修正するステップと、
    前記自動車の現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るステップと、を含むことを特徴とする障害物の絶対速度の推定方法。
  2. 前記障害物の第二時刻t2での相対速度を前記障害物の現在時刻t1での相対速度に修正することは、
    障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得るステップと、
    複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近く且つ数量が最も多い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得るステップと、
    第二時刻t2に測定される前記障害物の相対速度から前記平均誤差量を減算し、修正後の前記障害物の現在時刻t1での相対速度を得るステップと、を含む請求項1に記載の方法。
  3. 前記自動車の前記現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得ることは、
    クラスタリング後の同類障害物の数が第一閾値より大きく、及び/又は前記平均誤差量が第二閾値未満である場合、前記自動車の現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るステップを含む請求項2に記載の方法。
  4. 前記自動車の前記現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得ることは、
    障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得るステップと、
    複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得るステップと、
    クラスタリング後の同類障害物の数が第一閾値未満で、及び/又は前記平均誤差量が第二閾値より大きい場合、前記ミリ波レーダーにより検出される各種の同類障害物の数及び前記ミリ波レーダーの隣接する検出の間の検出周期を記録ステップと、
    各種の同類障害物の障害物数、検出周期、及び第二時刻t2と現在時刻t1との時間差t2−t1の関数関係を得るステップとを含む請求項1に記載の方法。
  5. 前記ミリ波レーダーにより検出される障害物の数と検出周期に基づき、前記ミリ波レーダーの第二時刻t2での時間データを現在時刻t1での時間データに修正して、修正後の前記障害物の現在時刻t1での相対速度を得るステップと、
    前記データテーブルにおいて、前記自動車の現在時刻t1での絶対速度を検索し、検索された自動車の絶対速度と修正後の複数種の前記同類障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るステップとをさらに含む請求項4に記載の方法。
  6. 障害物の絶対速度の推定システムであって、
    自動車の現在時刻t1での絶対速度を測定し、且つ前記現在時刻t1と前記絶対速度に対応するデータテーブルを格納する統合ナビゲーション装置と、
    前記自動車に対する前記障害物の第二時刻t2での相対速度を取得するミリ波レーダーと、
    前記障害物の第二時刻t2での相対速度を前記障害物の現在時刻t1での相対速度に修正する修正装置と、
    前記自動車の現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得る加算器と、を備えることを特徴とする障害物の絶対速度の推定システム。
  7. 前記修正装置は、
    障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得て、
    複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近く且つ数量が最も多い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得て、
    第二時刻t2に測定される前記障害物の相対速度から前記平均誤差量を減算し、修正後の前記障害物の現在時刻t1での相対速度を得るために用いられる請求項6に記載の障害物の絶対速度の推定システム。
  8. 前記加算器は、クラスタリング後の同類障害物の数が第一閾値より大きく、及び/又は前記平均誤差量が第二閾値未満である場合、前記自動車の現在時刻t1での絶対速度と修正後の前記障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るために用いられる請求項7に記載の障害物の絶対速度の推定システム。
  9. 前記修正装置は、
    障害物が存在するシーンにおける複数種の障害物の第二時刻t2での相対速度と前記自動車の現在時刻t1での絶対速度とを加算して、複数種の障害物の現在時刻t1での複数の想定絶対速度を得、
    複数種の障害物の現在時刻t1での複数の想定絶対速度のうち数値が近い障害物を同類障害物としてクラスタリングし、前記同類障害物の複数の想定絶対速度を誤差量として平均値を求め、平均誤差量を得、
    クラスタリング後の同類障害物の数が第一閾値未満で、及び/又は前平均記誤差量が第二閾値より大きい場合、前記ミリ波レーダーにより検出される各種の同類障害物の数及び前記ミリ波レーダーの隣接する検出の間の検出周期を記録し、
    各種の同類障害物の障害物数、検出周期、及び第二時刻t2と現在時刻t1との時間差t2−t1の関数関係を得るために用いられる請求項6に記載の障害物の絶対速度の推定システム。
  10. 前記修正装置は、
    前記ミリ波レーダーにより検出される障害物の数と検出周期に基づき、前記ミリ波レーダーの第二時刻t2での時間データを現在時刻t1での時間データに修正して、修正後の前記障害物の現在時刻t1での相対速度を得、
    前記データテーブルにおいて、前記自動車の現在時刻t1での絶対速度を検索し、前記加算器は、検索された自動車の絶対速度と修正後の複数種の前記同類障害物の現在時刻t1での相対速度とを加算して、前記障害物の現在時刻t1での絶対速度を得るために用いられる請求項9に記載の障害物の絶対速度の推定システム。
  11. コンピュータ装置であって、
    1つ又は複数のプロセッサと、
    1つ又は複数のプログラムを記憶するメモリと、を備え、
    前記1つ又は複数のプログラムが前記1つ又は複数のプロセッサにより実行されると、前記1つ又は複数のプロセッサが請求項1乃至5のいずれか一項に記載の方法を実現することを特徴とするコンピュータ装置。
  12. コンピュータプログラムが記憶されるコンピュータ可読記憶媒体であって、該プログラムがプロセッサにより実行されると、請求項1乃至5のいずれか一項に記載の方法を実現することを特徴とするコンピュータ可読記憶媒体。
JP2019128860A 2018-09-07 2019-07-11 障害物の絶対速度の推定方法、システム、コンピュータ装置、記憶媒体、及びプログラム Active JP6786676B2 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201811045665.9A CN109143242B (zh) 2018-09-07 2018-09-07 障碍物绝对速度估计方法、系统、计算机设备和存储介质
CN201811045665.9 2018-09-07

Publications (2)

Publication Number Publication Date
JP2020042012A true JP2020042012A (ja) 2020-03-19
JP6786676B2 JP6786676B2 (ja) 2020-11-18

Family

ID=64823823

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019128860A Active JP6786676B2 (ja) 2018-09-07 2019-07-11 障害物の絶対速度の推定方法、システム、コンピュータ装置、記憶媒体、及びプログラム

Country Status (4)

Country Link
US (1) US11307302B2 (ja)
EP (1) EP3620816A1 (ja)
JP (1) JP6786676B2 (ja)
CN (1) CN109143242B (ja)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111724598B (zh) * 2020-06-29 2022-04-05 北京百度网讯科技有限公司 用于自动驾驶规划路径的方法、装置、设备以及存储介质
CN112560580B (zh) * 2020-11-20 2022-01-28 腾讯科技(深圳)有限公司 障碍物识别方法、装置、系统、存储介质和电子设备

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003043139A (ja) * 2001-08-02 2003-02-13 Hitachi Ltd ミリ波レーダ装置
JP2013015411A (ja) * 2011-07-04 2013-01-24 Honda Motor Co Ltd 絶対速度推定装置
WO2015037173A1 (ja) * 2013-09-12 2015-03-19 パナソニック株式会社 レーダ装置、車両及び移動体速度検出方法
JP2018115934A (ja) * 2017-01-17 2018-07-26 株式会社デンソーテン レーダ装置および車速補正方法

Family Cites Families (73)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10132681C1 (de) * 2001-07-05 2002-08-22 Bosch Gmbh Robert Verfahren zur Klassifizierung von einem Hindernis anhand von Precrashsensorsignalen
DE10251037A1 (de) * 2002-11-02 2004-05-19 Robert Bosch Gmbh Vorrichtung zur adaptiven Abstands- und Geschwindigkeitsregelung mit Rückbegrenzung
US7212330B2 (en) 2004-03-22 2007-05-01 Angstrom, Inc. Three-dimensional imaging system for pattern recognition
US20090232388A1 (en) 2008-03-12 2009-09-17 Harris Corporation Registration of 3d point cloud data by creation of filtered density images
US8611585B2 (en) 2008-04-24 2013-12-17 GM Global Technology Operations LLC Clear path detection using patch approach
US8605947B2 (en) 2008-04-24 2013-12-10 GM Global Technology Operations LLC Method for detecting a clear path of travel for a vehicle enhanced by object detection
US8126642B2 (en) 2008-10-24 2012-02-28 Gray & Company, Inc. Control and systems for autonomously driven vehicles
CN101441076B (zh) 2008-12-29 2010-06-02 东软集团股份有限公司 一种检测障碍物的方法和装置
JP5058243B2 (ja) * 2009-12-14 2012-10-24 アイシン・エィ・ダブリュ株式会社 車両案内装置、車両案内方法、及び車両案内プログラム
US8260539B2 (en) 2010-05-12 2012-09-04 GM Global Technology Operations LLC Object and vehicle detection and tracking using 3-D laser rangefinder
JP5395956B2 (ja) 2010-07-02 2014-01-22 株式会社ソニー・コンピュータエンタテインメント 情報処理システムおよび情報処理方法
US9562778B2 (en) * 2011-06-03 2017-02-07 Robert Bosch Gmbh Combined radar and GPS localization system
CN103258338A (zh) 2012-02-16 2013-08-21 克利特股份有限公司 利用真实数据来驱动仿真的虚拟环境的方法和系统
CN102663196B (zh) 2012-04-17 2014-04-16 中南大学 一种基于虚拟现实的汽车起重机吊装仿真方法
US9255989B2 (en) 2012-07-24 2016-02-09 Toyota Motor Engineering & Manufacturing North America, Inc. Tracking on-road vehicles with sensors of different modalities
US9082014B2 (en) 2013-03-14 2015-07-14 The Nielsen Company (Us), Llc Methods and apparatus to estimate demography based on aerial images
CN104376297B (zh) 2013-08-12 2017-06-23 株式会社理光 道路上的线型指示标志的检测方法和装置
JP5812061B2 (ja) * 2013-08-22 2015-11-11 株式会社デンソー 物標検出装置およびプログラム
JP5919243B2 (ja) 2013-10-18 2016-05-18 本田技研工業株式会社 運転訓練装置及び運転訓練方法
CN103914830B (zh) 2014-02-22 2017-02-01 小米科技有限责任公司 直线检测方法和装置
CN104899855A (zh) 2014-03-06 2015-09-09 株式会社日立制作所 三维障碍物检测方法和装置
CN104933856B (zh) 2014-03-17 2017-08-25 径卫视觉科技(上海)有限公司 道路路况实时评估系统及方法
CN104020674B (zh) 2014-04-21 2017-01-25 华南农业大学 车辆Bug避障算法的Matlab仿真可视化平台
JP6354282B2 (ja) * 2014-04-21 2018-07-11 トヨタ自動車株式会社 運転支援装置
CN104183014B (zh) 2014-08-13 2017-01-18 浙江大学 一种面向城市增强现实的高融合度信息标注方法
KR101687073B1 (ko) 2014-10-22 2016-12-15 주식회사 만도 터널 높이 추정 장치 및 터널 높이 추정 방법
CN104331910B (zh) 2014-11-24 2017-06-16 沈阳建筑大学 一种基于机器视觉的轨道障碍物检测系统
CN104457569B (zh) 2014-11-27 2017-06-16 大连理工大学 一种大型复合板材几何参数视觉测量方法
JP6112123B2 (ja) 2015-01-19 2017-04-12 トヨタ自動車株式会社 自動運転装置
CN104950883A (zh) 2015-05-14 2015-09-30 西安电子科技大学 一种基于距离网格地图的移动机器人路径规划方法
TWI630132B (zh) 2015-06-04 2018-07-21 國立虎尾科技大學 3D animation car accident scene reconstruction method
CN104933708A (zh) 2015-06-07 2015-09-23 浙江大学 一种基于多谱三维特征融合的植被环境中障碍物检测方法
CN104931977B (zh) 2015-06-11 2017-08-25 同济大学 一种用于智能车辆的障碍物识别方法
US20170092000A1 (en) 2015-09-25 2017-03-30 Moshe Schwimmer Method and system for positioning a virtual object in a virtual simulation environment
JP6464075B2 (ja) 2015-11-11 2019-02-06 日本電信電話株式会社 What−ifシミュレーション装置、方法、及びプログラム
JP6852085B2 (ja) 2015-11-30 2021-03-31 ルミナー テクノロジーズ インコーポレイテッド 分布型レーザー及び複数のセンサー・ヘッドを備える光検出及び測距システム、並びに、光検出及び測距システムのパルス・レーザー
WO2017130639A1 (ja) * 2016-01-28 2017-08-03 株式会社リコー 画像処理装置、撮像装置、移動体機器制御システム、画像処理方法、及びプログラム
CN105761308B (zh) 2016-02-29 2018-09-07 武汉大学 一种地面LiDAR和影像数据融合的遮挡区域建筑物立面重建方法
EP4091894A1 (en) 2016-03-03 2022-11-23 Volvo Truck Corporation A vehicle with autonomous driving capability
US10690495B2 (en) 2016-03-14 2020-06-23 Canon Kabushiki Kaisha Ranging apparatus and moving object capable of high-accuracy ranging
CN107305383A (zh) 2016-04-22 2017-10-31 上海慧流云计算科技有限公司 一种自动避障的方法及使用该方法的机器人
CN105844600B (zh) 2016-04-27 2018-03-16 北京航空航天大学 一种空间目标三维点云光顺去噪方法
CN105957145A (zh) 2016-04-29 2016-09-21 百度在线网络技术(北京)有限公司 道路障碍物识别方法和装置
US9760806B1 (en) 2016-05-11 2017-09-12 TCL Research America Inc. Method and system for vision-centric deep-learning-based road situation analysis
CN106204457A (zh) 2016-07-19 2016-12-07 科盾科技股份有限公司 一种用于抓捕目标的方法和抓捕器
CN107818293A (zh) 2016-09-14 2018-03-20 北京百度网讯科技有限公司 用于处理点云数据的方法和装置
WO2018053833A1 (zh) 2016-09-26 2018-03-29 深圳市锐明技术股份有限公司 一种成对车道线的快速检测方法和装置
JP6548691B2 (ja) 2016-10-06 2019-07-24 株式会社アドバンスド・データ・コントロールズ 画像生成システム、プログラム及び方法並びにシミュレーションシステム、プログラム及び方法
CN107976688A (zh) * 2016-10-25 2018-05-01 菜鸟智能物流控股有限公司 一种障碍物的检测方法及相关装置
RO132599A2 (ro) 2016-11-23 2018-05-30 Centrul It Pentru Ştiinţă Şi Tehnologie S.R.L. Echipament modular pentru inspecţia drumurilor rutiere, incluzând carosabilul şi zona adiacentă, destinat pentru a fi montat pe vehicule nespecializate
CN106681318A (zh) 2016-12-09 2017-05-17 重庆长安汽车股份有限公司 自动驾驶中车道线检测短暂丢失的车辆安全控制系统及方法
CN106599832A (zh) 2016-12-09 2017-04-26 重庆邮电大学 一种基于卷积神经网络的多类障碍物检测与识别方法
CN106585622A (zh) 2016-12-20 2017-04-26 奇瑞汽车股份有限公司 一种道路施工情况下自动驾驶方法和智能车
JP6804991B2 (ja) 2017-01-05 2020-12-23 株式会社東芝 情報処理装置、情報処理方法、および情報処理プログラム
CN106845412B (zh) 2017-01-20 2020-07-10 百度在线网络技术(北京)有限公司 障碍物识别方法及装置、计算机设备及可读介质
JP7157054B2 (ja) 2017-01-26 2022-10-19 モービルアイ ビジョン テクノロジーズ リミテッド 整合画像及びlidar情報に基づいた車両ナビゲーション
CN106919908B (zh) 2017-02-10 2020-07-28 百度在线网络技术(北京)有限公司 障碍物识别方法及装置、计算机设备及可读介质
CN108492356A (zh) 2017-02-13 2018-09-04 苏州宝时得电动工具有限公司 增强现实系统及其控制方法
CN106997049B (zh) 2017-03-14 2020-07-03 奇瑞汽车股份有限公司 一种基于激光点云数据的检测障碍物的方法和装置
CN107103627B (zh) 2017-04-27 2020-12-11 深圳市天双科技有限公司 一种基于车道线的汽车全景摄像头外部参数标定方法
CN107672589B (zh) * 2017-09-26 2019-05-28 畅加风行(苏州)智能科技有限公司 一种基于雷达探测数据的车辆轨迹实时预测方法和装置
CN107657237B (zh) 2017-09-28 2020-03-31 东南大学 基于深度学习的汽车碰撞检测方法及系统
CN107659774B (zh) 2017-09-30 2020-10-13 北京拙河科技有限公司 一种基于多尺度相机阵列的视频成像系统及视频处理方法
CN107678306B (zh) 2017-10-09 2021-04-16 驭势(上海)汽车科技有限公司 动态场景信息录制和仿真回放方法、装置、设备及介质
CN207407892U (zh) * 2017-11-03 2018-05-25 河南思维轨道交通技术研究院有限公司 导航数据同步处理系统以及导航系统
CN107832806A (zh) 2017-12-06 2018-03-23 四川知创空间孵化器管理有限公司 一种车牌类型判别方法和系统
EP3591490B1 (en) 2017-12-15 2021-12-01 Autel Robotics Co., Ltd. Obstacle avoidance method and device, and unmanned aerial vehicle
CN108156419A (zh) 2017-12-22 2018-06-12 湖南源信光电科技股份有限公司 基于多特征联合与Camshift算法的多焦距镜头联动成像摄像机系统
CN108010360A (zh) 2017-12-27 2018-05-08 中电海康集团有限公司 一种基于车路协同的自动驾驶环境感知系统
CN107993512A (zh) 2018-01-03 2018-05-04 深圳市欣横纵技术股份有限公司 一种核安保Table Top Tool系统及使用方法
CN108256506B (zh) 2018-02-14 2020-11-24 北京市商汤科技开发有限公司 一种视频中物体检测方法及装置、计算机存储介质
CN108646735A (zh) 2018-05-02 2018-10-12 新石器龙码(北京)科技有限公司 一种无人车的控制方法和装置
CN109101022A (zh) 2018-08-09 2018-12-28 北京智行者科技有限公司 一种作业路径更新方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2003043139A (ja) * 2001-08-02 2003-02-13 Hitachi Ltd ミリ波レーダ装置
JP2013015411A (ja) * 2011-07-04 2013-01-24 Honda Motor Co Ltd 絶対速度推定装置
WO2015037173A1 (ja) * 2013-09-12 2015-03-19 パナソニック株式会社 レーダ装置、車両及び移動体速度検出方法
JP2018115934A (ja) * 2017-01-17 2018-07-26 株式会社デンソーテン レーダ装置および車速補正方法

Also Published As

Publication number Publication date
CN109143242A (zh) 2019-01-04
US11307302B2 (en) 2022-04-19
CN109143242B (zh) 2020-04-14
EP3620816A1 (en) 2020-03-11
JP6786676B2 (ja) 2020-11-18
US20200081112A1 (en) 2020-03-12

Similar Documents

Publication Publication Date Title
US11054518B2 (en) Method and apparatus for determining obstacle speed
CN109782258B (zh) 车辆激光雷达的位置检测方法、装置及存储介质
JP2017111813A (ja) 不確実性ベースの交通渋滞指標を生成するための方法、コンピュータ可読ストレージ媒体、およびシステム
JP6570791B2 (ja) 処理装置
JP2020042012A (ja) 障害物の絶対速度の推定方法、システム、コンピュータ装置及び記憶媒体
CN110136469B (zh) 公交车的行驶数据的补偿方法及装置
JP6311211B2 (ja) 障害物検出装置
US20130116819A1 (en) Estimating apparatus, estimating method, and computer product
CN110471075A (zh) 雷达测距方法、装置及终端设备
CN113176562B (zh) 多目标跟踪方法、装置、电子设备及可读存储介质
KR102473272B1 (ko) 목표 추적 방법 및 장치
CN116528279A (zh) 一种路侧测试时延的方法、装置、存储介质及电子设备
CN115792867A (zh) 激光雷达仿真方法和装置
CN113325415B (zh) 车辆雷达数据和相机数据的融合方法及系统
CN112560974B (zh) 一种信息融合、车辆信息获取方法及装置
CN111025300B (zh) 一种车位长度的测量方法及装置
US11119187B2 (en) Resolution of doppler ambiguity in a radar system through tracking
CN116359865B (zh) 毫米波雷达水平安装角估计方法
FR3088280A1 (fr) Construction par segmentation de voies virtuelles sur une chaussee
CN116955329A (zh) 一种车道连通的检查方法、装置及电子设备
US11835678B2 (en) Weather data with connected vehicles
US20230112318A1 (en) Ad or adas aided maneuvering of a vehicle
KR20230001783A (ko) 송출 신호 관리 방법, 송출 신호 관리 장치 및 상기 방법을 실행시키기 위하여 기록매체에 저장된 컴퓨터 프로그램
CN114735012A (zh) 基于盲区监测雷达的车辆速度获取系统、方法及介质
WO2020031711A1 (ja) 車両制御装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190711

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200625

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200923

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: 20201002

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20201028

R150 Certificate of patent or registration of utility model

Ref document number: 6786676

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313113

R350 Written notification of registration of transfer

Free format text: JAPANESE INTERMEDIATE CODE: R350

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250