JP2021043733A - Travel control device - Google Patents
Travel control device Download PDFInfo
- Publication number
- JP2021043733A JP2021043733A JP2019165713A JP2019165713A JP2021043733A JP 2021043733 A JP2021043733 A JP 2021043733A JP 2019165713 A JP2019165713 A JP 2019165713A JP 2019165713 A JP2019165713 A JP 2019165713A JP 2021043733 A JP2021043733 A JP 2021043733A
- Authority
- JP
- Japan
- Prior art keywords
- moving body
- destination
- forklift
- pallet
- distance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000001514 detection method Methods 0.000 claims abstract description 62
- 238000000034 method Methods 0.000 claims description 38
- 238000010586 diagram Methods 0.000 description 6
- 230000006870 function Effects 0.000 description 2
- 230000010365 information processing Effects 0.000 description 2
- 230000001678 irradiating effect Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006698 induction Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
本発明は、走行制御装置に関する。 The present invention relates to a traveling control device.
従来の走行制御装置としては、例えば特許文献1に記載されているような技術が知られている。特許文献1に記載の走行制御装置は、バーコードを撮像してバーコードの映像情報を取得するCCDカメラと、バーコードの映像情報に基づいて無人搬送車の停止位置を把握する映像情報処理部と、この映像情報処理部により算出された無人搬送車の停止位置とメモリに予め貯蔵された基準値との差を算出して位置補正値を求め、その位置補正値に応じて無人搬送車が予め決められた作業位置に移動するようにホイール駆動モータを制御する演算部とを備えている。 As a conventional traveling control device, for example, a technique described in Patent Document 1 is known. The travel control device described in Patent Document 1 includes a CCD camera that captures a barcode and acquires image information of the barcode, and an image information processing unit that grasps the stop position of an automatic guided vehicle based on the image information of the barcode. Then, the difference between the stop position of the automatic guided vehicle calculated by this video information processing unit and the reference value stored in advance in the memory is calculated to obtain the position correction value, and the automatic guided vehicle moves according to the position correction value. It is equipped with a calculation unit that controls a wheel drive motor so as to move to a predetermined work position.
ところで、上記従来技術のように、カメラ等を用いて移動体の自己位置を推定しながら移動体を目的地まで自動的に走行させる走行制御装置では、移動体の位置を目的地に対して高精度に合わせる必要がある。しかし、カメラ等を用いて移動体の自己位置を推定しながら移動体を走行させる場合には、例えば床面に埋設された磁気棒や磁気マークを磁気センサで検出しながら移動体を走行させる場合に比べて、移動体の位置精度が悪い。従って、目的地に対する移動体の位置合わせを高精度に行うことが困難である。 By the way, in a traveling control device that automatically travels a moving body to a destination while estimating the self-position of the moving body using a camera or the like as in the above-mentioned prior art, the position of the moving body is higher than the destination. It is necessary to match the accuracy. However, when the moving body is moved while estimating the self-position of the moving body using a camera or the like, for example, when the moving body is moved while detecting a magnetic rod or a magnetic mark embedded in the floor surface with a magnetic sensor. Compared to, the position accuracy of the moving body is poor. Therefore, it is difficult to accurately align the moving body with respect to the destination.
本発明の目的は、移動体を目的地まで走行させる際に、目的地に対する移動体の位置合わせを高精度に行うことができる走行制御装置を提供することである。 An object of the present invention is to provide a traveling control device capable of aligning a moving body with respect to a destination with high accuracy when the moving body travels to a destination.
本発明の一態様は、移動体を目的地まで走行させる走行制御装置において、移動体の自己位置を推定する位置推定部と、移動体に設けられ、移動体から目的地までの距離を検出する目的地距離検出部と、位置推定部により推定された移動体の自己位置に基づいて、移動体を目的地に近づく方向に走行させるように制御する第1走行制御部と、第1走行制御部による制御処理が実行された後、移動体の自己位置に基づいて、移動体が目的地距離検出部により目的地までの距離を検出可能な第1位置に達したかどうかを判断し、移動体が第1位置に達したときに、移動体の自己位置と目的地距離検出部の検出距離とに基づいて、移動体を第1位置から目的地に向けて走行させるように制御する第2走行制御部と、第2走行制御部による制御処理が実行された後、目的地距離検出部の検出距離または移動体の自己位置に基づいて、移動体が第1位置よりも目的地に近い第2位置に達したかどうかを判断し、移動体が第2位置に達したときに、移動体の自己位置と目的地距離検出部の検出距離とに基づいて、移動体を第2位置から目的地に向けて走行させるように制御する第3走行制御部とを備える。 One aspect of the present invention is a traveling control device for traveling a moving body to a destination, in which a position estimating unit for estimating the self-position of the moving body and a distance estimated from the moving body to the destination provided on the moving body are detected. A first travel control unit and a first travel control unit that control the moving body to travel in a direction approaching the destination based on the destination distance detection unit and the self-position of the moving body estimated by the position estimation unit. After the control process is executed, it is determined whether or not the moving body has reached the first position where the distance to the destination can be detected by the destination distance detection unit based on the self-position of the moving body. A second run that controls the moving body to travel from the first position toward the destination based on the self-position of the moving body and the detection distance of the destination distance detecting unit when the moving body reaches the first position. After the control process by the control unit and the second travel control unit is executed, the moving body is closer to the destination than the first position based on the detection distance of the destination distance detecting unit or the self-position of the moving body. It is determined whether or not the position has been reached, and when the moving body reaches the second position, the moving body is moved from the second position to the destination based on the self-position of the moving body and the detection distance of the destination distance detection unit. It is provided with a third traveling control unit that controls the traveling toward the vehicle.
このような走行制御装置においては、まず移動体の自己位置に基づいて、移動体が目的地に近づく方向に走行するように制御される。そして、移動体が目的地距離検出部により目的地までの距離を検出可能な第1位置に達すると、移動体の自己位置と目的地距離検出部の検出距離とに基づいて、移動体が第1位置から目的地に向けて走行するように制御される。そして、移動体が第1位置よりも目的地に近い第2位置に達すると、移動体の自己位置と目的地距離検出部の検出距離とに基づいて、移動体が第2位置から目的地に向けて走行するように制御される。このように第1位置よりも目的地に近い第2位置において、目的地距離検出部により移動体から目的地までの距離が再度検出される。このため、移動体から目的地までの距離の検出精度が高くなる。これにより、移動体を目的地まで走行させる際に、目的地に対する移動体の位置合わせを高精度に行うことができる。 In such a traveling control device, first, the moving body is controlled to travel in a direction approaching the destination based on the self-position of the moving body. Then, when the moving body reaches the first position where the distance to the destination can be detected by the destination distance detecting unit, the moving body becomes the first position based on the self-position of the moving body and the detection distance of the destination distance detecting unit. It is controlled to travel from one position toward the destination. Then, when the moving body reaches the second position closer to the destination than the first position, the moving body moves from the second position to the destination based on the self-position of the moving body and the detection distance of the destination distance detection unit. It is controlled to run toward. In this way, at the second position closer to the destination than the first position, the distance from the moving body to the destination is detected again by the destination distance detection unit. Therefore, the detection accuracy of the distance from the moving body to the destination is improved. As a result, when the moving body is moved to the destination, the positioning of the moving body with respect to the destination can be performed with high accuracy.
第2走行制御部は、移動体が第1位置に達したときに、移動体の自己位置と目的地距離検出部の検出距離とに基づいて、移動体から目的地までの第1走行経路を作成し、移動体を第1位置から目的地に向けて第1走行経路に沿って走行させるように制御し、第3走行制御部は、移動体が第2位置に達したときに、移動体の自己位置と目的地距離検出部の検出距離とに基づいて、移動体から目的地までの第2走行経路を作成し、移動体を第2位置から目的地に向けて第2走行経路に沿って走行させるように制御してもよい。このような構成では、移動体から目的地までの第1走行経路及び第2走行経路を作成することにより、移動体を目的地に向けて容易に誘導走行させることができる。また、移動体が目的地の真正面で目的地に対して真っ直ぐ向くような第2走行経路を作成すると、移動体の位置及び姿勢を目的地に対して高精度に合わせることができる。 When the moving body reaches the first position, the second traveling control unit sets the first traveling route from the moving body to the destination based on the self-position of the moving body and the detection distance of the destination distance detecting unit. Created and controlled so that the moving body travels along the first traveling path from the first position toward the destination, and the third traveling control unit controls the moving body when the moving body reaches the second position. A second travel route from the moving body to the destination is created based on the self-position of the mobile body and the detection distance of the destination distance detection unit, and the moving body is directed from the second position to the destination along the second traveling route. It may be controlled to run. In such a configuration, by creating the first traveling route and the second traveling route from the moving body to the destination, the moving body can be easily guided and traveled toward the destination. Further, if the second traveling path is created so that the moving body faces the destination directly in front of the destination, the position and posture of the moving body can be adjusted with high accuracy to the destination.
第2走行制御部は、移動体の自己位置と目的地距離検出部の検出距離とに基づいて、移動体に対する目的地の相対位置を検知して第1走行経路を作成し、第3走行制御部は、移動体の自己位置と目的地距離検出部の検出距離とに基づいて、移動体に対する目的地の相対位置を検知して第2走行経路を作成してもよい。このような構成では、移動体に対する目的地の相対位置を検知することにより、絶対座標系の位置誤差成分が無くなるため、目的地に対して正確な第1走行経路及び第2走行経路が作成される。従って、目的地に対する移動体の位置合わせをより高精度に行うことができる。 The second travel control unit detects the relative position of the destination with respect to the moving object based on the self-position of the moving body and the detection distance of the destination distance detection unit, creates a first travel route, and creates a third travel control. The unit may create a second traveling route by detecting the relative position of the destination with respect to the moving body based on the self-position of the moving body and the detection distance of the destination distance detecting unit. In such a configuration, by detecting the relative position of the destination with respect to the moving body, the position error component of the absolute coordinate system is eliminated, so that the first travel route and the second travel route that are accurate with respect to the destination are created. To. Therefore, the alignment of the moving body with respect to the destination can be performed with higher accuracy.
走行制御装置は、移動体から移動体の周囲に位置する物体までの距離を検出する物体距離検出部を更に備え、位置推定部は、物体距離検出部の検出データと予め保存された地図データとを照らし合わせることにより、移動体の自己位置を推定してもよい。このような構成では、例えばSLAMという自己位置推定技術を用いて、移動体の自己位置を簡単に推定することができる。 The travel control device further includes an object distance detection unit that detects the distance from the moving body to an object located around the moving body, and the position estimation unit includes the detection data of the object distance detection unit and the map data saved in advance. The self-position of the moving body may be estimated by comparing with each other. In such a configuration, the self-position of the moving body can be easily estimated by using, for example, a self-position estimation technique called SLAM.
本発明によれば、移動体を目的地まで走行させる際に、目的地に対する移動体の位置合わせを高精度に行うことができる。 According to the present invention, when the moving body is moved to the destination, the positioning of the moving body with respect to the destination can be performed with high accuracy.
以下、本発明の実施形態について図面を参照して詳細に説明する。 Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.
図1は、本発明の一実施形態に係る走行制御装置を示す概略構成図である。図1において、本実施形態の走行制御装置1は、図2に示されるように、移動体であるフォークリフト2をパレット3まで自動的に走行させる装置である。なお、図2は、倉庫内や工場内でフォークリフト2が作業を行う様子を示す概念図である。
FIG. 1 is a schematic configuration diagram showing a travel control device according to an embodiment of the present invention. In FIG. 1, the travel control device 1 of the present embodiment is a device that automatically travels the moving
フォークリフト2は、ここではリーチ式フォークリフトである。フォークリフト2は、基台2aと、この基台2aの前側に配置され、基台2aの前後方向及び上下方向に移動可能な1対のフォーク2bとを備えている。なお、フォークリフト2は、カウンタ式フォークリフトであってもよい。
The
パレット3は、フォークリフト2が走行する目的地である。パレット3は、荷物を載せるための荷役台である。パレット3には、フォークリフト2のフォーク2bが差し込まれる複数の開口部3aが設けられている。フォークリフト2は、パレット3の開口部3aにフォーク2bを差し込んだ状態で、フォーク2bによりパレット3を持ち上げる。
The
走行制御装置1は、フォークリフト2に搭載されている。走行制御装置1は、後部レーザセンサ4と、前部レーザセンサ5と、駆動部6と、コントローラ7とを備えている。
The travel control device 1 is mounted on the
後部レーザセンサ4は、図2に示されるように、基台2aの後部に取り付けられている。後部レーザセンサ4は、フォークリフト2の周囲にレーザを照射し、レーザの反射光を受光することにより、フォークリフト2からフォークリフト2の周囲に位置する物体8までの距離を検出する物体距離検出部を構成している。後部レーザセンサ4は、フォークリフト2の後方を含む領域にレーザを照射する。後部レーザセンサ4としては、例えばレーザレンジファインダが用いられる。なお、フォークリフト2の周囲に位置する物体8としては、壁8a、柱8b及びその他の特徴物8c等がある。
The
前部レーザセンサ5は、基台2aの前部に取り付けられている。前部レーザセンサ5は、フォークリフト2の前方にレーザを照射し、レーザの反射光を受光することにより、フォークリフト2の前方に位置するパレット3までの距離を検出する目的地距離検出部を構成している。前部レーザセンサ5は、フォークリフト2の前方を含む領域にレーザを照射する(図5及び図6参照)。前部レーザセンサ5としては、例えばレーザレンジファインダが用いられる。
The
駆動部6は、特に図示はしないが、フォークリフト2の走行輪を回転させる走行モータと、フォークリフト2の操舵輪を転舵させる操舵モータとを有している。
Although not particularly shown, the
コントローラ7は、CPU、RAM、ROM及び入出力インターフェース等により構成されている。コントローラ7は、位置推定部10と、第1走行制御部11と、第2走行制御部12と、第3走行制御部13とを有している。
The
位置推定部10は、後部レーザセンサ4の検出データに基づいて、フォークリフト2の自己位置を推定する。位置推定部10は、例えばSLAM(simultaneous localization andmapping)手法を用いて、フォークリフト2の自己位置を推定する。SLAMは、センサデータ及び地図データを使って自己位置推定を行う自己位置推定技術である。SLAMは、レーザセンサ等を利用して、自己位置推定と環境地図の作成とを同時に行う。
The
具体的には、位置推定部10は、後部レーザセンサ4により検出されたフォークリフト2から物体8までの距離データとメモリ(図示せず)に予め保存されたフォークリフト2の周囲環境の地図データとを照らし合わせることにより、フォークリフト2の自己位置を推定する。このとき、位置推定部10は、地図上の絶対座標系においてフォークリフト2の自己位置の推定演算を行う。なお、フォークリフト2の自己位置は、2次元座標(XY座標)及び向きで表される。地図データには、物体8が登録されている。
Specifically, the
第1走行制御部11は、フォークリフト2の走行開始が指示されると、位置推定部10により推定されたフォークリフト2の自己位置に基づいて、フォークリフト2をパレット3に近づく方向に走行させるように駆動部6を制御する。
When the
第2走行制御部12は、第1走行制御部11による制御処理が実行された後、位置推定部10により推定されたフォークリフト2の自己位置に基づいて、フォークリフト2が前部レーザセンサ5によりパレット3を検出可能なパレット検出可能位置(第1位置)に達したかどうかを判断する。そして、第2走行制御部12は、フォークリフト2がパレット検出可能位置に達したときに、フォークリフト2の自己位置と前部レーザセンサ5により検出されたフォークリフト2からパレット3までの距離(前部レーザセンサ5の検出距離)とに基づいて、フォークリフト2をパレット検出可能位置からパレット3に向けて走行させるように駆動部6を制御する。
In the second
第3走行制御部13は、第2走行制御部12による制御処理が実行された後、前部レーザセンサ5により検出されたフォークリフト2からパレット3までの距離(前部レーザセンサ5の検出距離)に基づいて、フォークリフト2がパレット検出可能位置よりもパレット3に近いパレット近傍位置(第2位置)に達したかどうかを判断する。そして、第3走行制御部13は、フォークリフト2がパレット近傍位置に達したときに、フォークリフト2の自己位置と前部レーザセンサ5の検出距離とに基づいて、フォークリフト2をパレット近傍位置からパレット3に向けて走行させるように駆動部6を制御する。
The third
図3及び図4は、コントローラ7により実行される制御処理手順の詳細を示すフローチャートである。本処理は、フォークリフト2の走行の開始が指示されると、実行される。なお、フォークリフト2及びパレット3の現在位置は、予め分かっている。
3 and 4 are flowcharts showing the details of the control processing procedure executed by the
図3及び図4において、コントローラ7は、フォークリフト2の走行の開始が指示されると、フォークリフト2をパレット3に近づく方向に走行させるように駆動部6を制御する(図3の手順S101)。
In FIGS. 3 and 4, when the start of travel of the
続いて、コントローラ7は、後部レーザセンサ4の検出データを取得する(図3の手順S102)。そして、コントローラ7は、後部レーザセンサ4の検出データと予め保存された地図データとをマッチングさせて、フォークリフト2の自己位置を推定する(図3の手順S103)。
Subsequently, the
続いて、コントローラ7は、フォークリフト2の推定位置に基づいて、フォークリフト2がパレット検出可能位置に達したかどうかを判断する(図3の手順S104)。パレット検出可能位置は、地図上の指定範囲として予め決められている。パレット検出可能位置は、前部レーザセンサ5によりパレット3を検出可能なぎりぎりの境界の位置ではなく、前部レーザセンサ5によりパレット3を検出することができる予め定められた位置である。パレット検出可能位置は、例えばパレット3からの距離が第1規定値以下の範囲内である。コントローラ7は、フォークリフト2がパレット検出可能位置に達していないと判断したときは、上記の手順S101〜S103を再度実行する。
Subsequently, the
コントローラ7は、フォークリフト2がパレット検出可能位置に達したと判断したときは、前部レーザセンサ5の検出データを取得する(図3の手順S105)。そして、コントローラ7は、前部レーザセンサ5の検出データに基づいて、フォークリフト2に対するパレット3の相対位置を検知する(図3の手順S106)。このとき、コントローラ7は、フォークリフト2に対するパレット3の相対位置として、フォークリフト2の基台2aの前端中心に対するパレット3の手前端中心の相対位置を検知する。パレット3の手前端は、パレット3のフォークリフト2側の端である。
When the
続いて、コントローラ7は、フォークリフト2に対するパレット3の相対位置に基づいて、フォークリフト2からパレット3までの走行経路P(第1走行経路)を作成する(図3の手順S107)。走行経路Pは、図5(a)に示されるように、フォークリフト2の基台2aの前端中心からパレット3の手前端中心までの経路である。
Subsequently, the
そして、コントローラ7は、図5(b)に示されるように、フォークリフト2を走行経路Pに沿って誘導走行させるように駆動部6を制御する(図3の手順S108)。続いて、コントローラ7は、前部レーザセンサ5の検出データを取得する(図3の手順S109)。そして、コントローラ7は、上記の手順S106と同様に、前部レーザセンサ5の検出データに基づいて、フォークリフト2に対するパレット3の相対位置を検知する(図3の手順S110)。
Then, as shown in FIG. 5B, the
続いて、コントローラ7は、フォークリフト2に対するパレット3の相対位置に基づいて、フォークリフト2がパレット近傍位置に達したかどうかを判断する(図3の手順S111)。パレット近傍位置は、地図上の指定範囲として予め決められている。パレット近傍位置は、例えばパレット3からの距離が第1規定値よりも短い第2規定値以下の範囲内である。コントローラ7は、フォークリフト2がパレット近傍位置に達していないと判断したときは、上記の手順S108〜S110を再度実行する。
Subsequently, the
コントローラ7は、フォークリフト2がパレット近傍位置に達したと判断したときは、前部レーザセンサ5の検出データを取得する(図4の手順S112)。そして、コントローラ7は、前部レーザセンサ5の検出データに基づいて、フォークリフト2に対するパレット3の相対位置を検知する(図4の手順S113)。フォークリフト2に対するパレット3の相対位置は、上記の手順S106と同様である。
When the
続いて、コントローラ7は、フォークリフト2に対するパレット3の相対位置に基づいて、フォークリフト2からパレット3までの走行経路Q(第2走行経路)を作成する(図4の手順S114)。走行経路Qは、図6(a)に示されるように、上記の走行経路Pと同様に、フォークリフト2の基台2aの前端中心からパレット3の手前端中心までの経路である。
Subsequently, the
このとき、走行経路Qは、フォークリフト2がパレット3の真正面に到達するように作成される。フォークリフト2がパレット3の真正面に到達するときは、フォークリフト2がパレット3に対して真っ直ぐ向くと共に、フォークリフト2のフォーク2bがパレット3の開口部3aと対向する。なお、走行経路Qは、上記の走行経路Pよりも短い。
At this time, the traveling path Q is created so that the
そして、コントローラ7は、図6(b)に示されるように、フォークリフト2を走行経路Qに沿って誘導走行させるように駆動部6を制御する(図4の手順S115)。続いて、コントローラ7は、前部レーザセンサ5の検出データを取得する(図4の手順S116)。そして、コントローラ7は、上記の手順S113と同様に、前部レーザセンサ5の検出データに基づいて、フォークリフト2に対するパレット3の相対位置を検知する(図4の手順S117)。
Then, as shown in FIG. 6B, the
続いて、コントローラ7は、フォークリフト2に対するパレット3の相対位置に基づいて、フォークリフト2がパレット3の真正面に達したかどうかを判断する(図4の手順S118)。コントローラ7は、フォークリフト2がパレット3の真正面に達していないと判断したときは、上記の手順S115〜S117を再度実行する。コントローラ7は、フォークリフト2がパレット3の真正面に達したと判断したときは、フォークリフト2を停止させるように駆動部6を制御する(図4の手順S119)。
Subsequently, the
以上において、位置推定部10は、手順S102,S103を実行する。第1走行制御部は、手順S101を実行する。第2走行制御部12は、手順S104〜S108を実行する。第3走行制御部13は、手順S109〜S119を実行する。
In the above, the
ところで、フォークリフト2の自己位置を推定しながらフォークリフト2をパレット3まで走行させる際には、フォーク2bにより荷役を行うために、パレット3に対するフォークリフト2の位置及び姿勢を高精度に合わせる必要がある。しかし、前部レーザセンサ5からパレット3までの距離が長くなるに従い、前部レーザセンサ5の検出誤差が大きくなる。
By the way, when the
本実施形態では、まずフォークリフト2の自己位置に基づいて、フォークリフト2がパレット3に近づく方向に走行するように制御される。そして、フォークリフト2が前部レーザセンサ5によりパレット3までの距離を検出可能なパレット検出可能位置に達すると、フォークリフト2の自己位置と前部レーザセンサ5の検出距離とに基づいて、フォークリフト2がパレット検出可能位置からパレット3に向けて走行するように制御される。そして、フォークリフト2がパレット検出可能位置よりもパレット3に近いパレット近傍位置に達すると、フォークリフト2の自己位置と前部レーザセンサ5の検出距離とに基づいて、フォークリフト2がパレット近傍位置からパレット3に向けて走行するように制御される。このようにパレット検出可能位置よりもパレット3に近いパレット近傍位置において、前部レーザセンサ5によりフォークリフト2からパレット3までの距離が再度検出される。このため、フォークリフト2からパレット3までの距離の検出精度が高くなる。これにより、フォークリフト2をパレット3まで走行させる際に、パレット3に対するフォークリフト2の位置合わせを高精度に行うことができる。その結果、磁気誘導式の走行制御システムのように、床面に磁気棒や磁気マーク等を埋設しなくて済む。従って、設備コストの削減を図りつつ、パレット3に対するフォークリフト2の位置合わせを高精度に行うことが可能となる。
In the present embodiment, first, the
また、本実施形態では、フォークリフト2の自己位置と前部レーザセンサ5の検出距離とに基づいて、フォークリフト2からパレット3までの走行経路Pが作成され、フォークリフト2がパレット検出可能位置からパレット3に向けて走行経路Pに沿って走行するように制御される。そして、フォークリフト2の自己位置と前部レーザセンサ5の検出距離とに基づいて、フォークリフト2からパレット3までの走行経路Qが作成され、フォークリフト2がパレット近傍位置からパレット3に向けて走行経路Qに沿って走行するように制御される。このようにフォークリフト2からパレット3までの走行経路P,Qを作成することにより、フォークリフト2をパレット3に向けて容易に誘導走行させることができる。また、フォークリフト2がパレット3の真正面でパレット3に対して真っ直ぐ向くような走行経路Qを作成すると、フォークリフト2の位置及び姿勢をパレット3に対して高精度に合わせることができる。
Further, in the present embodiment, a traveling path P from the
また、本実施形態では、フォークリフト2の自己位置と前部レーザセンサ5の検出距離とに基づいて、フォークリフト2に対するパレット3の相対位置が検知されて走行経路Pが作成される。そして、フォークリフト2の自己位置と前部レーザセンサ5の検出距離とに基づいて、フォークリフト2に対するパレット3の相対位置が検知されて走行経路Qが作成される。このようにフォークリフト2に対するパレット3の相対位置を検知することにより、絶対座標系の位置誤差成分が無くなるため、パレット3に対して正確な走行経路P,Qが作成される。従って、パレット3に対するフォークリフト2の位置合わせをより高精度に行うことができる。
Further, in the present embodiment, the relative position of the
また、本実施形態では、フォークリフト2からフォークリフト2の周囲に位置する物体8までの距離を検出する後部レーザセンサ4の検出データと予め保存された地図データとを照らし合わせることにより、フォークリフト2の自己位置が推定される。従って、例えばSLAMという自己位置推定技術を用いて、フォークリフト2の自己位置を簡単に推定することができる。
Further, in the present embodiment, the
なお、本発明は、上記実施形態には限定されない。例えば上記実施形態では、前部レーザセンサ5により検出されたフォークリフト2からパレット3までの距離(前部レーザセンサ5の検出距離)に基づいて、フォークリフト2がパレット近傍位置に達したかどうかが判断されているが、フォークリフト2がパレット近傍位置に達したかどうかの判断については、特にその形態には限られず、位置推定部10により推定されたフォークリフト2の自己位置に基づいて行ってもよい。また、フォークリフト2がパレット3の真正面に達したかどうかの判断についても、フォークリフト2の自己位置に基づいて行ってもよい。
The present invention is not limited to the above embodiment. For example, in the above embodiment, it is determined whether or not the
また、上記実施形態では、フォークリフト2の自己位置と前部レーザセンサ5の検出距離とに基づいて、フォークリフト2に対するパレット3の相対位置を検知し、パレット3の相対位置に応じてフォークリフト2を誘導走行させているが、特にその形態には限られず、例えばフォークリフト2に対するパレット3の相対位置からパレット3の絶対位置を算出し、その絶対位置に応じてフォークリフト2を誘導走行させてもよい。
Further, in the above embodiment, the relative position of the
また、上記実施形態では、フォークリフト2がパレット検出可能位置に達すると、フォークリフト2をパレット検出可能位置からパレット3に向けて走行させるように制御し、その後フォークリフト2がパレット近傍位置に達すると、フォークリフト2をパレット近傍位置からパレット3に向けて走行させるように制御する、という2段階でフォークリフト2の走行制御を行っているが、特にその形態には限られない。例えば、上記のパレット検出可能位置及びパレット近傍位置での走行制御に加え、フォークリフト2がパレット近傍位置よりも更にパレット3に近い位置に達すると、フォークリフト2をその位置からパレット3に向けて走行させるように制御する、という3段階以上でフォークリフト2の走行制御を行ってもよい。
Further, in the above embodiment, when the
また、上記実施形態では、後部レーザセンサ4によってフォークリフト2の周囲に位置する物体8までの距離が検出されているが、特にその形態には限られず、例えば前部レーザセンサ5によってフォークリフト2の周囲に位置する物体8までの距離を検出してもよい。この場合には、前部レーザセンサ5は、フォークリフト2からパレット3までの距離を検出する機能と、フォークリフト2から物体8までの距離を検出する機能とを兼ね備えることになる。従って、使用されるセンサが最小限で済み、部品点数の削減につながる。
Further, in the above embodiment, the distance to the
また、上記実施形態では、前部レーザセンサ5によってフォークリフト2からパレット3までの距離が検出されているが、フォークリフト2からパレット3までの距離を検出する目的地距離検出部としては、特にレーザセンサには限られず、カメラ等を使用してもよい。また、フォークリフト2から物体8までの距離を検出する物体距離検出部としても、同様にカメラ等を使用してもよい。
Further, in the above embodiment, the distance from the
また、上記実施形態では、走行制御装置1全体がフォークリフト2に搭載されているが、特にその形態には限られず、目的地距離検出部及び物体距離検出部がフォークリフト2に搭載されていればよく、位置推定部10、第1走行制御部11、第2走行制御部12及び第3走行制御部13については、フォークリフト2以外の固定設備等に設置されていてもよい。
Further, in the above embodiment, the entire traveling control device 1 is mounted on the
また、上記実施形態は、フォークリフト2をパレット3まで走行させる走行制御装置1であるが、フォークリフト2が走行する目的地としては、特にパレット3には限られず、例えばフォークリフト2の待機場所等であってもよい。
Further, the above embodiment is a travel control device 1 for traveling the
また、上記実施形態は、フォークリフト2を目的地まで走行させる走行制御装置1であるが、本発明は、特にフォークリフト2には限られず、例えば他の産業車両または無人搬送車等のように目的地に位置精度良く合わせる必要がある移動体であれば、適用可能である。
Further, the above embodiment is a traveling control device 1 for traveling the
1…走行制御装置、2…フォークリフト(移動体)、3…パレット(目的地)、4…後部レーザセンサ(物体距離検出部)、5…前部レーザセンサ(目的地距離検出部)、8…物体、10…位置推定部、11…第1走行制御部、12…第2走行制御部、13…第3走行制御部、P…走行経路(第1走行経路)、Q…走行経路(第2走行経路)。 1 ... Travel control device, 2 ... Fork lift (moving body), 3 ... Pallet (destination), 4 ... Rear laser sensor (object distance detection unit), 5 ... Front laser sensor (destination distance detection unit), 8 ... Object, 10 ... position estimation unit, 11 ... first travel control unit, 12 ... second travel control unit, 13 ... third travel control unit, P ... travel route (first travel route), Q ... travel route (second travel route) Travel route).
Claims (4)
前記移動体の自己位置を推定する位置推定部と、
前記移動体に設けられ、前記移動体から前記目的地までの距離を検出する目的地距離検出部と、
前記位置推定部により推定された前記移動体の自己位置に基づいて、前記移動体を前記目的地に近づく方向に走行させるように制御する第1走行制御部と、
前記第1走行制御部による制御処理が実行された後、前記移動体の自己位置に基づいて、前記移動体が前記目的地距離検出部により前記目的地までの距離を検出可能な第1位置に達したかどうかを判断し、前記移動体が前記第1位置に達したときに、前記移動体の自己位置と前記目的地距離検出部の検出距離とに基づいて、前記移動体を前記第1位置から前記目的地に向けて走行させるように制御する第2走行制御部と、
前記第2走行制御部による制御処理が実行された後、前記目的地距離検出部の検出距離または前記移動体の自己位置に基づいて、前記移動体が前記第1位置よりも前記目的地に近い第2位置に達したかどうかを判断し、前記移動体が前記第2位置に達したときに、前記移動体の自己位置と前記目的地距離検出部の検出距離とに基づいて、前記移動体を前記第2位置から前記目的地に向けて走行させるように制御する第3走行制御部とを備える走行制御装置。 In a travel control device that travels a moving object to its destination
A position estimation unit that estimates the self-position of the moving body,
A destination distance detecting unit provided on the moving body and detecting the distance from the moving body to the destination,
A first travel control unit that controls the moving body to travel in a direction approaching the destination based on the self-position of the moving body estimated by the position estimation unit.
After the control process by the first travel control unit is executed, the moving body is moved to the first position where the distance to the destination can be detected by the destination distance detecting unit based on the self-position of the moving body. It is determined whether or not the movement has been reached, and when the moving body reaches the first position, the moving body is moved to the first position based on the self-position of the moving body and the detection distance of the destination distance detection unit. A second travel control unit that controls the vehicle to travel from the position toward the destination,
After the control process by the second travel control unit is executed, the moving body is closer to the destination than the first position based on the detection distance of the destination distance detecting unit or the self-position of the moving body. It is determined whether or not the second position has been reached, and when the moving body reaches the second position, the moving body is based on the self-position of the moving body and the detection distance of the destination distance detection unit. A travel control device including a third travel control unit that controls the vehicle to travel from the second position toward the destination.
前記第3走行制御部は、前記移動体が前記第2位置に達したときに、前記移動体の自己位置と前記目的地距離検出部の検出距離とに基づいて、前記移動体から前記目的地までの第2走行経路を作成し、前記移動体を前記第2位置から前記目的地に向けて前記第2走行経路に沿って走行させるように制御する請求項1記載の走行制御装置。 When the moving body reaches the first position, the second traveling control unit receives the destination from the moving body based on the self-position of the moving body and the detection distance of the destination distance detecting unit. The first traveling route up to is created, and the moving body is controlled to travel along the first traveling route from the first position toward the destination.
When the moving body reaches the second position, the third traveling control unit can move the moving body to the destination based on the self-position of the moving body and the detection distance of the destination distance detecting unit. The travel control device according to claim 1, wherein the second travel route up to the above is created, and the moving body is controlled to travel along the second travel route from the second position toward the destination.
前記第3走行制御部は、前記移動体の自己位置と前記目的地距離検出部の検出距離とに基づいて、前記移動体に対する前記目的地の相対位置を検知して前記第2走行経路を作成する請求項2記載の走行制御装置。 The second travel control unit detects the relative position of the destination with respect to the moving body based on the self-position of the moving body and the detection distance of the destination distance detecting unit, and creates the first traveling route. And
The third travel control unit detects the relative position of the destination with respect to the moving body based on the self-position of the moving body and the detection distance of the destination distance detecting unit, and creates the second traveling route. 2. The traveling control device according to claim 2.
前記位置推定部は、前記物体距離検出部の検出データと予め保存された地図データとを照らし合わせることにより、前記移動体の自己位置を推定する請求項1〜3の何れか一項記載の走行制御装置。 An object distance detecting unit for detecting the distance from the moving body to an object located around the moving body is further provided.
The traveling according to any one of claims 1 to 3, wherein the position estimation unit estimates the self-position of the moving body by comparing the detection data of the object distance detection unit with the map data saved in advance. Control device.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019165713A JP7259662B2 (en) | 2019-09-11 | 2019-09-11 | travel control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019165713A JP7259662B2 (en) | 2019-09-11 | 2019-09-11 | travel control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021043733A true JP2021043733A (en) | 2021-03-18 |
JP7259662B2 JP7259662B2 (en) | 2023-04-18 |
Family
ID=74861723
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019165713A Active JP7259662B2 (en) | 2019-09-11 | 2019-09-11 | travel control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7259662B2 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024077716A1 (en) * | 2022-10-11 | 2024-04-18 | 劢微机器人科技(深圳)有限公司 | Local path planning method for amr |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019117585A (en) * | 2017-12-27 | 2019-07-18 | 株式会社ダイヘン | Mobile body |
-
2019
- 2019-09-11 JP JP2019165713A patent/JP7259662B2/en active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019117585A (en) * | 2017-12-27 | 2019-07-18 | 株式会社ダイヘン | Mobile body |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2024077716A1 (en) * | 2022-10-11 | 2024-04-18 | 劢微机器人科技(深圳)有限公司 | Local path planning method for amr |
Also Published As
Publication number | Publication date |
---|---|
JP7259662B2 (en) | 2023-04-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10248123B2 (en) | Mobile apparatus | |
US10048398B2 (en) | Methods and systems for pallet detection | |
US20140371973A1 (en) | Automated Guided Vehicle And Method Of Operating An Automated Guided Vehicle | |
KR101644270B1 (en) | Unmanned freight transportation system using automatic positioning and moving route correcting | |
CN110789529B (en) | Vehicle control method, device and computer-readable storage medium | |
CN107814153A (en) | A kind of AGV vehicles of high-precision off-position fork device and its off-position method | |
KR102564663B1 (en) | Coordinates recognition apparatus of automatic guided vehicle and method thereof | |
JP2021111153A (en) | System and method for controlling vehicle, and program | |
CN110884901A (en) | Deviation rectifying method, device and equipment for AGV butt joint of stacking vehicle and storage medium | |
JP2011141663A (en) | Automated guided vehicle and travel control method for the same | |
JP7259662B2 (en) | travel control device | |
US20230324913A1 (en) | Obstacle detection device and traveling control device | |
JP2018013860A (en) | Autonomous movable object control device | |
JP2021028796A (en) | Travel control apparatus | |
JP2010140080A (en) | Control method and control device for mobile object, and mobile object system | |
JP7283085B2 (en) | travel control device | |
JP7180399B2 (en) | travel control device | |
JP2021120810A (en) | Position detection device | |
JP2021117893A (en) | Self position estimation device and self position estimation method | |
JP2022051191A (en) | Self-position estimation device | |
JP2020119111A (en) | Movable body travel system | |
JP7347226B2 (en) | Self-position estimation device and self-position estimation method | |
JP2023106755A (en) | travel control device | |
JP7524725B2 (en) | Travel route generation method and device | |
US20230294781A1 (en) | Vehicle body transport system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20211214 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220823 |
|
A601 | Written request for extension of time |
Free format text: JAPANESE INTERMEDIATE CODE: A601 Effective date: 20221024 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221222 |
|
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: 20230307 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230320 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 7259662 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |