JP6975945B2 - 判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体 - Google Patents

判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体 Download PDF

Info

Publication number
JP6975945B2
JP6975945B2 JP2017013016A JP2017013016A JP6975945B2 JP 6975945 B2 JP6975945 B2 JP 6975945B2 JP 2017013016 A JP2017013016 A JP 2017013016A JP 2017013016 A JP2017013016 A JP 2017013016A JP 6975945 B2 JP6975945 B2 JP 6975945B2
Authority
JP
Japan
Prior art keywords
passage
distance information
continuum
directional
range
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.)
Active
Application number
JP2017013016A
Other languages
English (en)
Other versions
JP2017151095A (ja
Inventor
義人 平井
洋文 西村
直也 四十九
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.)
Panasonic Intellectual Property Management Co Ltd
Original Assignee
Panasonic Intellectual Property Management 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 Panasonic Intellectual Property Management Co Ltd filed Critical Panasonic Intellectual Property Management Co Ltd
Publication of JP2017151095A publication Critical patent/JP2017151095A/ja
Application granted granted Critical
Publication of JP6975945B2 publication Critical patent/JP6975945B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06—Road conditions
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance
    • G01C21/36—Input/output arrangements for on-board computers
    • G01C21/3697—Output of additional, non-guidance related information, e.g. low fuel level
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance
    • G01C21/36—Input/output arrangements for on-board computers
    • G01C21/3602—Input other than that of destination using image analysis, e.g. detection of road signs, lanes, buildings, real preceding vehicles using a camera
    • 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
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/40—Scenes; Scene-specific elements in video content
    • G06V20/44—Event detection
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/16—Anti-collision systems
    • G08G1/165—Anti-collision systems for passive traffic, e.g. including static obstacles, trees
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/16—Anti-collision systems
    • G08G1/166—Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/16—Anti-collision systems
    • G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Electromagnetism (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Theoretical Computer Science (AREA)
  • Multimedia (AREA)
  • Medical Informatics (AREA)
  • Artificial Intelligence (AREA)
  • Mathematical Physics (AREA)
  • Health & Medical Sciences (AREA)
  • Mechanical Engineering (AREA)
  • Evolutionary Computation (AREA)
  • Game Theory and Decision Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Business, Economics & Management (AREA)
  • Optics & Photonics (AREA)
  • Transportation (AREA)
  • Traffic Control Systems (AREA)
  • Image Analysis (AREA)
  • Image Processing (AREA)
  • Radar Systems Or Details Thereof (AREA)
  • Optical Radar Systems And Details Thereof (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本開示は、方位距離センサと通信可能な判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体に関する。
従来より、様々な手法で、自輸送機器の運転者に、次に通過する交差点に関する情報が提供されている。
例えば、特許文献１に記載の交差点検出方法では、まず、移動体周辺の状態を調査する際に使用される第１データと移動体の位置を示す第１位置情報とを含む車載データと、交差点の位置を示す第２位置情報を含む地図データとが取得される。その後、第１位置情報および第２位置情報に基づいて、交差点から所定距離以内の地点で取得された車載データが選択され、選択した車載データの第１データに交差点の特徴が存在するか否かが判定される。この判定結果に基づいて、交差点内で取得された車載データが特定された後、この車載データに基づき探索範囲の開始位置が決定される。また、車載データの探索方向が車載データの記録時間方向と逆行する時間方向に決定された後、判定対象の車載データが探索方向にしたがって順次選択され、判定対象の車載データに交差点開始位置に対応する特徴が出現するか否かが判定され、その結果、交差点開始位置の車載データが特定される。
また、特許文献２に記載の車両用警報装置は、車両の状態に関する情報及び車両周辺の状況に関する情報を取得する取得手段と、取得手段の取得情報に基づき減速又は停止を促す警報の出力の要否を判定する判定手段と、判定手段の判定結果に基づいて警報を出力する警報手段と、車両進行方向にある減速又は停止を促す標示を検出する検出手段とを備える。ここで、警報手段は、検出手段により標示が検出された場合、警報を出力しない、又は所定の条件が成立するまで警報を出力しない。
特開２０１４−１０６１４７号公報 特許第５３３８３７１号公報
車両が道路網を走行中、交差点に接続する道路や屈曲点の先の道路を見通すことが難しい場合がある。従って、かかる交差点や屈曲点（以下、特定領域という）に関しては、より詳細な情報が提供されることが要望される。
本開示の非限定的な実施例は、見通しの悪い特定領域に関する詳細な情報を提供可能な判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体を提供する。
本開示の一形態は、移動体に搭載される第１センサから、第１の範囲に存在する１つ以上の物体までの間の距離及び方位を示す１つ以上の第１方位距離情報を受け取る入力部と、前記移動体が走行する第１通路に沿った第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中の第１静止物体に対する１つ以上の方位距離情報である第１連続体と、前記第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中、前記第１静止物体よりも前記移動体から遠い第２静止物体に対する１つ以上の方位距離情報である第２連続体と、前記第１方向とは異なる第２方向に、前記１つ以上の第１方位距離情報のうち、前記第２静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第１連続体及び前記第２連続体の位置関係によって長さが変化する第３連続体と、を認識し、前記第２連続体に含まれる方位情報に基づいて、前記第１範囲にＴ字路が構成される可能性を判定し、前記第３連続体の長さが所定値以上である場合、前記第３連続体に沿った第２通路が前記第１通路に接続されているか否かを判定する通路検出部と、前記第１範囲にＴ字路が構成される可能性の判定結果と、前記第２通路と前記第１通路との接続の判定結果とに基づいて、前記第１範囲での通路の形状を判断する通路判定部と、前記判断した通路の形状を、前記移動体に搭載された移動体制御装置に出力する出力部と、を備える判定装置である。
上記一形態は、判定装置だけでなく、判定方法、プログラムおよびプログラムを記録した記録媒体であっても良い。
上記各形態によれば、見通しの悪い特定領域に関する詳細な情報を提供可能な判定装置および判定方法、プログラムおよびプログラムを記録した記録媒体を提供することができる。
本開示の一態様における更なる利点および効果は、明細書および図面から明らかにされる。かかる利点および／または効果は、いくつかの実施形態並びに明細書および図面に記載された特徴によってそれぞれ提供されるが、１つまたはそれ以上の同一の特徴を得るために必ずしも全てが提供される必要はない。
本開示に係る判定装置のハードウェア構成の一例を示す図である。 図１の判定装置の機能ブロックの一例及び、オクルージョン検出部の一例を示す図である。 方位距離情報と、第１連続体と、中断区間と、第２連続体との関係の一例を示す図である。 横軸θ、縦軸ｌ・ｃｏｓθの座標系に全角度ステップの方位距離情報の一例を示す図である。 横軸θ、縦軸ｌ・ｓｉｎθの座標系に全角度ステップの方位距離情報の一例を示す図である。 第１位置ＰＡ，第２位置ＰＢを結ぶ線分の近似直線の一例を示す図である。 図２の情報処理部からの出力情報の一例を示す図である。 ｎフレーム前の方位距離情報を現在の座標系に変換する手法の一例を示す図である。 図２のオクルージョン判定部の一例を示す図である。 図９の第３位置判定部の処理の一例を示す図である。 図２の特定領域判定部の一例を示す図である。 図１１の第１傾き判定部の判定結果の一例を示す図である。 変形例に係る判定装置のハードウェア構成の一例を示す図である。 図１３の判定装置の機能ブロックの一例、及び、移動帯検出部及びオクルージョン検出部の一例を示す図である。 図１４の移動体判定部の一例を示す図である。 図１５の移動軌跡計算部の処理の一例を示す図である。
≪１．実施形態≫
以下、上記図面を参照して、本開示に係る判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体を詳説する。
≪１−１．定義≫
図中、ｘ軸およびｙ軸は、輸送機器Ｔの幅方向および長さ方向を示し、両軸の原点Ｐ０は、輸送機器Ｔの現在位置における方位距離センサ１Ｒの取付位置とする。また、本実施形態では、ｙ軸は輸送機器Ｔの前進方向が正値であり、ｘ軸は前進方向に向かって右側が正値である。
また、輸送機器Ｔは、移動体の例示であって、典型的には車両である。また、特定領域Ｃは、輸送機器Ｔが移動可能な通路網（典型的には道路網）における交差点または屈曲点である。また、右Ｔ字路（├形道路交差点）（Ｔ−ｊｕｎｃｔｉｏｎ ｈａｖｉｎｇ Ｒｉｇｈｔ Ｅｘｉｔ ａｎｄ Ｓｔｒａｉｇｈｔ Ｅｘｉｔ）または左Ｔ字路（┤形道路交差点）（Ｔ−ｊｕｎｃｔｉｏｎ ｈａｖｉｎｇ Ｌｅｆｔ Ｅｘｉｔ ａｎｄ Ｓｔｒａｉｇｈｔ Ｅｘｉｔ）は、輸送機器Ｔが移動する第１通路Ｒ１に右側方または左側方から第２通路Ｒ２が接続する三叉路である。下Ｔ字路（┬形道路交差点）（Ｔ−ｊｕｎｃｔｉｏｎ ｈａｖｉｎｇ Ｌｅｆｔ Ｅｘｉｔ ａｎｄ Ｒｉｇｈｔ Ｅｘｉｔ）は、輸送機器Ｔが移動する第１通路Ｒ１に左右両側から第２通路Ｒ２が接続する三叉路である。また、右Ｌ字路（右方屈折）（Ｒｉｇｈｔ Ｃｏｒｎｅｒ）および左Ｌ字路（左方屈折）（Ｌｅｆｔ Ｃｏｒｎｅｒ）は、輸送機器Ｔの前進方向に対し右方向および左方向に概ね９０°屈曲している通路である。
≪１−２．判定装置の構成および周辺構成≫
図１は、判定装置のハードウェア構成の一例を示す図である。図１には、輸送機器Ｔとして車両が例示される。輸送機器Ｔには、方位距離センサ１Ｒ，１Ｌと、判定装置２とが搭載される。
方位距離センサ１Ｒは、例えばレーザレーダ、ミリ波レーダであり、輸送機器Ｔの右前方に取り付けられる。方位距離センサ１Ｒは、例えば、自身の測定可能範囲内（換言すると、輸送機器Ｔの右前方の測定可能範囲内）を所定角度ステップでスキャンし、所定角度ステップ毎で定義される方位に物体と方位距離センサ１Ｒとの距離を測定するための測距波を出射する。方位距離センサ１Ｒは、出射波（測距波）に対する反射波を受信し、例えばＴＯＦ（Ｔｉｍｅ Ｏｆ Ｆｌｉｇｈｔ）方式に基づき、各方位に存在する物体（移動体だけでなく壁、樹木、標識等）までの空間距離を導出し、空間距離および物体に対応する方位の組み合わせである方位距離情報ＤＲを１フレーム分生成する。単位フレームの方位距離情報ＤＲは、輸送機器Ｔが移動する通路の路面と、それ以外との境界を定義可能であり、フレーム周期毎に生成される。
判定装置２は、例えばＥＣＵ（Ｅｌｅｃｔｒｏｎｉｃ Ｃｏｎｔｒｏｌ Ｕｎｉｔ）の筐体内に収容され、入力部２１と、制御部２２と、不揮発性メモリ２３と、ＳＲＡＭ２４と、出力部２５と、を備えている。
入力部２１は、方位距離センサ１Ｒからの方位距離情報ＤＲを受け取る。入力部２１はさらに、制御部２２の制御下で、受信した方位距離情報ＤＲをＳＲＡＭ２４に転送する。出力部２５は、後述の制御部２２により生成された情報を、輸送機器Ｔに搭載された移動体制御装置３（例えばディスプレイ装置や自動走行制御装置）に出力する。
≪１−３．制御部の機能ブロック≫
制御部２２は、例えばマイコンであって、不揮発性メモリ２３に予め格納されたプログラムを、ＳＲＡＭ２４を作業領域として用いて実行することで、図２に示すように、オクルージョン検出部３１Ｒと、オクルージョン検出部３１Ｌと、特定領域判定部３２として機能する。
また、オクルージョン検出部３１Ｒは、機能ブロックとして、認識部４１Ｒと、情報処理部４２Ｒと、過去データバッファ部４３Ｒと、座標変換部４４Ｒと、オクルージョン判定部４５Ｒと、を備えている。
認識部４１Ｒは、フレーム単位で得られる複数の方位距離情報ＤＲから、所定条件を満たす方位距離情報ＤＲを選択する。以下、図３を参照して、所定条件を満たす方位距離情報ＤＲを説明する。図３において、一点鎖線で示す扇形で囲った領域内が測定可能範囲ＲＲの一例である。また、図中、角度ステップ毎の方位距離情報ＤＲは「＋」マークで示される。なお、図３の例では、ｘ軸方向が０°の方位（θ＝０°）で、ｙ軸方向が９０°の方位（θ＝９０°）と例示的に定義される。
図３には、第１通路Ｒ１上の特定領域Ｃ（例えば交差点）の手前（ｙ軸の負方向側）で得られる方位距離情報ＤＲが全角度ステップ分、示される。この特定領域Ｃには、輸送機器Ｔを基準として、例えば右斜め前方から細街路（以下、第２通路という）Ｒ２が接続する。
例えば、第１通路Ｒ１に沿った第１の物体としての第１連続体Ｕ１により、方位距離センサ１Ｒから第２通路Ｒ２の見通しが悪い場合、第２通路Ｒ２の第１の境界（即ち、ｙ軸の負方向寄りの部分）Ｒ２−１における方位距離情報ＤＲは、取得される量は少ない。また、第２通路Ｒ２の第２の境界（即ち、ｙ軸の正方向寄りの部分）Ｒ２−２における方位距離情報ＤＲは、第１通路Ｒ１の第１連続体Ｕ１に阻まれる領域において、取得される量は少ない。
ここで、本実施形態におけるｘｙ座標系の第１位置ＰＡ，第２位置ＰＢ及び、第３位置ＰＣを定義する。まず、第１位置ＰＡは、第１通路Ｒ１に沿った第２の物体としての第２連続体Ｕ２と、第２通路Ｒ２の第２の境界Ｒ２−２との交点である。まず、第３位置ＰＣは、第１通路Ｒ１に沿った第１の物体としての第１連続体Ｕ１と、第２通路Ｒ２の第１の境界Ｒ２−１との交点である。
なお、第１連続体Ｕ１と第２連続体Ｕ２との間には、第１位置ＰＡおよび第３位置ＰＣの間にて、方位距離情報ＤＲの中断区間Ｕ４が存在する。中断区間Ｕ４は、特定領域Ｃにおいて第１通路Ｒ１に沿う方向への幅を有する。
第２位置ＰＢは、第２連続体Ｕ２から離れた位置であって、第２通路Ｒ２の第２の境界Ｒ２−２に沿った第３連続体Ｕ３上にあり、かつ、輸送機器Ｔの現在位置Ｐ０から見通せる右側の端点である。方位距離センサ１Ｒは、全角度ステップの方位距離情報ＤＲのうち、少なくとも、第１位置ＰＡと第２位置ＰＢとの間に概ね分布する複数の方位距離情報ＤＲと、第３位置ＰＣの方位距離情報ＤＲと、を選択し出力する。
認識部４１Ｒは、まず、フレーム単位で得られる方位距離情報ＤＲから、下記の条件式（１）を満足するものを第１方位距離情報ＤＲとして選択し、これによって、輸送機器Ｔが走行する第１通路Ｒ１に沿った第１連続体Ｕ１、第２連続体Ｕ２を認識する。第１連続体Ｕ１、第２連続体Ｕ２はそれぞれ、壁、縁石等、第１通路Ｒ１を区切る第１の物体、第２の物体である。
｜ ｌ・ｃｏｓθ− ｌＤ｜< εＴＨ１ …（１）
ここで、ｌ，θそれぞれは、方位距離情報ＤＲにおける空間距離および方位である。ｌＤは、方位θが０°の方位距離情報ＤＲに含まれる空間距離である。εＴＨ１は、各位置のｘ方向距離ｌ・ｃｏｓθが距離ｌＤと実質的に同じとみなすための閾値であって、設定により変更可能な値である。
ここで、図４は、理解を容易にするために、横軸がθ、縦軸がｌ・ｃｏｓθの座標系に全角度ステップの方位距離情報ＤＲの一例を示すである。走行路Ｒ１は、ほぼｙ軸に平行となるため、第１位置ＰＡでのｌＡ・ｃｏｓθＡ，第３位置ＰＣでのＩＣ・ｃｏｓθＣは、点ＰＤの距離ＩＤの±εＴＨ１の範囲内に収まると推定される。第２位置ＰＢは、本実施形態では、上記条件式（１）を満たさない方位距離情報ＤＲのうち、第１通路Ｒ１に沿った第２連続体Ｕ２から離れた位置にあり、最も小さな方位θを有する方位距離情報ＤＲで定義される。第３位置ＰＣは、第２位置ＰＢに対し、１角度ステップ分、小さい方位距離情報ＤＲで定義される。第１位置ＰＡは、条件式（１）を満たす第１方位距離情報ＤＲのうち、第３位置ＰＣから所定数（複数）の角度ステップ分、離れた位置に存在する。認識部４１Ｒは、条件式（１）を満たす第１方位距離情報ＤＲから、以上のような第１位置ＰＡ，第３位置ＰＣを特定すると、第１連続体Ｕ１及び第２連続体Ｕ２との間に中断区間Ｕ４が存在すると認識する。また、認識部４１Ｒは、本実施形態では、上記条件式（１）を満たさない方位距離情報ＤＲに第２位置ＰＢが存在すると認識する場合、第２位置ＰＢから第１位置ＰＡの間に概ね分布する方位距離情報ＤＲを、第２方位距離情報ＤＲとして選択する。
以上の第１方位距離情報ＤＲおよび第２方位距離情報ＤＲを選択した後、認識部４１Ｒは、輸送機器Ｔが、見通しの悪い特定領域Ｃをこれから通過するとの前提で、以降の処理を進める。
認識部４１Ｒはさらに、第１位置ＰＡの方位θＡよりも大きな方位θを有する方位距離情報ＤＲから、下記の条件式（２）を満足する方位距離情報ＤＲが存在するか否かを判定する。
｜ｌ・ｓｉｎθ −ｌＡ・ｓｉｎθＡ｜ ＜ εＴＨ２ …（２）
ここで、εＴＨ２は、特定領域ＣがＴ字路か否かを判定するための閾値であって、設定により変更可能な値である。なお、上式（２）では、θＡ＜θ＜９０°である。
図５には、理解を容易にするために、横軸がθ、縦軸がｌ・ｓｉｎθの座標系に全角度ステップの方位距離情報ＤＲが示される。特定領域ＣでＴ字路が構成される場合、条件式（２）を満たす方位距離情報ＤＲが群で存在する。かかる場合、認識部４１Ｒは、現在のフレームに対しＴ字路判定フラグをたてる。
図２を再度参照する。情報処理部４２Ｒは、認識部４１Ｒで選択された方位距離情報ＤＲをｘｙ座標値に変換後、第１位置ＰＡ，第２位置ＰＢ間に分布する複数のｘｙ座標値を直線近似する（図６を参照）。対象となるｘｙ座標値がｍ個の角度ステップに相当する個数ある場合、情報処理部４２Ｒは、ｍ角度ステップ分のｘｙ座標値に対し最小２乗法等を適用して回帰直線の式ｙ＝ａｘ＋ｂを求める、ｍ角度ステップ分のｘｙ座標値の相関係数ＣＣを求める。
情報処理部４２Ｒでの計算過程を、図７を用いて説明する。情報処理部４２Ｒは、認識部４１Ｒから図７における（ａ）に示すデータが入力される。
図７における（ｂ）では、情報処理部４２Ｒは、図７における（ａ）に示したデータのうち、ＡＢ１（点ＰＡ）〜ＡＢｍ（点ＰＢ）と点ＰＣの極座標とを、レーダ位置を原点としたＸＹ座標に変換する。なお、情報処理部４２Ｒは、レーダから点ＰＢまでの距離ｌＢ、点ＰＣまでの距離ｌＣおよびＴ字路判定フラグを、処理しない。
次に、図７における（ｃ）では、情報処理部４２Ｒは、図７における（ｂ）に示すデータのうち、ＡＢ１（点ＰＡ）〜ＡＢｍ（点ＰＢ）のｍ個の座標を用いて、回帰直線の式ｙ＝ａｘ＋ｂと相関係数ＣＣとを算出する。なお、情報処理部４２Ｒは、点ＰＡ、点ＰＢ、点ＰＣのＸＹ座標、レーダからのＰＢまでの距離ｌＢ、ＰＣまでの距離ｌＣおよびＴ字路判定フラグを、処理しない。
情報処理部４２Ｒは、図７における（ｃ）に示すデータ（即ち、回帰直線式、相関係数ＣＣ、第１位置ＰＡ〜第３位置ＰＣのｘｙ座標値、第２位置ＰＢ，第３位置ＰＣへの距離ｌＢ，ｌＣ、Ｔ字路判定フラグ）を、後段のオクルージョン判定部４５Ｒと、過去データバッファ部４３Ｒと、に出力する。
図２を再度参照する。過去データバッファ部４３Ｒには、情報処理部４２Ｒの出力結果と、輸送機器Ｔの現在の速度及び舵角等のデータと、全角度ステップの方位距離情報ＤＲ（即ち、１フレーム分のデータ）と、が格納される。ここで、過去データバッファ部４３Ｒは、最大Ｎフレーム分をバッファすることが可能であり、Ｎ以下の自然数ｎが設定されることによって、最新ｎフレーム分のデータが蓄積される。
座標変換部４４Ｒは、過去データバッファ４３Ｒに蓄積されたｘｙ座標値を、フレーム単位で現在のｘｙ座標系の値に変換する。理解を容易にすべく、図８に、現在からｎフレーム前の方位距離情報ＤＲ等を現在の座標系に変換する手法を示す。図８では、ｎフレーム前のｘｙ座標系は、現在のｘｙ座標系と比べて、ｘ軸方向およびｙ軸方向に、次式（３）で示す量、シフトされている。
Figure 0006975945
ここで、ｖｔは、ｔフレーム前の輸送機器Ｔの速度である。φｔは、ｔフレーム前の舵角である。本実施形態で、舵角とは、ｔフレーム前の原点Ｐ０に対する現在の原点Ｐ０の方位である。また、Ｔｆは、フレーム周期である。
従って、ｎフレーム前の座標値を（ｘｎ，ｙｎ）とし、現在のｘｙ座標値を（ｘｃ，ｙｃ）とする場合、（ｘｎ，ｙｎ）は次式（４）で表される。
Figure 0006975945
図２を再度参照する。オクルージョン判定部４５Ｒは、図７に示すデータ出力（即ち、現在のデータ）と、過去データバッファ部４３Ｒに蓄積された過去ｎフレーム分のデータとに基づき、特定領域Ｃに接続する見通しの悪い第２通路Ｒ２に沿った第３連続体Ｕ３（即ちオクルージョン）の有無を判定する。
オクルージョン判定部４５Ｒは、オクルージョン判定を実行し特定領域Ｃの詳細な情報を得るため、図９に示すように、機能ブロックとして、第１位置判定部５１Ｒと、第２位置判定部５２Ｒと、第２通路幅判定部５３Ｒと、第２通路傾き判定部５４Ｒと、第３位置判定部５５Ｒと、第１尤度算出部５６Ｒと、Ｔ字路判定部５７Ｒと、を含む。
第１位置判定部５１Ｒは、図７に示すデータ出力（即ち、現在のデータ）と、過去データバッファ部４３Ｒに蓄積された過去ｎフレーム分のデータとに基づき、第１位置ＰＡ（特定領域Ｃの奥側の角、もしくは、第３連続体Ｕ３の左端）のｘｙ座標がｎ＋１フレームの間に渡って同一場所を示すかどうかを判定する。具体的には、まず、各座標ＰＡ０（ｘＡ０， ｙＡ０），ＰＡ１（ｘＡ１，ｙＡ１），ＰＡ２（ｘＡ２，ｙＡ２），・・・，ＰＡｎ（ｘＡｎ，ｙＡｎ）の標準偏差（σＡＸ、σＡＹ）が算出され、σＡＸ＜ΣＡかつσＡＹ＜ΣＡを満足する場合、第１位置ＰＡの位置は変わっていないと判定される。なお、ΣＡは、第１位置ＰＡが示す場所が実質上変わっていないとみなすための閾値であって、設定により適宜変更可能なパラメータである。第１位置判定部５１Ｒは、判定結果を第１尤度算出部５６Ｒに出力し、座標ＰＡ０（ｘＡ０， ｙＡ０）〜ＰＡｎ（ｘＡｎ，ｙＡｎ）の平均値（第１位置ＰＡのｘｙ座標値）を特定領域判定部３２に出力する。
第２位置判定部５２Ｒは、図７に示すデータ出力（即ち、現在のデータ）と、過去データバッファ部４３Ｒに蓄積された過去ｎフレーム分のデータとに基づき、第３位置ＰＣのｘｙ座標がｎ＋１フレームの間に渡って同一場所を示すかどうかを判定する。具体的には、まず、第２位置判定部５２Ｒは、各座標ＰＣ０（ｘＣ０，ｙＣ０），ＰＣ１（ｘＣ１，ｙＣ１），ＰＣ２（ｘＣ２，ｙＣ２），・・・，ＰＣｎ（ｘＣｎ，ｙＣｎ）の標準偏差（σＣＸ、σＣＹ）をもとめ、標準偏差（σＣＸ、σＣＹ）がσＣＸ＜ΣＣかつσＣＹ＜ΣＣを満足する場合、第２位置判定部５２Ｒは、第３位置ＰＣ（特定領域の手前側端部）の位置が変わっていないと判定する。なお、ΣＣは、第３位置ＰＣが示す場所が実質上変わっていないとみなすための閾値であって、設定により適宜変更可能なパラメータとする。第２位置判定部５２Ｒは、判定結果を第１尤度算出部５６Ｒに出力し、座標ＰＣ０（ｘＣ０， ｙＣ０）〜ＰＣｎ（ｘＣｎ，ｙＣｎ）の平均値（第３位置ＰＣのｘｙ座標値）を特定領域判定部３２に出力する。
第２通路幅判定部５３Ｒは、第２通路Ｒ２から特定領域Ｃに向かって他の移動体が出現する可能性を判定する。具体的には、第２通路幅判定部５３Ｒは、同一フレームの第１位置ＰＡ，第３位置ＰＣの各ｘｙ座標値（例えば、座標ＰＡ０，ＰＣ０）から、第１位置ＰＡと第３位置ＰＣとの間の距離ＡＣ（例えば、ＡＣ０）を求める。次に、第２通路幅判定部５３Ｒは、ｎ＋１フレーム分の距離ＡＣ０〜ＡＣｎの平均値ＡＣＡＶＥを求めた後、ＡＣＭＩＮ＜ＡＣＡＶＥ＜ＡＣＭＡＸを満足する場合、第２通路Ｒ２から他の移動体が出現する可能性が高いと判定し、平均値ＡＣＡＶＥを出力する。具体的には、第２通路幅判定部５３Ｒは、判定結果を第１尤度算出部５６Ｒに出力し、平均値ＡＣＡＶＥを第２通路Ｒ２の幅として特定領域判定部３２に出力する。
なお、ＡＣＭＩＮは、第２通路Ｒ２からの他の移動体が出現する可能性がないとみなせる程度に小さい値に選ばれ、ＡＣＭＡＸは、第２通路Ｒ２から出現する他の移動体を良好に見通せるとみなせる程度に大きな幅に選ばれる。なお、ＡＣＭＩＮ，ＡＣＭＡＸは、設定により適宜変更可能なパラメータである。
第２通路傾き判定部５４Ｒは、輸送機器Ｔが移動した場合、第１位置ＰＡを基準とする第３連続体Ｕ３が第２連続体Ｕ２とは異なる方向に伸びていくかどうか（即ち、回帰直線が推定通りに伸びていくかどうか）を判定する。具体的には、第２通路傾き判定部５４Ｒは、第２位置ＰＢおよび回帰直線の近接度合がｎ＋１フレームの間にどれだけ変わらないかを調べる。例えば、１フレーム前の回帰直線をｙ＝ａｘ＋ｂとし、第２位置ＰＢの座標を（ｘＢ，ｙＢ）とすると、回帰直線と第２位置ＰＢとの距離Ｅは、次式（５）で表される。
Figure 0006975945
上式（５）による距離ＥがＥ＜εＬＥＡＮを満足し、輸送機器Ｔが移動した場合、第２通路傾き判定部５４Ｒは、第１位置ＰＡを基準とする第３連続体Ｕ３が第２連続体Ｕ２とは異なる方向に伸びていくと判定する。なお、εＬＥＡＮは、フレーム単位で算出される距離Ｅが互いに同距離であるとみなすための閾値であって、設定で適宜変更可能なパラメータとする。第２通路傾き判定部５４Ｒは、判定結果を第１尤度算出部５６Ｒに出力し、現在の回帰直線の傾きを第３連続体Ｕ３（即ち、第２通路Ｒ２）の傾きとして特定領域算出部３２に出力する。
第３位置判定部５５Ｒは、輸送機器Ｔが移動した場合、第１位置ＰＡを基準とする第３連続体Ｕ３の長さの伸びが所定値以上かどうかを判定する。具体的には、図１０に示すように、現在の第２位置ＰＢの座標をＰＢ０（ｘＢ０，ｙＢ０）、第３位置ＰＣの座標をＰＣ０（ｘＣ０，ｙＣ０）、輸送機器Ｔの現在位置Ｐ０の座標をＰ００（ｘＰ０，ｙＰ０）（ｘＰ０＝ｙＰ０＝０）、Ｐ００ＰＣ０の長さをｌＣ０、Ｐ０Ｂ０の長さをｌＢ０とし、１フレーム前の第２位置ＰＢの座標をＢ１（ｘＢ１，ｙＢ１）、第３位置ＰＣの座標をＣ１（ｘＣ１，ｙＣ１）、１フレーム前の輸送機器Ｔの位置Ｐの座標をＰ１（ｘＰ１，ｙＰ１）、Ｐ１Ｃ１の長さをｌＣ１、Ｐ１Ｂ１の長さをｌＢ１とする。また、角度Ｐ０Ｃ０Ｐ１をθＰ、角度Ｂ０Ｃ０Ｂ１をθＢとする。このとき、次式（６），（７）が成り立つ。
Figure 0006975945
各フレームについて上式（６），（７）を用いて算出されたｃｏｓθＰ，ｃｏｓθＢが｜ｃｏｓθＰ−ｃｏｓθＢ｜＜εＯＣＬを満足し、輸送機器Ｔが移動する場合、第３位置判定部５５Ｒは、第１位置ＰＡを基準とする第３連続体Ｕ３の長さが所定値以上伸びたと判定する。なお、εＯＣＬは、第２位置ＰＢが輸送機器Ｔと実質的に同じ距離を移動しているとみなせる閾値であって、設定により適宜変更可能なパラメータである。第３位置判定部５５Ｒは、判定結果を第１尤度算出部５６Ｒに出力する。
第１尤度算出部５６Ｒは、各機能ブロック５１Ｒ〜５５Ｒの出力に基づき、前方の特定領域Ｃで第１通路Ｒ１に第２通路Ｒ２が接続しているかどうかを示す第１尤度ＳＲを算出する。表１は、尤度算出手法の一例を示す。第１尤度算出部５６Ｒでは、各判定項目（換言すると、各機能ブロック５１Ｒ〜５５Ｒ）にポイントが予め設定されている。ポイント値は適宜変更可能である。各機能ブロック５１Ｒ〜５５Ｒは、判定結果を、肯定的な判定結果に対して１とし、否定的な判定結果に対して０とする。第１尤度算出部５６Ｒは、判定項目毎にポイント値と判定結果とを乗算し、各乗算値の総和を第１尤度ＳＲとして出力する。
Figure 0006975945
Ｔ字路判定部５７Ｒは、現在フレームと過去ｎフレーム分のＴ字路判定フラグに基づき、前方の特定領域ＣがＴ字路の可能性があるかどうかを判定し出力する。本実施形態では、Ｔ字路判定部５７Ｒは、ｎ＋１フレームのＴ字路判定フラグの過半数以上が１であれば、Ｔ字路の可能性があることを示す判定結果として１を出力し、そうでなければ０が出力される。
以上、オクルージョン検出部３１Ｒの処理について詳説した。本実施形態では、オクルージョン判定部４５Ｒは、前方の特定領域Ｃに見通しの悪い第２通路Ｒ２が接続されているかどうかを判定し、その第２通路Ｒ２について、第１尤度ＳＲに加え、第１位置ＰＡ（特定領域Ｃの奥側の角、もしくは、第２通路Ｒ２の左端）位置と、第３位置ＰＣ（特定領域Ｃの手前側の角）の位置、第２通路Ｒ２の幅および傾きを、特定領域判定部３２（図２を参照）に出力する。
なお、前述のように、輸送機器Ｔは更に方位距離センサ１Ｌを備える。方位距離センサ１Ｌは、例えば輸送機器Ｔの縦中心面を基準として、方位距離センサ１Ｒと対称な位置に取り付けられ、方位距離情報ＤＲと同様の方位距離情報ＤＬを出力する。
また、入力部２１は、方位距離センサ１Ｌからの方位距離情報ＤＬを受信してＳＲＡＭ２４に転送する。オクルージョン検出部３１Ｌは、方位距離情報ＤＬに対してオクルージョン検出部３１Ｒと同様の手法を行って、特定領域に左側方から接続する第２通路に関し、第１尤度ＳＬに加え、第１位置ＰＡの位置と、第３位置ＰＣの位置、第２通路の幅および傾きを、特定領域判定部３２（図２を参照）出力する。なお、オクルージョン検出部３１Ｌのオクルージョン判定部４５Ｌの詳細な構成については、図９中、括弧内に参照符号を付して表した。
図２を再度参照する。特定領域判定部３２は、オクルージョン検出部３１Ｒ，３１Ｌの出力に基づき、特定領域Ｃに関して最終的な第２尤度Ｓｏｕｔを算出する。特定領域判定部３２はさらに、輸送機器Ｔから特定領域Ｃまでの距離、特定領域Ｃの形状、第１通路Ｒ１から特定領域Ｃへの進入部分の幅、第２通路Ｒ２の幅、および、第１通路Ｒ１に対する第２通路Ｒ２の角度を出力する。なお、本実施形態のように、輸送機器Ｔに方位距離センサ１Ｒ，１Ｌが設けられている場合、特定領域判定部３２は、特定領域Ｃに対し左右両側から接続する第２通路Ｒ２に関するデータを出力してもよい。以下、図１１を参照して、特定領域判定部３２について詳説する。
特定領域判定部３２は、図１１に示すように、第１傾き判定部６１と、第２傾き判定部６２と、第２通路幅判定部６３と、特定領域形状判定部６４と、特定領域情報出力部６５と、第２尤度算出部６６と、を含む。
第１傾き判定部６１は、左右の第２通路Ｒ２が概ね一直線上にあるかどうか判定する。具体的には、まず、左側の第１位置ＰＡの座標を（ｘＡＬ、ｙＡＬ）、右側の第１位置ＰＡの座標を（ｘＡＲ、ｙＡＲ）として、両第１位置ＰＡを結ぶ線分の傾きＬＭが、次式（８）から求められる。
Figure 0006975945
第１傾き判定部６１はさらに、左側の第２通路Ｒ２の傾きが傾きＬＭが近いか、右側の第２通路Ｒ２の傾きが傾きＬＭに近いかを判定する。左側の第２通路Ｒ２の傾きをＬＬ、右側の第２通路Ｒ２の傾きをＬＲとすると、第１傾き判定部６１の判定結果は、本実施形態では、下表２の通りである。
Figure 0006975945
（状態１）図１２Ａに示すように、第１傾き判定部６１は、ＬＬとＬＭが概ね同じか（即ち、｜ＬＬ−ＬＭ｜＜Ｌｔｈ１）、ＬＲとＬＭが概ね同じ場合（即ち、｜ＬＲ−ＬＭ｜＜Ｌｔｈ１）、上表２に示す通り、判定結果として１を出力する。また、判定結果１は、特定領域は十字交差点の可能性があることを意味する。
（状態２）（状態１）で無い場合、図１２Ｂに示すように、ＬＭ≧０ならば、上表２に示す通り、判定結果は２である。判定結果２の定義は、前方交差点は左側交差路のＴ字路（┤形道路交差点）の可能性がある。
（状態３）（状態１）で無い場合において、図１２Ｃに示すように、ＬＭ＜０ならば、上表２に示す通り、判定結果は３である。判定結果３の定義は、前方交差点は右側交差路のＴ字路（├形道路交差点）の可能性がある。
なお、Ｌｔｈ１は、左右交差路が一直線上にあるとみなすための閾値であって、設定により適宜変更可能なパラメータとする。
第２傾き判定部６２は、左側の第２通路Ｒ２の傾きと、右側の第２通路Ｒ２の傾きとが大きく異なっていないかどうか判定する。より具体的には、第２傾き判定部６２は、｜ＬＬ−ＬＲ｜< Ｌｔｈ２を満足する場合、両交差路の傾きは大きくずれていないと判定する。ここで、Ｌｔｈ２は、設定により適宜変更可能なパラメータとする。
第２通路幅判定部６３は、左右の第２通路Ｒ２の幅が大きく異なっていないかどうか判定する。具体的には、第２通路幅判定部６３は、左側の第２通路Ｒ２の幅をＤＬ、右側の第２通路Ｒ２の幅をＤＲとし、｜ＤＬ−ＤＲ｜< Ｄｔｈを満足する場合、左右交差路の幅は大きくことなっていないと判定する。ここで、Ｄｔｈは、左右交差路の幅が大きく異なっていないとみなるための閾値であって、設定により適宜変更可能なパラメータとする。
特定領域形状判定部６４は、左右の第２通路Ｒ２の第１尤度ＳＬ，ＳＲ（第１尤度算出部５６Ｒ等の出力）と、左右のＴ字路判定結果（Ｔ字路判定部５７Ｒ等の出力）および第１傾き判定部６１の判定結果に対応する特定領域の形状を、予め保持するテーブル（下表３を参照）から選択して前方交差点の形状を判定し、下記の１〜７のいずれかの判定結果を出力する。
Figure 0006975945
特定領域形状判定部６４は、表３のテーブルによれば、左右のＴ字路判定結果がいずれも０であり、第１傾き判定部６１の判定結果が１であり、第１尤度ＳＬ，ＳＲが閾値Ｓｔｈを超える場合、特定領域を十字交差点と判定し、判定結果としての１を出力する。なお、Ｓｔｈは、尤度ＳＬ，ＳＲが大きいと判定するための閾値であって、設定により適宜変更可能なパラメータである。
また、特定領域形状判定部６４は、表３のテーブルによれば、左右のＴ字路判定結果がいずれも０であり、第１傾き判定部６１の判定結果が２であり、第１尤度ＳＬ，ＳＲが閾値Ｓｔｈを超える場合、特定領域を左Ｔ字路と判定し、判定結果としての２を出力する。
また、特定領域形状判定部６４は、表３のテーブルによれば、左右のＴ字路判定結果の両方が０でなく、第１傾き判定部６１の判定結果が１であり、第１尤度ＳＬ，ＳＲが閾値Ｓｔｈを超える場合、特定領域を下Ｔ字路（┬形道路交差点）と判定し、判定結果としての４を出力する。
他の条件に対応する特定領域の形状に関しては、表３に記載の通りである。
特定領域情報出力部６５は、特定領域形状判定部６４による判定結果に加え、左右の第２通路Ｒ２の第１位置ＰＡ、第３位置ＰＣ、傾きおよび幅から導出可能な詳細な情報（即ち、特定領域までの距離、特定領域への進入部分の幅、第１通路Ｒ１に対する第２通路Ｒ２の角度および幅等）を出力する。特定領域情報出力部６５の出力例を表４に示す。
Figure 0006975945
上表４において、ｙＣＬは、左側の第２通路Ｒ２の第３位置ＰＣのｙ座標、ｙＣＲは、右側の第２通路Ｒ２の第３位置ＰＣのｙ座標、ｘＡＬは、左側の第２通路Ｒ２の第１位置ＰＡのｘ座標、ｘＡＲは、右側の第２通路Ｒ２の第１位置ＰＡのｘ座標である。また、ＲＬＲ：方位距離センサ１Ｒ，１Ｌ間の取付位置の間隔であり、ＬＬ，ＬＲは左側交差路および右側交差路の傾き、ＤＬ，ＤＲは、左側交差路および右側交差路の幅である。
第２尤度算出部６６は、第１尤度算出部５６Ｒ，５６Ｌからの第１尤度ＳＲ，ＳＬに、第２傾き判定部６２、第２通路幅判定部６３および特定領域形状判定部６４で得られた判定結果に基づく加算値を加算して、特定領域に対する第２尤度Ｓｏｕｔを算出する。表５は、加算値の算出手法の一例を示している。第２尤度算出部６６では、判定項目（換言すると、第２傾き判定部６２、第２通路幅判定部６３）に対しポイント（例えば、１０ポイント）が設定されている。ポイントの値は適宜変更可能である。第２傾き判定部６２および第２通路幅判定部６３は、判定結果を、肯定的な判定結果に対して１とし、否定的な判定結果に対して０とする。第２尤度算出部６６は、判定項目毎にポイントと判定結果の値とを乗算し、各乗算値の総和を加算値として出力する。
Figure 0006975945
第２尤度算出部６６はさらに、特定領域形状判定部６４の判定結果毎に定められた演算式に従って、前方の交差点に対する第２尤度（出力値）Ｓｏｕｔを求める。表６は、第２尤度の算出方法の一例を示している。
Figure 0006975945
図１を参照する。制御部２２は、以上の手法で得た最終的な第２尤度Ｓｏｕｔに基づき、各部を制御する。例えば、第２尤度算出部６６として得た第２尤度Ｓｏｕｔが所定の閾値よりも大きい場合、制御部２２は、特定領域情報出力部６５として得た情報を、出力部２５を介して移動体制御装置３の一例としてのディスプレイ装置に表示してもよい。他にも、輸送機器Ｔの自動運転が可能な場合、第２尤度算出部６６として得た第２尤度Ｓｏｕｔが所定の閾値よりも大きい場合、制御部２２は、輸送機器Ｔの速度を自動的に減速させるための情報を、移動体制御装置３の他の一例としての自動走行制御装置に出力部２５を介して出力してもよい。
≪１−４．実施形態の作用及び効果≫
以上説明した通り、本実施形態によれば、判定装置２は、入力部２１を介して、方位距離センサ１Ｒ，１Ｌから、輸送機器Ｔとその周辺に存在する物体との間の距離を示す方位距離データＤＲ，ＤＬを受け取る。制御部２２において、オクルージョン検出部３１Ｒ，３１Ｌは、受け取った方位距離データＤＲ，ＤＬから、前式（１）に基づき、輸送機器Ｔが走行する第１通路Ｒ１に沿った第１連続体Ｕ１、第２連続体Ｕ２を認識する。その後、オクルージョン検出部３１Ｒ，３１Ｌは、条件式（１）を満たす第１方位距離情報ＤＲから第１位置ＰＡ，第３位置ＰＣを特定した場合、第１連続体Ｕ１と第２連続体Ｕ２との間に中断区間があると認識する。
オクルージョン検出部３１Ｒ，３１Ｌはさらに、上記条件式（１）を満たさない方位距離情報ＤＲに第２位置ＰＢがあると認識する場合、輸送機器Ｔが見通しの悪い特定領域Ｃをこれから通過するとの前提で、下記の二点を判定する。第１に、第１位置ＰＡを基準とする第３連続体Ｕ３が第２連続体Ｕ２とは異なる方向に伸びていくかどうかが判定され、第２に、第１位置ＰＡを基準とする第３連続体Ｕ３の長さの伸びが所定値）以上かどうかが判定される。
この判定の結果、オクルージョン検出部３１Ｒ，３１Ｌは、第１位置ＰＡから第１連続体Ｕ２とは異なる方向に伸びる第３連続体Ｕ３の長さが所定値以上である場合、第２通路Ｒ２に関する検出結果を出力する。この検出結果は、輸送機器Ｔに搭載される制御装置（例えば、各種情報を表示するディスプレイ装置または自動運転の制御装置）で使用される第２尤度Ｓｏｕｔの基礎となる。
以上のような処理により、本判定装置１によれば、特定領域Ｃに見通しの悪い第２通路Ｒ２が接続していることを検出することが出来る。さらに、判定装置２は、輸送機器Ｔの運転者や自動運転に好適な特定領域Ｃに関する多くの詳細な情報を出力することが出来る。例えば、特定領域に進入前に、何メートル先にどのような形状の特定領域が存在するのか等を輸送機器Ｔの運転者等は把握することが出来る。
≪１−５．付記≫
以上の実施形態では、輸送機器Ｔに、方位距離センサ１Ｒ，１Ｌと判定装置２とが備わるとして説明した。しかし、輸送機器Ｔは、方位距離センサ１Ｒ，１Ｌが搭載されたプローブカー等の場合、判定装置２は、このプローブカーとデータ通信可能に遠隔に設けられたサーバ装置に実装されるようにしても良い。なお、第１−５欄の記載内容は、以下の第２欄の変形例にも適用可能である。
≪２．変形例≫
次に、上記実施形態の変形例に係る判定装置および方法について説明する。
≪２−１．判定装置の構成および周辺構成≫
図１３に示す通り、変形例に係る判定装置８は、方位距離センサ７Ｒ，７Ｌと通信可能に接続される。また、本変形例でも、方位距離センサ７Ｒ，７Ｌと、判定装置８とは車両に搭載される例が示される。
方位距離センサ７Ｒは、前述の方位距離センサ１Ｒと同様の方位距離情報ＤＲをフレーム周期毎に生成し、判定装置８に出力する。また、方位距離センサ７Ｒは、測定可能範囲内に移動体（人や他の輸送機器）を検出及び捕捉した後、当該移動体に対し追従ＩＤを割り振って複数フレームに渡って追尾可能であることが好ましい。
判定装置８は、判定装置２と比較すると、ハードウェア構成面で相違点は無い。それゆえ、図１３において、図１の構成に相当するものには同一参照符号を付け、それぞれの説明を省略する。
≪２−２．制御部の機能ブロック≫
制御部２２は、不揮発性メモリ２３内のプログラムを、ＳＲＡＭ２４を用いて実行することで、図１４に示すように、オクルージョン検出部３１Ｒと、オクルージョン検出部３１Ｌと、特定領域判定部３２に加え、移動体検出部９１Ｒ、移動体検出部９１Ｌとして機能する。なお、オクルージョン検出部３１Ｒ，３１Ｌおよび特定領域判定部３２の処理は、前述の実施形態と比較すると若干追加されているが、以下で適宜説明する。
また、移動体検出部９１Ｒは、機能ブロックとして、座標変換部１０１Ｒと、移動体判定部１０２Ｒとに分けられる。
座標変換部１０１Ｒは、方位距離センサ７Ｒから受け取った移動体の方位距離情報ＤＲの値を、フレーム単位で現在のｘｙ座標系の値に変換する。現在のｘｙ座標系の定義は、前述の実施形態と同様である。座標変換部１０１Ｒは、フレーム単位で、移動体の座標値を過去データバッファ部４３Ｒに蓄積し、移動体判定部１０２Ｒに出力する。
なお、過去データバッファ部４３Ｒは、前述の実施形態と同様、最近ｎフレーム分のデータを蓄積する。また、座標変換部４４Ｒは、前述の実施形態と同様の処理に加え、過去データバッファ４３Ｒに蓄積された移動体のｘｙ座標値であって、過去フレームのｘｙ座標値を、現在のｘｙ座標系の値に変換して移動体判定部１０２Ｒに出力する。
移動体判定部１０２Ｒは、移動体に関し、現在のｘｙ座標値と、過去ｎフレーム分のｘｙ座標値とから、移動体が輸送機器Ｔの進行方向と略垂直方向に移動しているかどうかを判定する。略垂直方向に移動していると判定した場合、移動体判定部１０２Ｒは、さらに、オクルージョン判定部４５Ｒから出力された第１位置ＰＡの位置、第３位置ＰＣの位置、第２通路Ｒ２の傾き、および第１尤度ＳＲを受け取り、これらに基づき、特定領域Ｃ内に存在する移動体かどうかを判定する。移動体判定部１０２Ｒはさらに、判定結果に基づき第３尤度ＳＭＶＲを算出し、特定領域判定部３２に出力する。
以上の処理を行うため、移動体判定部１０２Ｒは、図１５に示すように、機能ブロックとして、移動軌跡計算部１１１Ｒと、交差路面内判定部１１２Ｒと、第３尤度算出部１１３Ｒと分けられる。
移動軌跡計算部１１１Ｒは、ｘｙ座標値ｎ＋１フレーム分を受け取る。しかし、全てのｘｙ座標値に、移動体のｘｙ座標値が存在するとは限らない。移動体のｘｙ座標値の個数がｋＭＶ個（ｋＭＶ≦ｎ＋１）である場合、移動軌跡計算部１１１Ｒは、ｋＭＶ個のｘｙ座標値に対し最小二乗法等を適用して回帰直線の式（以下、軌跡直線式という）を求めて、図１６に示すような移動体の移動軌跡を直線で近似する。移動軌跡計算部１１１Ｒはさらに、ｋＭＶ個のｘｙ座標値の回帰直線に対する相関係数も算出する。なお、移動軌跡計算部１１１Ｒは、移動体の追従ＩＤ単位で、以上の計算を行う。
移動軌跡計算部１１１Ｒは、求めた軌跡直線式の中から、傾きがｌＭＶ＿ｔｈ以内で最も輸送機器Ｔの進行方向に近い軌跡直線式の追従ＩＤを選択する。なお、ｌＭＶ＿ｔｈは、輸送機器Ｔの進行方向に近いとみなせる閾値であって、設定により適宜変更可能なパラメータである。かかる追従ＩＤの選択に成功した後、移動軌跡計算部１１１Ｒは、移動体判定フラグを１として交差路面内判定部１１２Ｒに出力し、軌跡直線式も交差路面内判定部１１２Ｒに出力する。
交差路面内判定部１１２Ｒは、次式（９）〜（１２）の全て成り立つ場合、判定結果を１とし、それ以外の場合、判定結果を０とする。交差路面内判定部１１２Ｒは、判定結果を第３尤度算出部１１３Ｒに出力する。
ＦＭＶ＝１…（９）
ＳＲ＞Ｓｔｈ…（１０）
｜ＬＭＶ−Ｌ｜＜Ｌｔｈ３…（１１）
ＹＣ≦ＬＭＶ＊（ＸＡ＋ＸＣ）／２＋ＭＭＶ≦ＹＡ…（１２）
ここで、（ｘＡ，ｙＡ）は第１位置ＰＡのｘｙ座標値、（ｘＣ，ｙＣ）は第３位置ＰＣのｘｙ座標値、Ｌは第２通路Ｒ２の傾き、ＳＲは第１尤度である。
また、ＦＭＶは移動体判定フラグの値であり、軌跡直線式をｙ＝ＬＭＶｘ＋ＭＭＶとする。なお、Ｓｔｈは、第１尤度ＳＲが高いかどうかを判定するための閾値であり、Ｌｔｈ３は移動体が第２通路Ｒ２と同方向に移動しているかどうかを判定するための閾値であり、それぞれは設定により適宜変更可能なパラメータである。
第３尤度算出部１１３Ｒは、交差路面内判定部１１２Ｒの判定結果に基づき、第２通路Ｒ２上に移動体があるかどうかを示す第３尤度ＳＭＶＲを算出する。表７は、尤度算出方法の一例を示す。第３尤度算出部１１３Ｒでは、各判定項目（即ち、交差路面内判定部１１２Ｒ）にポイントが予め設定されている。ポイント値は適宜変更可能である。交差路面内判定部１１２Ｒは、判定結果を、肯定的な判定結果に対して１とし、否定的な判定結果に対して０とする。第１尤度算出部５６Ｒは、判定項目毎にポイント値と判定結果とを乗算した第３尤度ＳＭＶＲを出力する。
Figure 0006975945
なお、前述の実施形態と同様の観点で、移動体検出部９１Ｌは、移動体検出部９１Ｒと同様の手法を行って、左側の第３尤度ＳＭＶＬを算出して特定領域判定部３２に出力する。なお、移動体検出部９１Ｌの詳細な構成については、図１４，図１５中、括弧内に参照符号を付して表した。
特定領域判定部３２は、前述の実施形態で説明した処理に加え、第２尤度Ｓｏｕｔを求める際に移動体判定部１０２Ｒ，１０２Ｌの第３尤度ＳＭＶＲ，ＳＭＶＬを考慮する。表８は、第２尤度Ｓｏｕｔの算出方法の一例を示している。
Figure 0006975945
≪２−３．変形例の作用及び効果≫
以上説明した通り、本変形例によれば、判定装置８によれば、方位距離センサ７Ｒ，７Ｌが検出可能な移動体をも考慮しているため、特定領域Ｃの尤度の精度を縒り向上させることが出来る。
≪３．付記≫
以上の実施形態および変形例では、判定装置２は、方位距離センサ１Ｒからの方位距離情報を、輸送機器Ｔの周辺状況を示す情報として受信する。しかし、これに限らず、判定装置２は、カメラから画素毎に色及び輝度の情報を輸送機器Ｔの周辺状況を示す情報として取得しても構わない。この場合、判定装置２において、制御部２２は、カメラからの受信情報に対し特徴点検出等を行って、検出第１通路Ｒ１および第２通路Ｒ２の境界を示す位置情報を求める。
また、上記プログラムは、不揮発性メモリ２３に格納されて提供されるだけでなく、ＤＶＤ（Ｄｉｇｉｔａｌ Ｖｅｒｓａｔｉｌｅ Ｄｉｓｃ）等の記録媒体や通信ネットワークを介して提供されても構わない。
本開示に係る実施形態の種々の態様として、以下のものが含まれる。
第１の開示に係る判定装置は、移動体に搭載される第１センサから、第１範囲に存在する１つ以上の物体までの間の距離及び方位を示す１つ以上の第１方位距離情報を受け取る入力部と、前記移動体が走行する第１通路に沿った第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中の第１静止物体に対する１つ以上の方位距離情報である第１連続体と、前記第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中、前記第１静止物体よりも前記移動体から遠い第２静止物体に対する１つ以上の方位距離情報である第２連続体と、前記第１方向とは異なる第２方向に、前記１つ以上の第１方位距離情報のうち、前記第２静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第１連続体及び前記第２連続体の位置関係によって長さが変化する第３連続体と、を認識し、前記第２連続体に含まれる方位情報に基づいて、前記第１範囲にＴ字路が構成される可能性を判定し、前記第３連続体の長さが所定値以上である場合、前記第３連続体に沿った第２通路が前記第１通路に接続されているか否かを判定する通路検出部と、前記第１範囲にＴ字路が構成される可能性の判定結果と、前記第２通路と前記第１通路との接続の判定結果とに基づいて、前記第１範囲での通路の形状を判断する通路判定部と、前記判断した通路の形状を、前記移動体に搭載された移動体制御装置に出力する出力部と、を備える。
第２の開示に係る判定装置は、上記第１の開示の判定装置であって、前記１つ以上の第１方位距離情報は、所定のフレーム周期毎に、前記入力部に入力される情報である。
第３の開示に係る判定装置は、上記第１の開示の判定装置であって、前記通路検出部は、前記第３の連続体に沿った第２通路の検出結果に基づき、前記第１通路と前記第２通路とが接続しているか否かを示す前記第１範囲の第１尤度を算出し、前記通路判定部は、前記第１範囲の第１尤度を用いて、前記第１通路と前記第２通路とを含む通路の形状を判断する。
第４の開示に係る判定装置は、上記第３の開示の判定装置であって、前記通路判定部は、前記所定のフレーム周期毎に、前記第２連続体と前記第３連続体との交点である第１位置を求め、前記求めた第１位置のそれぞれが、互いに同一位置に存在するか否か判定し、前記所定のフレーム周期毎に、前記第１連続体の端点である第２位置を求め、前記求めた第２位置のそれぞれが、前記第２方向において、存在位置が変化するか否かを判定する。
第５の開示に係る判定装置は、上記第４の開示の判定装置であって、前記通路判定部は、前記所定のフレーム周期毎に、前記第１位置と前記第２位置との間の距離を求め、前記求めた距離を用いて、前記第２位置の存在位置の変化を判定する。
第６の開示に係る判定装置は、上記第１の開示の判定装置であって、前記入力部は、前記移動体に搭載される第２センサから、前記第１センサと異なる第２範囲に存在する前記１つ以上の物体までの間の距離及び方位を示す１つ以上の第２方位距離情報を受け取り、前記通路検出部は、前記第１方向に、前記１つ以上の第２方位距離情報のうち、前記１つ以上の物体の中の第３静止物体に対する１つ以上の方位距離情報である第４連続体と、前記第１方向に、前記１つ以上の第２方位距離情報のうち、前記１つ以上の物体の中、前記第３静止物体よりも前記移動体から遠い第４静止物体に対する１つ以上の方位距離情報である第５連続体と、前記第１方向とは異なる第３方向に、前記１つ以上の第２方位距離情報のうち、前記第４静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第４連続体及び前記第５連続体の位置関係によって長さが変化する第６連続体と、を認識し、前記第５連続体に含まれる方位情報に基づいて、前記第２範囲にＴ字路が構成される可能性を判定し、前記第６連続体の長さが所定値以上である場合、前記第６連続体に沿った第３通路が前記第１通路に接続されているか否かを判定し、前記通路判定部は、前記第２範囲にＴ字路が構成される可能性の判定結果と、前記第３通路と前記第１通路との接続の判定結果とに基づいて、前記第１範囲の通路の形状を判断する。
第７の開示に係る判定装置は、上記第６の開示の判定装置であって、前記通路検出部は、前記第４連続体に沿った第３通路の検出結果に基づき、前記第１通路に前記第３通路が接続しているか否かを示す第２範囲の第１尤度を算出し、前記判定部は、前記第２範囲の第１尤度を用いて、前記第１通路及び前記第３通路を含む通路の形状を判断する。
第８の開示に係る判定装置は、上記第７の開示の判定装置であって、前記通路判定部は、前記第１範囲の第１尤度及び前記第２範囲の第１尤度に基づき、前記第１通路、前記第２通路及び前記第３通路が接続している否かを示す第２尤度を算出する。
第９の開示に係る判定装置は、上記第５の開示の判定装置であって、前記１つ以上の第１方位距離情報に基づき、前記第２通路に他の移動体が存在するか否かを示す前記第１範囲の第３尤度を算出する第１移動物体検出部を含み、前記通路判定部は、前記第１範囲の第３尤度を用いて、前記第３通路の有無を判断する。
第１０の開示に係る判定装置は、上記第５の開示の判定装置であって、前記１つ以上の第２方位距離情報に基づき、前記第３通路に他の移動体が存在するか否かを示す前記第２範囲の第３尤度を算出する第２移動物体検出部を含み、前記通路判定部は、前記第２範囲の第３尤度を用いて、前記第３通路の有無を判断する。

第１１の開示に係る判定方法は、移動体に搭載される第１センサから、第１範囲に存在する１つ以上の物体までの間の距離及び方位を示す１つ以上の第１方位距離情報を受け取り、前記移動体が走行する第１通路に沿った第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中の第１静止物体に対する１つ以上の方位距離情報である第１連続体と、前記第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中、前記第１静止物体よりも前記移動体から遠い第２静止物体に対する１つ以上の方位距離情報である第２連続体と、前記第１方向とは異なる第２方向に、前記１つ以上の第１方位距離情報のうち、前記第２静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第１連続体及び前記第２連続体の位置関係によって長さが変化する第３連続体と、を認識し、前記第２連続体に含まれる方位情報に基づいて、前記第１範囲にＴ字路が構成される可能性を判定し、前記第３連続体の長さが所定値以上である場合、前記第３連続体に沿った第２通路が前記第１通路に接続されているか否かを判定し、前記第１範囲にＴ字路が構成される可能性の判定結果と、前記第２通路と前記第１通路との接続の判定結果とに基づいて、前記第１範囲の通路の形状を判断し、前記判断した通路の形状を、前記移動体に搭載された移動体制御装置に出力する。
第１２の開示に係るコンピュータに実行させるプログラムは、移動体に搭載される第１センサから、第１範囲に存在する１つ以上の物体までの間の距離及び方位を示す１つ以上の第１方位距離情報を受け取り、前記移動体が走行する第１通路に沿った第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中の第１静止物体に対する１つ以上の方位距離情報である第１連続体と、前記第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中、前記第１静止物体よりも前記移動体から遠い第２静止物体に対する１つ以上の方位距離情報である第２連続体と、前記第１方向とは異なる第２方向に、前記１つ以上の第１方位距離情報のうち、前記第２静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第１連続体及び前記第２連続体の位置関係によって長さが変化する第３連続体と、を認識し、前記第２連続体に含まれる方位情報に基づいて、前記第１範囲にＴ字路が構成される可能性を判定し、前記第３連続体の長さが所定値以上である場合、前記第３連続体に沿った第２通路が前記第１通路に接続されているか否かを判定し、前記第１範囲にＴ字路が構成される可能性の判定結果と、前記第２通路と前記第１通路との接続の判定結果に基づいて、前記第１範囲での領域の通路の形状を判断し、前記判断した通路の形状を、前記移動体に搭載された移動体制御装置に出力する、ことをコンピュータに実行させる。
第１３の開示に係るコンピュータに実行させるプログラムを記録した記録媒体は、移動体に搭載される第１センサから、第１範囲に存在する１つ以上の物体までの間の距離及び方位を示す１つ以上の第１方位距離情報を受け取り、前記移動体が走行する第１通路に沿った第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中の第１静止物体に対する１つ以上の方位距離情報である第１連続体と、前記第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中、前記第１静止物体よりも前記移動体から遠い第２静止物体に対する１つ以上の方位距離情報である第２連続体と、前記第１方向とは異なる第２方向に、前記１つ以上の第１方位距離情報のうち、前記第２静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第１連続体及び前記第２連続体の位置関係によって長さが変化する第３連続体と、を認識し、前記第２連続体に含まれる方位情報に基づいて、前記第１範囲にＴ字路が構成される可能性を判定し、前記第３連続体の長さが所定値以上である場合、前記第３連続体に沿った第２通路が前記第１通路に接続されているか否かを判定し、前記第１範囲にＴ字路が構成される可能性の判定結果と、前記第２通路と前記第１通路との接続の判定結果に基づいて、前記第１範囲での通路の形状を判断し、前記判断した通路の形状を、前記移動体に搭載された移動体制御装置に出力する、ことをコンピュータに実行させるプログラムを記録している。
以上、図面を参照しながら各種の実施形態について説明したが、本開示はかかる例に限定されないことは言うまでもない。当業者であれば、特許請求の範囲に記載された範疇内において、各種の変更例または修正例に想到し得ることは明らかであり、それらについても当然に本開示の技術的範囲に属するものと了解される。また、開示の趣旨を逸脱しない範囲において、上記実施形態における各構成要素を任意に組み合わせてもよい。
上記各実施形態では、本開示はハードウェアを用いて構成する例にとって説明したが、本開示はハードウェアとの連携においてソフトウェアでも実現することも可能である。
また、上記各実施形態の説明に用いた各機能ブロックは、典型的には、入力端子および出力端子を有する集積回路であるＬＳＩとして実現される。これらは個別に１チップ化されてもよいし、一部または全てを含むように１チップ化されてもよい。ここでは、ＬＳＩとしたが、集積度の違いにより、ＩＣ、システムＬＳＩ、スーパーＬＳＩ、ウルトラＬＳＩと呼称されることもある。
また、集積回路化の手法はＬＳＩに限るものではなく、専用回路または汎用プロセッサを用いて実現してもよい。ＬＳＩ製造後に、プログラムすることが可能なＦＰＧＡ（Field Programmable Gate Array）、ＬＳＩ内部の回路セルの接続又は設定を再構成可能なリコンフィギュラブル プロセッサ（Ｒｅｃｏｎｆｉｇｕｒａｂｌｅ Ｐｒｏｃｅｓｓｏｒ）を利用してもよい。
さらには、半導体技術の進歩又は派生する別技術により,ＬＳＩに置き換わる集積回路化の技術が登場すれば、当然、その技術を用いて機能ブロックを集積化してもよい。バイオ技術の適用等が可能性としてありえる。
本開示に係る判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体は、輸送機器前方で移動体が側方から飛び出して来る可能性のある特定領域に関する情報を生成可能であり、輸送機器の周辺監視装置または自動操縦システム等に応用可能である。
１Ｒ，１Ｌ，７Ｒ，７Ｌ 方位距離センサ
２，８ 判定装置
２１ 入力部
２２ 制御部

Claims (11)

  1. 移動体に搭載される第１センサから、第１範囲に存在する１つ以上の物体までの間の距離及び方位を示す１つ以上の第１方位距離情報を受け取る入力部と、
    前記移動体が走行する第１通路に沿った第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中の第１静止物体に対する１つ以上の方位距離情報である第１連続体と、前記第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中、前記第１静止物体よりも前記移動体から遠い第２静止物体に対する１つ以上の方位距離情報である第２連続体と、前記第１方向とは異なる第２方向に、前記１つ以上の第１方位距離情報のうち、前記第２静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第１連続体及び前記第２連続体の位置関係によって長さが変化する第３連続体と、を認識し、前記第２連続体に含まれる方位情報に基づいて、前記第１範囲にＴ字路が構成される可能性を判定し、前記第３連続体の長さが所定値以上である場合、前記第３連続体に沿った第２通路が前記第１通路に接続されているか否かを判定する通路検出部と、
    前記第１範囲にＴ字路が構成される可能性の判定結果と、前記第２通路と前記第１通路との接続の判定結果とに基づいて、前記第１範囲での通路の形状を判断する通路判定部と、
    前記判断した通路の形状を、前記移動体に搭載された移動体制御装置に出力する出力部と、
    を備える判定装置。
  2. 前記１つ以上の第１方位距離情報は、所定のフレーム周期毎に、前記入力部に入力される情報である、
    請求項１に記載の判定装置。
  3. 前記通路判定部は、前記所定のフレーム周期毎に、前記第２連続体と前記第３連続体との交点である第１位置を求め、前記求めた第１位置のそれぞれが、互いに同一位置に存在するか否か判定し、前記所定のフレーム周期毎に、前記第１連続体の端点である第２位置を求め、前記求めた第２位置のそれぞれが、前記第２方向において、存在位置が変化するか否かを判定する、
    請求項２に記載の判定装置。
  4. 前記通路判定部は、前記所定のフレーム周期毎に、前記第１位置と前記第２位置との間の距離を求め、前記求めた距離を用いて、前記第２位置の存在位置の変化を判定する、
    請求項３に記載の判定装置。
  5. 前記入力部は、前記移動体に搭載される第２センサから、前記第１センサと異なる前記第２センサで検出される第２範囲に存在する前記１つ以上の物体までの間の距離及び方位を示す１つ以上の第２方位距離情報を受け取り、
    前記通路検出部は、前記第１方向に、前記１つ以上の第２方位距離情報のうち、前記１つ以上の物体の中の第３静止物体に対する１つ以上の方位距離情報である第４連続体と、前記第１方向に、前記１つ以上の第２方位距離情報のうち、前記１つ以上の物体の中、前記第３静止物体よりも前記移動体から遠い第４静止物体に対する１つ以上の方位距離情報である第５連続体と、前記第１方向とは異なる第３方向に、前記１つ以上の第２方位距離情報のうち、前記第４静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第４連続体及び前記第５連続体の位置関係によって長さが変化する第６連続体と、を認識し、前記第５連続体に含まれる方位情報に基づいて、前記第２範囲にＴ字路が構成される可能性を判定し、前記第６連続体の長さが所定値以上である場合、前記第６連続体に沿った第３通路が前記第１通路に接続されているか否かを判定し、
    前記通路判定部は、前記第２範囲にＴ字路が構成される可能性の判定結果と、前記第３通路と前記第１通路との接続の判定結果とに基づいて、前記第１範囲の通路の形状を判断する、
    請求項１〜４のいずれかに記載の判定装置。
  6. 前記通路判定部は、前記第１範囲の第１尤度及び前記第２範囲の第１尤度に基づき、前記第１通路、前記第２通路及び前記第３通路が接続している否かを示す第２尤度を算出する、
    請求項５に記載の判定装置。
  7. 前記１つ以上の第１方位距離情報に基づき、前記第２通路に他の移動体が存在するか否かを示す前記第１範囲の第３尤度を算出する第１移動物体検出部を含み、
    前記通路判定部は、前記第１範囲の第３尤度を用いて、前記第３通路の有無を判断する、
    請求項５に記載の判定装置。
  8. 前記１つ以上の第２方位距離情報に基づき、前記第３通路に他の移動体が存在するか否かを示す前記第２範囲の第３尤度を算出する第２移動物体検出部を含み、
    前記通路判定部は、前記第２範囲の第３尤度を用いて、前記第３通路の有無を判断する、
    請求項５に記載の判定装置。
  9. 移動体に搭載される第１センサから、第１範囲に存在する１つ以上の物体までの間の距離及び方位を示す１つ以上の第１方位距離情報を受け取り、
    前記移動体が走行する第１通路に沿った第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中の第１静止物体に対する１つ以上の方位距離情報である第１連続体と、前記第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中、前記第１静止物体よりも前記移動体から遠い第２静止物体に対する１つ以上の方位距離情報である第２連続体と、前記第１方向とは異なる第２方向に、前記１つ以上の第１方位距離情報のうち、前記第２静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第１連続体及び前記第２連続体の位置関係によって長さが変化する第３連続体と、を認識し、
    前記第２連続体に含まれる方位情報に基づいて、前記第１範囲にＴ字路が構成される可能性を判定し、
    前記第３連続体の長さが所定値以上である場合、前記第３連続体に沿った第２通路が前記第１通路に接続されているか否かを判定し、
    前記第１範囲にＴ字路が構成される可能性の判定結果と、前記第２通路と前記第１通路との接続の判定結果とに基づいて、前記第１範囲の通路の形状を判断し、
    前記判断した通路の形状を、前記移動体に搭載された移動体制御装置に出力する、
    判定方法。
  10. 移動体に搭載される第１センサから、第１範囲に存在する１つ以上の物体までの間の距離及び方位を示す１つ以上の第１方位距離情報を受け取り、
    前記移動体が走行する第１通路に沿った第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中の第１静止物体に対する１つ以上の方位距離情報である第１連続体と、前記第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中、前記第１静止物体よりも前記移動体から遠い第２静止物体に対する１つ以上の方位距離情報である第２連続体と、前記第１方向とは異なる第２方向に、前記１つ以上の第１方位距離情報のうち、前記第２静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第１連続体及び前記第２連続体の位置関係によって長さが変化する第３連続体と、を認識し、
    前記第２連続体に含まれる方位情報に基づいて、前記第１範囲にＴ字路が構成される可能性を判定し、
    前記第３連続体の長さが所定値以上である場合、前記第３連続体に沿った第２通路が前記第１通路に接続されているか否かを判定し、
    前記第１範囲にＴ字路が構成される可能性の判定結果と、前記第２通路と前記第１通路との接続の判定結果に基づいて、前記第１範囲での領域の通路の形状を判断し、
    前記判断した通路の形状を、前記移動体に搭載された移動体制御装置に出力する、
    ことをコンピュータに実行させる、
    プログラム。
  11. 移動体に搭載される第１センサから、第１範囲に存在する１つ以上の物体までの間の距離及び方位を示す１つ以上の第１方位距離情報を受け取り、
    前記移動体が走行する第１通路に沿った第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中の第１静止物体に対する１つ以上の方位距離情報である第１連続体と、前記第１方向に、前記１つ以上の第１方位距離情報のうち、前記１つ以上の物体の中、前記第１静止物体よりも前記移動体から遠い第２静止物体に対する１つ以上の方位距離情報である第２連続体と、前記第１方向とは異なる第２方向に、前記１つ以上の第１方位距離情報のうち、前記第２静止物体に対する１つ以上の方位距離情報であって、前記移動体、前記第１連続体及び前記第２連続体の位置関係によって長さが変化する第３連続体と、を認識し、
    前記第２連続体に含まれる方位情報に基づいて、前記第１範囲にＴ字路が構成される可能性を判定し、
    前記第３連続体の長さが所定値以上である場合、前記第３連続体に沿った第２通路が前記第１通路に接続されているか否かを判定し、
    前記第１範囲にＴ字路が構成される可能性の判定結果と、前記第２通路と前記第１通路との接続の判定結果に基づいて、前記第１範囲での通路の形状を判断し、
    前記判断した通路の形状を、前記移動体に搭載された移動体制御装置に出力する、
    ことをコンピュータに実行させるプログラムを記録した、
    記録媒体。
JP2017013016A 2016-02-24 2017-01-27 判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体 Active JP6975945B2 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2016033420 2016-02-24
JP2016033420 2016-02-24

Publications (2)

Publication Number Publication Date
JP2017151095A JP2017151095A (ja) 2017-08-31
JP6975945B2 true JP6975945B2 (ja) 2021-12-01

Family

ID=58046544

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017013016A Active JP6975945B2 (ja) 2016-02-24 2017-01-27 判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体

Country Status (4)

Country Link
US (1) US10647325B2 (ja)
EP (1) EP3214408B1 (ja)
JP (1) JP6975945B2 (ja)
CN (1) CN107121148B (ja)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10012988B2 (en) * 2016-11-29 2018-07-03 Mitsubishi Electric Research Laboratories, Inc. Methods and systems for path planning using a network of safe-sets
JP6664371B2 (ja) * 2017-12-13 2020-03-13 本田技研工業株式会社 物体認識装置、物体認識方法及び車両
US11516042B2 (en) * 2018-07-19 2022-11-29 Panasonic Intellectual Property Management Co., Ltd. In-vehicle detection system and control method thereof

Family Cites Families (56)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3568768B2 (ja) * 1998-01-20 2004-09-22 三菱電機株式会社 車両位置同定装置
JP2916125B1 (ja) * 1998-01-22 1999-07-05 翼システム株式会社 経路探索方法
US7268700B1 (en) * 1998-01-27 2007-09-11 Hoffberg Steven M Mobile communication device
AU2003225228A1 (en) * 2002-05-03 2003-11-17 Donnelly Corporation Object detection system for vehicle
JP3873876B2 (ja) * 2002-12-06 2007-01-31 日産自動車株式会社 車両用運転操作補助装置およびその装置を備えた車両
US7376262B2 (en) * 2003-08-04 2008-05-20 American Gnc Corporation Method of three dimensional positioning using feature matching
JP3722487B1 (ja) * 2004-05-19 2005-11-30 本田技研工業株式会社 車両用走行区分線認識装置
JP4229051B2 (ja) * 2004-11-26 2009-02-25 日産自動車株式会社 運転意図推定装置、車両用運転操作補助装置および車両用運転操作補助装置を備えた車両
JP4367322B2 (ja) * 2004-11-26 2009-11-18 日産自動車株式会社 車両用運転操作補助装置および車両用運転操作補助装置を備えた車両
JP2006260217A (ja) * 2005-03-17 2006-09-28 Advics:Kk 車両用走行支援装置
US7415134B2 (en) * 2005-05-17 2008-08-19 Honda Motor Co., Ltd. Traffic lane marking line recognition system for vehicle
US7460951B2 (en) * 2005-09-26 2008-12-02 Gm Global Technology Operations, Inc. System and method of target tracking using sensor fusion
DE102006006850B4 (de) * 2006-02-15 2022-12-29 Bayerische Motoren Werke Aktiengesellschaft Verfahren zur Ausrichtung eines verschwenkbaren Fahrzeugsensors
JP4816248B2 (ja) * 2006-05-23 2011-11-16 日産自動車株式会社 車両用運転操作補助装置
JP4868964B2 (ja) * 2006-07-13 2012-02-01 三菱ふそうトラック・バス株式会社 走行状態判定装置
CN101231173A (zh) * 2007-01-25 2008-07-30 乐金电子（昆山）电脑有限公司 导航***中移动物体的行驶路线检索方法
JP5186953B2 (ja) * 2008-03-05 2013-04-24 日産自動車株式会社 車両用減速制御装置
US8428305B2 (en) * 2008-04-24 2013-04-23 GM Global Technology Operations LLC Method for detecting a clear path through topographical variation analysis
US8670592B2 (en) * 2008-04-24 2014-03-11 GM Global Technology Operations LLC Clear path detection using segmentation-based method
US8611585B2 (en) * 2008-04-24 2013-12-17 GM Global Technology Operations LLC Clear path detection using patch approach
US8917904B2 (en) * 2008-04-24 2014-12-23 GM Global Technology Operations LLC Vehicle clear path detection
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
US8099213B2 (en) * 2008-07-18 2012-01-17 GM Global Technology Operations LLC Road-edge detection
US9058746B2 (en) * 2008-10-02 2015-06-16 Hitachi Automotive Systems, Ltd. Information processing device associated with vehicle traveling
US8855917B2 (en) * 2008-10-16 2014-10-07 Csr Technology Inc. System and method for use of a vehicle back-up camera as a dead-reckoning sensor
US8126642B2 (en) * 2008-10-24 2012-02-28 Gray & Company, Inc. Control and systems for autonomously driven vehicles
JP5338371B2 (ja) 2009-02-24 2013-11-13 トヨタ自動車株式会社 車両用警報装置
EP2413301B1 (en) * 2009-03-26 2018-01-10 Toyota Mapmaster Incorporated System method and computer program for generating route restriction information of intersection
JP2010256878A (ja) * 2009-03-30 2010-11-11 Equos Research Co Ltd 情報表示装置
US8358224B2 (en) * 2009-04-02 2013-01-22 GM Global Technology Operations LLC Point of interest location marking on full windshield head-up display
US8395529B2 (en) * 2009-04-02 2013-03-12 GM Global Technology Operations LLC Traffic infrastructure indicator on head-up display
US8350724B2 (en) * 2009-04-02 2013-01-08 GM Global Technology Operations LLC Rear parking assist on full rear-window head-up display
US8629784B2 (en) * 2009-04-02 2014-01-14 GM Global Technology Operations LLC Peripheral salient feature enhancement on full-windshield head-up display
JP5396142B2 (ja) * 2009-05-11 2014-01-22 本田技研工業株式会社 車両の走行安全装置
EP2539197B1 (en) * 2010-02-26 2020-12-16 Gentex Corporation Automatic vehicle equipment monitoring, warning, and control system
WO2011129014A1 (ja) * 2010-04-16 2011-10-20 トヨタ自動車株式会社 運転支援装置
JP4979840B2 (ja) * 2010-07-27 2012-07-18 パナソニック株式会社 移動体検出装置および移動体検出方法
JP2012034076A (ja) * 2010-07-29 2012-02-16 Alps Electric Co Ltd 車両用視覚補助システム及び該システムを備える車両
JP5594102B2 (ja) * 2010-12-02 2014-09-24 トヨタ自動車株式会社 道路形状推定装置
JP5267596B2 (ja) * 2011-02-23 2013-08-21 株式会社デンソー 移動体検出装置
WO2012169029A1 (ja) * 2011-06-08 2012-12-13 トヨタ自動車株式会社 車線逸脱防止支援装置、区分線表示方法、プログラム
JP2013036978A (ja) * 2011-07-12 2013-02-21 Denso Corp 物標検出装置，壁判定方法
JP5612621B2 (ja) * 2012-02-28 2014-10-22 富士重工業株式会社 車外環境認識装置
US9139201B2 (en) * 2012-03-15 2015-09-22 Toyota Jidosha Kabushiki Kaisha Driving assist device
JP5796519B2 (ja) * 2012-03-15 2015-10-21 トヨタ自動車株式会社 運転支援装置
US9589193B2 (en) * 2012-07-27 2017-03-07 Nissan Motor Co., Ltd Three-dimensional object detection device and three-dimensional object detection method
JP6003585B2 (ja) 2012-11-28 2016-10-05 富士通株式会社 交差点検出方法および交差点検出システム
EP3185035B1 (en) * 2013-04-10 2022-04-06 Toyota Jidosha Kabushiki Kaisha Vehicle driving assistance apparatus
JP6040897B2 (ja) * 2013-09-04 2016-12-07 トヨタ自動車株式会社 注意喚起表示装置及び注意喚起表示方法
JP6307895B2 (ja) * 2014-01-23 2018-04-11 トヨタ自動車株式会社 車両用周辺監視装置
JP6388205B2 (ja) * 2014-02-25 2018-09-12 パナソニックＩｐマネジメント株式会社 表示制御プログラム、表示制御装置、および表示装置
CN103913748B (zh) * 2014-03-06 2017-03-08 武汉理工大学 一种基于多传感器的汽车感知***及感知方法
CN104535068B (zh) * 2014-11-25 2018-05-08 四川九洲电器集团有限责任公司 盲区路线导航方法及***
JP6416712B2 (ja) * 2015-08-06 2018-10-31 株式会社Ｓｏｋｅｎ ピッチ角推定装置
US9785150B2 (en) * 2015-12-11 2017-10-10 Uber Technologies, Inc. Formatting sensor data for use in autonomous vehicle communications platform
EP3264391A1 (en) * 2016-06-30 2018-01-03 Honda Research Institute Europe GmbH Method and system for assisting a driver in driving a vehicle and vehicle on which such system is mounted

Also Published As

Publication number Publication date
CN107121148B (zh) 2022-03-08
JP2017151095A (ja) 2017-08-31
CN107121148A (zh) 2017-09-01
EP3214408A1 (en) 2017-09-06
EP3214408B1 (en) 2019-09-04
US20170240180A1 (en) 2017-08-24
US10647325B2 (en) 2020-05-12

Similar Documents

Publication Publication Date Title
US10318822B2 (en) Object tracking
US10133947B2 (en) Object detection using location data and scale space representations of image data
US9064418B2 (en) Vehicle-mounted environment recognition apparatus and vehicle-mounted environment recognition system
JP2021523443A (ja) Ｌｉｄａｒデータと画像データの関連付け
EP3324152A1 (en) Own-position estimating device and own-position estimating method
KR102166512B1 (ko) 주변 환경에서 자동차를 정밀 위치 추적하기 위한 방법, 디바이스, 맵 관리 장치 및 시스템
Pantilie et al. Real-time obstacle detection in complex scenarios using dense stereo vision and optical flow
US10748014B2 (en) Processing device, object recognition apparatus, device control system, processing method, and computer-readable recording medium
JP6975945B2 (ja) 判定装置、判定方法、プログラムおよびプログラムを記録した記録媒体
Pantilie et al. Real-time obstacle detection using dense stereo vision and dense optical flow
US10832428B2 (en) Method and apparatus for estimating a range of a moving object
US11281916B2 (en) Method of tracking objects in a scene
CN111857135A (zh) 用于车辆的避障方法、装置、电子设备和计算机存储介质
Rasmussen et al. On-vehicle and aerial texture analysis for vision-based desert road following
Jiménez et al. Improving the lane reference detection for autonomous road vehicle control
JP5433289B2 (ja) 自動走行車両及び道路形状認識装置
Zhang et al. Real-time obstacle detection based on stereo vision for automotive applications
KR101980509B1 (ko) 차간 거리 추정 방법 및 차간 거리 추정 장치
US20200166346A1 (en) Method and Apparatus for Constructing an Environment Model
EP3869451A1 (en) Information processing device, program, and information processing method
JP2021021967A (ja) 認識システム、車両制御システム、認識方法、およびプログラム
WO2021145032A1 (ja) 周辺車両位置推定システム、周辺車両位置推定プログラム
US11341670B2 (en) Information processing device, information processing method, and recording medium
Van Crombrugge et al. Fast Ground Detection for Range Cameras on Road Surfaces Using a Three-Step Segmentation
CN118264761A (en) Method and device for calibrating a camera mounted on a vehicle

Legal Events

Date Code Title Description
RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20190625

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20190806

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20191018

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20200727

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200825

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201021

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210302

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210408

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20210615

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20210803

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20211026

R151 Written notification of patent or utility model registration

Ref document number: 6975945

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

S111 Request for change of ownership or part of ownership

Free format text: JAPANESE INTERMEDIATE CODE: R313113

S531 Written request for registration of change of domicile

Free format text: JAPANESE INTERMEDIATE CODE: R313531

SZ03 Written request for cancellation of trust registration

Free format text: JAPANESE INTERMEDIATE CODE: R313Z03