JP6388141B2 - 移動体 - Google Patents

移動体 Download PDF

Info

Publication number
JP6388141B2
JP6388141B2 JP2016566145A JP2016566145A JP6388141B2 JP 6388141 B2 JP6388141 B2 JP 6388141B2 JP 2016566145 A JP2016566145 A JP 2016566145A JP 2016566145 A JP2016566145 A JP 2016566145A JP 6388141 B2 JP6388141 B2 JP 6388141B2
Authority
JP
Japan
Prior art keywords
user
moving
moving body
movement
evaluation
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
JP2016566145A
Other languages
English (en)
Other versions
JPWO2016104265A1 (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.)
Equos Research Co Ltd
Original Assignee
Equos Research 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 Equos Research Co Ltd filed Critical Equos Research Co Ltd
Publication of JPWO2016104265A1 publication Critical patent/JPWO2016104265A1/ja
Application granted granted Critical
Publication of JP6388141B2 publication Critical patent/JP6388141B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/005Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/20Instruments for performing navigational calculations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34Route searching; Route guidance
    • G01C21/36Input/output arrangements for on-board computers
    • G01C21/3626Details of the output of route guidance instructions
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P13/00Indicating or recording presence, absence, or direction, of movement
    • G01P13/02Indicating direction only, e.g. by weather vane
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/20Scenes; Scene-specific elements in augmented reality scenes
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V40/00Recognition of biometric, human-related or animal-related patterns in image or video data
    • G06V40/10Human or animal bodies, e.g. vehicle occupants or pedestrians; Body parts, e.g. hands
    • G06V40/103Static body considered as a whole, e.g. static pedestrian or occupant recognition
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V40/00Recognition of biometric, human-related or animal-related patterns in image or video data
    • G06V40/20Movements or behaviour, e.g. gesture recognition
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V40/00Recognition of biometric, human-related or animal-related patterns in image or video data
    • G06V40/10Human or animal bodies, e.g. vehicle occupants or pedestrians; Body parts, e.g. hands
    • G06V40/16Human faces, e.g. facial parts, sketches or expressions
    • G06V40/172Classification, e.g. identification

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Theoretical Computer Science (AREA)
  • Multimedia (AREA)
  • Human Computer Interaction (AREA)
  • Health & Medical Sciences (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • General Health & Medical Sciences (AREA)
  • Psychiatry (AREA)
  • Social Psychology (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Traffic Control Systems (AREA)
  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Image Analysis (AREA)

Description

本発明は、移動体に関し、特に、ユーザが移動しやすいよう、周囲の状況に応じた適切な移動方向を当該ユーザに提示できる移動体に関する。
特許文献1には、周囲の障害物を避けつつ、ユーザから離脱しないように移動する移動体が開示されている。また、特許文献2には、ユーザの周囲環境を予測し、ユーザと危険物との接触が予測された場合には、ユーザと危険物との間に移動する自律移動装置が開示されている。
特開2009−151382号公報 特開2008−307658号公報
しかしながら、特許文献1,2に記載される各技術では、周辺環境に対するユーザの移動のしやすさについての考慮がされていない。よって、例えば、特許文献1に記載される移動体は、障害物を避けて歩くユーザから離脱することなく随伴することができるものの、障害物の回避はユーザの判断に委ねられるので、ユーザが障害物を回避しきれず接触する可能性がある。一方、特許文献2に記載される自律移動装置は、ユーザ自身が、当該ユーザと危険物との間に移動する自律移動装置に接触する可能性がある。
本発明は、上述した事情を鑑みてなされたものであり、ユーザが移動しやすいよう、周囲の状況に応じた適切な移動方向を当該ユーザに提示できる移動体を提供することを目的としている。
この目的を達成するために請求項1記載の移動体は、ユーザの状況を検知するユーザ検知手段と、周辺の状況を検知する周辺状況検知手段と、前記周辺状況検知手段により検知された周辺の状況に基づいて、前記周辺に存在する物体の移動を、当該周辺の未来状況として予測する周辺予測手段と、前記周辺予測手段により予測された前記周辺の未来状況と、前記ユーザ検知手段により検知された前記ユーザの状況とに基づいて、前記ユーザに提示する移動方向を決定する決定手段と、前記決定手段により決定された移動方向に応じた向きを、前記ユーザの前方周囲にて当該ユーザに提示する提示手段とを備え、前記決定手段は、前記周辺予測手段により予測された前記周辺の未来状況と、前記ユーザ検知手段により検知された前記ユーザの状況とに基づいて、前記ユーザの移動方向に逆らわない前記物体の流れのうち、前記ユーザの移動速度と所定範囲内の速度差で流れる流れに応じた方向を、前記ユーザに提示する移動方向を決定するための方向の候補として優先して抽出する候補抽出手段を備え、その候補抽出手段により抽出された候補に基づいて、前記ユーザに提示する移動方向を決定するものである。
請求項1記載の移動体によれば、周辺状況検知手段により検知された周辺の状況に基づいて、周辺予測手段によって、周辺に存在する物体の移動が当該周辺の未来状況として予測される。この周辺予測手段により予測された周辺の未来状況と、ユーザ検知手段により検知されたユーザの状況とに基づいて、決定手段によりユーザに提示する移動方向が決定され、提示手段によって、その決定された移動方向に応じた向きが、ユーザの前方周囲にて当該ユーザに提示される。具体的には、周辺予測手段により予測された周辺の未来状況に基づいて、候補抽出手段によりユーザの移動方向に逆らわない物体の流れのうち、ユーザの移動速度と所定範囲内の速度差で流れる流れに応じた方向がユーザに提示する移動方向を決定するための方向として優先して抽出される。決定手段は、候補抽出手段により抽出された候補に基づいて、ユーザに提示する移動方向を決定するので、ユーザは、提示された移動方向に移動することにより、自身の移動速度に近い速度で移動する物体の流れについて行くことができるため、移動しやすいという効果がある。よって、ユーザの移動速度との速度差が近く、ユーザが移動しやすい流れに応じた移動方向をユーザに提示できるという効果がある。なお、決定手段により決定される移動方向は、一方向であることに限られず、所定範囲の幅をもつ方向であることを含むものである。
請求項2記載の移動体は、請求項1が奏する効果に加え、次の効果を奏する。決定手段は、周辺予測手段により予測された周辺の未来状況と、ユーザ検知手段により検知されたユーザの状況とに基づいて、周辺におけるユーザの移動のし易さを評価し、その移動のし易さに基づいて、ユーザに提示する移動方向を決定する。よって、ユーザが移動しやすいよう、周辺の状況に応じた適切な移動方向を当該ユーザに提示できるという効果がある。
請求項3記載の移動体は、請求項1又は2が奏する効果に加え、次の効果を奏する。周辺予測手段により予測された周辺の未来状況と、ユーザ検知手段により検知されたユーザの状況とに基づいて、第1評価手段により、周辺におけるユーザの移動のし易さが評価される。決定手段は、第1評価手段による評価に基づいて、ユーザに提示する移動方向を決定するので、ユーザが移動しやすいよう、周辺の状況に応じた適切な移動方向を当該ユーザに提示できるという効果がある。
請求項4記載の移動体によれば、請求項1から3のいずれかが奏する効果に加え、次の効果を奏する。周辺予測手段により予測された周辺の未来状況に基づいて、第2評価手段により当該周辺における物体の流れが評価される。決定手段は、第2評価手段により評価された物体の流れに基づいて、ユーザに提示する移動方向を決定する。よって、物体の流れを考慮し、当該流れに適した移動方向をユーザに提示できるという効果がある。
請求項5記載の移動体は、請求項1から4のいずれかが奏する効果に加え、次の効果を奏する。提示手段は、決定手段により決定された移動方向に応じた向きを示すよう、ユーザの前方周囲にて、移動制御手段により、移動体を移動させる。よって、ユーザは、移動体の動きに合わせてついていくことにより、周辺の状況に応じて移動しやすくなるという効果がある。
請求項記載の移動体によれば、請求項1から5のいずれかが奏する効果に加え、次の効果を奏する。第2評価手段により評価された物体の流れのうち、ユーザの移動方向に逆らわない流れに応じた方向が、候補抽出手段により、候補として優先して抽出される。よって、ユーザの移動方向に逆らわない流れに応じた移動方向をユーザに提示できるという効果がある。
請求項記載の移動体によれば、請求項1からのいずれかが奏する効果に加え、次の効果を奏する。周辺状況検知手段により検知された周辺の状況に基づいて、当該周辺に存在する物体の移動と、当該周辺に存在する物体による死角に基づく今後の推移が不確かな領域とが、周辺予測手段により、当該周辺の未来状況として予測される。よって、周辺に存在する物体の移動だけでなく、当該物体による死角に基づく今後の推移が不確かな領域が考慮された、ユーザの移動しやすい移動方向を提示できるという効果がある。
請求項記載の移動体によれば、請求項1からのいずれかが奏する効果に加え、次の効果を奏する。所定の予測時間後に物体が存在し得る領域が、周辺予測手段により、物体の移動として予測されるので、所定の予測時間後に物体が存在し得る領域を考慮して、ユーザの移動しやすい移動方向を提示できるという効果がある。
請求項記載の移動体によれば、請求項が奏する効果に加え、次の効果を奏する。前記所定の予測時間は、周辺に存在する物体のそれぞれについて、各物体の状況に応じた可変値とされる。よって、物体の状況に応じた予測時間を用いて、当該予測時間後に各物体が存在し得る領域を考慮して、ユーザの移動しやすい移動方向を提示できるという効果がある。
請求項1記載の移動体によれば、請求項またはが奏する効果に加え、次の効果を奏する。周辺に存在する物体のうち、ユーザおよび移動体に対し相対的に近づく物体を対象とし、対象となる物体のそれぞれについて、その物体が存在し得る領域が、周辺予測手段により予測される。所定の予測時間は、ユーザまたは移動体と物体との間の距離に応じた値と、ユーザまたは移動体に対する物体の相対速度とに基づく値である。よって、ユーザに接触する可能性のある各物体について、ユーザまたは移動体との相対的な位置関係と相対速度とが考慮された移動方向を提示できるという効果がある。
請求項1記載の移動体によれば、請求項1が奏する効果に加え、次の効果を奏する。前記所定の予測時間は、ユーザおよび移動体と周辺に存在する物体とが、ユーザまたは移動体に対する物体の相対速度で近づいた場合に、ユーザおよび移動体を包括する周囲に所定の大きさで設けられた第1領域と、物体の周囲に所定の大きさで設けられた第2領域との間が所定の猶予距離だけ離れた位置に到達するまでの時間として算出される。よって、ユーザの前方周囲を移動する移動体と物体とが完全に接近する手前の状態が予測されるので、ユーザが移動しやすいだけでなく、物体にとっても余裕をもって移動体を避けることが可能となるような移動方向をユーザに提示できるという効果がある。
請求項1記載の移動体によれば、請求項から1のいずれかが奏する効果に加え、次の効果を奏する。ユーザが、周辺予測手段により予測される周辺の未来状況において、候補抽出手段により候補として抽出された方向に応じた向きで、ユーザ検知手段により検知されたユーザの状況に応じて定められる目標領域に移動した場合に、当該目標領域に到達するまでに、物体による影響を最も受け難い経路が、経路推定手段により推定される。周辺予測手段により予測された領域について、経路推定手段により推定された経路を挟む領域がある場合には、当該経路を挟む領域間の幅が広いほど、第1評価手段により、ユーザが移動しやすいと評価される。よって、経路推定手段により推定された経路について、その経路を挟む、周辺予測手段により予測された領域の間隔に応じて、ユーザの移動しやすさを評価できるという効果がある。
請求項1記載の移動体によれば、請求項1が奏する効果に加え、次の効果を奏する。経路推定手段により推定された経路を挟む領域間の幅が、ユーザおよび移動体を包括する周囲に所定の大きさで設けられた第1領域の幅より広い場合には、当該第1領域の幅より狭い場合に比べてユーザが移動しやすいと、第1評価手段により評価される。よって、第1領域を通過させやすい経路ほど、第1領域内への干渉が少なくなり、ユーザが移動しやすいとの判断結果を得ることができるという効果がある。
請求項1記載の移動体によれば、請求項1または1が奏する効果に加え、次の効果を奏する。経路推定手段により推定された経路を挟む領域間の幅は、各領域の中心を結んだ場合に、当該各領域に対応する物体の周囲にそれぞれ所定の大きさで設けられた第2領域の外側となる線分の長さである。よって、ユーザの移動に対する、ユーザによる第2領域への干渉を考慮して、ユーザの移動しやすさを判断できるという効果がある。
請求項1記載の移動体によれば、請求項3から1のいずれかが奏する効果に加え、次の効果を奏する。ユーザが、周辺予測手段により予測される周辺の未来状況において、候補抽出手段により候補として抽出された方向に応じた向きで、ユーザ検知手段により検知されたユーザの状況に応じて定められる目標領域に移動した場合に、当該目標領域に到達するまでに、物体による影響を最も受け難い経路が、経路推定手段により推定される。そのように推定された経路のうち、終点の位置が、ユーザ検知手段により検知されたユーザの状況が示す移動方向と目標位置とが交差する位置に近い経路ほど、第1評価手段により、ユーザが移動しやすいと評価される。よって、ユーザが現在の移動方向に進んだ場合とのずれが少ない経路であるほど、ユーザが移動しやすいとの判断結果を得ることができるという効果がある。
請求項1記載の移動体によれば、請求項3から1のいずれかが奏する効果に加え、次の効果を奏する。ユーザが、周辺予測手段により予測される周辺の未来状況において、候補抽出手段により候補として抽出された方向に応じた向きで、ユーザ検知手段により検知されたユーザの状況に応じて定められる目標領域に移動した場合に、当該目標領域に到達するまでに、物体による影響を最も受け難い経路が、経路推定手段により推定される。そのように推定された経路のうち、ユーザ検知手段により検知されたユーザの状況が示すユーザの移動方向に対する、始点からの移動方向の角度変化の絶対値が小さい経路ほど、第1評価手段により、ユーザが移動しやすいと評価される。よって、ユーザの現在位置における大きな方向転換が行われない経路であるほど、ユーザが移動しやすいとの判断結果を得ることができるという効果がある。
請求項1記載の移動体によれば、請求項1から1のいずれかが奏する効果に加え、次の効果を奏する。ユーザ検知手段により検知されたユーザの状況が示す当該ユーザの移動速度を用いて物体の移動が予測されるとともに、当該ユーザの移動速度は異なる移動速度を用いて物体の移動が予測される。ユーザの移動速度毎に予測された物体の移動を含む、周辺の未来状況に基づいて、ユーザの移動速度毎に、ユーザに提示する移動方向を決定するための方向の候補が抽出され、物体による影響を最も受け難い経路が推定される。そのように推定されたユーザの移動速度毎の経路のうち、物体の移動を予測するために用いたユーザの移動速度が、ユーザ検知手段により検知されたユーザの状況が示す当該ユーザの移動速度に近い経路ほど、第1評価手段により、ユーザが移動しやすいと評価される。よって、ユーザの移動速度が一定に近い経路であるほど、ユーザが移動しやすいとの判断結果を得ることができるという効果がある。
移動体の外観を示す模式図である。 移動体の概略的な電気的構成を示すフロック図である。 メイン処理を示すフローチャートである。 (a)は、S100処理を示すフローチャートであり、(b)は、ユーザ座標系に変換された周辺の状況の一例を示す模式図である。 S200にて評価される個の領域を説明するための図である。 S200にて評価される個の領域を説明するための図である。 S300にて行う予測および評価を説明するための図である。 S300にて行う予測および評価を説明するための図である。 ユーザの移動速度の変化に対する評価を説明するための図である。 S400の処理を示すフローチャートである。 S402にて行う評価を説明するための図である。 S403にて行う候補領域の絞り込みを説明するための図である。 S404にて行う候補経路の設定を説明するための図である。 S405にて行う評価を説明するための図である。 S405にて行う評価を説明するための図である。 S405にて行う評価を説明するための図である。 S500にて行う最適経路の決定を説明するための図である。
以下、本発明を実施するための形態について添付図面を参照して説明する。図1は、本発明の移動体の一実施形態である移動体100の外観を示す模式図である。移動体100は、移動するユーザ150の前方周囲を自律的に移動することによって、ユーザ150の移動をサポートする装置として機能する。
本実施形態の移動体100は、例えば、移動体100およびユーザ150の周辺の状況下で移動しやすいと推定される移動方向を随時ユーザ150に提示し、それにより、ユーザ150の移動をサポートする。なお、本実施形態では、移動体100がサポートするユーザ150の移動は、歩いてまたは小走りで移動する程度の速度による移動を想定している。
なお、移動体100の移動範囲である「ユーザ150の前方周囲」は、例えば、ユーザ150の前方であり、かつ、ユーザ150を中心とする180度の範囲である。あるいは、ユーザの視界の範囲内としてもよい。また、移動体100とユーザ150との間の距離は、ユーザ150から所定の確保すべき距離(例えば、40cm程度)以上、かつ、ユーザ150と共に移動するという点で自然な距離(例えば、70cm程度)を越えないように設定された距離以下の範囲内とされる。
図1に示すように、移動体100は、本体部101と、車輪102と、表示部103とを有する。本体部101は、略円柱状に構成される。本体部101の形状は、略円柱状に限られるものではなく、種々の形状を採用できる。本体部101の周辺には、ユーザ150または移動体100の周辺を撮像するための複数の撮像装置(図示せず)が設けられている。
車輪102は、全方位への移動が可能な全方位車輪として構成される。よって、移動体100は、全方位への移動をスムーズに行うことができる。本実施形態では、3つの車輪102が設けられているものとするが、車輪102の数は3つに限らず、適宜の数を採用できる。
表示部103は、液晶表示装置などのディスプレイを有し、ディスプレイへの表示によって情報をユーザ150に伝達する。なお、図1に示す例において、表示部103のディスプレイは、ユーザ150に対向する面に設けられている。表示部103のディスプレイは、タッチパネルとして構成され、ユーザ150からの指示を移動体100に入力することができる。
図2は、移動体100の概略的な電気的構成を示すフロック図である。移動体100は、センシング部10と、制御部20と、駆動部30と、ヒューマン・マシン・インタフェイス(以下「HMI」と称す)部40とを有する。
センシング部10は、ユーザ150の状態(以下「ユーザ状態」と称す)や、移動体100およびユーザの周辺の状態(以下「周辺状態」と称す)を検出するものである。センシング部10のうち、ユーザ状態を検出するものは、本発明におけるユーザ検知手段の一例である。センシング部10のうち、周辺状態を検出するものは、本発明における周辺状態検知手段の一例である。
センシング部10は、例えば、本体部101の周囲に設けられた複数の撮像装置、ミリ波やレーザなどの各種センサ装置などから構成される。なお、撮像装置としては、例えば、CCD(Charge Coupled Device)カメラや、CMOS(Complementary Metal Oxide Semiconductor )カメラなどのカメラ装置を採用できる。撮像装置は、レンジファインダを有するものを採用してもよい。
センシング部10は、センシング部10が検出した結果を制御部20に出力する。より詳細には、センシング部10は、ユーザ150を対象とする撮像画像およびレーダによる検出結果などを、ユーザ状態の検出結果として、制御部20に出力する。一方、センシング部10は、移動体100およびユーザ150の周辺を対象とする撮像画像およびレーダによる検出結果などを、周辺状態の検出結果として、制御部20に出力する。
制御部20は、CPU(Central Processing Unit)、ROM(Read Only Memory)、およびRAM(Random Access Memory)などから構成され、移動体100の全体を制御する制御装置として機能する。なお、図3を参照して後述する処理を実現するためのプログラムは、制御部20のROMに記憶され、制御部20のCPUにより実行される。制御部20は、センシング部10からの入力に応じた制御信号を生成し、当該制御信号を駆動部30またはHMI部40へ出力する。
駆動部30は、車輪102、および、車輪102の駆動源となるモータなどから構成される。駆動部30には、制御部20から制御信号が入力される。制御信号が駆動部30に入力されると、入力された信号に基づきモータが回転し、当該モータの回転が動力となって車輪102が駆動する。
HMI部40は、ユーザ150に情報を出力したり、ユーザ150が指示を入力するためのインタフェイスである。表示部103のディスプレイは、HMI部40の一例である。なお、音声を出力するスピーカや、音声を入力するマイクをHMI部40として設ける構成としてもよい。HMI部40は、制御部20から入力された制御信号に応じて、情報を出力する。一方、ユーザ150からHMI部40に指示が入力された場合、HMI部40は、当該入力に応じた制御信号を制御部20に出力する。
図3は、上記構成を有する移動体100の制御部20のCPUが、制御部20のROMに格納されるプログラムに従い実行するメイン処理を示すフローチャートである。このメイン処理は、所定時間毎(例えば、0.1秒毎)に定期的に実行される。制御部20のCPU(以下、単に「制御部20」と称す)は、ユーザ/周辺の状態を認識する処理(S100)を実行する。
S100の処理は、センシング部10からの入力に基づいて、移動体座標系(すなわち、移動体100を基準とする座標系)で表される各パラメータを、ユーザ座標系(すなわち、ユーザ150を基準とする座標系)に変換する。つまり、移動体100を基準とする相対的なパラメータを、ユーザ150を基準とする相対的なパラメータに変換する。
制御部20は、S100の処理後、個の領域を評価する処理を実行する(S200)。S200の処理は、移動体100、ユーザ150、および周辺の各物体のそれぞれについて、個の領域を評価する処理である。詳細は図5および図6を参照して後述するが、本実施形態では、個の領域を点数化することにより、個の領域を評価する。
なお、ユーザ150や周辺に存在する他者などの人間に対する「個の領域」は、所謂、心理的なパーソナルスペースであり、相手の進入を好ましく思わない領域であると同時に、相手も侵入したくないと感じる領域である。また、移動体100や周辺に存在する障害物などの対象に対する「個の領域」は、相手との接触が生じるという不安を感じる領域である。
制御部20は、S200の処理後、場の予測及び評価をする処理を実行する(S300)。S300の処理は、ユーザ150および移動体100の周辺の未来状況を予測するとともに、予測された未来状況を評価する処理である。S300の処理は、本発明の周辺予測手段の一例である。
詳細は後述するが、本実施形態では、周辺に存在する各他者について、予測時間t後の移動領域を、未来状況の1つとして予測する。一方で、周辺に存在する各他者および各障害物について、それらの死角に基づく、今後の推移が不確かな領域(以下「不確定領域」と称す)を、未来状況の1つとして予測する。
未来状況として予測された移動領域のそれぞれについて、各移動領域に対応する他者の存在確率を考慮して点数化することにより、各移動領域を評価する。一方で、未来状況として予測された不確定領域のそれぞれについて、それぞれの死角の大きさを考慮して点数化することにより、各不確定領域を評価する。そして、予測された各移動領域に対する評価と各不確定領域に対する評価が反映されたマップを生成することにより、周辺の未来状況を総合的に評価する。
制御部20は、S300の処理後、移動のしやすさを評価する処理を実行する(S400)。S400の処理は、S300にて予測および評価された未来状況下におけるユーザ150の移動のしやすさを評価する処理である。S400の処理は、本発明の候補抽出手段および第1評価手段の一例である。詳細は後述するが、本実施形態では、周辺に存在する他者の流れを考慮して抽出された各方向について、S300にて予測および評価された未来状況に基づいて、各方向に対するユーザ150の移動のしやすさを点数化することによって評価する。
制御部20は、S400の処理後、経路決定処理を実行する(S500)。S500の処理は、S400による評価に基づき、ユーザ150に最適な移動方向を決定する。S500の処理は、本発明の決定手段の一例である。詳細は後述するが、本実施形態では、S400にて算出された各方向の点数と、S300にて予測された未来状況のうち、各方向に相当する領域の点数とを考慮して、ユーザ150に最適な移動方向を決定する。
制御部20は、S500の処理後、提示処理を実行する(S600)。S600の処理は、S500の処理により決定された移動方向を移動体100の動きによってユーザ150に提示する。本実施形態では、ユーザ150の前方を移動する移動体100を、ユーザ150に対して左右方向に、決定された移動方向を示す距離だけ移動させることによって、ユーザ150に移動方向を提示する。
具体的に、制御部20は、移動体100が、S500にて決定された移動方向を示し、かつ、ユーザ150の移動速度に応じた速度で前方に移動するよう、駆動部30に制御信号を出力する。制御信号が入力された駆動部30は、移動体100が、ユーザ150の移動速度に応じた速度で前方に移動しつつ、決定された移動方向を示す距離だけ左右方向に移動するよう、車輪102を駆動する。ここで、移動体100の左右方向の移動とは、移動体100をユーザ座標系または移動体座標系におけるユーザ150との垂直距離を一定に保ったまま左右方向に移動させるものや、移動体100をユーザ150との相対距離を一定に保ったまま左右方向に移動させるもの(即ちユーザ150を中心とした円弧状の軌跡を左右方向に移動させるもの)を例示できる。これにより、移動体100は、ユーザ150とともに前方に移動しながら、周辺の状況下で移動しやすいと推定される移動方向を左右方向の動きによってユーザ150に提示する。S500の処理は、本発明の提示手段および移動制御手段の一例である。
図4(a)は、上述した、ユーザ/周辺の状態を認識する処理(S100)を示すフローチャートである。制御部20は、センシング部10からの入力に基づいて、移動体座標系におけるパラメータを取得する(S100)。S100にて取得されるパラメータは、ユーザ状態を示すパラメータと、周辺状態を示すパラメータとに大別される。
ユーザ状態を示すパラメータは、例えば、移動体100に対するユーザ150の相対位置(x0,y0)、移動体100に対するユーザ150の相対速度v0、移動体100に対するユーザ150の相対移動方向θ0、移動体100に対するユーザ150の体の向きθBなどである。
なお、詳細は後述するが、本実施形態では、ユーザ150の移動速度が現在値(すなわち、今回のセンシング部10からの入力に基づく値)から変化した場合を考慮するため、相対速度v0として、現在の移動速度を示す、センシング部10からの入力に基づいて取得された値に加え、ユーザ150の移動速度を現在値から予め決められた量だけ変化させた値を別途取得する。本実施形態では、ユーザ150の移動速度が、現在の移動速度と、現在の移動速度より±2km/hである速度との3種類の移動速度について考慮するため、各移動速度についてそれぞれ相対速度v0を取得する。
一方、周辺状態を示すパラメータは、例えば、移動体100に対する他者または障害物の相対位置(xi,yi)、移動体100に対する他者または障害物の相対速度vi、移動体100に対する他者または障害物の相対移動方向θiなどである。なお、変数iは、1以上の整数であり、周辺に存在する他者または障害物に対し個々に割り当てられる。つまり、変数iは、周辺に存在する他者または障害物を個々に特定するための値である。
ユーザ150、あるいは周辺に存在する他者または障害物の相対位置、ユーザ150の体の向きは、例えば、本体部101の周囲に設けられた複数の撮像装置(例えば、カメラ)により撮像された各画像を画像処理に供し、エッジ抽出やパターン認識を行うことにより取得できる。
なお、ユーザであるか否かの認識は、例えば、予めユーザの顔画像を記憶させておき、その顔画像と撮像画像との比較に基づいて行う。また、周辺に存在する物体が、移動する他者であるか、静止している障害物であるかの区別もまた、撮像画像に基づいて行う。一方、ユーザ150、あるいは周辺に存在する他者または障害物の相対速度、相対移動方向は、例えば、今回に取得した各画像および前回に取得した各画像に基づいて取得する。
制御部20は、S101にて取得した、移動体座標系における各パラメータを、ユーザ座標系に変換する(S102)。図4(b)は、ユーザ座標系に変換された周辺の状況の一例を示す模式図である。図4(b)に示すように、制御部20は、ユーザ座標系に変換された各パラメータから、周辺に存在する各他者200について、ユーザ150に対する相対位置と、相対速度と、相対移動方向とを把握する。図4(b)に示す例において、ユーザ150に対する相対移動方向および相対速度は、それぞれ、ベクトルの向きおよび長さで表している。
一方、本実施形態では、障害物300、すなわち、それ自体が静止している物体については、ユーザ150に対する相対位置のみ考慮し、相対速度および相対移動向きは考慮しない。よって、制御部20は、ユーザ座標系に変換された各パラメータから、周辺に存在する各障害物300について、ユーザ150に対する相対位置を把握する。
なお、図4(b)には、簡単な例として、2人の他者200と、1つの障害物300とを図示したが、実際には、制御部200は、多数の他者200を対象として、各他者200について、ユーザ150に対する相対位置、相対速度、相対移動方向を把握し、多数の障害物300を対象として、各障害物300について、ユーザ150に対する相対位置を把握する。
図5および図6を参照して、本実施形態において、上述したS200にて評価される個の領域について説明する。図5(a)に示すように、移動体100、ユーザ150、および他者200のそれぞれに対し、個の領域120,170,220が設定される。ユーザ150に対する個の領域170は、ユーザ150の移動方向である前方(ユーザ150から延びる矢印の方向)の方が後方よりも広く設定される。移動体100および他者200についても同様である。
図5(a)に示す例では、移動体100、ユーザ150、および他者200のそれぞれに対する個の領域120,170,220をいずれも円としたが、楕円などの適宜の形状を採用できる。また、個の領域120,170,220をいずれも同じ大きさとしたが、同じ大きさでなくてもよい。例えば、個の領域120,170,220を、移動体100、ユーザ150、または他者200の移動速度に応じて異なる大きさとしてもよい。また、移動体100、ユーザ150、または他者200の前方に設けられる後方より広い領域についても、移動体100、ユーザ150、または他者200の移動速度に応じた広さとしてもよい。
個の領域120,170,220は、各領域120,170,220内に設けられた排除領域120a,170a,220a内を最大とし、周縁に向かって次第に低くなるように設定された点数によって評価される。なお、排除領域120a,170a,220aは、相手を入らせないようにするための領域である。
図5(a)に示す例では、排除領域170aに対し、個の領域の点数として設定可能な最大値(本実施形態では200点)を設定し、排除領域170aの周縁から個の領域170の周縁までの領域に対し、100から0まで直線的に点数が下がる一次関数として点数を設定する。図示はしないが、個の領域120および個の領域220についても、個の領域170と同様に点数を設定する。
本明細書における個の領域の「点数」は、低い点数ほど、相手の進入に対する許容度が高く、高いほど、相手の進入に対する許容度が低いことを示す。なお、最大値とする点数は、200点に限らず適宜の値を採用できる。また、排除領域170aの周縁から個の領域170の周縁までの点数を設定するための関数については、周縁に向かって減少する関数であれば、一次関数に限らず、適宜の値を採用できる。また、当該関数は、個の領域が、移動体100、ユーザ150、または他者200のいずれのものであるかに応じて異なっていてもよい。
移動体100およびユーザ150は連れ立って移動するので、両者を1つとして考え、図5(b)に示すように、個の領域130が設定される。本実施形態では、ユーザ150と移動体100とが確保すべき距離Lを隔てて位置する場合を想定し、その場合における個の領域120,170を包含する領域を、個の領域130として設定する。なお、図5(b)に示す例では、個の領域120,170を包含する小判状の領域を個の領域130とするが、個の領域120,170を包括する領域であれば、個の領域130は左右に膨れた楕円状の領域であってもよい。
本実施形態では、確保すべき距離Lを、ユーザ150の個の領域170が前方の移動体100に接した場合におけるユーザ150と移動体100との距離とするが、これに限らず、互いが近すぎずかつ離れすぎない程度の適宜の距離を採用できる。
個の領域130の内部には、排除領域130aが設けられる。排除領域130aは、排除領域120a,170a,220aと同様、相手を入らせないようにする領域である。図5(b)に示す例では、排除領域120a,170aを包含する小判状の領域を排除領域130aとするが、排除領域120a,170aを包括する領域であれば、排除領域130aは左右に膨れた楕円状の領域であってもよい。
個の領域130の評価は、個の領域120,170,220と同様、排除領域130a内に最大の点数を設定し、周縁に向かって次第に低い点数を設定する。図5(b)に示す例では、排除領域130aに対し、点数としての最大値である200点を設定し、排除領域130aの周縁から個の領域130の周縁までを、100から0まで直線的に点数を一次関数として設定する。排除領域130aの周縁から個の領域130の周縁までの点数を設定する関数については、周縁に向かって減少する関数であれば、一次関数に限らず、適宜の値を採用できる。
図6に示すように、障害物300に対し、障害物300から所定距離だけ離れた領域であり、かつ、移動体100から見える領域を、個の領域320として設定する。本実施形態では、個の領域320は、相手を入らせないようにする排除領域のみから構成されるものとする。よって、個の領域320には、点数としての最大値である200点が全域に亘って設定される。なお、個の領域320を、個の領域120などのように、排除領域と、当該排除領域より点数が低くなる領域とを設ける構成としてもよい。
図7および図8を参照して、本実施形態において、上述したS300にて行われる予測および評価について説明する。上述した通り、本実施形態では、周辺に存在する各他者200について、予測時間t後の移動領域が未来状況の1つとして予測され、予測された各移動領域が点数により評価される。なお、本明細書における未来状況の「点数」は、低い点数ほど、その未来状況においてユーザ150が移動しやすいことを示す。
S300において、周辺に存在する各他者200に対する移動領域を予測するために、制御部20は、まず、周囲に存在する他者200のそれぞれについて、予測時間tを算出する。予測時間tは、(Δx−α)/Δvから算出される。ただし、Δvは、0より大きい値とする。
Δxは、他者200と移動体100との距離である。Δvは、ユーザ座標系における他者200の相対速度である。上述した通り、Δvは、0より大きい値とするので、移動体100およびユーザ150に相対的に近づく他者200についてのみ、予測時間tの算出を行う。
αは、猶予距離である。猶予距離は、移動体100およびユーザ150と他者200とを、他者200と移動体100とを結ぶ線上に沿って近づけた場合に、他者200と移動体100とがある程度以上近づかないようにすることを想定して設定される距離である。本実施形態では、排除領域220aと排除領域170aとが所定距離(例えば、1m)離れた場合における、他者200と移動体100との距離を、猶予距離とする。
よって、予測時間tは、移動体100およびユーザ150と他者200とを、他者200と移動体100とを結ぶ線上に沿って近づけた場合に、他者200と移動体100およびユーザ150とが、排除領域220aと排除領域170aとが所定距離(例えば、1m)だけ離れた位置に到達するまでの時間として算出される。このように、予測時間tは、他者200の位置および移動速度に依存するので、各他者200の状況に応じた可変値とされる。
次に、制御部20は、周囲に存在する他者200のそれぞれについて、各他者200が現在の移動方向および移動方向に移動した場合の、予測時間t後の移動領域250を予測する。なお、上述した通り、予測時間tは、移動体100およびユーザ150に相対的に近づく他者200を対象として、他者200毎に算出される値である。各移動領域250は、他者200の移動方向の線上に中心を有する円として予測され、中心に近いほど、予測時間t後において他者200の存在確率が高い。
なお、予測時間tの算出には、上述したように猶予距離が考慮されるため、予測される移動領域は、ユーザ150にとって、排除領域170aに他者200が進入しない領域であるとともに、他者200にとっても、排除領域220aに移動体100およびユーザ150が進入しない領域である。よって、ユーザ100の移動に対して、他者200にかかる負荷もできるだけ少なくなるよう考慮されている。
次に、制御部20は、各他者200対して予測した移動領域250を評価する。本実施形態では、移動領域250の中心から周縁に向かって、0以上の所定値から0まで直線的に点数が下がる一次関数として点数を設定する。本明細書における移動領域の「点数」は、高い点数ほど、他者の存在確率が高いことをしめす。本実施形態では、存在確率100%に対し、100点を割り当てる。よって、移動領域の「点数」は、存在確率の数値に等しい数値の点数とされる。
本実施形態では、移動領域250の中心の点数を、当該中心における存在確率の値とする。よって、例えば、図7に示すように、他者200aに対する移動領域250aの中心における存在確率が、他者200bに対する移動領域250bの中心における存在確率よりも高い場合、移動領域250aに対する中心に対して設定された点数Kaの方が、移動領域250bに対する中心に対して設定された点数Kbより高い点数となる。
なお、移動領域250の中心に対して設定する値は、当該中心における存在確率の値に限らず、存在確率に応じた適宜の値を採用できる。また、移動領域250の中心から周縁までの点数を設定するための関数については、当該中心から周縁に向かって減少する関数であれば、一次関数に限らず、適宜の値を採用できる。また、当該関数は、他者200の個々の状態に応じて異なっていてもよい。
本実施形態では、ユーザ150の移動速度が変化することを考慮し、ユーザ150の現在の移動速度と、現在の移動速度とは異なる移動速度とに対する各パターンについて、それぞれ各他者200における予測時間t後の移動領域250を予測する。本実施形態では、ユーザ150の移動速度の変化幅を、−2km/hから+2km/hまでの範囲とし、当該変化幅の範囲内で、ユーザ150の移動速度を2km/h刻みで変化させる。つまり、各他者200に対する移動領域250の予測および評価は、ユーザ150の現在の移動速度と、現在の移動速度より±2km/hである速度との3パターンについて行われる。
なお、ユーザの移動速度が変化した場合、予測時間tは、ユーザの移動速度に応じた相対速度で算出される。よって、ユーザの移動速度を速くするほど、予測時間tは長くなるため、各他者200に対する移動領域は、図7に示す移動領域250より、他者200から離れた側(すなわち、ユーザ150に近い側)に位置し、かつ、図7に示す移動領域250より広い領域となる。
また、上述した通り、本実施形態では、周辺に存在する各他者200および各障害物300について、それらの死角に応じた不確定領域が未来状況の1つとして予測され、予測された不確定領域が点数により評価される。よって、制御部20は、まず、不確定領域を予測する。
例えば、制御部20は、図8に示すように、障害物300の裏側に形成される死角に対し、当該死角の領域に隣接する領域に不確定領域320を予測する。この例では、不確定領域320を、縦幅K1が、横幅K2の2倍である半円としたが、縦幅K1と横幅K2の比率は2:1に限らない。また、半円など全体が円の一部である形状に限らず、適宜の形状の不確定領域320を採用できる。
次に、制御部20は、予測された不確定領域を評価する。図8に示す例では、不確定領域320の縦幅K1の中央を100点とし、当該中央の位置から周縁に向かって直線的に下がる一次関数として点数を設定するとともに、不確定領域320の横幅K2の障害物側の端から周縁に向かって直線的に点数が下がる一次関数として点数を設定する。
不確定領域320の評価としては、これに限らず、不確定領域320内における不確定さが大きい位置ほど点数を高くし、周縁に近づくほど点数を低く設定する条件を満たせば、障害物300の形状などに応じた評価を行うことができる。また、不確定領域320内の点数の最大値は100点に限らず種々の値を採用できる。
なお、制御部20は、周囲に存在する他者200により形成される死角に対しても、障害物300に対する不確定領域320と同様に、死角に応じた不確定領域の予測および評価を行う。周囲に存在する他者200について不確定領域を予測する場合には、死角を形成する他者200の数に応じて不確定領域の大きさを変更する。例えば、他者200が数人重なって死角を形成する場合には、1人の他者200から形成される死角に対する不確定領域より大きな領域を、不確定領域として予測する。
S300では、種々の未来状況を予測し、その未来状況に対する評価を行うことにより、各未来状況の評価が反映されたマップ(以下、「評価マップ」と称す)が生成される。なお、障害物300に対する個の領域320に対する評価もまた、評価マップに反映される。よって、本実施形態では、他者200に対して予測された移動領域に対する評価と、死角に応じた不確定領域に対する評価とが、未来状況の評価として反映されるとともに、障害物300に対する個の領域320に対する評価が反映された評価マップが生成される。
なお、上述した通り、本実施形態では、他者200に対する移動領域の予測が、ユーザ150の現在の移動速度と、現在の移動速度より±2km/hである速度との3パターンについて行われるので、各パターンについて未来状況の評価を行う。つまり、評価マップとして、ユーザ150の移動速度に応じた3パターンのマップが生成される。
各パターンのマップに対し、ユーザ150の移動速度に応じた評価を加算する。ユーザ150の現在の移動速度からの変化量と、評価点数との関係の一例を、図9に示す。図9に示す例では、現在の移動速度からの変化量が0km/hから1km/hである場合、評価点数が、ユーザの移動速度の変化を評価する上での最小値である0点とされる。つまり、移動速度の変化が1km/h以下であれば、ユーザ150の移動のしやすさに影響を与えるものではないと評価する。
現在の移動速度からの変化量が、1km/hから3km/hまでの範囲では、当該変化量の値が大きくなるほど、すなわち、ユーザ150の移動速度が速くなるほど、一次関数で評価点数が上昇する。現在の移動速度からの変化量が3km/hにおいて、評価点数は、ユーザの移動速度の変化を評価する上での最大値である100点とされる。つまり、移動速度の変化が3km/h以上になると、移動速度の変化に伴うユーザ150の移動のしやすさは最低(すなわち、最も移動し難い)と評価される。
ユーザ150の現在の移動速度からの変化量に応じた点数を評価した後、その評価点数を、該当する評価マップの全域に加算する。なお、ユーザ150の移動速度の変化量と評価点数との関係は、移動速度の変化量が0より大きくなると、評価点数が高くなるという条件を満たしていれば、図9の例に示す関係に限らず、種々の関係を採用できる。
図10は、上述した、移動のしやすさを評価する処理(S400)を示すフローチャートである。なお、図10のフローチャートを説明するにあたり、必要に応じて、図11〜図16を参照する。制御部20は、周辺の場における大局的な流れを評価する(S401)。S401の処理は、本発明の第2評価手段の一例である。
「大局的な流れ」とは、各他者200が個々に移動する流れではなく、各他者200が個々に移動したことにより形成される全体的な流れである。よって、場合によっては、他者200の移動方向が、当該他者200を含む大局的な流れの方向とは逆方向であることもある。
S401において、制御部20は、まず、ユーザ座標系における各他者200の相対位置、相対速度、相対移動方向などから算出される流れの密度に基づき、大局的な流れの有無を判定する。流れの密度は、例えば、単位面積あたりでの、他者200の相対移動方向の重なり度合いに応じて算出される。
次に、制御部20は、大局的な流れがあると判定した場合に、その流れの方向および強さや、その流れとユーザ150および移動体100との距離などを考慮して流れ方向の絞り込みを行う。例えば、ユーザ150および移動体100から離れる方向の流れを優先する。一方、ユーザ150および移動体100とは逆方向となる流れを除外する。
また、ユーザ150および移動体100から離れる方向の流れの中でも、より強い流れが優先される。よって、例えば、ユーザ150および移動体100から離れる方向に強い流れがある場合には、その他の流れを除外する。ユーザ150および移動体100の近くにある程度の流れがある場合には、遠くに強い流れがあったとしても、その流れを除外する。
制御部20は、絞り込まれた流れについて、その流れに乗るための移動先領域(以下、この領域を「第1移動先領域」と称す)を設定する。第1移動先領域は、その流れに乗る場合に、ユーザ150および移動体100の移動距離が短く、方向転換が少なく到達できるような領域である。第1移動先領域が設定されたことにより、大局的な流れに乗るためのユーザ150および移動体100の移動方向の候補が、現在位置から第1移動先領域に向かう方向として、ある程度(例えば、0〜10度程度)の角度範囲で設定される。
制御部20は、S401の処理後、周辺の場における局所的な流れを評価する(S402)。「局所的な流れ」とは、各他者200が個々に移動する流れである。具体的に、制御部20は、局所的な流れの評価を、ユーザ座標系における各他者200の相対速度に応じて行う。S402の処理は、本発明の第2評価手段の一例である。
例えば、ユーザ150に対する他者200の相対速度が0以上(すなわち、前方にいる他者200が相対的にユーザ150から離れる状況)である場合に、ユーザ150に対する他者200の相対速度が負の値(すなわち、前方にいる他者200が相対的にユーザ150に近づく状況)である場合に比べて、ユーザ150が歩きやすいと評価する。本実施形態では、ユーザ座標系における他者200の相対速度に応じて、各他者200による局所的な流れを点数化して評価する。局所的な流れに対する評価点数は、S300にて評価された、各他者200に対して予測された移動領域に対する点数に加算される。
ユーザ座標系における他者200の相対速度と評価点数との関係の一例を図11に示す。図11に示す例では、ユーザ150に対する他者200の相対速度が0から+2km/hである場合、評価点数が、局所的な流れを評価する上での最小値である0点であるのに対し、ユーザ150に対する他者200の相対速度が負の値である場合、評価点数は0より大きい点数とされる。これは、ユーザ150が、その前を、ユーザ150と同方向に、ユーザ150と同速度またはある程度速い速度で移動する他者200について移動すると、ユーザ150が移動しやすいからである。
ユーザ150に対する他者200の相対速度が負の値である場合、当該相対速度が0から−2km/hまでの範囲では、相対値の絶対値が大きくなるほど、すなわち、前方にいる他者200がユーザ150に近づく速度が速いほど、一次関数で評価点数が上昇し、相対速度が−3km/hにおいて、評価点数は、局所的な流れを評価する上での最大値である100点とされる。つまり、他者200が、3km/h以上の速度でユーザ150に近づく場合には、当該他者200による局所的な流れに対するユーザ150の移動のしやすさは最低(すなわち、最も移動し難い)と評価される。
ユーザ150に対する他者200の相対速度が+2km/h以上である場合、0より大きい点数とされる。これは、ユーザが、その前をユーザ150に対してある程度以上の速さで遠ざかる他者200について移動したとしても、特に移動しやすいわけではないからである。
なお、ユーザ座標系における他者200の相対速度と評価点数との関係は、相対速度が0以上である場合に、ユーザ150に対する他者200の相対速度が負の値である場合に比べて評価点数が低いという条件を満たしていれば、図11の例に示す関係に限らず、種々の関係を採用できる。相対速度が0以上である場合の評価点数を一定値としてもよい。また、相対速度が+2km/h以上において取り得る最大値を、局所的な流れを評価する上での最大値としたが、当該最大値より小さい値としてもよい。
図10に戻る。制御部20は、S402の処理後、候補領域の絞り込みを行う(S403)。S403の処理は、本発明の候補抽出手段の一例である。S403において、制御部20は、まず、S300による評価に基づいて得られた評価マップ(すなわち、周辺の未来状況の評価が反映されたマップ)に対し、ユーザ150を基準として、ユーザ150の前方における180度の範囲を、一定角度刻みで分割する。例えば、図12(a)に示すように、ユーザ150の移動方向を中心として、左右を10度刻みで、評価マップを分割する。
次に、制御部20は、ユーザ150の前方に引かれた各分割線について、分割線を含み所定の幅をもつ領域(以下、この領域を「分割領域」と称す)を設定する。例えば、図12(b)に示すように、各分割線のうち、ユーザ150の位置から左右方向に延びる分割線を除く17本の分割線について、分割線を中心とする所定幅(本実施形態では、1m)の分割領域を設定する。各分割領域の端部は、一端が、移動体100およびユーザ150を包含する個の領域130の周縁により規定され、他端が、ユーザ150の前方に定められた第2移動先領域との境界線501により規定される。
「第2移動先領域」は、ユーザ150が、現在の移動速度において今後移動すると予測される領域であり、そのときのユーザ150の移動速度に応じて設定される。例えば、第2移動先領域は、ユーザ150の移動速度が遅いほど、ユーザ150の現在位置に近い位置に設定される。
なお、S401にて評価された大局的な流れに応じて第1移動先領域が設定された場合、制御部20は、分割領域の設定を、現在位置から第1移動先領域に向かう方向を含む領域に限定して行う。一方、第1移動先領域が設定されていない場合、制御部20は、ユーザ150の位置から左右方向に延びる分割線を除く17本の分割線の全てに対し、分割領域を設定する。
よって、1の評価マップに対し、分割領域は、最大で17領域設定できる。評価マップは、ユーザ150の移動速度に応じて異なるマップとして得られる。本実施形態では、ユーザ150の移動速度を3種類とし、3パターンの評価マップが得られるので、最大で、17×(3パターン)分の領域、すなわち、51の領域が設定される。
次に、制御部20は、設定された分割領域、すなわち、最大で51の分割領域のそれぞれについて、分割領域内に含まれる未来状況の評価点数を積分し、得られた積分値に基づき、分割領域の中から、経路探索を行う候補とする候補領域の絞り込みを行う。例えば、積分値が小さい順に所定数(例えば、5)の分割領域を候補領域として絞り込む。
図10に戻る。制御部20は、S403の処理後、S403にて絞り込まれた候補領域を対象として、ユーザ150が移動しやすい候補経路を設定する(S404)。S404の処理は、本発明の経路推定手段の一例である。例えば、図13に示すように、制御部20は、候補領域を、一定間隔毎に、分割線に直交する線分601を設定する。次に、制御部20は、各線分601について、未来状況の評価点数が最も低い箇所を探索して通過候補点を特定する。次に、制御部20は、各線分601において特定された通過候補点を結び、候補経路を設定する。
なお、線分上に、未来状況の評価点数が最も低い箇所がある程度の幅をもって存在する場合には、その幅における中点を通過候補点として特定する。また、線分上に、未来状況の評価点数が最も低い箇所が複数存在する場合には、複数の箇所のうち、現在の探索対象の線分601の直前に探索対象となった線分601において決定された通過候補点からの方向転換の度合いが最も少ない箇所を通過候補点として特定する。あるいは、現在の探索対象の線分601の直前に探索対象となった線分601がない場合には、ユーザ150の移動方向からの方向転換の度合いが最も少ない箇所を通過候補点とする。
図10に戻る。制御部20は、S404の処理後、S404にて設定された各候補経路について、ユーザ150の移動のしやすさを評価し(S405)、S400の処理を終了する。S405の処理は、本発明の第1評価手段の一例である。本実施形態では、第1に、ユーザ150の現在の移動方向からの方向変化が少ない候補経路であるほど、ユーザ150が移動しやすい経路であると評価する。方向変化が少ない経路とは、例えば、始点からの移動方向が、ユーザ150の現在の移動方向に近い経路といえる。
本実施形態では、図14(a)に示すように、候補経路701における始点からの移動方向と、ユーザ150の現在の移動方向とのなす角の絶対値θが小さいほど、ユーザ150が移動しやすい経路であると評価する。例えば、図14(b)に示すように、θの値が0度から5度である場合、評価点数が、候補経路を評価する上での最小値である0点とされる。これは、ユーザ150が移動するときの方向の揺らぎを考慮したものであり、θの値が0度から5度である場合は、移動時の方向の揺らぎであるとして、ユーザ150の移動のしやすさに影響を与えるものではないと評価する。
θの値が5度を越えると、45度までの範囲では、θの値が大きくなるほど、一次関数で評価点数が上昇する。そして、θの値が45度において、評価点数は、候補経路を評価する上での最大値である100点とされる。つまり、候補経路701における始点からの移動方向が、ユーザ150の現在の移動方向から45度以上変化する場合には、その候補経路をユーザ150が進む場合の移動のしやすさは最低(すなわち、最も移動し難い)と評価される。なお、図14(b)は、評価の一例である。θの値が0より大きくなると、評価点数が高くなるという条件を満たしていれば、図14(b)に示す関係に限らず、種々の関係を用いて評価を行うことができる。
また、方向変化が少ない経路とは、候補経路における終点(すなわち、第2移動先領域への到達点)と、ユーザ150が現在の移動方向に移動した場合に第2移動先領域との交点(すなわち、第2移動先領域への到達点)とが近い経路ともいえる。
本実施形態では、図15(a)に示すように、候補経路701における終点(すなわち、候補経路701と境界線501との交点)と、ユーザ150の現在の移動方向に延びる軸線801と境界線501との交点との間の距離Qが小さいほど、ユーザ150が移動しやすい経路であると評価する。このとき、距離Qがある程度の範囲であれば、ユーザ150の現在の移動方向に概ね合致しており、ユーザ150の移動のしやすさに影響を与えるものではないと評価する。
なお、上述したように、第2移動先領域は、そのときのユーザ150の移動速度に応じて設定されるため、第2移動先領域の位置に応じて、ユーザ150の移動のしやすさに影響を与えないとする距離Qの範囲も異なる。第2移動先領域の位置(すなわち、境界線501の位置)がユーザ150から遠くなるほど、ユーザ150の移動のしやすさに影響を与えないとする距離Qの範囲は広くなる。
例えば、境界線501がユーザ150の現在位置から5m離れている場合、図15(b)に示すように、距離Qが0mから2mである場合、評価点数が、候補経路を評価する上での最小値である0点とされる。つまり、5mの移動に対し、距離Qが2m以下であれば、ユーザ150の移動のしやすさに影響を与えるものではないと評価する。
図15(b)に示す例において、距離Qが2mを越えると、10mまでの範囲では、Qの値が大きくなるほど、一次関数で評価点数が上昇する。そして、Qの値が10mにおいて、評価点数は、候補経路を評価する上での最大値である100点とされる。つまり、候補経路における終点が、軸線801と境界線501との交点から10m以上離れている場合には、その候補経路をユーザ150が進む場合の移動のしやすさは最低(すなわち、最も移動し難い)と評価される。
なお、図15(b)には、境界線501がユーザ150の現在位置から5m離れている場合を例示したが、ユーザ150の現在位置と境界線501との距離として設定可能な数だけ、距離Qと評価点数との関係が準備されており、それらの中から、ユーザ150の移動速度に応じて設定される第2移動先領域の位置に応じたものが用いられる。あるいは、図15(b)に示す関係において、横軸の値を、所定の関数に応じてユーザ150の移動速度から算出する構成としてもよい。
図15(b)は、評価の一例である。Qの値が0より大きくなると、評価点数が高くなるという条件を満たしていれば、図15(b)に示す関係に限らず、種々の関係を用いて評価を行うことができる。
本実施形態では、第2に、他者200の進路による妨害を考慮して、ユーザの移動しやすさを評価する。具体的には、候補経路を挟む、他者200に対する移動領域250の幅を考慮して、ユーザの移動しやすさを評価する。例えば、図16(a)に示すように、候補経路を挟む移動領域250の間に設定した進む幅Wが、排除領域130aにおける移動方向に直交する向きの幅Z以上の幅である場合に、ユーザ150の移動のしやすさに影響を与えるものではないと評価する。進む幅Wは、候補経路を挟む移動領域250の各中心を結ぶ線分のうち、その両側から他者200に対する排除領域220aの幅Mの半分の長さを差し引いた線分の長さとする。
図16(b)に示す例では、Wの値が、排除領域170aの幅Z以上の幅である場合、評価点数が、候補経路を評価する上での最小値である0点とされる。つまり、この例では、Wの値が幅Z以上の幅である場合、ユーザ150の移動のしやすさに影響を与えるものではないと評価する。
Wの値が、排除領域170aの幅Zより狭い幅である場合、Wの値が小さくなるほど、一次関数で評価点数が上昇する。そして、Wの値が、幅Zの1/4、すなわち、(1/4)Zであるときに、評価点数は、候補経路を評価する上での最大値である100点とされる。つまり、Wの値が、幅Z(すなわち、ユーザ150の排除領域170aの幅)の1/4以下である場合には、その候補経路をユーザ150が進む場合の移動のしやすさは最低(すなわち、最も移動し難い)と評価される。
候補領域毎に、進む幅Wに対する評価は、その候補経路を挟む移動領域の数だけ行い、各評価での評価点数を加算して、ユーザの移動しやすさを評価する。なお、幅Wは、他者200に対する排除領域220aが考慮されているので、ユーザ100の移動に対して、他者200にかかる負荷もできるだけ少なくなるよう考慮されている。
本実施形態では、上述した第1の評価(すなわち、ユーザ150の現在の移動方向からの方向変化に応じた評価)による評価点数と、第2の評価(すなわち、進む幅Wに応じた評価)による評価点数との合算値を、各候補経路に対するユーザ150の移動のしやすさとして評価とする。
なお、図16(b)は、評価の一例である。幅Wが幅Zより小さくなると、評価点数が高くなるという条件を満たしていれば、図16(b)に示す関係に限らず、種々の関係を用いて評価を行うことができる。
図17を参照して、本実施形態において、上述したS500にて行われる経路決定処理について説明する。経路決定処理は、S400による評価に基づいて、候補経路の中から、最適経路を決定する処理である。
S500において、制御部20は、各候補経路について、候補経路上の通過候補点毎に、S405にて評価された点数(本実施形態では、第1の評価による評価点数と、第2の評価による評価点数との合算値)と、評価マップにおける候補経路上の点数とを合算して評価する。
具体的に、制御部20は、まず、図16(a)に示すように、候補経路の始点からの距離を横軸とするグラフに対し、通過候補点毎に、S405にて評価された点数をプロットする。よって、候補経路の始点C0から最初の通過候補点Caに到達するまでは、点数が0点から、S405にて評価された点数まで一次関数で上昇し、最後の通過候補点Cbから候補経路の終点C1に到達するまでは、点数が、S405にて評価された点数から0点まで一次関数で減少するグラフが作成される。なお、当該グラフは、候補経路毎に作成される。
次に、制御部20は、S405にて評価された点数をプロットして作成された、候補経路毎の各グラフについて、通過候補点毎に、評価マップにおける候補経路上の点数を加算する。これにより、例えば、図16(b)に示すグラフが得られる。制御部20は、評価マップにおける点数が加算されたグラフのうち、積分値が最も小さいグラフに対応する候補経路を抽出する。
次に、制御部20は、抽出された候補経路について、積分値が下がるよう、評価マップにおける点数と、候補経路に対するユーザ150の移動のしやすさを示す点数とを調整する。制御部20は、調整によって最適化された候補経路を最適経路として決定する。制御部20は、決定された最適経路における最初の移動方向を、ユーザ150に最適な移動方向として決定する。
なお、S403において、最大で17の分割領域において、ユーザ150の移動が、例えば、人だかりなどで困難と推定される場合には、ユーザ150の位置から左右またはいずれかの方向を、最適な移動方向として決定する。
このように決定された、ユーザ150に最適な移動方向は、S600の処理により、移動体100の動きによってユーザ150に提示される。ユーザ150は、移動体100の動きを参照して移動することができる。移動体100の動きは、上述した通り、ユーザ150が周辺の状況下にて最適と推定された移動方向を示すので、ユーザ100は、移動体100の動きに応じて移動することにより、周辺の状況に対して好適に移動すること可能となる。
本実施形態の移動体100によれば、周辺の状況が評価された評価マップを用い、ユーザ150が移動しやすいよう、周辺状態に応じた適切な移動方向を当該ユーザ150に提示することができる。特に、周辺に存在する他者200の流れ(大局的、局所的)を評価することにより、その流れに応じた移動方向を設定できるので、周囲の流れに適した移動方向をユーザ150に提示できる。
また、移動体100は、ユーザ150の現在からの移動方向からの方向変化が少ない方向を優先的に提示するので、ユーザ150の移動に大きな方向変化を強いることを抑制できる。また、移動体100は、ユーザ150の現在の移動速度から速度変化が少ない方向を優先的に提示するので、ユーザ150の移動に大きな速度変化を強いることを抑制できる。また、移動体100は、他者200の進路によって妨害され難い方向を優先的に提示するので、ユーザ150と他者200との接触を抑制できる。また、移動体100は、死角に基づく不確定領域を考慮した方向をユーザに提示するので、死角から飛び出すヒトとの接触を抑制できる。
周辺に存在する他者200の予測時間t後の移動領域を予測する場合に、予測時間tとして、他者200の状況に応じた可変値が用いられるので、移動体100は、他者200の状況が考慮された移動しやすい方向をユーザ150に提示できる。特に、予測時間tは、移動体100と他者200との相対位置と、ユーザ100に対する他者200との相対速度に応じた値とされるので、移動体100は、他者200との接触を回避可能な方向を提示できる。また、猶予距離αを考慮した予測時間tが算出されるので、移動体100は、他者200に対し、余裕のある位置でユーザ150に移動方向を提示できる。これにより、移動体100は、周囲に対する露払いであるかのようにユーザ150に移動方向を提示することができる。
移動体100は、ユーザ150および移動体100を包含する個の領域130の排除領域130aだけでなく、他者200の個の領域220における排除領域220を考慮した方向を、ユーザ150に提示する。よって、移動体100がユーザ150に提示する方向は、ユーザ150にとって移動しやすい方向であるだけでなく、他者200にとっても、ユーザ100の移動により生じる負荷を抑制できる。
以上、実施形態に基づき本発明を説明したが、本発明は上記実施形態に何ら限定されるものではなく、本発明の趣旨を逸脱しない範囲内で種々の改良変形が可能であることは容易に推察できるものである。
例えば、上記実施形態で挙げた数値は一例であり、他の数値を採用することは当然可能である。
上記実施形態では、ユーザ150の周辺にて移動する移動体として、ヒトである他者200を例示したが、犬や猫などの動物や、低速で走行する自転車などの車両、なども移動体として同様に評価することができる。
上記実施形態では、個の領域120,170,220について、相手を入らせないようにするための排除領域120a,170a,220aを設け、排除領域120a,170a,220aに対し、点数としての最大値である200点を設定する構成とした。これに代えて、排除領域を設けず、移動体100、ユーザ150、および他者200の各中心から周縁に向けて徐々に点数が下がる構成としてもよい。
上記実施形態では、予測時間tの算出や幅Wの算出に際して、排除領域130aおよび排除領域220aを考慮する構成としたが、排除領域130aや排除領域220aでなく、個の領域130および個の領域220を考慮する構成としてもよい。
上記実施形態では、制御部20は、移動体座標系における各パラメータを、ユーザ座標系に変換し、周辺の状態をユーザ150の状態を基準として把握する構成とした。これに代えて、制御部20は、移動体座標系における各パラメータ(すなわち、センシング部10からの入力に基づき取得される各パラメータ)から、ユーザ150および周辺の各状態を把握する構成としてもよい。
上記実施形態では、ユーザ座標系における他者の相対移動方向を、移動体100に対する他者または障害物の相対移動方向θiと、移動体100に対するユーザ150の相対移動方向θ0とから算出する構成としたが、移動体100に対するユーザ150の体の向きθBを考慮して、ユーザ座標系における他者の相対移動方向を算出する構成としてもよい。つまり、相対移動方向θ0を体の向きθBで補正し、補正後の相対移動方向と、相対移動方向θiとから、ユーザ座標系における他者の相対移動方向を算出してもよい。
上記実施形態では、予測時間tを、各他者200についてそれぞれ(Δx−α)/Δvから算出する構成とした。つまり、上記実施形態は、予測時間tを、各他者200の状況に応じた可変値としたが、予測時間tを各他者200の状況に依存しない特定の値としてもよい。
なお、予測時間tを、特定の値とする場合には、ユーザ周辺の流れの速さに応じて、その都度予測時間tを変化させる構成としてもよい。例えば、ユーザ周辺の流れが比較的遅い場合には、予測時間tを長めの時間とし、ユーザ周辺の流れが速くなるにつれて、予測時間tを短くしてもよい。予測時間tがユーザ周辺の流れに応じて変化する場合、当該変化に応じてメイン処理の実行間隔が変更されてもよい。
上記実施形態では、猶予距離αを考慮して予測時間tを算出する構成としたが、α=0としてもよい。すなわち、他者200と移動体100とが相対速度Δvで、両者を結ぶ線上に沿って近づいた場合に、両者とが接触するまでの時間を、予測時間tとして算出する距離としてもよい。
上記実施形態では、予測時間tを、他者200と移動体100との距離であるΔxと、ユーザ座標系における他者200の相対速度であるΔvとを用いて算出する構成としたが、例えば、ユーザ座標系における他者200の相対速度を他者200と移動体100とを結ぶ方向に分解した成分の速度を、Δvとして用いる構成としてもよい。
上記実施形態では、ユーザ150の移動速度の変化を考慮し、現在の移動速度を含む3種類の移動速度を用いて、3パターンの評価マップを生成する構成とした。これに代えて、ユーザ150の移動速度の変化を考慮せず、現在の移動速度のみから1パターンの評価マップを生成する構成としてもよい。
上記実施形態では、ユーザ150の移動速度の変化幅を、−2km/hから+2km/hまでの範囲としたが、これに限らず、−3km/hから+3km/hまでなど、種々の変化幅を採用できる。また、変化幅の範囲内での刻み幅を、2km/hとしたが、変化幅の範囲内であれば、1km/hなど種々の刻み幅を採用できる。
上記実施形態では、評価マップに分割領域を設定するための分割線を、ユーザ150の前方を一定角度刻みで分割する線としたが、一定角度刻みでなく、例えば、ユーザ150の移動方向に対する角度が小さい側では、分割線の刻み方を密とし、ユーザ150の左右方向に近い側では、分割線の刻み方を疎としてもよい。
上記実施形態では、S401において、大局的な流れがあると判定された場合に、その流れおよび強さなどを考慮して、大局的な流れに乗るための移動方向を絞り込む一方で、S402において、局所的な流れを点数によって評価し、その評価点数を評価マップ上にて加算する構成とした。これに代えて、大局的な流れについても、局所的な流れと同様、点数によって評価し、その評価点数を評価マップ上にて加算する構成としてもよい。
あるいは、局所的な流れについても、大局的な流れと同様、流れの有無を判定し、局所的な流れがあると判定された場合に、ユーザ150との相対速度などに応じて、局所的な流れに乗るための移動方向を絞り込む構成としてもよい。なお、局所的な流れに乗るための移動方向が絞り込まれた場合には、S403において、分割領域の設定が、絞り込まれた移動方向を含む領域に限定して行う。
上記実施形態では、大局的な流れと局所的な流れとの両方を考慮する構成としたが、いずれか一方であってもよい。また、大局的な流れと局所的な流れとでそれぞれ別途最適な移動方向を決定する構成としてもよい。かかる場合、最適な移動方向として異なる結果がでた場合に、大局的な流れに基づき決定されたものであるか、局所的な流れに基づき決定されたものであるかに応じて、提示の態様を変える構成としてもよい。
上記実施形態では、S404において、候補領域に設定した線分601上における、未来状況の評価点数が最も低い箇所を結ぶことによって、候補経路を設定する構成としたが、候補領域ないにおける点数が低い領域に接する線分を結ぶことによって、経路候補を設定する構成としてもよい。
上記実施形態では、S500において、候補経路の中から、積分値が最も小さいグラフに対応する候補経路が抽出される構成としたが、積分値が最も小さいグラフに対応する候補経路であっても、各通過候補点における、S405にて評価された点数と、評価マップにおける候補経路上の点数との合計点数が、所定の条件に該当する候補経路は、抽出の対象から除外する構成としてもよい。例えば、前記合計点数が、隣接する通過候補点に対して急激に上昇する候補経路は、抽出の対象から除外する。あるいは、前記合計点数の最大値が所定値より高い候補経路は、抽出の対象から除外する。
上記実施形態では、抽出された候補経路について、評価マップにおける点数と、候補経路に対するユーザ150の移動のしやすさを示す点数とを調整して、積分値を下げる構成としたが、各通過候補点における、S405にて評価された点数と、評価マップにおける候補経路上の点数との合計点数が好ましく変化するような調整を行う構成としてもよい。例えば、隣接する通過候補点に対して急激に上昇する前記合計点数が下がるような調整を行う構成としてもよい。あるいは、前記合計点数の最大値が下がるような調整を行う構成としてもよい。
上記実施形態では、S500において、1の最適経路が決定される構成としたが、方向にある程度の範囲がある状態で経路が決定される構成としてもよい。本変形例では、S600にて、移動方向をユーザ150に提示する場合に、その範囲の中で所定の方向(例えば、当該範囲における中央)を提示するようにすればよい。
上記実施形態では、ユーザ150に最適な移動方向を、移動体100の動きによりユーザ150に提示する構成としたが、これに限らず、例えば、最適な移動方向を、表示部103のディスプレイに文字や矢印などで表示することによって提示する構成としてもよい。あるいは、HMI部40にスピーカを設け、最適な移動方向を音声によって提示する構成としてもよい。
上記実施形態では、S300において、周辺の未来状況および不確定領域を予測し、それらを評価する構成としたが、場の予測および評価は、上記方法に限らず、他のモデルを利用して行うこともできる。例えば、ヒトを粒子としたヒトの流れのモデルや、速度ベクトル場によるヒトの流れのモデルなどを用いて、場の予測および評価を行ってもよい。例えば、「山本江,岡田昌史,人の歩行軌跡データを用いた歩行者群モデルのパラメータ同定と交差流制御への応用,第29回日本ロボット学会学術講演会,RSJ2011AC1N1−2(CD−ROM),2011(9月7日,東京)」にて引用されるモデルである、ソーシャルフォースモデル(social force model)や、ソーシャルフォースモデルと同様のモデルに予測による衝突回避行動を加えたモデルや、目的地の選択などの意思決定モデルや、複数のヒトの流れが交差する「交差流」と呼ばれる現象に着目したモデルなどを用いて、場の予測および評価を行ってもよい。
100 移動体
150 ユーザ
200 周辺に存在する他者
300 周辺に存在する障害物

Claims (17)

  1. 移動体であって、
    ユーザの状況を検知するユーザ検知手段と、
    周辺の状況を検知する周辺状況検知手段と、
    前記周辺状況検知手段により検知された周辺の状況に基づいて、前記周辺に存在する物体の移動を、当該周辺の未来状況として予測する周辺予測手段と、
    前記周辺予測手段により予測された前記周辺の未来状況と、前記ユーザ検知手段により検知された前記ユーザの状況とに基づいて、前記ユーザに提示する移動方向を決定する決定手段と、
    前記決定手段により決定された移動方向に応じた向きを、前記ユーザの前方周囲にて当該ユーザに提示する提示手段とを備え
    前記決定手段は、
    前記周辺予測手段により予測された前記周辺の未来状況と、前記ユーザ検知手段により検知された前記ユーザの状況とに基づいて、前記ユーザの移動方向に逆らわない前記物体の流れのうち、前記ユーザの移動速度と所定範囲内の速度差で流れる流れに応じた方向を、前記ユーザに提示する移動方向を決定するための方向の候補として優先して抽出する候補抽出手段を備え、
    その候補抽出手段により抽出された候補に基づいて、前記ユーザに提示する移動方向を決定するものであることを特徴とする移動体。
  2. 前記決定手段は、前記周辺予測手段により予測された前記周辺の未来状況と、前記ユーザ検知手段により検知された前記ユーザの状況とに基づいて、前記周辺における前記ユーザの移動のし易さを評価し、その移動のし易さに基づいて、前記ユーザに提示する移動方向を決定するものであることを特徴とする請求項1記載の移動体。
  3. 前記決定手段は、
    前記周辺予測手段により予測された前記周辺の未来状況と、前記ユーザ検知手段により検知された前記ユーザの状況とに基づいて、前記周辺における前記ユーザの移動のし易さを評価する第1評価手段とを備え、
    前記第1評価手段による評価に基づいて、前記ユーザに提示する移動方向を決定するものであることを特徴とする請求項1又は2に記載の移動体。
  4. 前記決定手段は、
    前記周辺予測手段により予測された前記周辺の未来状況に基づいて、前記周辺における前記物体の流れを評価する第2評価手段を備え、
    前記第2評価手段により評価された前記物体の流れに基づいて、前記ユーザに提示する移動方向を決定するものであることを特徴とする請求項1から3のいずれかに記載の移動体。
  5. 前記ユーザ検知手段により検知された前記ユーザの状況に基づいて、当該ユーザの前方周囲にて前記移動体を移動させる移動制御手段と、
    前記提示手段は、前記決定手段により決定された移動方向に応じた向きを示すよう、前記ユーザの前方周囲にて、前記移動制御手段により、前記移動体を移動させることにより、当該移動方向を前記ユーザに提示することを特徴とする請求項1から4のいずれかに記載の移動体。
  6. 前記決定手段は、
    前記周辺予測手段により予測された前記周辺の未来状況に基づいて、前記周辺における前記物体の流れを評価する第2評価手段を備え、
    前記候補抽出手段は、前記第2評価手段により評価された前記物体の流れのうち、前記ユーザの移動方向に逆らわない流れに応じた方向を、前記候補として優先して抽出することを特徴とする請求項1から5のいずれかに記載の移動体。
  7. 前記周辺予測手段は、前記周辺状況検知手段により検知された周辺の状況に基づいて、前記物体の移動と、前記周辺に存在する前記物体による死角に基づく、今後の推移が不確かな領域とを、前記周辺の未来状況として予測することを特徴とする請求項1からのいずれかに記載の移動体。
  8. 前記周辺予測手段は、所定の予測時間後に前記物体が存在し得る領域を、前記物体の移動として予測することを特徴とする請求項1からのいずれかに記載の移動体。
  9. 前記所定の予測時間は、前記周辺に存在する物体のそれぞれについて、前記各物体の状況に応じた可変値であることを特徴とする請求項記載の移動体。
  10. 前記周辺予測手段は、前記物体のうち、前記ユーザおよび前記移動体に対し相対的に近づく物体を対象とし、対象となる前記物体のそれぞれについて前記領域の予測を行い、
    前記所定の予測時間は、前記ユーザまたは前記移動体と前記物体との間の距離に応じた値と、前記ユーザまたは前記移動体に対する前記物体の相対速度とに基づく値であることを特徴とする請求項またはに記載の移動体。
  11. 前記所定の予測時間は、前記ユーザおよび前記移動体と前記物体とが、前記ユーザまたは前記移動体に対する前記物体の相対速度で近づいた場合に、前記ユーザおよび前記移動体を包括する周囲に所定の大きさで設けられた第1領域と、前記物体の周囲に所定の大きさで設けられた第2領域との間が所定の猶予距離だけ離れた位置に到達するまでの時間として算出されることを特徴とする請求項1記載の移動体。
  12. 前記ユーザが、前記周辺予測手段により予測される前記周辺の未来状況において、前記候補抽出手段により候補として抽出された方向に応じた向きで、前記ユーザ検知手段により検知されたユーザの状況に応じて定められる目標領域に移動した場合に、当該目標領域に到達するまでに、前記物体による影響を最も受け難い経路を推定する経路推定手段を備え、
    前記決定手段は、
    記周辺予測手段により予測された領域について、前記経路推定手段により推定された経路を挟む領域がある場合、当該経路を挟む領域間の幅が広いほど、前記ユーザが移動し易いと評価する第1評価手段を備え、
    その第1評価手段による評価に基づいて、前記ユーザに提示する移動方向を決定するものである請求項から1のいずれかに記載の移動体。
  13. 前記第1評価手段は、前記経路を挟む領域間の幅が、前記ユーザおよび前記移動体を包括する周囲に所定の大きさで設けられた第1領域の幅より広い場合には、当該第1領域の幅より狭い場合に比べて、前記ユーザが移動し易いと評価することを特徴とする請求項1記載の移動体。
  14. 前記経路を挟む領域間の幅は、各領域の中心を結んだ場合に、当該各領域に対応する前記物体の周囲にそれぞれ所定の大きさで設けられた第2領域の外側となる線分の長さであることを特徴とする請求項1または1に記載の移動体。
  15. 前記ユーザが、前記周辺予測手段により予測される前記周辺の未来状況において、前記候補抽出手段により候補として抽出された方向に応じた向きで、前記ユーザ検知手段により検知されたユーザの状況に応じて定められる目標領域に移動した場合に、当該目標領域に到達するまでに、前記物体による影響を最も受け難い経路を推定する経路推定手段を備え、
    前記決定手段は、
    記経路推定手段により推定された経路のうち、終点の位置が、前記ユーザ検知手段により検知されたユーザの状況が示す移動方向と前記目標領域とが交差する位置に近い経路ほど、前記ユーザが移動し易いと評価する第1評価手段を備え、
    その第1評価手段による評価に基づいて、前記ユーザに提示する移動方向を決定するものであることを特徴とする請求項3から1のいずれかに記載の移動体。
  16. 前記ユーザが、前記周辺予測手段により予測される前記周辺の未来状況において、前記候補抽出手段により候補として抽出された方向に応じた向きで、前記ユーザ検知手段により検知されたユーザの状況に応じて定められる目標領域に移動した場合に、当該目標領域に到達するまでに、前記物体による影響を最も受け難い経路を推定する経路推定手段を備え、
    前記決定手段は、
    記経路推定手段により推定された経路のうち、前記ユーザ検知手段により検知されたユーザの状況が示す移動方向に対する、始点からの移動方向の角度変化の絶対値が小さい経路ほど、前記ユーザが移動し易いと評価する第1評価手段を備え、
    その第1評価手段による評価に基づいて、前記ユーザに提示する移動方向を決定するものであることを特徴とする請求項3から1のいずれかに記載の移動体。
  17. 前記周辺予測手段は、前記ユーザ検知手段により検知されたユーザの状況が示す当該ユーザの移動速度を用いて前記物体の移動を予測するとともに、前記ユーザの移動速度とは異なる移動速度を用いて前記物体の移動を予測し、
    前記候補抽出手段は、前記周辺予測手段により前記ユーザの移動速度毎に予測された前記物体の移動を含む、前記周辺の未来状況に基づいて、前記ユーザの移動速度毎に、前記ユーザに提示する移動方向を決定するための方向の候補を抽出し、
    前記経路推定手段は、前記ユーザの移動速度毎に、前記物体による影響を最も受け難い経路を推定し、
    前記第1評価手段は、前記経路推定手段により前記ユーザの移動速度毎に推定された経路のうち、前記物体の移動を予測するために用いた前記ユーザの移動速度が、前記ユーザ検知手段により検知されたユーザの状況が示す当該ユーザの移動速度に近い経路ほど、前記ユーザが移動し易いと評価することを特徴とする請求項1から1のいずれかに記載の移動体。
JP2016566145A 2014-12-25 2015-12-16 移動体 Active JP6388141B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2014262883 2014-12-25
JP2014262883 2014-12-25
PCT/JP2015/085151 WO2016104265A1 (ja) 2014-12-25 2015-12-16 移動体

Publications (2)

Publication Number Publication Date
JPWO2016104265A1 JPWO2016104265A1 (ja) 2017-09-14
JP6388141B2 true JP6388141B2 (ja) 2018-09-12

Family

ID=56150290

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016566145A Active JP6388141B2 (ja) 2014-12-25 2015-12-16 移動体

Country Status (4)

Country Link
US (1) US10331140B2 (ja)
JP (1) JP6388141B2 (ja)
CN (1) CN107111317B (ja)
WO (1) WO2016104265A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11526172B2 (en) 2018-06-19 2022-12-13 Sony Corporation Mobile object control apparatus and mobile object control method

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019035362A1 (ja) * 2017-08-18 2019-02-21 三菱電機株式会社 ロボット制御装置およびこれを用いたロボットシステム
JP6894596B2 (ja) * 2018-03-29 2021-06-30 株式会社エクォス・リサーチ 移動体
EP3841358A4 (en) 2018-08-21 2022-06-08 Moonshot Health Inc. SYSTEMS AND METHODS FOR MAPPING A GIVEN ENVIRONMENT
CN111103875B (zh) * 2018-10-26 2021-12-03 科沃斯机器人股份有限公司 避让的方法、设备及存储介质
US20210072027A1 (en) * 2019-09-09 2021-03-11 Caci, Inc. - Federal Systems and methods for providing localization and navigation services
JP7487478B2 (ja) * 2020-01-23 2024-05-21 セイコーエプソン株式会社 移動ロボットの制御方法及び制御装置、並びに、ロボットシステム
JP7232210B2 (ja) * 2020-03-31 2023-03-02 株式会社アイシン 移動体制御装置、移動体制御プログラム及び移動体
JP7004475B1 (ja) * 2020-11-13 2022-01-21 三菱電機株式会社 経路生成システム、経路生成方法、経路生成プログラム、及び自律移動体
CN112880689A (zh) * 2021-01-29 2021-06-01 北京百度网讯科技有限公司 一种领位方法、装置、电子设备及存储介质

Family Cites Families (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE10301468B4 (de) * 2002-01-18 2010-08-05 Honda Giken Kogyo K.K. Vorrichtung zur Beobachtung der Umgebung eines Fahrzeugs
JP3987048B2 (ja) * 2003-03-20 2007-10-03 本田技研工業株式会社 車両周辺監視装置
JP4055656B2 (ja) * 2003-05-30 2008-03-05 トヨタ自動車株式会社 衝突予測装置
US7117090B2 (en) * 2003-08-28 2006-10-03 Siemens Aktiengesellschaft Moving vehicle in cuboidal panorama
JP3987057B2 (ja) * 2004-06-14 2007-10-03 本田技研工業株式会社 車両周辺監視装置
US7899211B2 (en) * 2005-12-07 2011-03-01 Nissan Motor Co., Ltd. Object detecting system and object detecting method
CN101583842B (zh) * 2006-12-05 2011-11-16 株式会社纳维泰 导航系统、便携终端装置及周边图像显示方法
JP4528295B2 (ja) * 2006-12-18 2010-08-18 株式会社日立製作所 案内ロボット装置及び案内システム
JP4682973B2 (ja) * 2006-12-19 2011-05-11 トヨタ自動車株式会社 移動経路作成方法、自律移動体および自律移動体制御システム
JP4371153B2 (ja) 2007-06-15 2009-11-25 トヨタ自動車株式会社 自律移動装置
CN100524363C (zh) * 2007-06-29 2009-08-05 中国科学院计算技术研究所 一种用于动态实体的分层避障方法
JP2009151382A (ja) 2007-12-18 2009-07-09 Toyota Motor Corp 移動体
JP4717105B2 (ja) * 2008-08-29 2011-07-06 株式会社日立製作所 自律移動ロボット装置及びかかる装置における飛び出し衝突回避方法
JP5086942B2 (ja) 2008-09-02 2012-11-28 トヨタ自動車株式会社 経路探索装置、経路探索方法、及び経路探索プログラム
JP5581770B2 (ja) * 2010-03-26 2014-09-03 ソニー株式会社 ロボット装置及びロボット装置による情報提供方法
JP2012203646A (ja) * 2011-03-25 2012-10-22 Advanced Telecommunication Research Institute International 流れ状態判別装置、流れ状態判別方法、流れ状態判別プログラムおよびそれらを用いたロボット制御システム
US10246030B2 (en) * 2012-08-09 2019-04-02 Toyota Jidosha Kabushiki Kaisha Object detection apparatus and driving assistance apparatus
CN104768821A (zh) * 2012-11-08 2015-07-08 丰田自动车株式会社 驾驶辅助装置和方法、碰撞预测装置和方法以及通知装置和方法
CN103823466B (zh) * 2013-05-23 2016-08-10 电子科技大学 一种动态环境下移动机器人路径规划方法
KR20150055271A (ko) * 2013-11-13 2015-05-21 현대모비스 주식회사 타겟의 운동 특성 판단 장치 및 이를 구비하는 주행 경로 제어 장치

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11526172B2 (en) 2018-06-19 2022-12-13 Sony Corporation Mobile object control apparatus and mobile object control method

Also Published As

Publication number Publication date
WO2016104265A1 (ja) 2016-06-30
CN107111317A (zh) 2017-08-29
JPWO2016104265A1 (ja) 2017-09-14
US20170357264A1 (en) 2017-12-14
CN107111317B (zh) 2020-07-17
US10331140B2 (en) 2019-06-25

Similar Documents

Publication Publication Date Title
JP6388141B2 (ja) 移動体
US10546201B2 (en) Method and apparatus for determining abnormal object
US11001196B1 (en) Systems and methods for communicating a machine intent
CN108537326B (zh) 用于自动驾驶车辆的方法、介质和系统
AU2015262344B2 (en) Processing apparatus, processing system, processing program, and processing method
JPWO2016098238A1 (ja) 走行制御装置
WO2013046563A1 (ja) 自律移動装置、自律移動方法、及び、自律移動装置用のプログラム
JP2019053658A (ja) 車両制御装置
JP2012243029A (ja) 経路探索機能付き移動体
JP2012200818A (ja) 歩行者の軌跡を予測して自己の回避行動を決定するロボット
US9607230B2 (en) Mobile object control apparatus and target object detecting apparatus
JP5577126B2 (ja) 走行支援装置
WO2013171905A1 (ja) 自律移動装置、制御装置および自律移動方法
JP4937844B2 (ja) 歩行者検出装置
Pundlik et al. Collision detection for visually impaired from a body-mounted camera
JP2022008854A (ja) 制御装置
Kenk et al. Human-aware Robot Navigation in Logistics Warehouses.
JP2009301123A (ja) 車両の運転支援装置
JP7178066B2 (ja) ロボット、並びに、その行動計画装置及び行動計画用プログラム
Vorapatratorn et al. Fast obstacle detection system for the blind using depth image and machine learning.
JP2022132902A (ja) 移動体の制御システム、移動体、移動体の制御方法、およびプログラム
US20240112580A1 (en) Traffic safety support system and storage medium
JP2006092253A (ja) 自律移動装置
CN115713738A (zh) 使用神经网络模型的凝视和意识预测
JP2022181105A (ja) 移動体、制御装置及びそのプログラム

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20170414

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20170606

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20170414

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20180206

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180409

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20180731

R150 Certificate of patent or registration of utility model

Ref document number: 6388141

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250