JP7489609B2 - MOBILE SYSTEM AND MOBILE SYSTEM CONTROL METHOD - Google Patents
MOBILE SYSTEM AND MOBILE SYSTEM CONTROL METHOD Download PDFInfo
- Publication number
- JP7489609B2 JP7489609B2 JP2019184813A JP2019184813A JP7489609B2 JP 7489609 B2 JP7489609 B2 JP 7489609B2 JP 2019184813 A JP2019184813 A JP 2019184813A JP 2019184813 A JP2019184813 A JP 2019184813A JP 7489609 B2 JP7489609 B2 JP 7489609B2
- Authority
- JP
- Japan
- Prior art keywords
- area
- detection
- moving body
- moving
- detection area
- 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
Links
- 238000000034 method Methods 0.000 title claims description 33
- VJYFKVYYMZPMAB-UHFFFAOYSA-N ethoprophos Chemical compound CCCSP(=O)(OCC)SCCC VJYFKVYYMZPMAB-UHFFFAOYSA-N 0.000 title 2
- 238000001514 detection method Methods 0.000 claims description 325
- 230000008569 process Effects 0.000 claims description 14
- 230000008859 change Effects 0.000 claims description 7
- 238000004891 communication Methods 0.000 description 40
- 230000032258 transport Effects 0.000 description 34
- 238000003860 storage Methods 0.000 description 16
- 238000012545 processing Methods 0.000 description 14
- 230000015654 memory Effects 0.000 description 13
- 230000006870 function Effects 0.000 description 11
- 238000013459 approach Methods 0.000 description 3
- 230000010354 integration Effects 0.000 description 3
- 239000004065 semiconductor Substances 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005192 partition Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000004590 computer program Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000003466 welding Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
本開示は、移動体システム、及び移動体制御方法に関する。より詳細には、本開示は、移動体を制御する移動体システム、及び移動体制御方法に関する。 The present disclosure relates to a mobile body system and a mobile body control method . More particularly, the present disclosure relates to a mobile body system and a mobile body control method for controlling a mobile body.
特許文献１は、障害物検知領域内の障害物を検知する自動車用障害物検知装置を開示する。自動車用障害物検知装置は、自車（移動体）の予測進路と自車周辺の特定の道路構成物とに応じて、自車の進行方向の前方に、障害物検知領域（検知領域）を設定する検知領域設定部を有している。障害物検知部が、障害物検知領域において障害物を検知すると、自動車が警報で報知したり、制動制御を実行したりする。
上述の自動車用障害物検知装置において、自動車の外部から障害物検知領域を設定することが要望されていた。 In the above-mentioned automobile obstacle detection device, there was a demand for the obstacle detection area to be set from outside the automobile.
本開示の目的は、外部からの制御指示で検知領域を設定可能な移動体システム、及び移動体制御方法を提供することにある。 An object of the present disclosure is to provide a mobile body system and a mobile body control method capable of setting a detection area based on an external control instruction.
本開示の一態様の移動体システムは、移動体と、前記移動体に制御指示を出力する上位システムと、を備える。前記移動体は、物体の検知領域を前記移動体の周囲に設定する領域設定部と、前記検知領域における物体の検知結果に基づいて前記移動体を制御する制御部と、を有する。前記領域設定部は、前記制御指示に基づいて前記検知領域を設定する。前記移動体の移動状態は、移動速度と移動方向との少なくとも一方が異なる複数種類の移動モードを含む。前記領域設定部は、前記移動体の前記移動モードに応じて前記検知領域を変更する。複数種類の前記移動モードは、直進走行モードと、カーブ走行モードと、旋回走行モードとを少なくとも含む。 A mobile body system according to one aspect of the present disclosure includes a mobile body and a host system that outputs a control instruction to the mobile body. The mobile body has a region setting unit that sets an object detection region around the mobile body, and a control unit that controls the mobile body based on a detection result of the object in the detection region. The region setting unit sets the detection region based on the control instruction . The moving state of the mobile body includes a plurality of types of moving modes in which at least one of a moving speed and a moving direction is different. The region setting unit changes the detection region according to the moving mode of the mobile body. The plurality of types of moving modes include at least a straight running mode, a curve running mode, and a cornering running mode.
本開示の一態様の移動体制御方法は、物体の検知領域を移動体の周囲に設定する領域設定処理と、前記検知領域における物体の検知結果に基づいて前記移動体を制御する制御処理と、を含む。前記移動体の移動状態は、移動速度と移動方向との少なくとも一方が異なる複数種類の移動モードを含む。前記領域設定処理では、前記移動体の前記移動モードに応じて前記検知領域を変更する。複数種類の前記移動モードは、直進走行モードと、カーブ走行モードと、旋回走行モードとを少なくとも含む。 A moving body control method according to an aspect of the present disclosure includes a region setting process for setting an object detection region around a moving body, and a control process for controlling the moving body based on a result of object detection in the detection region. The moving state of the moving body includes a plurality of types of moving modes in which at least one of a moving speed and a moving direction is different. In the region setting process, the detection region is changed according to the moving mode of the moving body. The plurality of types of moving modes include at least a straight running mode, a curve running mode, and a cornering running mode.
本開示の一態様の移動体システムは、移動体と、前記移動体に制御指示を出力する上位システムと、を備える。前記移動体は、物体の検知領域を前記移動体の周囲に設定する領域設定部と、前記検知領域における物体の検知結果に基づいて前記移動体を制御する制御部と、を有する。前記領域設定部は、前記制御指示に基づいて前記検知領域を設定する。前記検知領域は複数の小領域を含み、前記制御部は、前記複数の小領域の各々での物体の検知結果に基づいて前記移動体を制御する。前記複数の小領域は、前記移動体が入る大きさの円と、前記円の中心を通る線分と平行な２本の線分とで囲まれ、前記移動体が少なくとも入る第１領域と、前記円の内側の領域のうち前記第１領域の外側の領域である第２領域と、を含む。A mobile body system according to one aspect of the present disclosure includes a mobile body and a host system that outputs a control instruction to the mobile body. The mobile body includes a region setting unit that sets an object detection region around the mobile body, and a control unit that controls the mobile body based on the detection result of the object in the detection region. The region setting unit sets the detection region based on the control instruction. The detection region includes a plurality of small regions, and the control unit controls the mobile body based on the detection result of the object in each of the plurality of small regions. The plurality of small regions are surrounded by a circle of a size that can accommodate the mobile body and two line segments parallel to a line segment passing through the center of the circle, and include a first region in which at least the mobile body is accommodated, and a second region that is an area inside the circle that is outside the first region.
本開示によれば、外部からの制御指示で検知領域を設定可能な移動体システム、及び移動体制御方法を提供することができる。 According to the present disclosure, it is possible to provide a mobile body system and a mobile body control method capable of setting a detection area based on an external control instruction.
以下、本実施形態に係る移動体システムについて、図１～図９を参照して説明する。 The mobile system according to this embodiment will be described below with reference to Figures 1 to 9.
（１）概要
本実施形態の移動体システム１は、図１に示すように、移動体１０と、上位システム２０とを備える。
(1) Overview A
移動体１０は、上位システム２０からの指示を受けて、所定エリア１００（図２参照）内を自律的に移動する。移動体１０は、自機の周囲に物体が存在する場合において、物体との接触を回避するための動作（例えば徐行又は停止等の動作）を行う。所定エリア１００内を移動する複数の移動体１０のうちの１つの移動体１０Ａ（図２参照）に着目した場合、移動体１０Ａの周囲に存在する物体は、他の移動体１０Ｂを含み得る。また、移動体１０Ａの周囲に存在する物体は、通路の端の壁５０、柱、間仕切り等の所定エリア１００内に固定された物体、通路に置かれた搬送対象物のように移動可能な状態で所定エリア１００内に配置された物体、及び人等を含み得る。なお、複数の移動体１０のうちの１つの移動体を移動体１０Ａと表記し、移動体１０Ａと区別するため他の移動体を移動体１０Ｂと表記しているが、移動体１０Ａと１０Ｂとは同じ構成を有している。
The moving
以下の実施形態で説明する「移動体」は、搬送対象物４０を搬送する搬送装置である。本実施形態では、搬送対象物４０は、一例として、荷物が載せられた、ロールボックスパレット等のパレットである。移動体１０がロールボックスパレットのような搬送対象物４０を搬送する場合、移動体１０は、ロールボックスパレットの下面の四隅に配置された車輪の間に入り込み、ロールボックスパレットを上面に載せた状態で搬送する。この種の搬送装置は、無人搬送車（AGV：Automated Guided Vehicle）、移動ロボット、ドローン等を含み得る。本開示でいう「移動ロボット」は、例えば、車輪型、クローラ型又は脚型（歩行型を含む）のロボットである。移動体１０は、所定エリア１００内で搬送対象物４０の搬送作業を行うだけでなく、例えば、ピッキング、溶接、実装、陳列、接客、警備、組立及び検査等の様々な作業を実行する機能を有していてもよい。「所定エリア」は、１台以上の移動体１０が移動する範囲であって、一例として、工場、倉庫、建設現場、店舗、物流センタ、事務所、公園、住宅、学校、病院、駅、空港又は駐車場等である。さらに、例えば、船舶、電車又は飛行機の内部等、乗り物の内部に移動体１０が配備されている場合には、乗り物の内部が所定エリア１００になる。
The "mobile body" described in the following embodiment is a transport device that transports the
本実施形態の移動体システム１では、上位システム２０が移動体１０に制御指示を出力する。
In the
移動体１０（１０Ａ）は、領域設定部１１２と、制御部１１３とを備える。
The moving body 10 (10A) includes an
領域設定部１１２は、物体の検知領域Ａ１（図２参照）を移動体１０の周囲に設定する。
The
制御部１１３は、検知領域Ａ１における物体（他の移動体１０Ｂ又は壁５０等）の検知結果に基づいて移動体１０を制御する。
The
領域設定部１１２は、制御指示に基づいて検知領域Ａ１を設定する。
The
移動体１０の制御部１１３は、検知領域Ａ１における物体の検知結果に基づいて移動体１０を制御している。移動体１０の領域設定部１１２は、上位システム２０からの制御指示に基づいて、物体の検知領域Ａ１を設定しているので、移動体１０の検知領域Ａ１を上位システム２０から設定することが可能になる。これにより、上位システム２０が把握している移動体１０の周囲の状況に基づいて移動体１０の周囲に最適な範囲で検知領域Ａ１を設定できる。例えば、移動体１０が移動する通路が狭いものの、人等の移動物体が存在しない安全な状況であれば、上位システム２０は検知領域Ａ１を狭い領域に設定する。また、移動体１０を充電器に接近させたり、移動体１０Ａを搬送対象物４０の受け渡し等の目的で他の移動体１０Ｂに接近させたりする場合、上位システム２０は検知領域Ａ１を狭い領域に設定する。一方、移動体１０の周囲に移動物体が存在するような状況では、上位システム２０は検知領域Ａ１を広い領域に設定する。このように、本実施形態では、外部（上位システム２０）からの制御指示で検知領域を設定可能な移動体システム１を提供することができる。領域設定部１１２が、外部からの制御指示に基づいて、検知領域Ａ１を必要最小限の大きさに設定することで、移動体１０の移動に支障がない物体まで検知してしまう可能性を低減でき、移動体１０を安全かつスムーズに移動させることができる。
The
（２）詳細
（２．１）構成
以下、本実施形態に係る移動体システム１の構成について、図１～図８を参照して、詳細に説明する。以下に示す、数値、形状、材料、構成要素の位置、複数の構成要素間の位置関係及び接続関係等は、一例であって、本開示を限定する主旨ではない。また、以下で参照する図面は、いずれも模式的な図であり、図中の各構成要素の大きさ及び厚さそれぞれの比が、必ずしも実際の寸法比を反映しているとは限らない。以下の説明において、図２においてＸ軸方向を前後方向、Ｙ軸方向を左右方向と規定する。さらに、Ｘ軸方向の正の向きを前側、Ｙ軸方向の正の向きを左側と規定する。ただし、これらの方向は一例であり、移動体１０の使用時の方向を限定する趣旨ではない。また、図面中の各方向を示す矢印は説明のために表記しているに過ぎず、実体を伴わない。
(2) Details (2.1) Configuration The configuration of the
以下では、移動体システム１の制御対象である移動体１０が、無人搬送車である場合を例として説明する。移動体１０としての無人搬送車は、所定エリア１００内を移動しつつ、搬送対象物４０の搬送という作業を実行する。
In the following, a case will be described in which the
移動体システム１は、図１に示すように、上位システム２０と、所定エリア１００に設置された中継装置３０と、上位システム２０によって制御される複数の移動体１０と、を備える。
As shown in FIG. 1, the
上位システム２０は、例えば所定エリア１００の外部に設置されており、インターネット等の通信ネットワークＮＴ１を介して、中継装置３０に接続されている。
The
上位システム２０と複数の移動体１０の各々とは、互いに通信可能に構成されている。本開示において「通信可能」とは、有線通信又は無線通信の適宜の通信方式により、直接的、又は通信ネットワークＮＴ１若しくは中継装置３０等を介して間接的に、情報を授受できることを意味する。すなわち、上位システム２０と複数の移動体１０の各々とは、互いに情報を授受することができる。本実施形態では、複数の移動体１０の各々は、中継装置３０と、電波を媒体とする無線通信によって通信を行う。そのため、上位システム２０と複数の移動体１０とは、少なくとも通信ネットワークＮＴ１及び中継装置３０を介して、間接的に通信を行うことになる。
The
要するに、各中継装置３０は、各移動体１０と上位システム２０との間の通信を中継する機器（アクセスポイント）である。中継装置３０は、通信ネットワークＮＴ１を介して、上位システム２０と通信する。本実施形態では一例として、中継装置３０と移動体１０との間の通信には、Wi-Fi（登録商標）、Bluetooth（登録商標）、ZigBee（登録商標）又は通信免許を必要としない小電力無線（特定小電力無線）等の規格に準拠した、無線通信を採用する。また、通信ネットワークＮＴ１は、インターネットに限らず、例えば、所定エリア１００内又は所定エリア１００の運営会社内のローカルな通信ネットワークが適用されてもよい。なお、中継装置３０の台数は１台でも複数台でもよく、所定エリア１００内の任意の場所にいる移動体１０と上位システム２０との間の通信を中継可能なように、所定エリア１００内の適宜の位置に配置されていればよい。
In short, each
（２．１．１）移動体
次に、移動体１０について図１及び図２を参照してより詳細に説明する。移動体１０は、例えば、所定エリア１００の床面等からなる平坦な移動面６０を自律移動（自律走行）する。移動体１０は、第１処理部１１と、第１通信部１２と、物体検知部１３と、センサ部１４と、走行装置１５と、第１記憶部１６と、を備える。なお、移動体１０は、繰り返し充電が可能な二次電池を内蔵し、二次電池が蓄えた電気エネルギを利用して走行する。
(2.1.1) Mobile Body Next, the
第１通信部１２は、中継装置３０及び通信ネットワークＮＴ１を介して上位システム２０（上位システム２０の第２通信部２２）と通信する。ここで、第１通信部１２は中継装置３０との間で無線通信方式により通信を行う。
The
物体検知部１３は、移動体１０の周囲に設定された検知領域Ａ１において物体の存否を検出する。物体検知部１３は、例えば、イメージセンサ（カメラ）、ソナーセンサ、レーダ、及びＬｉＤＡＲ（Light Detection and Ranging）等のセンサを含み、これらのセンサにて検知領域Ａ１における物体の存否を検出する。
The
ところで、本実施形態では検知領域Ａ１が複数の小領域を含んでいる。以下では、検知領域Ａ１が２つの小領域（第１領域ＳＡ１及び第２領域ＳＡ２）を含む形態について説明する。第１領域ＳＡ１は、移動体１０の周りに設定される領域である。第２領域ＳＡ２は、第１領域ＳＡ１の外側であって、移動体１０の進行方向の前方に設定される領域である。なお、検知領域Ａ１は２つの小領域を含むものに限定されず、検知領域Ａ１は１つの領域でもよいし、３つ以上の小領域を含んでいてもよい。
In this embodiment, the detection area A1 includes multiple small areas. Below, a description will be given of an embodiment in which the detection area A1 includes two small areas (a first area SA1 and a second area SA2). The first area SA1 is an area that is set around the moving
物体検知部１３は、第１領域ＳＡ１と第２領域ＳＡ２との各々で物体の存否を個別に検出しており、制御部１１３は、複数の小領域（第１領域ＳＡ１及び第２領域ＳＡ２）の各々での物体の検知結果に基づいて、移動体１０を制御する。例えば、物体検知部１３が、移動体１０から見て第１領域ＳＡ１よりも遠い第２領域ＳＡ２において物体を検出した場合、物体との接触までに時間的な余裕があるので、制御部１１３は、移動体１０の速度を減速して徐行させる。一方、物体検知部１３が、移動体１０の近傍の第１領域ＳＡ１において物体を検出した場合、制御部１１３は、物体との接触を回避するために移動体１０を停止させる。このように、制御部１１３は、検知領域Ａ１での物体の検出結果に基づいて、検知領域Ａ１内に存在する物体との接触を回避するように移動体１０を制御する。なお、物体検知部１３がイメージセンサ（カメラ）を含む場合、イメージセンサの画像の所望の範囲を検知領域Ａ１に設定すればよい。また、物体検知部１３がソナーセンサ、レーダ、ＬｉＤＡＲ等のセンサを含む場合、センサから見た検出方向ごとに検出範囲を設定することによって、検知領域Ａ１を任意の領域に設定することができる。
The
センサ部１４は、例えば、所定エリア１００内で移動体１０が存在する現在位置に関する現在位置情報等を検知する。センサ部１４は、例えば、ＬｉＤＡＲによる周囲の物体の検出情報と、所定エリア１００の電子的な地図情報とに基づいて現在位置を推定する。なお、センサ部は、電波ビーコンを用いたＬＰＳ（Local Positioning System）を利用して、現在位置を推定してもよい。なお、センサ部１４は、ＧＰＳ（Global Positioning System）等の衛星測位システムを用いて実現されてもよい。移動体１０は、センサ部１４が検知した現在位置の情報と当該移動体１０の識別情報とを第１通信部１２から上位システム２０へ所定の送信時間間隔（例えば１秒間隔）で定期的に送信する。なお、移動体１０は、上位システム２０からの送信要求等に応じて、センサ部１４が検知した現在位置の情報と当該移動体１０の識別情報とを第１通信部１２から上位システム２０へ不定期に送信してもよい。
The
また、センサ部１４は、移動体１０の動作状態等を検知してもよい。移動体１０の動作状態は、移動体１０が有する蓄電部２４の残量、移動体１０が走行中か停止中かを表す状態、移動体１０の速度（及び速度変化）、移動体１０に作用する加速度、及び移動体１０の姿勢等を含み得る。物体検知部１３は、例えば、速度センサ、加速度センサ、ジャイロセンサ等のセンサを含み、これらのセンサにて移動体１０の動作状態を検知する。
The
走行装置１５は、移動体１０の移動体本体１７に設けられた複数の車輪を駆動することによって移動体１０を走行させる。複数の車輪の少なくとも一部は駆動輪である。駆動輪は例えばオムニホイールのような全方向移動型車輪である。走行装置１５は、第１処理部１１から入力される制御指令に基づいて駆動輪を駆動することによって、移動体１０を走行させる。
The running
第１記憶部１６は、例えば、不揮発性メモリ等の半導体メモリを含む。第１記憶部１６は、移動体１０の周囲に設定する検知領域Ａ１の設定情報等を記憶する。なお、本実施形態では、移動体１０の走行モード（移動モード）に応じて検知領域Ａ１の形状及び大きさの少なくとも一方を変化させている。第１記憶部１６は、互いに範囲が異なる複数の領域候補を表す複数の領域データを記憶している。領域候補の領域データは、例えば、移動体本体１７の中心位置を原点とするＸＹ座標上で、領域候補の範囲を示す座標データ等からなる。複数の領域候補の領域データは第１記憶部１６に予め記憶されていてもよいし、上位システム２０から受信した複数の領域候補の領域データが第１記憶部１６に記憶されてもよい。
The
第１処理部１１は、例えば、メモリ及びプロセッサを含むコンピュータシステムを主構成とする。すなわち、コンピュータシステムのメモリに記録されたプログラムを、プロセッサが実行することにより、第１処理部１１の機能（領域選択部１１１、領域設定部１１２、及び制御部１１３等の機能）が実現される。プログラムはメモリに予め記録されていてもよいし、インターネット等の電気通信回線を通して提供されてもよく、メモリカード等の非一時的記録媒体に記録されて提供されてもよい。
The
本実施形態では移動体１０が領域選択部１１１を有している。本実施形態では、移動体１０の周囲に設定する検知領域Ａ１の候補として、互いに範囲が異なる複数の領域候補の領域データが第１記憶部１６に記憶されている。領域選択部１１１は、上位システム２０からの制御指示に基づいて複数の領域候補の領域データの中から、検知領域Ａ１とする領域候補の領域データを選択する。さらに言えば、領域選択部１１１は、上位システム２０からの制御指示と、移動体１０の走行モードとに基づいて、複数の領域候補の領域データから、検知領域Ａ１とする領域候補の領域データを選択する。
In this embodiment, the moving
領域設定部１１２は、上位システム２０からの制御指示に基づいて、検知領域Ａ１の大きさ及び形状の少なくとも一方を設定することができる。具体的には、領域設定部１１２は、複数の領域候補の中から領域選択部１１１が選択した領域候補を検知領域Ａ１として設定する。つまり、領域設定部１１２は、第１記憶部１６に記憶された複数の領域候補の領域データの中から領域選択部１１１が選択した領域候補の領域データに基づいて、移動体１０の周囲に検知領域Ａ１を設定する。
The
制御部１１３は、例えば上位システム２０から搬送対象物４０の搬送指令を受信すると、搬送指令に基づいて走行装置１５を制御して移動体１０を自律的に走行させ、搬送対象物４０を所定の搬送先まで搬送させる。制御部１１３は、例えば搬送指令によって指示された移動経路と、センサ部１４が検知した現在位置情報と、物体検知部１３による物体の検出結果とに基づいて、移動体１０を自律的に走行させる。ここで、物体検知部１３が検知領域Ａ１において物体の存在を検出すると、制御部１１３は、検知領域Ａ１に存在する物体との接触を回避するように移動体１０を制御する。例えば、物体検知部１３が第２領域ＳＡ２において物体の存在を検出すると、制御部１１３は、走行装置１５を制御して、移動体１０を徐行させる。一方、物体検知部１３が第１領域ＳＡ１において物体の存在を検出すると、制御部１１３は、走行装置１５を制御して、移動体１０を停止させる。
For example, when the
ここで、第１記憶部１６に記憶されている複数の領域候補について図２～図８を参照して説明する。
Here, the multiple area candidates stored in the
検知領域Ａ１は、移動体１０が移動する経路（換言すれば移動体１０が使用される周囲の状況）と、移動体１０の走行モード（移動モード）との少なくとも一方に基づいて変更される。したがって、第１記憶部１６には、移動体１０が使用される周囲の状況、及び、移動体１０の走行モードに応じて範囲が決定された複数の領域候補の領域データが記憶されている。領域選択部１１１は、複数の領域候補の制御データから、移動体１０の周囲の状況及び移動体１０の走行モードに基づいて検知領域Ａ１とする領域候補の領域データを選択する。そして、領域設定部１１２は、領域選択部１１１が選択した領域候補の領域データに基づいて、移動体１０の周囲に検知領域を設定する。
The detection area A1 is changed based on at least one of the route along which the moving
ここで、移動体１０の走行モードは、直進走行モードと、カーブ走行モードと、旋回走行モードとを少なくとも含む。「直進走行モード」は、移動体１０が前方又は後方に直進走行する走行モードである。「カーブ走行モード」は、移動体１０が任意の曲率半径でカーブしながら走行する走行モードである。「旋回走行モード」は、移動体本体１７の中心位置（例えば前後方向及び左右方向のそれぞれでの中心位置）を中心として移動体１０が回転する走行モードである。これらのモードでは、モードごとに移動体１０が移動する方向が異なるので、モードごとに検知領域Ａ１を設定するのが好ましい。以下では、走行モードごとの検知領域Ａ１を区別する場合、図３Ａ～図３Ｃに示すように、直進走行モードでは検知領域Ａ１１、カーブ走行モードでは検知領域Ａ１２、旋回走行モードでは検知領域Ａ１３とそれぞれ表記する。また、本実施形態では検知領域Ａ１が２つの小領域（第１領域ＳＡ１及び第２領域ＳＡ２）を含んでおり、各走行モードでの第１領域ＳＡ１及び第２領域ＳＡ２を区別する場合、直進走行モードでは第１領域ＳＡ１１及び第２領域ＳＡ１２と表記する。また、カーブ走行モードでは第１領域ＳＡ２１及び第２領域ＳＡ２２と表記し、旋回走行モードでは第１領域ＳＡ３１及び第２領域ＳＡ３２とそれぞれ表記する。ここで、直進走行モードでの検知領域Ａ１１の一例を図３Ａに示し、カーブ走行モードでの検知領域Ａ１２の一例を図３Ｂに示し、旋回走行モードでの検知領域Ａ１３の一例を図３Ｃに示す。なお、図３Ａ及び図３Ｂにおいて、図面中の左側が、移動体本体１７の進行方向における前方である。
Here, the travel modes of the moving
直進走行モードでの検知領域Ａ１１は、図３Ａに示すように、移動体１０の周りに設定される長方形状の第１領域ＳＡ１１と、第１領域ＳＡ１１に対して移動体１０の進行方向の前方に設定される長方形状の第２領域ＳＡ１２とを含む。移動体１０の前後方向（直進進行モードでの進行方向）において、第１領域ＳＡ１１の後端は、移動体本体１７の後端と同じ位置に設定され、第１領域ＳＡ１１の前端は、移動体本体１７の前端から距離Ｄ１（例えば２５０ｍｍ）だけ前方の位置に設定される。なお、本実施形態において、２つの物の位置、大きさ、又は形状が同じであるとは、位置、大きさ、又は形状が完全に同じであることに限定されず、多少のずれがあってもよい。また、移動体１０の左右方向において、第１領域ＳＡ１１の右端は、移動体本体１７の右端から距離Ｗ１（例えば２９０ｍｍ）だけ右側の位置に設定され、第１領域ＳＡ１１の左端は、移動体本体１７の左端から距離Ｗ１だけ左側の位置に設定される。また、第２領域ＳＡ１２は、第１領域ＳＡ１１の前方に設定されている。第２領域ＳＡ１２は、移動体１０の左右方向における幅Ｗ２（例えば１２００ｍｍ）が第１領域ＳＡ１１と同じ長方形状の領域である。そして、移動体本体１７の前後方向において、第２領域ＳＡ１２の前端の位置は、移動体本体１７の前端から距離Ｄ２（例えば８００ｍｍ）だけ前方の位置に設定されている。なお、図３Ａに示す直進走行モードでの検知領域Ａ１１は一例であり、適宜変更が可能である。
3A, the detection area A11 in the straight-line travel mode includes a rectangular first area SA11 set around the moving
カーブ走行モードでの検知領域Ａ１２は、図３Ｂに示すように、直進走行モードでの検知領域Ａ１１と、全体の形状及び大きさが同じになるように設定されている。ただし、検知領域Ａ１１を構成する第１領域ＳＡ１１及び第２領域ＳＡ１２と、検知領域Ａ１２を構成する第１領域ＳＡ２１及び第２領域ＳＡ２２とは大きさがそれぞれ異なっている。図３Ｂの例では、第１領域ＳＡ２１の前端は、移動体本体１７の前端から距離Ｄ３（例えば２００ｍｍ）だけ前方の位置に設定されており、検知領域Ａ１１に比べて第１領域ＳＡ２１の範囲が狭くなっている。また、移動体１０の左右方向において、第１領域ＳＡ２１の右端は、移動体本体１７の右端から距離Ｗ３だけ右側の位置に設定され、第１領域ＳＡ２１の左端は、移動体本体１７の左端から距離Ｗ３だけ左側の位置に設定されている。ここで、距離Ｗ３は距離Ｗ１と同じであり、検知領域Ａ１２に含まれる第１領域ＳＡ２１の左右方向の幅は、検知領域Ａ１１に含まれる第１領域ＳＡ１１の左右方向の幅と同じ幅に設定されている。また、第２領域ＳＡ２２は、移動体１０の左右方向における幅Ｗ４（例えば１２００ｍｍ）が第１領域ＳＡ２１と同じ長方形状の領域である。そして、第２領域ＳＡ２２の後端の位置は、移動体本体１７の前端から距離Ｄ３だけ前方の位置に設定され、第２領域ＳＡ２２の前端の位置は、移動体本体１７の前端から距離Ｄ４（例えば８００ｍｍ）だけ前方の位置に設定されている。このように、カーブ走行モードでの検知領域Ａ１２では、直進走行モードでの検知領域Ａ１１に比べて、前後方向における第１領域ＳＡ１１，ＳＡ２１の長さが短めに設定されている。カーブ走行モードでは直進走行モードに比べて移動体１０の速度が遅いと想定されるので、カーブ走行モードでの第１領域ＳＡ２１の長さが、直進走行モードでの第１領域ＳＡ１１の長さよりも短い寸法に設定されている。これにより、カーブ走行モードでは、直進走行モードに比べて、物体が検知された場合に移動体１０が停止させられる第１領域ＳＡ２１の範囲を狭めることができる。なお、図３Ｂに示すカーブ走行モードでの検知領域Ａ１２は一例であり、適宜変更が可能である。図３Ａ及び図３Ｂの例では、カーブ走行モードでの検知領域Ａ１２と直進走行モードでの検知領域Ａ１１とは、全体の形状及び大きさが同じであるが、全体の形状及び大きさの少なくとも一方が異なっていてもよい。
As shown in FIG. 3B, the detection area A12 in the curve driving mode is set to have the same overall shape and size as the detection area A11 in the straight driving mode. However, the first area SA11 and the second area SA12 constituting the detection area A11 are different in size from the first area SA21 and the second area SA22 constituting the detection area A12. In the example of FIG. 3B, the front end of the first area SA21 is set at a position forward by a distance D3 (e.g., 200 mm) from the front end of the
旋回走行モードでの検知領域Ａ１３は、図３Ｃに示すように、移動体１０の周りに設定される円形の領域であり、第１領域ＳＡ３１と第２領域ＳＡ３２とを含む。第１領域ＳＡ３１は、移動体本体１７が入る大きさ（直径Ｒ１）の円Ｃ１と、円Ｃ１の中心ＣＰ１を通る線分Ｌ１０に平行な２本の線分Ｌ１，Ｌ２とで囲まれる領域である。ここで、移動体本体１７の前後方向において、移動体本体１７の前端から第１領域ＳＡ３１の前端までの距離はＤ５（例えば１５５ｍｍ）である。また、移動体本体１７の左右方向において、第１領域ＳＡ３１の右端は、移動体本体１７の右端から距離Ｗ５（例えば２９０ｍｍ）だけ右側の位置に設定され、第１領域ＳＡ２１の左端は、移動体本体１７の左端から距離Ｗ５だけ左側の位置に設定される。また、第２領域ＳＡ２２は、移動体本体１７から見て第１領域ＳＡ２１よりも遠い位置に設定されている。第２領域ＳＡ２２は移動体本体１７の右側及び左側にそれぞれ設定されており、第２領域ＳＡ２２は、円Ｃ１の内側の領域のうち、第１領域ＳＡ２１の外側の領域となる。つまり、第２領域ＳＡ３２は、線分Ｌ１と円Ｃ１とで囲まれる領域と、線分Ｌ２と円Ｃ１とで囲まれる領域と、を含む。
As shown in FIG. 3C, the detection area A13 in the turning driving mode is a circular area set around the moving
なお、図３Ａ及び図３Ｂの例では、直進走行モードでの検知領域Ａ１１とカーブ走行モードでの検知領域Ａ１２とがそれぞれ全体として長方形状の領域に設定されているが、検知領域Ａ１１，Ｓ１２の形状は長方形状の領域に限定されず、適宜変更が可能である。 In the examples of Figures 3A and 3B, the detection area A11 in the straight driving mode and the detection area A12 in the curve driving mode are each set to a rectangular area overall, but the shapes of the detection areas A11 and S12 are not limited to rectangular areas and can be changed as appropriate.
例えば、直進走行モードでの検知領域Ａ１１は、図４に示すように、平面視の形状がＴ型の領域に設定されてもよい。この検知領域Ａ１１は、上述と同様、第１領域ＳＡ１１と、第１領域ＳＡ１１よりも前側に設けられた第２領域ＳＡ１２と、を含む。 For example, the detection area A11 in the straight-ahead driving mode may be set to a T-shaped area in a plan view, as shown in FIG. 4. As described above, this detection area A11 includes a first area SA11 and a second area SA12 provided forward of the first area SA11.
図４の例では、第１領域ＳＡ１１は、移動体本体１７が入る長方形状の第１部分Ｐ１と、第１部分Ｐ１よりも前側に設けられた第１部分Ｐ１よりも左右方向の幅が広い幅広部分Ｐ２１とを含む。第１部分Ｐ１の後端は移動体本体１７の後端と同じ位置であり、第１部分Ｐ１の前端は移動体本体１７の前端と同じ位置である。第１部分Ｐ１の右端は、移動体本体１７の右端から距離Ｗ２３（例えば３００ｍｍ）だけ右側の位置に設定され、第１部分Ｐ１の左端は、移動体本体１７の左端から距離Ｗ２３だけ左側の位置に設定される。また、幅広部分Ｐ２１の左右方向の幅は、第１部分Ｐ１の左右方向の幅Ｗ２１（例えば１２００ｍｍ）よりも広い寸法に設定されている。幅広部分Ｐ２１の前端の位置は、移動体本体１７の前端の位置から距離Ｄ２１（例えば３５０ｍｍ）だけ前方の位置に設定されている。
4, the first area SA11 includes a rectangular first portion P1 in which the
また、第２領域ＳＡ１２は、幅広部分Ｐ２１よりも前方に設けられた長方形状の領域であり、移動体本体１７の左右方向において、第２領域ＳＡ１２の幅Ｗ２２（例えば１４００ｍｍ）は、幅広部分Ｐ２１と同じ幅に設定されている。第２領域ＳＡ１２の前端の位置は、幅広部分Ｐ２１の前端の位置から距離Ｄ２２（例えば１８００ｍｍ）だけ前方の位置に設定されている。ここにおいて、第１領域ＳＡ１１の幅広部分Ｐ２１と、第２領域ＳＡ１２とで、第１部分Ｐ１よりも移動体本体１７の進行方向前方にあり、第１部分Ｐ１に比べて幅が広い第２部分Ｐ２が構成されている。すなわち、検知領域Ａ１１は、移動体本体１７が入る第１部分Ｐ１と、第１部分Ｐ１よりも移動体本体１７の進行方向前方にある第２部分Ｐ２とを含んでいる。移動体本体１７の進行方向と直交する方向（図４の左右方向）において、第１部分Ｐ１の幅（最大幅）Ｗ２１よりも第２部分Ｐ２の幅（最大幅）Ｗ２２が大きくなるように、検知領域Ａ１１が設定されている。
The second area SA12 is a rectangular area provided forward of the wide portion P21, and the width W22 (e.g., 1400 mm) of the second area SA12 is set to the same width as the wide portion P21 in the left-right direction of the
このように、検知領域Ａ１１において、移動体本体１７の近傍に設定される第１部分Ｐ１よりも、進行方向前方にある第２部分Ｐ２の方が、左右方向における幅が広くなるように検知領域Ａ１１が構成されている。したがって、直進走行している移動体１０の進行方向が右又は左に数度程度ずれた場合に移動体１０及び搬送対象物４０が通る可能性がある領域を第２部分Ｐ２に含めることができる。よって、物体検知部１３は、直進走行している移動体１０が接触する可能性がある物体の存否をより確実に検出でき、移動体１０を安全かつスムーズに移動させることができる。
In this way, the detection area A11 is configured so that the second portion P2, which is located forward in the direction of travel, is wider in the left-right direction than the first portion P1, which is set near the
なお、図４は、直進走行モードでの検知領域Ａ１１の一例を示しているが、カーブ走行モードでの検知領域Ａ１２が、図４に示すような形状に設定されていてもよく、カーブ走行している移動体１０が接触する可能性がある物体の存否をより確実に検出できる。
Note that while FIG. 4 shows an example of the detection area A11 in the straight-line driving mode, the detection area A12 in the curve driving mode may be set to a shape as shown in FIG. 4, allowing for more reliable detection of the presence or absence of an object that the
ところで、移動体１０が前方又は後方に直進走行する直進走行モードは、所定の基準値（例えば０．５［ｍ／Ｓ］）以上の速度で直進する高速直進モードと、所定の基準値未満の速度で直進する低速直進モードとに更に分かれていてもよい。そして、高速直進モードと低速直進モードとの各々で検知領域が設定されていてもよい。
The straight-line travel mode in which the
ここで、図５Ａは、高速直進モードでの検知領域Ａ１４の概略的な平面図を示し、図５Ｂは、低速直進モードでの検知領域Ａ１５の概略的な平面図を示している。これらの検知領域Ａ１４，Ａ１５の形状は、図４に示す直進走行モードでの検知領域Ａ１１と同様の形状に設定されているので、その説明は省略する。高速直進モードで走行中の移動体１０は、低速直進モードで走行中の移動体１０に比べて、単位時間当たりに移動する距離が長くなるので、前方に存在する物体との接触を回避するためには、より遠くの領域で物体の存否を検出する必要がある。したがって、高速直進モードでの検知領域Ａ１４に含まれる第２領域ＳＡ４２の前端の位置は、低速直進モードでの検知領域Ａ１５に含まれる第２領域ＳＡ５２の前端の位置よりも前方に設定されている。具体的には、高速直進モードでの第２領域ＳＡ４２の前端と移動体本体１７の前端との間の距離Ｄ２２は例えば１８００ｍｍであるのに対して、低速直進モードでの第２領域ＳＡ５２の前端と移動体本体１７の前端との間の距離Ｄ２３は例えば８００ｍｍである。なお、高速直進モードでの検知領域Ａ１４と低速直進モードでの検知領域Ａ１５とでは、第２領域ＳＡ４２，ＳＡ５２の前端と移動体本体１７の前端との間の距離Ｄ２２，Ｄ２３以外は同じ形状及び大きさに設定されている。
Here, FIG. 5A shows a schematic plan view of the detection area A14 in the high-speed straight-line mode, and FIG. 5B shows a schematic plan view of the detection area A15 in the low-speed straight-line mode. The shapes of these detection areas A14 and A15 are set to the same shape as the detection area A11 in the straight-line mode shown in FIG. 4, so their description will be omitted. The moving
このように、高速直進モードでの検知領域Ａ１４の第２領域ＳＡ４２は、低速直進モードでの検知領域Ａ１５の第２領域ＳＡ５２に比べて、より前方に広がっているので、物体検知部１３はより前方にある物体をより早いタイミングで検出することができる。したがって、制御部１１３は、物体検知部１３の検知結果に基づいて、前方にある物体との接触を回避する行動を取りやすくなる。
In this way, the second area SA42 of the detection area A14 in the high-speed straight-line mode extends further forward than the second area SA52 of the detection area A15 in the low-speed straight-line mode, so the
上述のように移動体１０の周囲に設定される検知領域Ａ１は移動体１０の走行モードに応じて変更されているが、検知領域Ａ１の大きさ及び形状は、移動体１０が使用される状況によっても変更されるのが好ましい。例えば、移動体１０が狭い通路を移動する場合、通路の端にある壁５０等の物体が検知領域Ａ１内に入って移動体１０が徐行したり停止したりする可能性があるため、移動体１０が広い通路を移動する場合に比べて検知領域Ａ１を狭くするのが好ましい。また、移動体１０Ａが内蔵するバッテリを充電するために充電器に接続したり、他の移動体１０Ｂとの間で搬送対象物４０を受け渡したりする場合、充電器又は他の移動体１０Ｂに接近する必要があるため、検知領域Ａ１を狭くするのが好ましい。
As described above, the detection area A1 set around the moving
例えば、図６Ａ～図６Ｄは、道幅が十分に確保された通路等を移動体１０が移動するような通常の使用状況において、移動体１０の走行モードごとに設定される検知領域の組み合わせを示しており、この組み合わせを第１パターンと言う。図６Ａは高速直進モードでの検知領域Ａ１４の概略的な平面図、図６Ｂは低速直進モードでの検知領域Ａ１５の概略的な平面図、図６Ｃはカーブ走行モードでの検知領域Ａ１２の概略的な平面図、図６Ｄは旋回走行モードでの検知領域Ａ１３の概略的な平面図を示している。
For example, Figures 6A to 6D show combinations of detection areas set for each driving mode of the
第１パターンでは、旋回走行モードの検知領域Ａ１３は、円形の第１領域ＳＡ３１のみを含んでいる。高速直進モードでの検知領域Ａ１４、低速直進モードでの検知領域Ａ１５、及びカーブ走行モードでの検知領域Ａ１２は、移動体本体１７を含む第１部分Ｐ１の幅に比べて前方の第２部分Ｐ２の幅が大きい形状に形成されている。ここで、第１領域ＳＡ４１，ＳＡ５１，ＳＡ３１の幅広部分Ｐ２１の前端と移動体本体１７の前端との間の距離Ｄ２１は、カーブ走行モード、低速直進モード、高速直進モードの順番で長くなるように設定されている。また、第２領域ＳＡ４２，ＳＡ５２，ＳＡ３２の前端と移動体本体１７の前端との間の距離Ｄ２２は、カーブ走行モードと低速直進モードとでは同じ長さであるが、カーブ走行モード及び低速直進モードに比べて高速直進モードの方が長くなるように設定されている。
In the first pattern, the detection area A13 in the turning mode includes only the circular first area SA31. The detection area A14 in the high-speed straight-line mode, the detection area A15 in the low-speed straight-line mode, and the detection area A12 in the curved mode are formed in a shape in which the width of the front second part P2 is larger than the width of the first part P1 including the
また、図７Ａ～図７Ｄは、道幅が狭い通路等を移動体１０が移動するような使用状況において、移動体１０の走行モードごとに設定される検知領域の組み合わせを示しており、この組み合わせを第２パターンと言う。図７Ａは高速直進モードでの検知領域Ａ１４の概略的な平面図、図７Ｂは低速直進モードでの検知領域Ａ１５の概略的な平面図、図７Ｃはカーブ走行モードでの検知領域Ａ１２の概略的な平面図、図７Ｄは旋回走行モードでの検知領域Ａ１３の概略的な平面図を示している。
Figures 7A to 7D also show combinations of detection areas set for each driving mode of the
第２パターンは狭い通路等を移動する場合に使用されるので、第２パターンでの各走行モードの検知領域は、第１パターンでの各走行モードの検知領域に比べて、左右方向における幅が狭くなるように設定されている。 The second pattern is used when moving through narrow passages, etc., so the detection area for each driving mode in the second pattern is set to be narrower in the left-right direction than the detection area for each driving mode in the first pattern.
第２パターンでは、高速直進モードの検知領域Ａ１４、低速直進モードの検知領域Ａ１５、及びカーブ走行モードの検知領域Ａ１３は、進行方向と直交する方向の幅が同じ大きさの長方形状の領域に設定されている。そして、第１領域ＳＡ４１，ＳＡ５１，ＳＡ３１の前端と移動体本体１７の前端との間の距離Ｄ１，Ｄ３は、カーブ走行モード、低速直進モード、高速直進モードの順番で長くなるように設定されている。また、第２領域ＳＡ４２，ＳＡ５２，ＳＡ３２の前端と移動体本体１７の前端との間の距離Ｄ２，Ｄ４は、カーブ走行モードと低速直進モードとでは同じ長さであるが、カーブ走行モード及び低速直進モードに比べて高速直進モードの方が長くなるように設定されている。なお、第２パターンでの検知領域Ａ１４，Ａ１５，Ａ１３の幅Ｗ２，Ｗ４は、第１パターンでの検知領域Ａ１４，Ａ１５，Ａ１３の幅Ｗ２２よりも小さい寸法に設定されているので、壁等を検知したために移動体１０が停止してしまう可能性を低減できる。
In the second pattern, the detection area A14 in the high-speed straight-line mode, the detection area A15 in the low-speed straight-line mode, and the detection area A13 in the curve driving mode are set to rectangular areas with the same width in the direction perpendicular to the traveling direction. The distances D1 and D3 between the front ends of the first areas SA41, SA51, and SA31 and the front end of the
また、第２パターンでの旋回走行モードの検知領域Ａ１３は、円Ｃ１と２本の線分Ｌ１，Ｌ２とで囲まれる第１領域ＳＡ３１と、２本の線分Ｌ１，Ｌ２の各々と円Ｃ１とで囲まれる２つの第２領域ＳＡ３２とを含んでいる。ここで、第２パターンでの検知領域Ａ１３の直径Ｒ１は、第１パターンでの検知領域Ａ１３の直径Ｒ１よりも小さい寸法に設定されている。そして、第１パターンでは検知領域Ａ１３の全体が第１領域ＳＡ３１であるのに対して、第２パターンでは、検知領域Ａ１３が、移動体本体１７が入る第１領域ＳＡ３１と、第１領域ＳＡ３１の左右方向の両側にある第２領域ＳＡ３２とで構成されている。したがって、移動体１０が狭い通路等を移動する場合でも、壁等の物体が検知領域Ａ１３に入りにくくなるので、壁等を検知したために移動体１０が停止してしまう可能性を低減できる。また、検知領域Ａ１３に物体が入ったとしても、第２領域ＳＡ３２内で物体が検知された場合は、移動体１０が減速した状態で徐行するので、壁等を検知したために移動体１０が停止してしまう可能性を低減できる。
The detection area A13 in the turning travel mode in the second pattern includes a first area SA31 surrounded by a circle C1 and two line segments L1, L2, and two second areas SA32 surrounded by each of the two line segments L1, L2 and the circle C1. Here, the diameter R1 of the detection area A13 in the second pattern is set to a smaller dimension than the diameter R1 of the detection area A13 in the first pattern. And, while the entire detection area A13 in the first pattern is the first area SA31, in the second pattern, the detection area A13 is composed of the first area SA31 in which the
また、図８Ａ～図８Ｄは、例えば移動体１０を充電器又は他の移動体１０Ｂ等の対象物に接近させるような使用状況において、移動体１０の走行モードごとに設定される検知領域の組み合わせを示しており、この組み合わせを第３パターンと言う。図８Ａは高速直進モードでの検知領域Ａ１４の概略的な平面図、図８Ｂは低速直進モードでの検知領域Ａ１５の概略的な平面図、図８Ｃはカーブ走行モードでの検知領域Ａ１２の概略的な平面図、図８Ｄは旋回走行モードでの検知領域Ａ１３の概略的な平面図を示している。
Furthermore, Figures 8A to 8D show combinations of detection areas set for each driving mode of the
第３パターンは対象物に移動体１０を接近させる場合に使用されるので、第２パターンに比べて、物体が検出された場合に移動体１０を停止させる第１領域ＳＡ４１，ＳＡ５１，ＳＡ２１，ＳＡ３１を更に狭くしている。
The third pattern is used when the
第３パターンでの高速直進モードの検知領域Ａ１４は、長方形状の第１領域ＳＡ４１と、左右方向の幅Ｗ２が第１領域ＳＡ４１よりも広い長方形状の第２領域ＳＡ４２とを含む。 The detection area A14 in the high-speed straight-line mode in the third pattern includes a rectangular first area SA41 and a rectangular second area SA42 whose width W2 in the left-right direction is wider than that of the first area SA41.
ここで、左右方向において、第１領域ＳＡ４１の端（右端又は左端）と移動体本体１７の端（右端又は左端）との間の距離W６は、第２モードでの距離Ｗ１，Ｗ３に比べて小さい寸法に設定されている。また、検知領域Ａ１４の第２領域ＳＡ４２は、移動体本体１７の前端の位置から、距離Ｄ２だけ離れた位置まで、第１領域ＳＡ４１を除いた領域に設定されている。ここで、第３パターンでの第２領域ＳＡ４２の左右方向の幅Ｗ２は、第１パターンでの第１領域ＳＡ４１の幅Ｗ２２と同じ寸法に設定されている。
Here, the distance W6 between the end (right or left end) of the first area SA41 and the end (right or left end) of the
これにより、移動体１０を対象物に接近させる場合に、物体検知部１３が第２領域ＳＡ４２において物体を検知すると、制御部１１３が移動体１０を徐行させ、物体検知部１３が第１領域ＳＡ４１において物体を検知すると、制御部１１３が移動体１０を停止させる。したがって、第３パターンでの検知領域を使用することで、制御部１１３は、移動体１０を対象物に対してより近い位置まで接近させることができる。
As a result, when the moving
第３パターンでは、低速直進モード及びカーブ走行モードでの検知領域Ａ１５，Ａ１２は形状及び大きさが同じである。そして、低速直進モード及びカーブ走行モードでの検知領域Ａ１５，Ａ１２と、高速直進モードでの検知領域Ａ１４とは、第２領域ＳＡ２２，ＳＡ４２，ＳＡ５２の前端と移動体本体１７の前端との間の距離Ｄ２，Ｄ４のみが異なっている。例えば、第２領域ＳＡ２２，ＳＡ４２，ＳＡ５２の前端と移動体本体１７の前端との間の距離Ｄ２，Ｄ４は、高速直進モードでは１８００ｍｍに設定されているのに対して、低速直進モード及びカーブ走行モードでは８００ｍｍに設定されている。すなわち、高速直進モードに比べて低速の低速直進モード及びカーブ走行モードでは、第２領域ＳＡ２２，ＳＡ４２，ＳＡ５２の範囲を狭くすることで、移動体１０が徐行する距離を短くできる。
In the third pattern, the detection areas A15, A12 in the low-speed straight-line mode and the curve driving mode have the same shape and size. The detection areas A15, A12 in the low-speed straight-line mode and the curve driving mode and the detection area A14 in the high-speed straight-line mode differ only in the distances D2, D4 between the front ends of the second areas SA22, SA42, SA52 and the front end of the
また、第３パターンでの旋回走行モードの検知領域Ａ１３の直径Ｒ１は、第２パターンでの検知領域Ａ１３の直径Ｒ１よりも小さい寸法に設定されている。また、左右方向において第１領域ＳＡ３１の端（右端又は左端）から、移動体本体１７の端（右端又は左端）までの距離Ｗ５は、第２パターンに比べて第３パターンでは小さい寸法に設定されており、第２パターンに比べて移動体１０を対象物に更に近付けることができる。
In addition, the diameter R1 of the detection area A13 in the turning driving mode in the third pattern is set to a smaller dimension than the diameter R1 of the detection area A13 in the second pattern. In addition, the distance W5 in the left-right direction from the end (right end or left end) of the first area SA31 to the end (right end or left end) of the
上述のように、複数の走行モードごとに、互いに範囲が異なる検知領域Ａ１が設定されており、複数の検知領域Ａ１にそれぞれ対応した複数の領域候補の領域データが第１記憶部１６に記憶されている。さらに言えば、移動体１０の使用状況に応じて、走行モードごとの検知領域Ａ１の組み合わせが複数パターン設定されており、第１記憶部１６には、複数のパターンのそれぞれで、各走行モードの検知領域Ａ１に対応する領域候補の領域データが記憶されている。領域選択部１１１は、上位システム２０からの制御指示に基づいて移動体１０の使用状況に対応した領域候補の組み合わせのパターンを選択する。そして、領域選択部１１１は、選択したパターンの中から、移動体１０の現在の走行モードに対応した領域候補を選択する。そして、領域設定部１１２が、領域選択部によって選択された領域候補の領域データに基づいて、移動体１０の周囲に検知領域Ａ１を設定しており、移動体１０の使用状況及び走行モードに対応した検知領域Ａ１を設定することができる。上述のように、移動体１０の移動状態（走行状態）は、移動速度と移動方向との少なくとも一方が異なる複数種類の移動モード（走行モード）を含んでいる。そして、領域設定部１１２は、移動体１０の移動モードに応じて検知領域Ａ１を変更しているので、複数種類の移動モードごとに最適な検知領域Ａ１を設定できる。
As described above, a detection area A1 having a different range is set for each of the multiple driving modes, and the area data of multiple area candidates corresponding to the multiple detection areas A1 is stored in the
なお、移動体１０の使用状況に応じて設定される検知領域Ａ１の組み合わせは上記の第１～第３パターンに限定されず、上記の第１～第３パターン以外の組み合わせが設定されていてもよい。また、移動体１０を充電器の周囲に設定された待機位置から、充電器に接続される充電位置まで移動させるような使用状況では、移動体１０をカーブ走行モードや高速直進モードで移動させることはない。したがって、移動体１０を充電器に接近させる使用状況では、低速直進モードでの検知領域Ａ１５と旋回走行モードでの検知領域Ａ１３の組み合わせのみ設定されていてもよい。
The combination of detection areas A1 set according to the usage situation of the
（２．１．２）上位システム
次に、上位システム２０について図１を参照してより詳細に説明する。上位システム２０は、第２処理部２１と、第２通信部２２と、第２記憶部２３と、を備える。
(2.1.2) Host System Next, the
第２通信部２２は、通信ネットワークＮＴ１を介して中継装置３０と通信する。第２通信部２２は、通信ネットワークＮＴ１及び中継装置３０を介して、複数（本実施形態では２台）の移動体１０の各々と通信する。第２通信部２２と中継装置３０との間の通信方式としては、無線通信又は有線通信の適宜の通信方式が採用される。
The
第２記憶部２３は、移動体１０が移動する所定エリア１００の電子的な地図情報等を記憶する。また、第２記憶部２３は、複数の検知領域Ａ１にそれぞれ対応する複数の領域候補の領域データ等も記憶する。
The
第２処理部２１は、例えば、メモリ及びプロセッサを含むコンピュータシステムを主構成とする。すなわち、コンピュータシステムのメモリに記録されたプログラムを、プロセッサが実行することにより、第２処理部２１の機能が実現される。プログラムはメモリに予め記録されていてもよいし、インターネット等の電気通信回線を通して提供されてもよく、メモリカード等の非一時的記録媒体に記録されて提供されてもよい。
The
第２処理部２１は、制御対象の移動体１０に対して、搬送対象物４０の搬送を指示する搬送指示を第２通信部２２から送信させる。また、第２処理部２１は、制御対象の移動体１０の使用状況（例えば移動体１０が移動する経路周辺の状況）等に基づいて、検知領域Ａ１の領域候補の組み合わせであるパターンを指示する制御指示を第２通信部２２から制御対象の移動体１０に送信させる。
The
ここで、制御対象の移動体１０の第１通信部１２が上位システム２０から搬送指示と制御指示とを受信すると、第１処理部１１は、搬送指示に基づいて走行装置１５を制御して、搬送対象物４０を搬送する処理を行う。
Here, when the
また、移動体１０の領域選択部１１１は上位システム２０からの制御指示に基づいて、検知領域Ａ１とする領域候補のパターンを選択する。さらに、領域選択部１１１は、移動体１０の現在の走行モードに基づいて、選択したパターンの中から走行モードに応じた領域候補を選択する。そして、領域設定部１１２が、領域選択部１１１が選択した領域候補の領域データに基づいて検知領域Ａ１を設定する。物体検知部１３は、領域設定部１１２が設定した検知領域Ａ１において物体の存否を検出し、第１処理部１１は、物体検知部１３の検知結果に基づいて移動体１０を制御する。例えば、物体検知部１３が第２領域ＳＡ２において物体を検出すると、第１処理部１１は、走行装置１５を制御して移動体１０を徐行させる。また、物体検知部１３が第１領域ＳＡ１において物体を検出すると、第１処理部１１は、走行装置１５を制御して移動体１０を停止させる。これにより、移動体システム１では、移動体１０の使用状況、及び移動体１０の走行モードに応じて最適な検知領域Ａ１を設定できる。また、移動体１０は、検知領域Ａ１における物体の検出結果に基づいて、移動体１０を制御することで、移動体１０を安全かつスムーズに移動させることができる。
In addition, the
（２．２）動作
本実施形態の移動体システム１の動作を図９に基づいて説明する。
(2.2) Operation The operation of the
上位システム２０の第２処理部２１が、所定エリア１００内で搬送対象物４０を搬送させる場合、搬送指示と、使用する検知領域Ａ１のパターンを指示する制御指示とを、第２通信部２２から制御対象の移動体１０に送信させる。
When the
制御対象の移動体１０の第１通信部１２が上位システム２０から搬送指示と制御指示とを受信（取得）すると（ＳＴ１）、領域選択部１１１が、制御指示に基づいて、走行モードごとの検知領域Ａ１に対応する領域候補の組み合わせのパターンを選択する（ＳＴ２）。
When the
また、制御対象の移動体１０の制御部１１３は、上位システム２０から取得した制御指示に基づいて走行装置１５を制御し、上位システム２０から指示された経路にしたがって移動体１０を自律走行させる。
The
ここで、制御部１１３は、移動体１０を高速直進モード、低速直進モード、カーブ走行モード及び旋回走行モードのいずれかの走行モードで走行させており、領域選択部１１１は、現在の走行モードに応じて走行モードに応じた領域候補を選択する。領域選択部１１１が領域候補を選択すると、領域設定部１１２が、領域選択部１１１によって選択された領域候補の領域データに基づいて、移動体１０の周囲に検知領域Ａ１を設定する（ＳＴ１３）。
Here, the
物体検知部１３は、領域設定部１１２によって設定された検知領域Ａ１（第１領域ＳＡ１及び第２領域ＳＡ２）において物体の存否を検出しており、制御部１１３は、検知領域Ａ１における物体の検出結果に基づいて移動体１０を制御する。物体検知部１３が検知領域Ａ１において物体を検出しなければ、制御部１１３は、移動体１０を徐行させたり停止させたりする処理は行わず、移動動作を継続させる。一方、物体検知部１３が第２領域ＳＡ２において物体の存在を検出すると、制御部１１３は走行装置１５を制御して移動体１０を徐行させており、物体との接触を回避するための時間を確保できる。また、物体検知部１３が第１領域ＳＡ１において物体の存在を検出すると、制御部１１３は走行装置１５を制御して移動体１０を停止させており、物体との接触を回避することができる。
The
なお、移動体１０（具体的には領域設定部１１２）は現在の検知領域Ａ１の設定を第１記憶部１６に記憶しており、領域設定部１１２は、上位システム２０からの制御指示に基づいて、移動体１０（第１記憶部１６）が記憶している検知領域Ａ１を変更可能である。領域設定部１１２は、検知領域を変更可能であるので、例えば移動体１０の移動モードの変化に応じて、検知領域を更新することができる。
The moving body 10 (specifically, the area setting unit 112) stores the current setting of the detection area A1 in the
以上のように、移動体１０の領域選択部１１１は、上位システム２０からの制御指示に基づいて、各走行モードでの検知領域Ａ１に対応する領域候補の組み合わせのパターンを選択する。そして、領域設定部１１２は、領域選択部１１１が選択した領域候補の領域データに基づいて、現在の走行モードに応じた検知領域Ａ１を設定している。したがって、移動体システム１は、上位システム２０からの制御指示に基づいて、移動体１０での検知領域Ａ１を設定でき、外部からの制御指示に基づいて検知領域Ａ１を設定可能な移動体システム１を提供することができる。
As described above, the
（３）変形例
上記実施形態は、本開示の様々な実施形態の一つに過ぎない。上記実施形態は、本開示の目的を達成できれば、設計等に応じて種々の変更が可能である。また、移動体システム１と同様の機能は、移動体制御方法、コンピュータプログラム、又はプログラムを記録した非一時的な記録媒体等で具現化されてもよい。一態様に係る移動体制御方法は、物体の検知領域Ａ１を移動体１０の周囲に設定する領域設定処理と、検知領域Ａ１における物体の検知結果に基づいて移動体１０を制御する制御処理と、を含む。領域設定処理では、上位システム２０から入力される制御指示に基づいて検知領域Ａ１を設定する。一態様に係る（コンピュータ）プログラムは、コンピュータシステムに、上記の移動体制御方法を実行させるためのプログラムである。
(3) Modifications The above embodiment is merely one of various embodiments of the present disclosure. The above embodiment can be modified in various ways depending on the design, etc., as long as the object of the present disclosure can be achieved. In addition, the same function as the
以下、上記の実施形態の変形例を列挙する。以下に説明する変形例は、適宜組み合わせて適用可能である。 Below, we will list some variations of the above embodiment. The variations described below can be applied in appropriate combinations.
本開示における移動体システム１は、コンピュータシステムを含んでいる。コンピュータシステムは、ハードウェアとしてのプロセッサ及びメモリを主構成とする。コンピュータシステムのメモリに記録されたプログラムをプロセッサが実行することによって、本開示における移動体システム１としての機能が実現される。プログラムは、コンピュータシステムのメモリに予め記録されてもよく、電気通信回線を通じて提供されてもよく、コンピュータシステムで読み取り可能なメモリカード、光学ディスク、ハードディスクドライブ等の非一時的記録媒体に記録されて提供されてもよい。コンピュータシステムのプロセッサは、半導体集積回路（ＩＣ）又は大規模集積回路（ＬＳＩ）を含む１ないし複数の電子回路で構成される。ここでいうＩＣ又はＬＳＩ等の集積回路は、集積の度合いによって呼び方が異なっており、システムＬＳＩ、ＶＬＳＩ（Very Large Scale Integration）、又はＵＬＳＩ（Ultra Large Scale Integration）と呼ばれる集積回路を含む。さらに、ＬＳＩの製造後にプログラムされる、ＦＰＧＡ（Field-Programmable Gate Array）、又はＬＳＩ内部の接合関係の再構成若しくはＬＳＩ内部の回路区画の再構成が可能な論理デバイスについても、プロセッサとして採用することができる。複数の電子回路は、１つのチップに集約されていてもよいし、複数のチップに分散して設けられていてもよい。複数のチップは、１つの装置に集約されていてもよいし、複数の装置に分散して設けられていてもよい。ここでいうコンピュータシステムは、１以上のプロセッサ及び１以上のメモリを有するマイクロコントローラを含む。したがって、マイクロコントローラについても、半導体集積回路又は大規模集積回路を含む１ないし複数の電子回路で構成される。
The
また、移動体システム１における複数の機能が、１つの筐体内に集約されていることは移動体システム１に必須の構成ではなく、移動体システム１の構成要素は、複数の筐体に分散して設けられていてもよい。さらに、移動体システム１の少なくとも一部の機能、例えば、領域選択部１１１及び領域設定部１１２の一部の機能、又は上位システム２０の一部の機能がクラウド（クラウドコンピューティング）等によって実現されてもよい。
In addition, it is not essential for the
なお、上記の実施形態では、高速直進モード及び低速直進モードの各々で範囲が互いに異なる検知領域Ａ１を設定しているが、速度範囲が異なる３段階以上の直進走行モードの各々で、範囲が互いに異なる検知領域Ａ１を設定してもよい。 In the above embodiment, a detection area A1 with a different range is set for each of the high-speed straight-line mode and the low-speed straight-line mode, but a detection area A1 with a different range may be set for each of three or more straight-line driving modes with different speed ranges.
また、上記の実施形態において、カーブ走行モードにおいても、直進走行モードと同様、速度範囲が異なる複数段階のカーブ走行モードの各々で、範囲が互いに異なる検知領域Ａ１を設定してもよい。また、上記の実施形態において、旋回走行モードにおいても、直進走行モードと同様に、速度範囲が異なる複数段階の旋回走行モードの各々で、範囲が互いに異なる検知領域Ａ１を設定してもよい。 In addition, in the above embodiment, in the curve driving mode, similar to the straight driving mode, a detection area A1 with a different range may be set for each of the multiple stages of curve driving modes with different speed ranges. In addition, in the above embodiment, in the turning driving mode, similar to the straight driving mode, a detection area A1 with a different range may be set for each of the multiple stages of turning driving modes with different speed ranges.
また、上記の実施形態では、領域設定部１１２は、走行モードに応じて、移動面６０と平行な平面内での検知領域Ａ１の形状及び大きさを変更しているが、移動面６０と直交する方向において検知領域Ａ１の形状及び大きさを変更してもよい。すなわち、検知領域Ａ１は三次元の領域でもよい。領域設定部１１２は、外部からの制御指示に基づいて三次元の検知領域Ａ１の形状及び大きさの少なくとも一方を変更するので、例えば移動体１０が搬送する搬送対象物４０の高さ寸法等に応じて検知領域Ａ１の高さを変更することができる。
In the above embodiment, the
また、上記の実施形態において、領域設定部１１２は、移動体１０が搬送する搬送対象物４０に応じて検知領域Ａ１を変更してもよい。検知領域Ａ１は、移動体１０が搬送する搬送対象物４０が少なくとも入る領域であることが好ましい。領域設定部１１２が、搬送対象物４０の形状又は大きさに基づいて、検知領域Ａ１の形状及び大きさの少なくとも一方を設定することで、移動体１０が搬送する搬送対象物４０が所定エリア１００内の物体と接触する可能性を低減できる。また、領域設定部１１２が、検知領域Ａ１を搬送対象物４０が入る最小面の大きさに設定することによって、移動体１０の移動に支障がない物体まで検知してしまう可能性を低減でき、移動体１０を安全かつスムーズに移動させることができる。
In the above embodiment, the
また、上記の実施形態では、移動体１０が領域選択部１１１を備えているが、領域選択部１１１の機能を上位システム２０が備えていてもよい。つまり、上位システム２０が領域選択部を有し、上位システム２０は、領域選択部が選択した領域候補を検知領域Ａ１とする制御指示を移動体１０に出力すればよい。例えば、上位システム２０は、移動体１０に対して、当該移動体１０の移動モードを指定するモード指令と、領域選択部が選択した領域候補を検知領域Ａ１とする制御指示と、を移動体１０に送信させる。移動体１０の第１通信部１２が上位システム２０からの制御指示を受信すると、移動体１０の領域設定部１１２が、制御指示に基づいて、上位システム２０の領域選択部が選択した領域候補の領域データに基づいて検知領域Ａ１を設定する。これにより、外部（上位システム２９）からの制御指示により、移動体１０の検知領域を設定可能な移動体システム１を提供できる。
In the above embodiment, the moving
（まとめ）
以上説明したように、第１の態様の移動体システム（１）は、移動体（１０）と、移動体（１０）に制御指示を出力する上位システム（２０）と、を備える。移動体（１０）は、物体の検知領域（Ａ１）を移動体（１０）の周囲に設定する領域設定部（１１２）と、検知領域（Ａ１）における物体の検知結果に基づいて移動体（１０）を制御する制御部（１１３）と、を有する。領域設定部（１１２）は、制御指示に基づいて検知領域（Ａ１）を設定する。
(summary)
As described above, the mobile body system (1) of the first aspect includes a mobile body (10) and a host system (20) that outputs a control instruction to the mobile body (10). The mobile body (10) has an area setting unit (112) that sets an object detection area (A1) around the mobile body (10), and a control unit (113) that controls the mobile body (10) based on the detection result of the object in the detection area (A1). The area setting unit (112) sets the detection area (A1) based on the control instruction.
この態様によれば、外部（２０）からの制御指示に基づいて検知領域（Ａ１）を設定可能な移動体システム（１）を提供することができる。 According to this aspect, it is possible to provide a mobile system (1) capable of setting a detection area (A1) based on a control instruction from the outside (20).
第２の態様の移動体システム（１）は、第１の態様において、互いに範囲が異なる複数の領域候補の中から検知領域（Ａ１）とする領域候補を選択する領域選択部（１１１）を更に備える。領域設定部（１１２）は、領域選択部（１１１）が選択した領域候補に基づく検知領域（Ａ１）を移動体（１０）の周囲に設定する。 The mobile body system (1) of the second aspect further includes an area selection unit (111) that selects an area candidate to be a detection area (A1) from among a plurality of area candidates having different ranges from each other in the first aspect. The area setting unit (112) sets the detection area (A1) based on the area candidate selected by the area selection unit (111) around the mobile body (10).
この態様によれば、領域設定部（１１２）は、互いに範囲が異なる複数の領域候補のいずれかを検知領域（Ａ１）に設定することができる。 According to this aspect, the area setting unit (112) can set one of a plurality of area candidates having different ranges as the detection area (A1).
第３の態様の移動体システム（１）では、第２の態様において、移動体（１０）が領域選択部（１１１）を更に有する。 In the third aspect of the mobile body system (1), the mobile body (10) in the second aspect further has a region selection unit (111).
この態様によれば、移動体（１０）において、複数の領域候補の中から検知領域（Ａ１）とする領域候補を選択することができる。 According to this aspect, the moving body (10) can select a region candidate to be the detection region (A1) from among multiple region candidates.
第４の態様の移動体システム（１）では、第２の態様において、上位システム（２０）が領域選択部（１１１）を有する。上位システム（２０）は、領域選択部（１１１）が選択した領域候補に基づく検知領域（Ａ１）を設定するよう指示する制御指示を移動体（１０）に出力する。 In the fourth aspect of the mobile system (1), in the second aspect, the host system (20) has a region selection unit (111). The host system (20) outputs a control instruction to the mobile body (10) to instruct the mobile body (10) to set a detection region (A1) based on the region candidate selected by the region selection unit (111).
この態様によれば、移動体（１０）の領域設定部（１１２）は、上位システム（２０）からの制御指示に基づいて、制御指示で指示された領域候補に基づく検知領域（Ａ１）を設定することができる。 According to this aspect, the area setting unit (112) of the moving body (10) can set a detection area (A1) based on area candidates specified in a control instruction from the higher-level system (20).
第５の態様の移動体システム（１）では、第１～第４のいずれかの態様において、領域設定部（１１２）は、制御指示に基づいて、検知領域（Ａ１）の大きさ及び形状の少なくとも一方を設定する。 In the fifth aspect of the mobile system (1), in any of the first to fourth aspects, the area setting unit (112) sets at least one of the size and shape of the detection area (A1) based on a control instruction.
この態様によれば、領域設定部（１１２）は、外部（２０）からの制御指示に基づいて検知領域（Ａ１）の大きさ及び形状の少なくとも一方を設定することができる。 According to this aspect, the area setting unit (112) can set at least one of the size and shape of the detection area (A1) based on a control instruction from the outside (20).
第６の態様の移動体システム（１）では、第１～第５のいずれかの態様において、移動体（１０）は検知領域（Ａ１）を記憶している。領域設定部（１１２）は、制御指示に基づいて、移動体（１０）が記憶している検知領域（Ａ１）を変更可能である。 In the sixth aspect of the mobile body system (1) in any of the first to fifth aspects, the mobile body (10) stores a detection area (A1). The area setting unit (112) can change the detection area (A1) stored in the mobile body (10) based on a control instruction.
この態様によれば、領域設定部（１１２）は、移動体（１０）の周囲に設定する検知領域（Ａ１）を更新することができる。 According to this aspect, the area setting unit (112) can update the detection area (A1) set around the moving body (10).
第７の態様の移動体システム（１）では、第１～第６のいずれかの態様において、検知領域（Ａ１）は三次元の領域である。 In the seventh aspect of the mobile system (1), in any of the first to sixth aspects, the detection area (A1) is a three-dimensional area.
この態様によれば、領域設定部（１１２）は、外部（２０）からの制御指示に基づいて、移動体１０の周囲に、三次元の領域である検知領域（Ａ１）を設定することができる。
According to this aspect, the area setting unit (112) can set a detection area (A1), which is a three-dimensional area, around the moving
第８の態様の移動体システム（１）では、第１～第７のいずれかの態様において、移動体（１０）の移動状態は、移動速度と移動方向との少なくとも一方が異なる複数種類の移動モードを含む。領域設定部（１１２）は、移動体（１０）の移動モードに応じて検知領域（Ａ１）を変更する。 In the eighth aspect of the mobile body system (1), in any of the first to seventh aspects, the moving state of the mobile body (10) includes multiple types of moving modes in which at least one of the moving speed and the moving direction is different. The area setting unit (112) changes the detection area (A1) according to the moving mode of the mobile body (10).
この態様によれば、領域設定部（１１２）は、移動体（１０）の移動モードに応じた検知領域（Ａ１）を設定することができる。 According to this aspect, the area setting unit (112) can set the detection area (A1) according to the movement mode of the moving body (10).
第９の態様の移動体システム（１）では、第１～第８のいずれかの態様において、移動体（１０）は、搬送対象物（４０）を搬送する搬送装置を含む。 In the ninth aspect of the mobile body system (1), in any of the first to eighth aspects, the mobile body (10) includes a transport device that transports the object to be transported (40).
この態様によれば、領域設定部（１１２）は、外部（２０）からの制御指示に基づいて、搬送装置の周囲に検知領域（Ａ１）を設定することができる。 According to this aspect, the area setting unit (112) can set a detection area (A1) around the conveying device based on a control instruction from the outside (20).
第１０の態様の移動体システム（１）では、第９の態様において、領域設定部（１１２）は、搬送対象物（４０）に応じて検知領域（Ａ１）を変更する。 In the mobile system (1) of the tenth aspect, in the ninth aspect, the area setting unit (112) changes the detection area (A1) depending on the object to be transported (40).
この態様によれば、領域設定部（１１２）は、搬送対象物（４０）に応じて検知領域（Ａ１）を設定することができる。 According to this aspect, the area setting unit (112) can set the detection area (A1) according to the object to be transported (40).
第１１の態様の移動体システム（１）では、第１～第１０のいずれかの態様において、検知領域（Ａ１）は複数の小領域（ＳＡ１，ＳＡ２）を含む。制御部（１１３）は、複数の小領域（ＳＡ１，ＳＡ２）の各々での物体の検知結果に基づいて移動体（１０）を制御する。 In the mobile body system (1) of the eleventh aspect, in any of the first to tenth aspects, the detection area (A1) includes a plurality of small areas (SA1, SA2). The control unit (113) controls the mobile body (10) based on the object detection results in each of the plurality of small areas (SA1, SA2).
この態様によれば、外部（２０）からの制御指示に基づいて、複数の小領域（ＳＡ１，ＳＡ２）を含む検知領域（Ａ１）を設定することができる。 According to this aspect, a detection area (A1) including multiple small areas (SA1, SA2) can be set based on a control instruction from the outside (20).
第１２の態様の移動体システム（１）では、第１１の態様において、複数の小領域は、第１領域（ＳＡ１）と、第２領域（ＳＡ２）と、を含む。第１領域（ＳＡ１）は、移動体（１０）が入る大きさの円（Ｃ１）と、円（Ｃ１）の中心（ＣＰ１）を通る線分（Ｌ１０）と平行な２本の線分（Ｌ１，Ｌ２）とで囲まれ、移動体（１０）が少なくとも入る領域である。第２領域（ＳＡ２）は、円（Ｃ１）の内側の領域のうち第１領域（ＳＡ１）の外側の領域である。 In the mobile body system (1) of the 12th aspect, in the 11th aspect, the multiple small areas include a first area (SA1) and a second area (SA2). The first area (SA1) is surrounded by a circle (C1) large enough to accommodate the mobile body (10) and two line segments (L1, L2) parallel to a line segment (L10) passing through the center (CP1) of the circle (C1), and is an area that accommodates at least the mobile body (10). The second area (SA2) is an area inside the circle (C1) that is outside the first area (SA1).
この態様によれば、外部（２０）からの制御指示に基づいて検知領域（Ａ１）を設定可能な移動体システム（１）を提供することができる。 According to this aspect, it is possible to provide a mobile system (1) capable of setting a detection area (A1) based on a control instruction from the outside (20).
第１３の態様の移動体システム（１）では、第１～第１１のいずれかの態様において、検知領域（Ａ１）は、移動体（１０）が入る第１部分（Ｐ１）と、第１部分（Ｐ１）よりも移動体（１０）の進行方向前方にある第２部分（Ｐ２）とを含む。移動体（１０）の進行方向と直交する方向において、第１部分（Ｐ１）の幅（Ｗ２１）よりも第２部分（Ｐ２）の幅（Ｗ２２）が大きい。 In the mobile body system (1) of the thirteenth aspect, in any of the first to eleventh aspects, the detection area (A1) includes a first portion (P1) into which the mobile body (10) enters, and a second portion (P2) that is located forward of the first portion (P1) in the traveling direction of the mobile body (10). In a direction perpendicular to the traveling direction of the mobile body (10), the width (W22) of the second portion (P2) is larger than the width (W21) of the first portion (P1).
この態様によれば、外部（２０）からの制御指示に基づいて検知領域（Ａ１）を設定可能な移動体システム（１）を提供することができる。 According to this aspect, it is possible to provide a mobile system (1) capable of setting a detection area (A1) based on a control instruction from the outside (20).
第１４の態様の移動体制御方法は、物体の検知領域（Ａ１）を移動体（１０）の周囲に設定する領域設定処理と、検知領域（Ａ１）における物体の検知結果に基づいて移動体（１０）を制御する制御処理と、を含む。領域設定処理では、上位システム（２０）から入力される制御指示に基づいて検知領域（Ａ１）を設定する。 The mobile body control method of the fourteenth aspect includes a region setting process for setting an object detection region (A1) around the mobile body (10), and a control process for controlling the mobile body (10) based on the detection result of the object in the detection region (A1). In the region setting process, the detection region (A1) is set based on a control instruction input from a higher-level system (20).
この態様によれば、外部（２０）からの制御指示に基づいて検知領域（Ａ１）を設定可能な移動体制御方法を実現することができる。 According to this aspect, it is possible to realize a mobile object control method that can set the detection area (A1) based on a control instruction from the outside (20).
第１５の態様のプログラムは、コンピュータシステムに、第１４の態様の移動体制御方法を実行させるためのプログラムである。 The program of the fifteenth aspect is a program for causing a computer system to execute the mobile object control method of the fourteenth aspect.
この態様によれば、外部（２０）からの制御指示に基づいて検知領域（Ａ１）を設定可能な移動体制御方法をコンピュータシステムに実行させるためのプログラムを提供することができる。 According to this aspect, it is possible to provide a program for causing a computer system to execute a mobile object control method capable of setting a detection area (A1) based on a control instruction from the outside (20).
上記態様に限らず、上記の実施形態に係る移動体システム（１）の種々の構成（変形例を含む）は、移動体制御方法、（コンピュータ）プログラム、又はプログラムを記録した非一時的記録媒体等で具現化可能である。 Not limited to the above aspects, various configurations (including modified examples) of the mobile body system (1) according to the above embodiment can be embodied as a mobile body control method, a (computer) program, or a non-transitory recording medium on which a program is recorded, etc.
第２～第１３の態様に係る構成については、移動体システム（１）に必須の構成ではなく、適宜省略可能である。 The configurations according to the second to thirteenth aspects are not essential for the mobile system (1) and may be omitted as appropriate.
１ 移動体システム
１０ 移動体
２０ 上位システム
４０ 搬送対象物
１１１ 領域選択部
１１２ 領域設定部
１１３ 制御部
Ａ１ 検知領域
Ｃ１ 円
ＣＰ１ 円の中心
Ｌ１，Ｌ２，Ｌ１０ 線分
Ｐ１ 第１部分
Ｐ２ 第２部分
ＳＡ１ 第１領域（小領域）
ＳＡ２ 第２領域（小領域）
REFERENCE SIGNS
SA2 Second area (small area)
Claims (15)
前記移動体に制御指示を出力する上位システムと、を備え、
前記移動体は、
物体の検知領域を前記移動体の周囲に設定する領域設定部と、
前記検知領域における物体の検知結果に基づいて前記移動体を制御する制御部と、を有し、
前記領域設定部は、前記制御指示に基づいて前記検知領域を設定し、
前記移動体の移動状態は、移動速度と移動方向との少なくとも一方が異なる複数種類の移動モードを含み、
前記領域設定部は、前記移動体の前記移動モードに応じて前記検知領域を変更し、
複数種類の前記移動モードは、直進走行モードと、カーブ走行モードと、旋回走行モードとを少なくとも含む、
移動体システム。 A moving body,
a host system that outputs a control instruction to the moving body,
The moving body is
an area setting unit that sets an object detection area around the moving body;
a control unit that controls the moving body based on a detection result of an object in the detection area,
The area setting unit sets the detection area based on the control instruction,
the moving state of the moving body includes a plurality of types of moving modes that differ in at least one of a moving speed and a moving direction,
the area setting unit changes the detection area in accordance with the movement mode of the moving object;
The plurality of types of travel modes include at least a straight running mode, a curve running mode, and a turning running mode.
Mobile systems.
前記領域設定部は、前記領域選択部が選択した前記領域候補に基づく前記検知領域を前記移動体の周囲に設定する、
請求項１に記載の移動体システム。 A region selection unit is further provided for selecting the region candidate to be the detection region from a plurality of region candidates having different ranges from each other,
the region setting unit sets the detection region based on the region candidate selected by the region selection unit around the moving object.
The mobile system of claim 1 .
請求項２に記載の移動体システム。 The moving body further includes the area selection unit.
The mobile system according to claim 2 .
前記上位システムは、前記領域選択部が選択した前記領域候補に基づく前記検知領域を設定するよう指示する前記制御指示を前記移動体に出力する、
請求項２に記載の移動体システム。 the host system includes the region selection unit,
the host system outputs the control instruction to the moving object to instruct the moving object to set the detection area based on the area candidate selected by the area selection unit.
The mobile system according to claim 2 .
請求項１～４のいずれか１項に記載の移動体システム。 The area setting unit sets a size and a shape of the detection area based on the control instruction.
The mobile system according to any one of claims 1 to 4.
前記領域設定部は、前記制御指示に基づいて、前記移動体が記憶している前記検知領域を変更可能である、
請求項１～５のいずれか１項に記載の移動体システム。 The moving body stores the detection area,
The area setting unit is capable of changing the detection area stored in the moving object based on the control instruction.
The mobile system according to any one of claims 1 to 5.
請求項１～６のいずれか１項に記載の移動体システム。 The sensing region is a three-dimensional region.
The mobile system according to any one of claims 1 to 6.
請求項１～７のいずれか１項に記載の移動体システム。The mobile system according to any one of claims 1 to 7.
請求項８に記載の移動体システム。The mobile system according to claim 8.
前記制御部は、前記複数の小領域の各々での物体の検知結果に基づいて前記移動体を制御する、The control unit controls the moving body based on a result of the object detection in each of the plurality of small regions.
請求項１～９のいずれか１項に記載の移動体システム。The mobile system according to any one of claims 1 to 9.
前記移動体が入る大きさの円と、前記円の中心を通る線分と平行な２本の線分とで囲まれ、前記移動体が少なくとも入る第１領域と、a first area surrounded by a circle large enough to accommodate the moving object and two lines parallel to a line passing through a center of the circle, the first area including at least the moving object;
前記円の内側の領域のうち前記第１領域の外側の領域である第２領域と、を含む、A second region that is an area inside the circle and is an area outside the first region,
請求項１０に記載の移動体システム。The mobile system of claim 10.
前記移動体の進行方向と直交する方向において、前記第１部分の幅よりも前記第２部分の幅が大きい、In a direction perpendicular to a traveling direction of the moving body, a width of the second portion is larger than a width of the first portion.
請求項１～１０のいずれか１項に記載の移動体システム。The mobile system according to any one of claims 1 to 10.
請求項１～１２のいずれか１項に記載の移動体システム。The mobile system according to any one of claims 1 to 12.
前記検知領域における物体の検知結果に基づいて前記移動体を制御する制御処理と、を含み、A control process for controlling the moving body based on a detection result of an object in the detection area,
前記移動体の移動状態は、移動速度と移動方向との少なくとも一方が異なる複数種類の移動モードを含み、the moving state of the moving body includes a plurality of types of moving modes that differ in at least one of a moving speed and a moving direction,
前記領域設定処理では、前記移動体の前記移動モードに応じて前記検知領域を変更し、In the area setting process, the detection area is changed in accordance with the movement mode of the moving object;
複数種類の前記移動モードは、直進走行モードと、カーブ走行モードと、旋回走行モードとを少なくとも含む、The plurality of types of travel modes include at least a straight running mode, a curve running mode, and a turning running mode.
移動体制御方法。A mobile object control method.
前記移動体に制御指示を出力する上位システムと、を備え、a host system that outputs a control instruction to the moving body,
前記移動体は、The moving body is
物体の検知領域を前記移動体の周囲に設定する領域設定部と、an area setting unit that sets an object detection area around the moving body;
前記検知領域における物体の検知結果に基づいて前記移動体を制御する制御部と、を有し、a control unit that controls the moving body based on a detection result of an object in the detection area,
前記領域設定部は、前記制御指示に基づいて前記検知領域を設定し、The area setting unit sets the detection area based on the control instruction,
前記検知領域は複数の小領域を含み、the sensing region includes a plurality of small regions;
前記制御部は、前記複数の小領域の各々での物体の検知結果に基づいて前記移動体を制御し、The control unit controls the moving body based on a result of the detection of the object in each of the plurality of small regions;
前記複数の小領域は、The plurality of small regions include
前記移動体が入る大きさの円と、前記円の中心を通る線分と平行な２本の線分とで囲まれ、前記移動体が少なくとも入る第１領域と、a first area surrounded by a circle large enough to accommodate the moving object and two lines parallel to a line passing through a center of the circle, the first area including at least the moving object;
前記円の内側の領域のうち前記第１領域の外側の領域である第２領域と、を含む、A second region that is an area inside the circle and is an area outside the first region,
移動体システム。Mobile systems.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019184813A JP7489609B2 (en) | 2019-10-07 | 2019-10-07 | MOBILE SYSTEM AND MOBILE SYSTEM CONTROL METHOD |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2019184813A JP7489609B2 (en) | 2019-10-07 | 2019-10-07 | MOBILE SYSTEM AND MOBILE SYSTEM CONTROL METHOD |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2021060825A JP2021060825A (en) | 2021-04-15 |
| JP7489609B2 true JP7489609B2 (en) | 2024-05-24 |
Family
ID=75380222
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2019184813A Active JP7489609B2 (en) | 2019-10-07 | 2019-10-07 | MOBILE SYSTEM AND MOBILE SYSTEM CONTROL METHOD |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7489609B2 (en) |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001222320A (en) | 2000-02-10 | 2001-08-17 | Shinko Electric Co Ltd | Traveling controller for traveling object and anterior monitoring method |
| JP2003073093A (en) | 2001-09-06 | 2003-03-12 | Nippon Yusoki Co Ltd | Automated forklift |
| JP2003233423A (en) | 2002-02-07 | 2003-08-22 | Jfe Steel Kk | Collision avoidance method for autonomous traveling vehicle and method therefor |
| JP2004094298A (en) | 2002-08-29 | 2004-03-25 | Daifuku Co Ltd | Transport device using self-propelled vehicle |
| JP2015170284A (en) | 2014-03-10 | 2015-09-28 | 株式会社日立製作所 | Forklift type unmanned carrier vehicle, control method of the same, and control device of the same |
| JP2016151897A (en) | 2015-02-17 | 2016-08-22 | 株式会社安川電機 | Mobile body control device and mobile body control method |
| JP2018155597A (en) | 2017-03-17 | 2018-10-04 | シャープ株式会社 | Obstacle detector, traveling device, obstacle detection system, and method for detecting obstacle |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0283713A (en) * | 1988-09-21 | 1990-03-23 | Daifuku Co Ltd | Safety device for automatic traveling vehicle |
-
2019
- 2019-10-07 JP JP2019184813A patent/JP7489609B2/en active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001222320A (en) | 2000-02-10 | 2001-08-17 | Shinko Electric Co Ltd | Traveling controller for traveling object and anterior monitoring method |
| JP2003073093A (en) | 2001-09-06 | 2003-03-12 | Nippon Yusoki Co Ltd | Automated forklift |
| JP2003233423A (en) | 2002-02-07 | 2003-08-22 | Jfe Steel Kk | Collision avoidance method for autonomous traveling vehicle and method therefor |
| JP2004094298A (en) | 2002-08-29 | 2004-03-25 | Daifuku Co Ltd | Transport device using self-propelled vehicle |
| JP2015170284A (en) | 2014-03-10 | 2015-09-28 | 株式会社日立製作所 | Forklift type unmanned carrier vehicle, control method of the same, and control device of the same |
| JP2016151897A (en) | 2015-02-17 | 2016-08-22 | 株式会社安川電機 | Mobile body control device and mobile body control method |
| JP2018155597A (en) | 2017-03-17 | 2018-10-04 | シャープ株式会社 | Obstacle detector, traveling device, obstacle detection system, and method for detecting obstacle |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2021060825A (en) | 2021-04-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US11145206B2 (en) | Roadmap segmentation for robotic device coordination | |
| US10994418B2 (en) | Dynamically adjusting roadmaps for robots based on sensed environmental data | |
| JP5984986B1 (en) | Transport vehicle system | |
| CN110730931A (en) | Deadlock free multi-agent navigation roadmap annotation | |
| JPWO2018110568A1 (en) | Mobile object for performing obstacle avoidance operation and computer program therefor | |
| WO2019054208A1 (en) | Mobile body and mobile body system | |
| US11468770B2 (en) | Travel control apparatus, travel control method, and computer program | |
| WO2019059307A1 (en) | Moving body and moving body system | |
| JP7489609B2 (en) | MOBILE SYSTEM AND MOBILE SYSTEM CONTROL METHOD | |
| US20210123766A1 (en) | Travel control apparatus, mobile body, and operation system | |
| TWI733593B (en) | Anti-collision control method and rail car control system | |
| JP7149568B2 (en) | Mobile object control system, mobile object system, mobile object control method, and program | |
| JP7397469B2 (en) | management system | |
| CN116166029A (en) | Multi-AGV navigation method and system compatible with local obstacle avoidance function | |
| JP7378062B2 (en) | Transport method, program, transport system, and component mounting system | |
| JP2023162890A (en) | Mobile body control system and design support system | |
| US20220179422A1 (en) | Control method, non-transitory storage medium, mover system, and parts mounting system | |
| JP2005149008A (en) | Automatic conveying carriage and conveying system | |
| JP2022165832A (en) | Mobile body system, mobile body controlling method, and program | |
| Dubova et al. | Virtual Prototype of AGV-Based Warehouse System | |
| WO2021171974A1 (en) | Control device, mobile body, movement control system, control method, and program | |
| US20230347951A1 (en) | Driverless transport system | |
| JP7503790B2 (en) | CONTROL METHOD, PROGRAM, MOBILE SYSTEM, AND COMPONENT MOUNTING SYSTEM | |
| JP6687313B1 (en) | Transport system | |
| JP2022153068A (en) | Conveyance control method, conveyance control program, and conveyance control system |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220808 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230531 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230606 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230807 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20231114 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20240115 |
|
| 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: 20240402 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20240426 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 7489609 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |