JP2003141692A - 車両の障害物検出装置 - Google Patents

車両の障害物検出装置

Info

Publication number
JP2003141692A
JP2003141692A JP2001334753A JP2001334753A JP2003141692A JP 2003141692 A JP2003141692 A JP 2003141692A JP 2001334753 A JP2001334753 A JP 2001334753A JP 2001334753 A JP2001334753 A JP 2001334753A JP 2003141692 A JP2003141692 A JP 2003141692A
Authority
JP
Japan
Prior art keywords
radar
vehicle
obstacle
detected
turning
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
JP2001334753A
Other languages
English (en)
Other versions
JP3865121B2 (ja
Inventor
Masanori Tooshima
雅徳 遠嶋
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.)
Komatsu Ltd
Original Assignee
Komatsu 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 Komatsu Ltd filed Critical Komatsu Ltd
Priority to JP2001334753A priority Critical patent/JP3865121B2/ja
Priority to US10/277,188 priority patent/US6809680B2/en
Publication of JP2003141692A publication Critical patent/JP2003141692A/ja
Application granted granted Critical
Publication of JP3865121B2 publication Critical patent/JP3865121B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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/00—Systems 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/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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/00—Systems 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/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/06—Systems determining position data of a target
    • G01S13/42—Simultaneous measurement of distance and other co-ordinates
    • G01S13/426—Scanning radar, e.g. 3D radar
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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/00—Systems 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/87—Combinations of radar systems, e.g. primary radar and secondary radar
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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/00—Systems 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/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/932—Radar 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
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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/00—Systems 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/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9321—Velocity regulation, e.g. cruise control
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO 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/00—Systems 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/88—Radar or analogous systems specially adapted for specific applications
    • G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
    • G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2013/9327—Sensor installation details
    • G01S2013/93271—Sensor installation details in the front of the vehicles

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)
  • Radar Systems Or Details Thereof (AREA)
  • Traffic Control Systems (AREA)

Abstract

(57)【要約】 【課題】車両の障害物を検出するに際して、死角がな
く、また検出周期を短くでき、しかも障害物の誤検出を
少なくできるようにする。 【解決手段】走行路５０を車両１が走行するときに、旋
回レーダ２４を車両１の進行方向に応じた方向に旋回さ
せて、旋回レーダ２４の検出範囲３Ｂの全部あるいは一
部を固定レーダ２１〜２３の検出範囲３Ａ外にすること
ができる。このため旋回レーダ２４で、固定レーダ２１
〜２３の検出範囲外の範囲の障害物６０を検出すること
ができる。

Description

【発明の詳細な説明】
【０００１】
【発明の属する技術分野】本発明は、無人車両などの車
両の障害物を検出する装置に関するものである。
【０００２】
【従来の技術】採石現場、鉱山などの広域現場で稼動す
る無人ダンプトラックなどの無人車両は、車両前方の障
害物を自動的に検出して、その検出結果に基づいて自動
走行制御される。この場合、無人ダンプトラックなどの
無人車両は一般的に車幅が広く走行路も幅広いことか
ら、無人車両に搭載される障害物検出装置には、広い検
出エリアで障害物を捕らえることができる機能が要求さ
れる。
【０００３】障害物検出装置としては、従来より光レー
ザ、ミリ波レーダ、視覚センサなどの各種類のレーダが
知られている。
【０００４】レーダは精度が高いという利点があり無人
車両搭載用に好適である。そこでレーダを無人車両に搭
載するにあたって、下記１）、２）、３）に示すように
広い検出エリアをカバーするための様々な方式がある。
【０００５】１）固定スキャンレーダ方式 これは図１１（ａ）に示すように、無人車両１にレーダ
２を搭載して、レーダビーム３を±１０゜程度の範囲で
左右に高速スキャンさせて、走行路５０上の障害物６０
を検出するというものである。
【０００６】２）回転レーダ方式 これは図１１（ｂ）に示すように、無人車両１にレーダ
２を搭載してレーダビーム３を無人車両１を中心に３６
０゜回転させて、走行路５０上の障害物６０を検出する
というものである。
【０００７】３）旋回スキャンレーダ方式 これは図１１（ｃ）に示すように、無人車両１にレーダ
２を旋回台を介して搭載して、レーダビーム３を±１０
゜程度の範囲で左右に高速スキャンさせるとともに、旋
回台を低速で旋回させることによりレーダビーム３を旋
回させて、走行路５０上の障害物６０を検出するという
ものである。
【０００８】障害物６０の絶対位置は、レーダビーム３
の方位角（スキャン角）と、レーダ２から障害物６０ま
での距離を計測し、これら計測値と無人車両１の位置、
方位角とに基づいて、計測することができる。さらに上
記３）の旋回スキャンレーダ方式の場合には、旋回台の
旋回角を計測して障害物６０の絶対位置を計測する必要
がある。
【０００９】また上記１）と３）を組み合わせた技術も
知られている。たとえば特開平４−１６３２５０号公報
には、一般自動車のバックセンサに関し、１）の固定レ
ーダ方式と３）の旋回レーダ方式とを組み合わせ、固定
レーダで捕らえた障害物の方向に旋回レーダを旋回させ
て更に障害物を旋回レーダで捕らえるという発明が記載
されている。
【００１０】またＵＳＰ５６１２８８３号には、旋回ス
キャンレーダ方式で、スキャンする範囲を変化させると
いう発明が記載されている。
【００１１】またこの文献には、レーダビームで検出さ
れた各物体の絶対位置を逐次計測して同一の障害物であ
るか否かを判定するという発明が記載されている。
【００１２】
【発明が解決しようとする課題】図１１（ａ）の固定ス
キャンレーダ方式を採用した場合には、レーダビーム３
の方位角の計測精度はよく、曲がりの小さい走行路上の
障害物６０を検出できるものの、レーダビーム３のスキ
ャニングエリアが狭いため交差点や急カーブなどに死角
が存在し障害物６０を見逃すおそれがあるまた図１１
（ｂ）の回転レーダ方式を採用した場合には、レーダビ
ーム３は３６０゜回転するため死角はないものの、検出
周期が遅いため、前方の障害物６０だけを検出するには
無駄が多く、また障害物６０を捕らえるのに相当な時間
を要する。とりわけ無人車両１が高速（５０ｋｍ/ｈ）
で走行している場合には、前方の障害物６０を検出する
までに相当の距離を走行してしまうことがあり、障害物
６０に干渉するおそれがある。
【００１３】図１１（ｃ）の旋回スキャンレーダ方式を
採用した場合には、死角がなく検出周期も短いため、固
定スキャンレーダ方式、回転レーダ方式のもつ欠点をカ
バーしている。
【００１４】しかし障害物６０の絶対位置を計測するた
めには、レーダビーム３の方位角（スキャン角）、無人
車両１の方位角のみならず旋回台の旋回角を計測しなけ
ればならず、これら角度の計測誤差が累積されて障害物
位置の計測誤差が大きくなる。このように角度精度がよ
くないため走行路５０外の障害物６０を走行路５０内の
ものと誤検出しやすい。
【００１５】本発明はこうした実状に鑑みてなされたも
のであり、車両の障害物を検出するに際して、死角がな
く、また検出周期を短くでき、しかも障害物の誤検出を
少なくできるようにすることを、解決課題とするもので
ある。
【００１６】さて前述したように上記ＵＳＰ５６１２８
８３号では、同一障害物であることを判定するために、
各物体の絶対位置を逐次計測している。
【００１７】しかし物体の絶対位置を逐次計測すること
にすると、演算処理が煩雑となる。そこで本発明は、煩
雑な演算処理を行うことなく同一障害物であると判定で
きるようにすることを、解決課題とするものである。
【００１８】
【課題を解決するための手段および作用効果】第１発明
は、車両の障害物を、レーダを用いて検出する障害物検
出装置において、前記車両に固定された固定レーダと、
前記車両に対して相対的に旋回自在の旋回レーダとを備
え、車両の進行方向に応じた方向にレーダビームが出射
されるように、前記旋回レーダを車両の進行方向に応じ
た方向に旋回させることを特徴とする。
【００１９】第１発明によれば、図６に示すように、走
行路５０を車両１が走行するときに、旋回レーダ２４を
車両１の進行方向に応じた方向に旋回させて、旋回レー
ダ２４の検出範囲３Ｂの全部あるいは一部を固定レーダ
２１〜２３の検出範囲３Ａ外にすることができる。この
ため旋回レーダ２４で、固定レーダ２１〜２３の検出範
囲外の範囲の障害物６０を検出することができる。
【００２０】このため車両１の障害物６０を検出するに
際して、死角をなくすことができる。つまり固定レーダ
２１〜２３と、旋回レーダ２４を備えているので、図６
に示すような直線路あるいは大きい曲率の走行路５０
と、図７に示すような交差点や急カーブなどの小さい曲
率の走行路５０の両方について、障害物検出範囲をカバ
ーすることができる。また固定レーダ２１〜２３と旋回
レーダ２４を併用しているので検出周期を短くすること
ができる。また旋回レーダ２４を固定レーダ２１〜２３
と併用しているので、障害物であるとの誤検出を少なく
することができる。
【００２１】第２発明は、車両の障害物を、レーダを用
いて検出する障害物検出装置において、前記車両に固定
された固定レーダと、前記車両に対して相対的に旋回自
在の旋回レーダとを備え、前記固定レーダと前記旋回レ
ーダの両方からレーダビームを同時に出射させることに
より、同一障害物を両レーダで検出することを特徴とす
る。
【００２２】第２発明によれば、図７に示すように、車
両１が走行路５０を走行するときに、固定レーダ２１〜
２３と旋回レーダ２４の両方が障害物６０を同時に冗長
的に検出することができるので、障害物６０の検出を信
頼性高く行うことができる。
【００２３】第３発明は、車両の障害物を、レーダを用
いて検出する障害物検出装置において、前記車両に固定
された固定レーダと、前記車両に対して相対的に旋回自
在の旋回レーダとを備え、前記固定レーダから出射され
るレーダビームの検出範囲外の範囲に、レーダビームが
出射されるように、前記旋回レーダを旋回させることを
特徴とする。
【００２４】第３発明によれば、図６に示すように、小
さい曲率の走行路５０を車両１が走行するときには、旋
回レーダ２４を旋回させて、旋回レーダ２４の検出範囲
３Ｂの全部あるいは一部を固定レーダ２１〜２３の検出
範囲３Ａ外にすることができ、旋回レーダ２４で、固定
レーダ２１〜２３の検出範囲外の範囲の障害物６０を検
出することができる。
【００２５】第４発明は、第１発明または第２発明また
は第３発明において、前記固定レーダで物体を検出した
場合と、前記旋回レーダで物体を検出した場合とで異な
る重みを付与し、これら重みの合計値に基づいて、検出
物体が障害物であると判定することを特徴とする。
【００２６】固定レーダ２１〜２３は旋回しないため角
度精度誤差が小さく障害物６０の位置計測精度がよく、
障害物６０が走行路５０外であると誤検出することは少
なく、信頼性が高い。
【００２７】これに対して旋回レーダ２４は旋回するた
め角度精度誤差が大きく障害物６０の位置計測精度が悪
く、障害物６０が走行路５０外であると誤検出すること
が多く、信頼性が低い。
【００２８】このように「レーダの方式」毎に、信頼性
が異なるため、方式毎に重み（得点）を異ならせてい
る。すなわち図８に示すように固定レーダ２１〜２３は
旋回レーダ２４よりも信頼性が高いので、旋回レーダ２
４で障害物を検出したときの重み（得点）よりも大きい
重み（得点）が与えられる。
【００２９】こうして固定レーダ２１〜２３で物体を検
出した場合と、旋回レーダ２４で物体を検出した場合と
で異なる重み（得点）を付与し、これら重み（得点）の
合計値に基づいて、検出物体が「障害物」であるとの判
定をする。
【００３０】第５発明は、車両の障害物を、レーダを用
いて検出する障害物検出装置において、前記車両に固定
された固定レーダと、前記車両に対して相対的に旋回自
在の旋回レーダとを備え、前記固定レーダで物体を検出
した場合と、前記旋回レーダで物体を検出した場合とで
異なる重みを付与し、これら重みの合計値に基づいて、
検出物体が障害物であると判定することを特徴とする。
【００３１】第５発明は、第４発明を独立した請求項と
する発明である。
【００３２】第６発明は、車両の障害物を、レーダを用
いて検出する障害物検出装置において、方式、種類のう
ち少なくともいずれか一方が異なる複数のレーダを、車
両に搭載し、レーダの方式、種類ごとに異なる重みを付
与し、各レーダで物体を検出した場合に、重みの合計値
に基づいて、検出物体が障害物であると判定することを
特徴とする。
【００３３】図１１に示す各レーダ方式の３つ若しくは
いずれか２つを組み合わせる場合に対して上記第５発明
を適用することができる。たとえば図１１（ａ）の固定
レーダ方式と図１１（ｂ）の回転レーダ方式を組み合わ
せ、固定レーダで物体を検出した場合と、回転レーダで
物体を検出した場合とで異なる重み（得点）を付与し、
これら重み（得点）の合計値に基づいて、検出物体が
「障害物」であるとの判定をする。
【００３４】またレーダの種類（レーダが光レーダであ
るかミリ波レーダであるか視覚センサであるか）に応じ
て、重み（得点）を異ならせることもできる。
【００３５】第７発明は、車両の複数の障害物を、レー
ダを用いて検出する障害物検出装置において、前記レー
ダで物体を検出した場合に、以後、車両から当該検出物
体までの予測距離を、逐次演算する予測距離演算手段
と、前記レーダで物体を検出する毎に、車両から当該検
出物体までの距離を計測する距離計測手段と、前記レー
ダで物体を検出する毎に、前記距離計測手段で計測され
る距離と、前記予測距離演算手段で演算される予測距離
とを比較し、検出物体が過去に検出された物体と同一で
あるか否かを判断し、検出物体が同一であると判断した
場合には、対応する検出物体の得点を順次加算する得点
加算手段と、前記得点加算手段で加算された得点が所定
のしきい値以上になった場合に、対応する検出物体が障
害物であると判定する障害物判定手段とを具えたことを
特徴とする。
【００３６】図９（ｂ）に示すようにレーダ２１〜２４
で障害物候補６１（６２、６３）を検出する毎に、前述
したように車両１から障害物候補６１（６２、６３）ま
での距離Ｒが計測される。
【００３７】一方、車両１の内部では、図９（ａ）に示
すように、レーダ２１〜２４で新たな障害物候補６１
（６２、６３）を検出すると、以後、車両１から当該障
害物候補６１（６２、６３）までの予測距離Ｒexpが、
所定時間Δｔ経過する毎に逐次演算される。
【００３８】そしてレーダ２１〜２４で障害物候補６１
（６２、６３）を検出する毎に、計測距離Ｒと、予測距
離Ｒexpとを比較して、検出された障害物候補が過去に
検出された障害物候補と同一であるか否かが判断され
る。
【００３９】この結果、同一障害物候補であると判断し
た場合には、当該障害物候補のリストの得点に一定得点
を順次を加算していく。
【００４０】そしてリストの得点が所定のしきい値（１
００点）以上になった場合に、そのリストの障害物候補
は「障害物」であると判定される。
【００４１】第７発明では上記ＵＳＰ５６１２８８３号
のように、同一障害物であることを判定するために、各
物体の絶対位置を逐次計測する必要はなく、距離を計
測、予測すればよい。このため物体の絶対位置を逐次計
測する場合と比較して、演算処理が簡易なものとなり、
煩雑な演算処理を行うことなく同一障害物であるとの判
定を行うことができる。
【００４２】
【発明の実施の形態】以下図面を参照して本発明に係る
車両の障害物検出装置の実施の形態について説明する。
【００４３】なお本実施形態で車両として無人ダンプト
ラックなどの無人車両（以下、車両という）を想定して
いる。しかし以下に述べる実施形態は無人車両のみなら
ず有人の車両に対しても適用することができる。また本
実施形態ではレーダとしてレーダビームをスキャンする
スキャンレーダを想定している。しかし以下に述べる実
施形態はスキャンレーダに限定されることなくスキャン
を行わないレーダに対しても適用することができる。
【００４４】図２は実施形態の車両１に搭載される各レ
ーダの配置例を示している。
【００４５】同図２は車両１を前方からみた図であり、
３台の固定レーダ２１、２２、２３と、１台の旋回レー
ダ２４が車両１に搭載されている。なお本実施形態では
レーダの種類としてはミリ波レーダを想定している。し
かしレーダの種類としてはミリ波レーダ以外の光レー
ザ、視覚センサなどを使用してもよい。この場合レーダ
２１〜２４の全てが同じ種類のレーダであってもよくま
た異なる種類のレーダを混在させてもよい。
【００４６】固定レーダ２１、２２、２３は、図１１
（ａ）の固定スキャンレーダ２に相当する。また旋回レ
ーダ２４は、図１１（ｃ）の旋回スキャンレーダ２に相
当する。
【００４７】固定レーダ２１、２２、２３は、車両１に
固定されている。
【００４８】車両１には旋回台４０が旋回自在に設けら
れている。旋回台４０上には旋回レーダ２４が設けられ
ている。このため旋回台４０が旋回することによって、
旋回レーダ２４は車両１に対して相対的に旋回する。図
３（ａ）、（ｂ）はそれぞれ固定レーダ、旋回レーダの
検出範囲を示している。
【００４９】同図３（ａ）に示すように、固定レーダ２
１、２２、２３からはレーダビーム３ａ、３ｂ、３ｃが
それぞれ出射され、所定の範囲をそれぞれスキャンす
る。各固定レーダ２１、２２、２３のスキャニングエリ
アを合計したスキャニングエリアを３Ａとする。このた
め車両１が走行路５０に沿って進行するに伴い、固定レ
ーダ２１、２２、２３では車両１の前方のスキャニング
エリア３Ａの範囲内の障害物６０が検出される。
【００５０】また図３（ｂ）に示すように、旋回レーダ
２４からはレーダビーム３ｄが出射され、所定の範囲を
それぞれスキャンする。スキャニングエリアを３Ｂとす
る。旋回台４０が旋回すると矢印に示すようにスキャニ
ングエリア３Ｂが旋回する。このため車両１が走行路５
０に沿って進行するに伴い、旋回レーダ２４では、旋回
方向のスキャニングエリア３Ｂの範囲内の障害物６０が
検出される。
【００５１】図１は車両１に搭載される位置計測コント
ローラ５、コース管理コントローラ６、安全コントロー
ラ１０を示している。
【００５２】安全コントローラ１０は、上記レーダ２
１、２２、２３、２４の出力に基づいて、車両１の障害
物６０を判定し、障害物６０であると判定した場合に
は、障害物６０に干渉しないように車速を制御する。
【００５３】安全コントローラ１０は、検出エリア計算
部１１、内外判定部１２、得点演算部１３、同一障害物
探索部１４、障害物判定部１５、データテーブル１６、
障害物候補記憶部１７とからなる。
【００５４】まず安全コントローラ１０内の検出エリア
計算部１１、上記内外判定部１２で行われる処理につい
て説明する。
【００５５】図４は車両１搭載のレーダ２１〜２４で検
出された物体６０が車両１の「障害物」であると判定す
る処理を示している。なお本明細書において「障害物」
とは車両１が干渉する可能性のある物体を意味し、具体
的には車両１の前方の走行路５０内に存在する物体をい
うものとする。
【００５６】同図４（ａ）に示すように、無人車両１は
目標コース７に沿って、いわゆる推測航法によって誘導
走行制御される。すなわち目標コース７上の各点Ｐ1、
Ｐ2、Ｐ3、Ｐ4、Ｐ5…の位置（ｘtraj[]、ｙtraj[]）、
方位角φtraj[]が教示され、コースデータとして記憶さ
れる。そこで車両１の逐次の位置（Ｘ、Ｙ）、逐次の方
位角φを計測し、この計測した逐次の位置、方位角
（Ｘ、Ｙ、φ）が、コースデータ（ｘtraj[]、ｙtra
j[]、方位角φtraj[]）に一致するように、車両１の操
舵角、走行速度等が制御される。車両１の逐次の位置、
方位角（Ｘ、Ｙ、φ）は図１に示す位置計測コントロー
ラ５で計測され、この計測結果に基づいて、車両１は走
行する。
【００５７】また位置計測コントローラ５では車両１の
逐次の位置、方位角（Ｘ、Ｙ、φ）に基づき逐次の車速
Ｖが演算される。
【００５８】つぎに図４（ｂ）に示すように、目標コー
ス７の位置データ（ｘtraj[]、ｙtraj[]）に基づいて車
両１の進行方向前方に、障害物検出エリア８が設定され
る。この障害物検出エリア８はコース５０の幅に対応し
ている。この障害物検出エリア８は、その境界線上の各
点Ｑの位置（ｘbound[]、ｙbound[]）で定義される。安
全コントローラ１０内の検出エリア計算部１１は、コー
ス管理コントローラ６からコースデータ（ｘtraj[]、ｙ
traj[]）を入力し、このコースデータに基づき障害物検
出エリア８の境界線上の各点Ｑの位置（ｘbound[]、ｙb
ound[]）を計算する。障害物検出エリア８の境界線位置
Ｑ（ｘbound[]、ｙbound[]）は絶対座標系上の位置つま
り絶対位置として与えられる。
【００５９】つぎに図４（ｃ）に示すように、固定レー
ダ２１〜２３、旋回レーダ２４を作動させて、レーダビ
ームを出射させ、スキャニングエリア３Ａ、３Ｂ内の物
体を検出する。
【００６０】この結果図４（ｄ）に示すように、各レー
ダ２１〜２４からは、車両１（レーダ２１〜２４）と物
体６０との距離Ｒ、物体６０（レーダビーム）の方位角
θ、物体６０でレーダビームが反射した際の反射強度Ｐ
が出力され、内外判定部１２に入力される。
【００６１】内外判定部１２には、位置計測コントロー
ラ５から車両１の位置・方位角データ（Ｘ、Ｙ、φ）、
検出エリア計算部１１から障害物検出エリア８の境界線
位置位置データＱ（ｘbound[]、ｙbound[]）が入力され
る。
【００６２】そこで、下記（１）に示すように、ｆ1を
所定の関数として、物体６０までの距離Ｒ、物体６０の
方位角θ、車両１の位置Ｘ、Ｙ、車両１の方位角φとに
基づいて、物体６０の絶対位置Ｓ（ｘ、ｙ）が演算され
る。
【００６３】 （ｘ、ｙ）＝ｆ1（Ｒ、θ、Ｘ、Ｙ、φ） …（１） つぎに図４（ｃ）に示すように、演算された物***置Ｓ
（ｘ、ｙ）と、障害物検出エリア８の境界線位置位置デ
ータＱ（ｘbound[]、ｙbound[]）とを対比して、物***
置Ｓ（ｘ、ｙ）が、境界線（ｘbound[]、ｙbound[]）の
内側の座標位置であるか否か、つまり物体６０が障害物
検出エリア８の内側にあるか外側にあるかが判定され
る。
【００６４】この結果物体６０が障害物検出エリア８の
内側にあると判定された場合には、その検出物体６０は
「障害物」の候補であると判定される。以上の判定は各
レーダ２１〜２４毎に個別に行われる。
【００６５】内外判定部１２で、物体６０が障害物検出
エリア８の内にあり、検出物体６０は障害物候補である
と判定された場合には、各レーダ２１〜２４毎に、距離
Ｒ、方位角θのデータが得点演算部１３に対して出力さ
れる。
【００６６】つぎに図５を参照して固定レーダ２１〜２
３と旋回レーダ２４の検出範囲について説明する。
【００６７】図５は、車両１の走行路５０の曲率Ｒと、
固定レーダ２１〜２３、旋回レーダ２４の検出範囲との
関係を示している。
【００６８】同図５に示すように、曲率が１００Ｒ程度
までは（４００Ｒ、２００Ｒ、１００Ｒ）、固定レーダ
２１〜２３で走行路５０上の障害物を検出できるが、そ
れ以上小さい曲率では固定レーダ２１〜２３で走行路５
０上の障害物を検出することができない。これに対して
旋回レーダ２４では、固定レーダ２１〜２３の検出でき
る曲率の走行路５０上の障害物のみならず、旋回させる
ことによって固定レーダ２１〜２４では検出できない小
さい曲率（５０Ｒ、２５Ｒ…）の走行路５０上の障害物
をも検出することができる。
【００６９】このため図６に示すように、小さい曲率の
走行路５０を車両１が走行するときには、旋回レーダ２
４の検出範囲３Ｂの全部あるいは一部を固定レーダ２１
〜２３の検出範囲３Ａ外にすることができ固定レーダ２
１〜２３の検出範囲外の範囲の障害物６０を検出するこ
とができる。
【００７０】また図７に示すように、直線路あるいは大
きい曲率の走行路５０を車両１が走行するときには、旋
回レーダ２４は、固定レーダ２１〜２３の検出範囲３Ａ
と重なる範囲３Ｂの障害物６０を検出することができ
る。
【００７１】以上のように固定レーダ２１〜２３と、旋
回レーダ２４を備えているので、直線路あるいは大きい
曲率の走行路５０と、交差点や急カーブなどの小さい曲
率の走行路５０の両方について、障害物検出範囲をカバ
ーすることができる。
【００７２】とりわけ図７に示すように、直線路あるい
は大きい曲率の走行路５０では固定レーダ２１〜２３と
旋回レーダ２４の両方が障害物６０を同時に冗長的に検
出することができるので、障害物６０の検出を信頼性高
く行うことができる。
【００７３】旋回レーダ２４の旋回制御は、車両１の計
測位置（Ｘ、Ｙ）と、コースデータ（ｘtraj[]、ｙtraj
[]）に基づいて、行うことができる。たとえば車両１の
計測位置（Ｘ、Ｙ）と、車両１の前方の数点のコースデ
ータ（ｘtraj[]、ｙtraj[]）とに基づき、車両１の進行
方向を求め、この進行方向に沿って、レーダビームが出
射されるように旋回レーダ２４を旋回させる。
【００７４】つぎに、「障害物候補」から「障害物」で
あると判定するまでの処理について説明する。
【００７５】本実施形態では図１の内外判定部１２で障
害物候補であると判定されると、以後つぎのような基準
で得点を加算し、得点が所定のしきい値を超えた時点
で、障害物であると判定するようにしている。
【００７６】図１の得点加算部１３では以下のような基
準で障害物候補の得点を加算する。
【００７７】さて図１１で前述したように固定レーダ２
１〜２３は旋回しないため角度精度誤差が小さく障害物
６０の位置計測精度がよく、障害物６０が走行路５０外
であると誤検出することは少なく、信頼性が高い。
【００７８】これに対して旋回レーダ２４は旋回するた
め角度精度誤差が大きく障害物６０の位置計測精度が悪
く、障害物６０が走行路５０外であると誤検出すること
が多く、信頼性が低い。
【００７９】このように「レーダの方式」毎に、信頼性
が異なるため、方式毎に得点を異ならせている。すなわ
ち図８に示すように固定レーダ２１〜２３は旋回レーダ
２４よりも信頼性が高いので、旋回レーダ２４で障害物
を検出したときの得点よりも大きい得点が与えられる。
【００８０】また検出物体までの距離Ｒが大きければ、
検出物体が車両１に干渉までに余裕があるので得点を低
く設定して障害物候補を「障害物」と判定するまでの時
間を遅くする。逆に距離Ｒが小さければ、車両１と干渉
まで余裕がないので得点を高く設定して障害物候補を
「障害物」と判定するまでの時間を早める。このため図
８に示すように、距離Ｒが小さくなるほど得点を高くし
て障害物候補を「障害物」と判定するまでの時間を早め
ている。
【００８１】同様にして車両１の車速Ｖが小さければ、
検出物体が車両１に干渉までに余裕があるので得点を低
く設定して障害物候補を「障害物」と判定するまでの時
間を遅くする。逆に車速Ｖが大きければ、車両１と干渉
までに余裕がないので得点を高く設定して障害物候補を
「障害物」と判定するまでの時間を早める。このため車
速Ｖが大きくなるほど得点を高くして障害物候補を「障
害物」と判定するまでの時間を早める。
【００８２】本実施形態では、「レーダの種類」はミリ
波レーダであり、すべてのレーダ２１〜２４について同
じである。しかしレーダの種類を異ならせた場合には、
信頼度に応じて得点を異ならせることができる。たとえ
ば同じ固定レーダであってもレーダ２１がミリ波レーダ
で、レーダ２２が光レーザで、レーダ２３が視覚センサ
であれば、これらレーダの種類に応じて、得点を異なら
せることができる。データテーブル１６には、レーダの
方式、種類、距離Ｒ、車速Ｖに対応づけられた得点がデ
ータテーブル形式で格納されている。
【００８３】すなわち障害物候補の得点は、ｆ2を所定
の関数とし、距離Ｒ、車速Ｖ、レーダの方式、レーダの
種類をパラメータとして、下記（２）式から求めること
ができる。
【００８４】 得点＝ｆ2（Ｒ、Ｖ、レーダ方式、レーダ種類） …（２） そこで、得点演算部１３は、内外判定部１２から、レー
ダ２１、２２、２３、２４（レーダ方式は固定、旋回の
いずれか、レーダ種類はミリ波レーダ）毎に距離Ｒ、方
位角θを入力するとともに、位置計測コントローラ５か
ら現在の車速Ｖを入力して、これら距離Ｒ、車速Ｖ、レ
ーダの方式、レーダの種類に対応する障害物候補の得点
を、データテーブル１６から読み出す。
【００８５】同一障害物探索部１４では、障害物候補が
複数存在する場合に、いずれが同一の障害物候補である
かを探索する処理を行う。探索の結果、同一障害物候補
と認定された場合には、各同一障害物候補は、障害物候
補記憶部１７の各リスト０、リスト１、リスト２、リス
ト３…それぞれに格納される。障害物候補記憶部１７の
各リスト０、リスト１、リスト２、リスト３…には、障
害物候補ごとに得点が記述される。
【００８６】障害物判定部１５では、障害物候補記憶部
１７の各リスト０、リスト１、リスト２、リスト３…に
記述された得点が、基準点（しきい値）を超えた場合
に、その超えたリストの障害物候補を「障害物」である
と判定する処理を行う。
【００８７】同一障害物探索部１４、障害物判定部１５
で行われる処理については図９を参照して後述する。
【００８８】障害物判定部１５で「障害物」であると判
定されると、障害物６０と車両１との干渉を回避するよ
うに車両１が制御される。具体的には車両１を停止させ
るように車速指令が、図示しない走行機構に出力され
る。なお車両１を減速させるようにしてもよい。また車
両１の車速を制御する代わりに操舵角を制御して、障害
物６０を回避してもよい。
【００８９】以下本実施形態の動作について説明する。
【００９０】１）車両１が直線路、曲率の大きい走行路
５０を走行する場合 図７に示すように、直線路あるいは大きい曲率の走行路
５０を車両１が走行するときには、固定レーダ２１〜２
３で、車両１の前方のスキャニングエリア３Ａ内の障害
物６０が検出されると同時に、旋回レーダ２４を車両進
行方向に旋回させて、固定レーダ２１〜２３のスキャニ
ングエリア３Ａと重なるスキャニングエリア３Ｂ内の障
害物６０が検出される。
【００９１】このように直線路あるいは大きい曲率の走
行路５０では固定レーダ２１〜２３と旋回レーダ２４の
両方が障害物６０を同時に冗長的に検出することができ
るので、障害物６０の検出を信頼性高く行うことができ
る。
【００９２】ただし固定レーダ２１〜２３は信頼性が高
いので得点は高く設定され旋回レーダ２４は信頼性が低
いので得点は低く設定され、「障害物」と判定する得点
に達する時間は、固定レーダ２１〜２３の方が早まる。
【００９３】２）曲率の小さい走行路 図６に示すように、曲率の小さい走行路５０を車両１が
走行するときには、旋回レーダ２４を車両進行方向に旋
回させることによって、固定レーダ２１〜２３のスキャ
ニングエリア３Ａ外の範囲の障害物６０を検出すること
ができる。
【００９４】このように交差点や急カーブなどの小さい
曲率の走行路５０では固定レーダ２１〜の検出範囲外を
旋回レーダ２４でカバーすることができる。
【００９５】ただし旋回レーダ２４は信頼性が低いので
得点は低く設定され、「障害物」と判定する得点に達す
るまでの時間は、遅くなる。
【００９６】以上のように本実施形態によれば、固定レ
ーダ２１〜２３と、旋回レーダ２４を備えているので、
直線路あるいは大きい曲率の走行路５０と、交差点や急
カーブなどの小さい曲率の走行路５０の両方について、
障害物検出範囲をカバーすることができる。
【００９７】３）複数の障害物候補が車両１の進行方向
に出現する場合 この場合には、いずれの検出物体が同一障害物であるか
の判定が必須となる。図９を参照して同一障害物探索部
１４、障害物判定部１５で行われる処理について説明す
る。
【００９８】図９（ａ）は障害物候補記憶部１７でリス
トの内容が更新される様子を示し、図９（ｂ）は車両１
搭載のレーダ２１〜２４が複数の障害物候補を検出する
様子を示している。障害物候補として６１、６２、６３
が車両１の進行方向に出現する場合を想定する。
【００９９】図９（ｂ）に示すようにレーダ２１〜２４
で障害物候補６１（６２、６３）を検出する毎に、前述
したように車両１から障害物候補６１（６２、６３）ま
での距離Ｒが計測される。
【０１００】一方、車両１の内部では、レーダ２１〜２
４で新たな障害物候補６１（６２、６３）を検出する
と、以後、車両１から当該障害物候補６１（６２、６
３）までの予測距離Ｒexpが、所定時間Δｔ経過する毎
に逐次演算される。
【０１０１】予測距離Ｒexpの演算処理内容について図
１０を参照して説明する。
【０１０２】本実施形態では、ミリ波レーダを使用して
いるのでドップラ効果による相対速度を検出できる。す
なわちレーダで障害物候補６１を時刻ｔで検出したとき
に、距離Ｒとともに、車両１の速度Ｖに対する障害物候
補６１の速度ｖの相対速度（Ｖ−ｖ）を検出することが
できる。
【０１０３】したがって、障害物候補６１を時刻ｔで検
出してからΔｔ経過したときの予測距離Ｒexpは、時刻
ｔにおける障害物候補６１の相対速度Ｖ−ｖ、障害物候
補６１までの計測距離Ｒを用いて、次式（３）によって
求められる。
【０１０４】Ｒexp＝Ｒ−（Ｖ−ｖ）Δｔ …（３） そしてレーダ２１〜２４で障害物候補６１（６２、６
３）を検出する毎に、計測距離Ｒと、予測距離Ｒexpと
を比較して、検出された障害物候補が過去に検出された
障害物候補と同一であるか否かが判断される。同一障害
物候補であるか否かは、次式（４）が成立しているか否
かによって判断される。
【０１０５】Ｒexp−ΔＲ＜Ｒ＜Ｒexp＋ΔＲ …（４） ただし上記（４）式において予測距離ＲexpにΔＲを付
加しているのは、距離の誤差を考慮したものである。
【０１０６】上記（４）式が成立して、同一障害物候補
であると判断した場合には、当該障害物候補のリストの
得点に一定得点を順次を加算していく。
【０１０７】そしてリストの得点が所定のしきい値（１
００点）以上になった場合に、そのリストの障害物候補
は「障害物」であると判定される。
【０１０８】図９（ｂ）に示すように、時刻ｔで、障害
物候補をレーダ２１〜２４で検出したならば、そのとき
の計測距離Ｒ＝１００ｍ（障害物候補の絶対位置（ｘ、
ｙ）＝（２５００、−２０００））を予測距離Ｒexpに
置換して、図９（ａ）に示すようにリスト０に新たな障
害物候補６１として格納する。はじめて障害物候補６１
を検出したときは、得点として３０点を加える。
【０１０９】そして時間Δｔが経過した時刻ｔ＋Δｔに
おける予測距離Ｒexpが９５ｍと演算され、リスト０の
内容が更新される。時刻ｔ＋Δｔではレーダ２１〜２４
によって障害物候補６１を検出しなかったのでリスト０
に記述された得点は３０点のままで更新されない。
【０１１０】つぎの時刻ｔ＋２Δｔで、障害物候補をレ
ーダ２１〜２４で検出したならば（図９（ｂ）参照）、
そのときの計測距離Ｒ＝６０ｍとリスト０に記述された
予測距離Ｒexp＝９０ｍと比較するが、（４）式が成立
しないので、この障害物候補は過去の障害物候補６１と
同一でないと判断して、リスト１に新たな障害物候補６
２として格納する。そして、はじめて障害物候補６２を
検出したときの得点としてリスト１に得点４０点が与え
られる。この得点（４０点）が、はじめて障害物候補６
１を検出したときの得点（３０点）よりも高いのは、障
害物候補６２を検出したときの距離Ｒ（＝６０ｍ）が障
害物候補６１を検出したときの距離Ｒ（＝１００ｍ）よ
りも小さいためである（図９（ａ）参照）。
【０１１１】つぎの時刻ｔ＋３Δｔで、障害物候補をレ
ーダ２１〜２４で検出したならば（図９（ｂ）参照）、
そのときの計測距離Ｒ＝１０ｍとリスト０、リスト１に
記述された予測距離Ｒexp＝８５ｍ、５５ｍと比較する
が、（４）式が成立しないので、この障害物候補は過去
の障害物候補６１、６２と同一でないと判断して、リス
ト２に新たな障害物候補６３として格納する。そして、
はじめて障害物候補６３を検出したときの得点としてリ
スト２に得点５０点が与えられる。この得点（５０点）
が、はじめて障害物候補６１、６２を検出したときの得
点（３０点、４０点）よりも高いのは、障害物候補６３
を検出したときの距離Ｒ（＝１０ｍ）が障害物候補６
１、６２を検出したときの距離Ｒ（＝１００ｍ、６０
ｍ）よりも小さいためである（図９（ａ）参照）。
【０１１２】つぎの時刻ｔ＋４Δｔで、障害物候補をレ
ーダ２１〜２４で検出したならば（図９（ｂ）参照）、
そのときの計測距離Ｒ＝７７ｍとリスト０、リスト１、
リスト２に記述された予測距離Ｒexp＝８０ｍ、５０
ｍ、５ｍと比較する。この結果リスト０についてのみ
（４）式が成立するので、この障害物候補は過去の障害
物候補６１と同一であると判断して、リスト０の得点を
３０点加算して合計得点を６０点とする。
【０１１３】つぎの時刻ｔ＋５Δｔで、リスト２の得点
が５０点のまましきい値（１００点）に達することな
く、予測距離Ｒexpが０ｍに達してしまったならば（車
両１と干渉すべき位置に達してしまったならば）、その
リスト２の障害物候補は「障害物」ではない（たとえば
人が一時的に走行路５０に侵入した）と判断して、リス
ト２を削除する。
【０１１４】つぎの時刻ｔ＋６Δｔで、障害物候補をレ
ーダ２１〜２４で検出したならば（図９（ｂ）参照）、
そのときの計測距離Ｒ＝６５ｍとリスト０、リスト１に
記述された予測距離Ｒexp＝６７ｍ、４０ｍと比較す
る。この結果リスト０についてのみ（４）式が成立する
ので、この障害物候補は過去の障害物候補６１と同一で
あると判断して、リスト０の得点を４０点加算して合計
得点を１００点とする。
【０１１５】この時刻ｔ＋６Δｔでの加算得点（４０
点）が、前回の時刻ｔ＋４Δｔでの加算点（３０点）よ
りも高いのは、今回、障害物候補６１を検出したときの
距離Ｒ（＝６５ｍ）が、前回、障害物候補６１を検出し
たときの距離Ｒ（＝７７ｍ）よりも小さいためである
（図９（ａ）参照）。
【０１１６】時刻ｔ＋６Δｔで、リスト０の得点がしき
い値（１００点）以上になったので、このリスト０の障
害物候補６１を「障害物」であると判定し、車両１を停
止させるよう車速指令が出力される。この結果車両１は
障害物６１に干渉することなく安全に停止することがで
きる。
【０１１７】以上説明した実施形態では、レーダの方式
として固定レーダ２１〜２３と、旋回レーダ２４とを組
み合わせ各レーダ方式ごとに得点を異ならせるようにし
ている。しかし上述した実施形態は、図１１に示す各レ
ーダ方式の３つ若しくはいずれか２つを組み合わせる場
合に対して適用することができる。たとえば図１１
（ａ）の固定レーダ方式と図１１（ｂ）の回転レーダ方
式を組み合わせて、各レーダ方式ごとに得点を異ならせ
るようにしてもよい。
【図面の簡単な説明】
【図１】図１は実施形態の障害物検出装置の構成を示す
ブロック図である。
【図２】図２は実施形態の車両に搭載されるレーダを車
両前方から見た図である。
【図３】図３（ａ）、（ｂ）は、実施形態のレーダのス
キャニングエリアを示す図である。
【図４】図４（ａ）、（ｂ）、（ｃ）、（ｄ）は車両の
走行コースのデータと、レーダの出力から、走行路上の
障害物であると判定するまでの処理の手順を説明する図
である。
【図５】図５は固定レーダの検出範囲、旋回レーダの検
出範囲と、走行路の曲率との関係を示す図である。
【図６】図６は固定レーダの検出範囲外を旋回レーダで
検出する様子を説明する図である。
【図７】図７は固定レーダの検出範囲と重複する範囲を
旋回レーダで検出する様子を説明する図である。
【図８】図８は固定レーダと旋回レーダとで異なる重み
（得点）を付加していることを説明する図である。
【図９】図９（ａ）、（ｂ）は図１に示す同一障害物探
索部、障害物判定部で行われる処理の手順を説明する図
である。
【図１０】図１０は車両から物体までの予測距離の演算
処理内容を説明する図である。
【図１１】図１１（ａ）、（ｂ）、（ｃ）は各レーダの
方式を説明する図である。
【符号の説明】
１ 車両 １０ 安全コントローラ １２ 内外判定部 １３ 得点演算部 １４ 同一障害物探索部 １５ 障害物判定部 １６ データテーブル １７ 障害物候補記憶部 ２１〜２３ 固定レーダ ２４ 旋回レーダ ５０ 走行路 ６０ 障害物 ６１、６２、６３ 障害物候補
フロントページの続き (51)Int.Cl.7 識別記号 ＦＩ テーマコート゛(参考） Ｇ０１Ｓ 13/06 Ｇ０１Ｓ 13/06 13/87 13/87 Ｇ０８Ｇ 1/00 Ｇ０８Ｇ 1/00 Ｘ Ｆターム(参考） 5H180 AA07 AA27 CC03 CC12 CC14 CC15 FF04 FF10 LL01 LL02 LL09 LL15 5J070 AB24 AC01 AC02 AC06 AE01 AE09 AF03 AK30 BA01 BD01 BF19

Claims (7)

    【特許請求の範囲】
  1. 【請求項１】 車両の障害物を、レーダを用いて検
    出する障害物検出装置において、 前記車両に固定された固定レーダと、前記車両に対して
    相対的に旋回自在の旋回レーダとを備え、 車両の進行方向に応じた方向にレーダビームが出射され
    るように、前記旋回レーダを車両の進行方向に応じた方
    向に旋回させることを特徴とする車両の障害物検出装
    置。
  2. 【請求項２】 車両の障害物を、レーダを用いて検
    出する障害物検出装置において、 前記車両に固定された固定レーダと、前記車両に対して
    相対的に旋回自在の旋回レーダとを備え、 前記固定レーダと前記旋回レーダの両方からレーダビー
    ムを同時に出射させることにより、同一障害物を両レー
    ダで検出することを特徴とする車両の障害物検出装置。
  3. 【請求項３】 車両の障害物を、レーダを用いて検
    出する障害物検出装置において、 前記車両に固定された固定レーダと、前記車両に対して
    相対的に旋回自在の旋回レーダとを備え、 前記固定レーダから出射されるレーダビームの検出範囲
    外の範囲に、レーダビームが出射されるように、前記旋
    回レーダを旋回させることを特徴とする車両の障害物検
    出装置。
  4. 【請求項４】 前記固定レーダで物体を検出した場
    合と、前記旋回レーダで物体を検出した場合とで異なる
    重みを付与し、これら重みの合計値に基づいて、検出物
    体が障害物であると判定することを特徴とする請求項１
    または２または３記載の車両の障害物検出装置。
  5. 【請求項５】 車両の障害物を、レーダを用いて検
    出する障害物検出装置において、 前記車両に固定された固定レーダと、前記車両に対して
    相対的に旋回自在の旋回レーダとを備え、 前記固定レーダで物体を検出した場合と、前記旋回レー
    ダで物体を検出した場合とで異なる重みを付与し、これ
    ら重みの合計値に基づいて、検出物体が障害物であると
    判定することを特徴とする車両の障害物検出装置。
  6. 【請求項６】 車両の障害物を、レーダを用いて検
    出する障害物検出装置において、 方式、種類のうち少なくともいずれか一方が異なる複数
    のレーダを、車両に搭載し、 レーダの方式、種類ごとに異なる重みを付与し、 各レーダで物体を検出した場合に、重みの合計値に基づ
    いて、検出物体が障害物であると判定することを特徴と
    する車両の障害物検出装置。
  7. 【請求項７】 車両の複数の障害物を、レーダを用
    いて検出する障害物検出装置において、 前記レーダで物体を検出した場合に、以後、車両から当
    該検出物体までの予測距離を、逐次演算する予測距離演
    算手段と、 前記レーダで物体を検出する毎に、車両から当該検出物
    体までの距離を計測する距離計測手段と、 前記レーダで物体を検出する毎に、前記距離計測手段で
    計測される距離と、前記予測距離演算手段で演算される
    予測距離とを比較し、検出物体が過去に検出された物体
    と同一であるか否かを判断し、検出物体が同一であると
    判断した場合には、対応する検出物体の得点を順次加算
    する得点加算手段と、 前記得点加算手段で加算された得点が所定のしきい値以
    上になった場合に、対応する検出物体が障害物であると
    判定する障害物判定手段とを具えたことを特徴とする車
    両の障害物検出装置。
JP2001334753A 2001-10-31 2001-10-31 車両の障害物検出装置 Expired - Fee Related JP3865121B2 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2001334753A JP3865121B2 (ja) 2001-10-31 2001-10-31 車両の障害物検出装置
US10/277,188 US6809680B2 (en) 2001-10-31 2002-10-22 Obstacle detecting apparatus of vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2001334753A JP3865121B2 (ja) 2001-10-31 2001-10-31 車両の障害物検出装置

Publications (2)

Publication Number Publication Date
JP2003141692A true JP2003141692A (ja) 2003-05-16
JP3865121B2 JP3865121B2 (ja) 2007-01-10

Family

ID=19149839

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2001334753A Expired - Fee Related JP3865121B2 (ja) 2001-10-31 2001-10-31 車両の障害物検出装置

Country Status (2)

Country Link
US (1) US6809680B2 (ja)
JP (1) JP3865121B2 (ja)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007240446A (ja) * 2006-03-10 2007-09-20 Omron Corp 車両用測距装置
JP2008065545A (ja) * 2006-09-06 2008-03-21 Toyota Motor Corp 車両用運転支援装置
JP2010044443A (ja) * 2008-08-08 2010-02-25 Honda Motor Co Ltd 車両走行支援装置
JP2012127919A (ja) * 2010-12-17 2012-07-05 Denso Corp 車両用障害物監視装置
WO2015004855A1 (ja) * 2013-07-11 2015-01-15 ヤマハ発動機株式会社 ナビゲーション装置、シミュレーション装置、移動装置およびナビゲーション方法
WO2015025984A1 (ja) * 2014-09-01 2015-02-26 株式会社小松製作所 運搬車両及び運搬車両の制御方法
JP2016008922A (ja) * 2014-06-25 2016-01-18 株式会社東芝 センサ情報融合装置
WO2016051524A1 (ja) * 2014-09-30 2016-04-07 日立建機株式会社 運転支援システム、車両、運転支援端末装置、及び運転支援プログラム
JP2016130896A (ja) * 2015-01-13 2016-07-21 株式会社デンソー 障害物識別装置、及び障害物識別システム
JP2016130129A (ja) * 2016-04-04 2016-07-21 株式会社小松製作所 運搬車両
JPWO2016181618A1 (ja) * 2015-05-11 2018-04-05 パナソニックＩｐマネジメント株式会社 監視対象領域設定装置および監視対象領域設定方法
JP2020525948A (ja) * 2017-06-29 2020-08-27 ユーエーティーシー， エルエルシー 自律車両衝突軽減システムおよび方法
US10780880B2 (en) 2017-08-03 2020-09-22 Uatc, Llc Multi-model switching on a collision mitigation system

Families Citing this family (30)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3865121B2 (ja) * 2001-10-31 2007-01-10 株式会社小松製作所 車両の障害物検出装置
US7136753B2 (en) * 2002-12-05 2006-11-14 Denso Corporation Object recognition apparatus for vehicle, inter-vehicle control apparatus, and distance measurement apparatus
US7317388B2 (en) * 2004-03-31 2008-01-08 Honda Motor Co., Ltd. Position detection system for mobile object
JP2006189393A (ja) * 2005-01-07 2006-07-20 Toyota Motor Corp 周辺物体情報取得装置及びこれを用いる駐車支援装置
US7227474B2 (en) * 2005-01-25 2007-06-05 Vistoen Global Technologies, Inc. Object detection system: zone matching and programmability
DE102006006850B4 (de) * 2006-02-15 2022-12-29 Bayerische Motoren Werke Aktiengesellschaft Verfahren zur Ausrichtung eines verschwenkbaren Fahrzeugsensors
JP4793094B2 (ja) * 2006-05-17 2011-10-12 株式会社デンソー 走行環境認識装置
ATE479907T1 (de) * 2006-07-13 2010-09-15 Siemens Ag Radaranordnung
US9207673B2 (en) * 2008-12-04 2015-12-08 Crown Equipment Corporation Finger-mounted apparatus for remotely controlling a materials handling vehicle
US9645968B2 (en) 2006-09-14 2017-05-09 Crown Equipment Corporation Multiple zone sensing for materials handling vehicles
US8970363B2 (en) * 2006-09-14 2015-03-03 Crown Equipment Corporation Wrist/arm/hand mounted device for remotely controlling a materials handling vehicle
US9122276B2 (en) 2006-09-14 2015-09-01 Crown Equipment Corporation Wearable wireless remote control device for use with a materials handling vehicle
WO2009090807A1 (ja) * 2008-01-16 2009-07-23 Nec Corporation 移動装置、移動装置の移動方法、及び移動装置の移動制御プログラム
US9522817B2 (en) 2008-12-04 2016-12-20 Crown Equipment Corporation Sensor configuration for a materials handling vehicle
US8731777B2 (en) * 2009-08-18 2014-05-20 Crown Equipment Corporation Object tracking and steer maneuvers for materials handling vehicles
US8577551B2 (en) * 2009-08-18 2013-11-05 Crown Equipment Corporation Steer control maneuvers for materials handling vehicles
JP2013195086A (ja) * 2012-03-15 2013-09-30 Komatsu Ltd 障害物検出機構付きダンプトラック
JP5781978B2 (ja) * 2012-05-22 2015-09-24 株式会社小松製作所 ダンプトラック
US9574326B2 (en) 2012-08-02 2017-02-21 Harnischfeger Technologies, Inc. Depth-related help functions for a shovel training simulator
AU2014202349A1 (en) 2012-08-02 2014-05-22 Harnischfeger Technologies, Inc. Depth-related help functions for a wheel loader training simulator
US10222462B2 (en) * 2013-02-27 2019-03-05 Waymo Llc Adaptive algorithms for interrogating the viewable scene of an automotive radar
DE102013216994A1 (de) * 2013-08-27 2015-03-05 Robert Bosch Gmbh Geschwindigkeitsassistent für ein Kraftfahrzeug
CA2922812C (en) 2013-08-29 2021-11-16 Joy Mm Delaware, Inc. Detecting sump depth of a miner
KR20150055271A (ko) * 2013-11-13 2015-05-21 현대모비스 주식회사 타겟의 운동 특성 판단 장치 및 이를 구비하는 주행 경로 제어 장치
JP6010634B2 (ja) * 2014-09-01 2016-10-19 株式会社小松製作所 運搬車両、ダンプトラック、及び運搬車両の制御方法
JP6992704B2 (ja) * 2018-08-22 2022-01-13 株式会社デンソー 物体検知装置
EP3918588A1 (en) 2019-02-01 2021-12-08 Crown Equipment Corporation On-board charging station for a remote control device
US11641121B2 (en) 2019-02-01 2023-05-02 Crown Equipment Corporation On-board charging station for a remote control device
KR20210060237A (ko) * 2019-11-18 2021-05-26 현대모비스 주식회사 후방 교차 충돌 감지 시스템 및 방법
CN116057491A (zh) 2020-08-11 2023-05-02 克朗设备公司 远程控制设备

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5648901A (en) 1990-02-05 1997-07-15 Caterpillar Inc. System and method for generating paths in an autonomous vehicle
JPH04163250A (ja) 1990-10-24 1992-06-08 Japan Electron Control Syst Co Ltd 車両用障害物検出装置
US5530651A (en) * 1992-08-03 1996-06-25 Mazda Motor Corporation Running-safety system for an automotive vehicle
JP3865121B2 (ja) * 2001-10-31 2007-01-10 株式会社小松製作所 車両の障害物検出装置

Cited By (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007240446A (ja) * 2006-03-10 2007-09-20 Omron Corp 車両用測距装置
JP2008065545A (ja) * 2006-09-06 2008-03-21 Toyota Motor Corp 車両用運転支援装置
JP2010044443A (ja) * 2008-08-08 2010-02-25 Honda Motor Co Ltd 車両走行支援装置
JP2012127919A (ja) * 2010-12-17 2012-07-05 Denso Corp 車両用障害物監視装置
WO2015004855A1 (ja) * 2013-07-11 2015-01-15 ヤマハ発動機株式会社 ナビゲーション装置、シミュレーション装置、移動装置およびナビゲーション方法
JP2015017914A (ja) * 2013-07-11 2015-01-29 ヤマハ発動機株式会社 ナビゲーション装置、シミュレーション装置、移動装置およびナビゲーション方法
US9885580B2 (en) 2013-07-11 2018-02-06 Yamaha Hatsudoki Kabushiki Kaisha Navigation apparatus, simulation apparatus, moving device and navigation method
JP2016008922A (ja) * 2014-06-25 2016-01-18 株式会社東芝 センサ情報融合装置
CN105993039A (zh) * 2014-09-01 2016-10-05 株式会社小松制作所 搬运车辆及搬运车辆的控制方法
WO2015025984A1 (ja) * 2014-09-01 2015-02-26 株式会社小松製作所 運搬車両及び運搬車両の制御方法
CN105993039B (zh) * 2014-09-01 2017-11-24 株式会社小松制作所 搬运车辆及搬运车辆的控制方法
JP5990285B2 (ja) * 2014-09-01 2016-09-07 株式会社小松製作所 運搬車両
JPWO2015025984A1 (ja) * 2014-09-01 2017-03-02 株式会社小松製作所 運搬車両
US9550493B2 (en) 2014-09-01 2017-01-24 Komatsu Ltd. Transporter vehicle and transporter vehicle control method
WO2016051524A1 (ja) * 2014-09-30 2016-04-07 日立建機株式会社 運転支援システム、車両、運転支援端末装置、及び運転支援プログラム
JPWO2016051524A1 (ja) * 2014-09-30 2017-04-27 日立建機株式会社 運転支援システム、車両、運転支援端末装置、及び運転支援プログラム
US9898011B2 (en) 2014-09-30 2018-02-20 Hitachi Construction Machinery Co., Ltd. Driving assistance system and program for driving according to operations management
JP2016130896A (ja) * 2015-01-13 2016-07-21 株式会社デンソー 障害物識別装置、及び障害物識別システム
JPWO2016181618A1 (ja) * 2015-05-11 2018-04-05 パナソニックＩｐマネジメント株式会社 監視対象領域設定装置および監視対象領域設定方法
JP2016130129A (ja) * 2016-04-04 2016-07-21 株式会社小松製作所 運搬車両
JP2020525948A (ja) * 2017-06-29 2020-08-27 ユーエーティーシー， エルエルシー 自律車両衝突軽減システムおよび方法
US11048272B2 (en) 2017-06-29 2021-06-29 Uatc, Llc Autonomous vehicle collision mitigation systems and methods
US11789461B2 (en) 2017-06-29 2023-10-17 Uatc, Llc Autonomous vehicle collision mitigation systems and methods
US10780880B2 (en) 2017-08-03 2020-09-22 Uatc, Llc Multi-model switching on a collision mitigation system
US11702067B2 (en) 2017-08-03 2023-07-18 Uatc, Llc Multi-model switching on a collision mitigation system

Also Published As

Publication number Publication date
US20030083818A1 (en) 2003-05-01
JP3865121B2 (ja) 2007-01-10
US6809680B2 (en) 2004-10-26

Similar Documents

Publication Publication Date Title
JP2003141692A (ja) 車両の障害物検出装置
JP5678793B2 (ja) 周辺監視装置および周辺監視方法並びに運転支援装置
US10747229B2 (en) Environment arrangement robot and control program thereof
JPH06131596A (ja) 車両用障害物検出装置
JP4530996B2 (ja) 移動ロボット
US7509217B2 (en) Vehicle detector and vehicle detecting method
JP2001521212A (ja) 自動ガイド車両の位置を求める方法
JPH05257533A (ja) 移動ロボットの床面掃引方法及び装置
KR101882483B1 (ko) 무인 수상정의 장애물 탐지 장치 및 방법
JP2009223757A (ja) 自律移動体、その制御システム、自己位置推定方法
JP4745159B2 (ja) 移動ロボット
JP2003058998A (ja) 車両駐車装置
JP2017032329A (ja) 障害物判定装置、移動体、及び障害物判定方法
JP4745150B2 (ja) 移動ロボット
JP2019057197A (ja) 移動物体認識装置
JPH0862333A (ja) 障害物検出装置
JP2008009927A (ja) 移動ロボット
JP3149661B2 (ja) 無人搬送車の位置同定方法
JP2003075531A5 (ja)
JPH06156170A (ja) 車両用障害物検出装置
JPH03111785A (ja) 先行車両認識装置
JP5644673B2 (ja) 周辺監視装置および周辺監視方法、並びに運転支援装置
JPH11167699A (ja) 車両の物体認識装置
JP6863049B2 (ja) 自律移動ロボット
JP7459732B2 (ja) 自己位置推定システム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040323

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20060501

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20060704

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20060830

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20060927

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

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

Free format text: PAYMENT UNTIL: 20091013

Year of fee payment: 3

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

Free format text: PAYMENT UNTIL: 20101013

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20111013

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20121013

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20121013

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20131013

Year of fee payment: 7

LAPS Cancellation because of no payment of annual fees