JP2020170237A - Manned-unmanned forklift and travel control method - Google Patents
Manned-unmanned forklift and travel control method Download PDFInfo
- Publication number
- JP2020170237A JP2020170237A JP2019069873A JP2019069873A JP2020170237A JP 2020170237 A JP2020170237 A JP 2020170237A JP 2019069873 A JP2019069873 A JP 2019069873A JP 2019069873 A JP2019069873 A JP 2019069873A JP 2020170237 A JP2020170237 A JP 2020170237A
- Authority
- JP
- Japan
- Prior art keywords
- manned
- unit
- region
- mode
- unmanned
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000001514 detection method Methods 0.000 claims description 19
- 230000000007 visual effect Effects 0.000 claims description 6
- 230000007613 environmental effect Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 7
- 238000002474 experimental method Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 125000002066 L-histidyl group Chemical group [H]N1C([H])=NC(C([H])([H])[C@](C(=O)[*])([H])N([H])[H])=C1[H] 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
Images
Landscapes
- Forklifts And Lifting Vehicles (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
本発明は、有人無人フォークリフトおよび当該有人無人フォークリフトの走行制御方法に関する。 The present invention relates to a manned unmanned forklift and a traveling control method for the manned unmanned forklift.
従来から、走行モードとしてオペレータの手動操作により走行する有人走行モードと自動走行する無人走行モードとを備える有人無人フォークリフトが知られている(例えば、特許文献1参照)。 Conventionally, a manned unmanned forklift having a manned running mode for running by manual operation by an operator and an unmanned running mode for automatic running has been known as a running mode (see, for example, Patent Document 1).
また、無人フォークリフトとして、レーザ誘導により自動走行を行うものが知られている(例えば、特許文献2参照)。この無人フォークリフトは、レーザスキャナ装置を回転させながら周囲にレーザ光を投光するとともに、建屋内に設置された複数の反射体からの反射光を検出することにより、三角測量の原理に基づいて自己位置を算出しながら自動走行を行う。 Further, as an unmanned forklift, one that automatically travels by laser guidance is known (see, for example, Patent Document 2). This unmanned forklift is self-driving based on the principle of triangulation by projecting laser light to the surroundings while rotating the laser scanner device and detecting reflected light from multiple reflectors installed in the building. Automatic driving is performed while calculating the position.
しかしながら、建屋内には、レーザスキャナ装置のレーザ光が棚等の障害物によって遮られるおそれのある領域、すなわちレーザ誘導の実効性の低い領域が存在する。レーザ誘導の実効性の低い領域では、無人フォークリフトは、レーザ誘導による自動走行が困難になる。 However, in the building, there is a region where the laser beam of the laser scanner device may be blocked by an obstacle such as a shelf, that is, a region where the effectiveness of laser guidance is low. In areas where laser guidance is less effective, unmanned forklifts are difficult to drive automatically by laser guidance.
有人無人フォークリフトの自動走行としてレーザ誘導による自動走行を採用する場合、例えば、レーザ誘導の実効性の低い領域において走行モードが有人走行モードから無人走行モードに切り替わると、有人無人フォークリフトは、レーザ誘導を行うことができず、走行不能になるおそれがある。 When the automatic driving by laser guidance is adopted as the automatic driving of the manned unmanned forklift, for example, when the driving mode is switched from the manned driving mode to the unmanned driving mode in the region where the effectiveness of the laser guidance is low, the manned unmanned forklift performs the laser guidance. It cannot be done and may make it impossible to drive.
本発明は上記事情に鑑みてなされたものであって、その課題とするところは、走行モードが有人走行モードから無人走行モードに切り替わる際に走行不能になるのを防ぐことが可能な有人無人フォークリフトおよびその走行制御方法を提供することにある。 The present invention has been made in view of the above circumstances, and an object of the present invention is a manned unmanned forklift that can prevent the vehicle from becoming inoperable when the driving mode is switched from the manned driving mode to the unmanned driving mode. And its travel control method.
上記課題を解決するために、本発明に係る有人無人フォークリフトは、
走行モードとしてオペレータの手動操作により走行する有人走行モードとレーザ誘導により自動走行する無人走行モードとを備える有人無人フォークリフトであって、
表示部と、
前記有人走行モード時に、自己位置の推定を行う位置推定部と、
前記有人走行モード時に、環境マップの作成を行うマップ作成部と、
前記走行モードを前記有人走行モードまたは前記無人走行モードに設定する走行モード設定部と、
前記有人走行モードから前記無人走行モードに切り替わるタイミングで、前記自己位置が前記レーザ誘導の実効性の低い第1領域に存在するか前記レーザ誘導の実効性の高い第2領域に存在するかの実効性判定を行う判定部と、
前記表示部に走行ルートを表示させる走行ルート生成部と、
を備え、
前記判定部により前記自己位置が前記第1領域に存在すると判定された場合、
前記走行モード設定部は、前記走行モードを前記有人走行モードに設定したまま、
前記走行ルート生成部は、前記走行ルートとして現在位置から前記第2領域へのルートを計算し、当該ルートを前記表示部に表示させることを特徴とする。
In order to solve the above problems, the manned unmanned forklift according to the present invention
It is a manned unmanned forklift that has a manned driving mode that runs manually by the operator and an unmanned running mode that automatically runs by laser guidance as the running mode.
Display and
In the manned driving mode, a position estimation unit that estimates its own position and
A map creation unit that creates an environment map in the manned driving mode,
A driving mode setting unit that sets the driving mode to the manned driving mode or the unmanned driving mode,
At the timing of switching from the manned running mode to the unmanned running mode, the effectiveness of whether the self-position exists in the first region where the laser guidance is less effective or in the second region where the laser guidance is more effective. Judgment unit that performs sex judgment and
A travel route generation unit that displays a travel route on the display unit,
With
When the determination unit determines that the self-position exists in the first region,
The traveling mode setting unit keeps the traveling mode set to the manned traveling mode.
The traveling route generation unit calculates a route from the current position to the second region as the traveling route, and displays the route on the display unit.
上記有人無人フォークリフトは、
前記環境マップが格納される記憶部をさらに備え、
前記記憶部には、前記第1領域および前記第2領域を規定した基礎環境マップが格納されており、
前記マップ作成部は、前記基礎環境マップに基づいて前記環境マップの作成を行い、
前記判定部は、前記位置推定部で推定した前記自己位置と前記マップ作成部で作成した前記環境マップに基づいて前記実効性判定を行うよう構成できる。
The above manned unmanned forklift
Further provided with a storage unit for storing the environment map
A basic environment map defining the first area and the second area is stored in the storage unit.
The map creation unit creates the environment map based on the basic environment map, and then creates the environment map.
The determination unit can be configured to perform the effectiveness determination based on the self-position estimated by the position estimation unit and the environment map created by the map creation unit.
上記有人無人フォークリフトは、
前記判定部により前記自己位置が前記第1領域に存在すると判定された場合に、前記オペレータに対して視覚的および/または聴覚的な手段で警告を発する警告部をさらに備えるよう構成できる。
The above manned unmanned forklift
When the determination unit determines that the self-position exists in the first region, the determination unit may further include a warning unit that issues a warning to the operator by visual and / or auditory means.
上記有人無人フォークリフトは、
前記オペレータの降車を検出する検出部をさらに備え、
前記判定部は、前記検出部が前記オペレータの降車を検出したタイミングで前記実効性判定を行うよう構成できる。
The above manned unmanned forklift
Further provided with a detection unit for detecting the getting off of the operator
The determination unit can be configured to perform the effectiveness determination at the timing when the detection unit detects the operator's disembarkation.
また、上記課題を解決するために、本発明に係る走行制御方法は、
走行モードとしてオペレータの手動操作により走行する有人走行モードとレーザ誘導により自動走行する無人走行モードとを備える有人無人フォークリフトの走行制御方法であって、
前記有人走行モード時に、前記有人無人フォークリフトに自己位置の推定および環境マップの作成を行わせる第1有人走行制御ステップと、
前記有人走行モードから前記無人走行モードに切り替わるタイミングで、前記有人無人フォークリフトに、前記自己位置が前記レーザ誘導の実効性の低い第1領域に存在するか前記レーザ誘導の実効性の高い第2領域に存在するかの実効性判定を行わせる判定ステップと、
前記自己位置が前記第1領域に存在すると判定された場合に、前記走行モードを前記有人走行モードとし、かつ前記有人無人フォークリフトの表示部に現在位置から前記第2領域へのルートを表示させる第2有人走行制御ステップと、
を含むことを特徴とする。
Further, in order to solve the above problems, the traveling control method according to the present invention is used.
It is a driving control method for a manned unmanned forklift that includes a manned driving mode in which the vehicle travels manually by an operator and an unmanned driving mode in which the vehicle automatically travels by laser guidance.
In the manned driving mode, the first manned driving control step for causing the manned unmanned forklift to estimate its own position and create an environmental map,
At the timing of switching from the manned traveling mode to the unmanned traveling mode, the manned unmanned forklift has its own position in the first region where the laser guidance is less effective or the second region where the laser guidance is highly effective. Judgment step to make the effectiveness judgment of existence in
When it is determined that the self-position exists in the first region, the traveling mode is set to the manned traveling mode, and the display unit of the manned unmanned forklift is made to display the route from the current position to the second region. 2 manned driving control steps and
It is characterized by including.
上記走行制御方法は、
前記第1有人走行制御ステップでは、前記有人無人フォークリフトは前記第1領域および前記第2領域を規定した基礎環境マップに基づいて前記環境マップの作成を行い、
前記判定ステップでは、前記有人無人フォークリフトは前記自己位置および前記環境マップに基づいて前記実効性判定を行うよう構成できる。
The above driving control method is
In the first manned traveling control step, the manned unmanned forklift creates the environment map based on the basic environment map defining the first region and the second region.
In the determination step, the manned and unmanned forklift can be configured to perform the effectiveness determination based on the self-position and the environment map.
上記走行制御方法は、
前記判定ステップでは、前記自己位置が前記第1領域に存在すると判定された場合に、前記オペレータに対して視覚的および/または聴覚的な手段で警告を発するよう構成できる。
The above driving control method is
In the determination step, when it is determined that the self-position exists in the first region, the operator can be configured to warn the operator by visual and / or auditory means.
上記走行制御方法は、
前記判定ステップでは、前記有人無人フォークリフトの検出部が前記オペレータの降車を検出したタイミングで、前記有人無人フォークリフトに前記実効性判定を行わせるよう構成できる。
The above driving control method is
In the determination step, the manned unmanned forklift can be configured to perform the effectiveness determination at the timing when the detection unit of the manned unmanned forklift detects the operator's disembarkation.
本発明によれば、走行モードが有人走行モードから無人走行モードに切り替わる際に走行不能になるのを防ぐことが可能な有人無人フォークリフトおよびその走行制御方法を提供することができる。 INDUSTRIAL APPLICABILITY According to the present invention, it is possible to provide a manned unmanned forklift capable of preventing the forklift from becoming inoperable when the traveling mode is switched from the manned traveling mode to the unmanned traveling mode, and a traveling control method thereof.
以下、添付図面を参照して、本発明に係る有人無人フォークリフトおよびその走行制御方法の実施形態について説明する。 Hereinafter, embodiments of a manned unmanned forklift truck and a traveling control method thereof according to the present invention will be described with reference to the accompanying drawings.
[第1実施形態]
(有人無人フォークリフト)
図1に、本発明の第1実施形態に係る有人無人フォークリフト1Aを示す。有人無人フォークリフト1Aは、走行モードとして、オペレータの手動操作により走行する有人走行モードとレーザ誘導により自動走行する無人走行モードとを備える。
[First Embodiment]
(Manned unmanned forklift)
FIG. 1 shows a manned
有人無人フォークリフト1Aは、車体2と、車体2の前部に設けられた荷役装置3とを備える。荷役装置3は、左右一対のマストと、マストに昇降可能に取り付けられた左右一対のフォークとを含む。
The manned
有人無人フォークリフト1Aは、車体2の後部に設けられた運転席4を備える。オペレータは、有人走行モード時に、運転席4に立った状態で運転する。運転席4には、オペレータが足で操作するブレーキペダルが設けられている。
The manned and
運転席4の前方にはレバー類5が設けられており、運転席4の側方にはステアリングハンドル6が設けられている。レバー類5には、車体2を前後進させるための走行レバーと、荷役装置3を操作して荷役作業を行うための荷役レバーが含まれる。
The levers 5 are provided in front of the driver's
レバー類5とステアリングハンドル6との間には、表示部7が設けられている。表示部7は、例えば、液晶ディスプレイで構成される。表示部7には、後述する走行ルートが表示される。表示部7には、さらに、バッテリー容量やスピード表示等の車体2の状況が表示されてもよい。
A
運転席4の後方における車体2の側面には、走行モードを切り替えるための切替スイッチ8が設けられている。オペレータによって切替スイッチ8が操作されると、所定の条件下で、走行モードが有人走行モードから無人走行モード(または、無人走行モードから有人走行モード)に切り替わる。
A changeover switch 8 for switching the traveling mode is provided on the side surface of the
運転席4の上方には、落下物からオペレータを保護するためのヘッドガード9が設けられている。ヘッドガード9には、レーザ誘導による自動走行を行うためのレーザスキャナ装置10が設けられている。なお、図1(A)では、ヘッドガード9およびレーザスキャナ装置10を省略している。
Above the driver's
図2に示すように、建屋100内を自動走行する有人無人フォークリフト1Aは、レーザスキャナ装置10を回転させながら周囲にレーザ光Lを投光するとともに、建屋100の壁や柱等に設置された複数の反射体101からの反射光L’を検出することにより、三角測量の原理に基づいて自己位置を算出する。
As shown in FIG. 2, the manned
建屋100内には、レーザスキャナ装置10のレーザ光L(反射光L’)が棚102等の障害物によって遮られるおそれのある領域、すなわちレーザ誘導の実効性の低い第1領域R1が存在する一方で、レーザ光L(反射光L’)が障害物によって遮られるおそれのない領域、すなわちレーザ誘導の実効性の高い第2領域R2が存在する。
In the
有人無人フォークリフト1Aは、車体2の内部に設けられた走行制御装置11Aの制御下で、第1領域R1においては有人走行モードのみで走行し、第2領域R2においては有人走行モードまたは無人走行モードで走行する。
The manned
図3に示すように、走行制御装置11Aは、記憶部12と、マップ作成部13と、位置推定部14と、走行モード設定部15と、判定部16と、走行ルート生成部17と、警告部18とを備える。走行制御装置11Aは、例えば、マイコンで構成される。走行制御装置11Aの各機能部は、例えば、マイコンのCPUが所定のプログラムを実行すること等によって実現される。
As shown in FIG. 3, the
記憶部12には、第1領域R1および第2領域R2を規定した基礎環境マップが予め格納される。基礎環境マップは、例えば、レーザスキャナ装置10のレーザ光L(反射光L’)が棚102等の障害物によって遮られるか否かの実験を実際に行うか、または当該の実験のシミュレーションを行うことにより作成される。基礎環境マップには、建屋100の構造および建屋100に配置された棚102等の情報が含まれていてもよい。記憶部12に格納されている情報は、走行制御装置11Aの各機能部で共有される。
The
マップ作成部13は、有人走行モード時に、環境マップの作成を行うよう構成される。有人無人フォークリフト1Aには、車体2の周囲の障害物等を認識するための計測センサ(例えば、レーザレンジファインダ)が備えられており、マップ作成部13は、計測センサから受け取る情報と記憶部12に格納された基礎環境マップとに基づいて環境マップを作成し、作成した環境マップを記憶部12に格納する。環境マップには、第1領域R1および第2領域R2に関する情報が含まれる。
The
位置推定部14は、有人走行モード時に、自己位置の推定を行うよう構成される。具体的には、位置推定部14は、マップ作成部13で生成された環境マップと、車体2の下部に設けられた駆動輪の回転量および操舵角に関する情報と、に基づいて自己位置の推定を行う。これにより、位置推定部14は、自己位置が第1領域R1に存在するか第2領域R2に存在するかを特定することができる。なお、駆動輪の回転量は有人無人フォークリフト1Aの移動距離に対応し、駆動輪の操舵角は有人無人フォークリフト1Aの移動方向に対応する。
The
走行モード設定部15は、走行モードを有人走行モードまたは無人走行モードに設定し、設定した走行モードで車体2を走行させるよう構成される。特に、有人走行モード時に切替スイッチ8が操作された場合、走行モード設定部15は、判定部16の判定結果に応じて、走行モードを有人走行モードから無人走行モードに切り替えるか、または走行モードを有人走行モードに設定したままにする。
The traveling
判定部16は、有人走行モードから無人走行モードに切り替わるタイミングで、位置推定部14で推定された自己位置に基づいて、自己位置が第1領域R1に存在するか第2領域R2に存在するかの実効性判定を行う。本実施形態では、有人走行モードから無人走行モードに切り替わるタイミングは、有人走行モード時にオペレータによって切替スイッチ8が操作されたタイミングである。
The
また、判定部16は、自己位置が第1領域R1に存在すると判定した場合、上記の実効性判定を所定の周期で繰り返し行い、自己位置が第2領域R2に存在すると判定するまで、走行モード設定部15による無人走行モードの設定を禁止する。
When the
走行ルート生成部17は、表示部7に走行ルートを表示させるよう構成される。本実施形態では、走行ルート生成部17は、判定部16により自己位置が第1領域R1に存在すると判定された場合に、環境マップに基づいて自己位置(現在位置)から第2領域R2への走行ルートを計算し、当該走行ルートを表示部7に表示させる。走行ルートには、現在位置から第2領域R2への最短ルートを含む、少なくとも1つのルートが含まれる。
The travel
図4に、走行ルートが表示された表示部7の一例を示す。表示部7には、建屋100のモデル図Mが表示され、モデル図M内には有人無人フォークリフト1Aの現在位置Maと障害物Mb(例えば、他のフォークリフトや荷物)と走行ルートMcとが表示される。また、モデル図Mとは別に第2領域R2まで案内する矢印Xが表示される。
FIG. 4 shows an example of the
再び図3を参照して、警告部18は、判定部16により自己位置が第1領域R1に存在すると判定された場合に、オペレータに対して視覚的および/または聴覚的な手段で警告を発するよう構成される。例えば、警告部18は、自己位置が第1領域R1に存在することを示す警告を表示部7に表示させ、かつ/または有人無人フォークリフト1Aに備えられたスピーカーに警告音を出力させる。
With reference to FIG. 3 again, the
本実施形態に係る有人無人フォークリフト1Aでは、有人走行モードから無人走行モードに切り替わるタイミングで、判定部16により自己位置が第1領域R1に存在すると判定された場合、走行モード設定部15は、走行モードを有人走行モードに設定したままにする。したがって、本実施形態に係る有人無人フォークリフト1Aによれば、走行モードが有人走行モードから無人走行モードに切り替わる際に走行不能になるのを防ぐことができる。
In the manned
また、本実施形態に係る有人無人フォークリフト1Aでは、判定部16により自己位置が第1領域R1に存在すると判定された場合、走行ルート生成部17は、表示部7に現在位置から第2領域R2への走行ルートを表示させる。したがって、本実施形態に係る有人無人フォークリフト1Aによれば、オペレータは迷うことなく第2領域R2に到達することができる。
Further, in the manned
なお、本実施形態では、走行ルートとして、モデル図Mおよび矢印Xを表示部7に表示させたが、モデル図Mだけ表示させてもよいし、矢印Xだけで走行ルートを示してもよい。
In the present embodiment, the model diagram M and the arrow X are displayed on the
(走行制御方法)
続いて、本発明の第1実施形態に係る有人無人フォークリフト1Aの走行制御方法について説明する。図5に、本実施形態に係る走行制御方法のフローチャートを示す。
(Running control method)
Subsequently, the traveling control method of the manned
本実施形態に係る走行制御方法は、第1有人走行制御ステップ(S1)と、判定ステップ(S2〜S4)と、第2有人走行制御ステップ(S5)と、無人走行制御ステップ(S6)とを含む。 The travel control method according to the present embodiment includes a first manned travel control step (S1), a determination step (S2 to S4), a second manned travel control step (S5), and an unmanned travel control step (S6). Including.
第1有人走行制御ステップ(S1)では、有人走行モードの有人無人フォークリフト1Aに、自己位置の推定および環境マップの作成を行わせる。有人無人フォークリフト1Aは、マップ作成部13で環境マップを作成するとともに、位置推定部14で自己位置の推定を行う。
In the first manned running control step (S1), the manned
判定ステップ(S2〜S4)では、オペレータによって切替スイッチ8が操作されると(S2)、有人無人フォークリフト1Aは実効性判定を行う(S3)。
In the determination steps (S2 to S4), when the changeover switch 8 is operated by the operator (S2), the manned and
実効性判定で第1領域R1と判定された場合(S4で第1領域)、すなわちオペレータによる切替スイッチ8の操作時に位置推定部14により自己位置が第1領域R1に存在すると特定された場合、第2有人走行制御ステップ(S5)に移行する。
When it is determined to be the first region R1 in the effectiveness determination (first region in S4), that is, when the
第2有人走行制御ステップ(S5)では、有人無人フォークリフト1Aは、走行モードを有人走行モードに設定したまま、表示部7に現在位置から第2領域R2への走行ルートを表示させる。さらに、有人無人フォークリフト1Aは、警告部18により、オペレータに対して視覚的および/または聴覚的な手段で警告を発する。
In the second manned traveling control step (S5), the manned
また、第2有人走行制御ステップ(S5)では、有人無人フォークリフト1Aは、上記の実効性判定を所定の周期で繰り返し行い、判定部16により自己位置が第2領域R2に存在すると判定するまで、走行モード設定部15による無人走行モードの設定を禁止する。
Further, in the second manned traveling control step (S5), the manned
実効性判定で第2領域R2と判定された場合(S4で第2領域)、すなわちオペレータによる切替スイッチ8の操作時に位置推定部14により自己位置が第2領域R2に存在すると特定された場合、無人走行制御ステップ(S6)に移行する。
When it is determined to be the second region R2 in the effectiveness determination (second region in S4), that is, when the
無人走行制御ステップ(S6)では、有人無人フォークリフト1Aは、レーザ誘導による自動走行を行う。
In the unmanned traveling control step (S6), the manned
本実施形態に係る走行制御方法では、有人無人フォークリフト1Aの自己位置が第1領域R1に存在する場合、有人無人フォークリフト1Aは走行モードを有人走行モードのままにするので、走行モードが有人走行モードから無人走行モードに切り替わる際に有人無人フォークリフト1Aが走行不能になるのを防ぐことができる。
In the traveling control method according to the present embodiment, when the self-position of the manned
また、本実施形態に係る走行制御方法によれば、有人無人フォークリフト1Aが表示部7に現在位置から第2領域R2への走行ルートを表示させるので、オペレータは迷うことなく第2領域R2に到達することができる。
Further, according to the travel control method according to the present embodiment, the manned
[第2実施形態]
(有人無人フォークリフト)
図6に、本発明の第2実施形態に係る有人無人フォークリフト1Bを示す。有人無人フォークリフト1Bは、検出部19および走行制御装置11Bを備えること以外、第1実施形態の有人無人フォークリフト1Aと共通する。
[Second Embodiment]
(Manned unmanned forklift)
FIG. 6 shows a manned
検出部19は、運転席4の床部に設けられ、オペレータの降車を検出するよう構成される。検出部19の検出信号は、走行制御装置11Bに出力される。なお、検出部19は、オペレータの降車を検出できるのであれば、適宜構成を変更できる。
The
図7に示すように、走行制御装置11Bは、検出部19の検出信号が入力された場合に、所定の条件下で走行モードを切り替えること以外、第1実施形態の走行制御装置11Aと共通する。すなわち、走行モード設定部15は、検出部19の検出信号が入力された場合に、判定部16の判定結果に応じて、走行モードを有人走行モードから無人走行モードに切り替えるか、または走行モードを有人走行モードに設定したままにする。
As shown in FIG. 7, the
判定部16は、検出部19がオペレータの降車を検出したタイミングで、自己位置が第1領域R1に存在するか第2領域R2に存在するかの実効性判定を行う。本実施形態では、有人走行モードから無人走行モードに切り替わるタイミングは、検出部19がオペレータの降車を検出したタイミングである。
The
判定部16は、実効性判定において自己位置が第1領域R1に存在すると判定した場合、上記の実効性判定を所定の周期で繰り返し行い、自己位置が第2領域R2に存在すると判定するまで、走行モード設定部15による無人走行モードの設定を禁止する。
When the
また、判定部16は、実効性判定において自己位置が第2領域R2に存在すると判定した場合、オペレータによる切替スイッチ8の操作が行われたか否かの判定をさらに行う。走行モード設定部15は、判定部16により切替スイッチ8の操作が行われたと判定された場合に、走行モードを有人走行モードから無人走行モードに切り替える。
Further, when the
本実施形態に係る有人無人フォークリフト1Bでは、オペレータによって切替スイッチ8が操作される前に実効性判定が行われるので、第1実施形態の有人無人フォークリフト1Aよりも早期に、表示部7に走行ルートを表示させたりオペレータに警告を発したりすることができる。
In the manned
(走行制御方法)
続いて、本発明の第2実施形態に係る有人無人フォークリフト1Bの走行制御方法について説明する。図8に、本実施形態に係る走行制御方法のフローチャートを示す。
(Running control method)
Subsequently, the traveling control method of the manned
本実施形態に係る走行制御方法は、検出部19がオペレータの降車を検出したこと(S2’)をきっかけとして有人無人フォークリフト1Aが実効性判定(S3)を行うこと、無人走行制御ステップ(S6)の前に切替スイッチ8の操作が行われたか否かの判定(S4’)をさらに行うこと以外、第1実施形態の走行制御方法と共通する。
In the travel control method according to the present embodiment, the manned
切替スイッチ8の操作が行われたと判定部16が判定した場合(S4’でYES)、無人走行制御ステップ(S6)に移行する一方、切替スイッチ8の操作が行われていないと判定部16が判定した場合(S4’でNO)、第1有人走行制御ステップ(S1)に移行する。
When the
本実施形態に係る走行制御方法によれば、オペレータによって切替スイッチ8が操作される前に実効性判定(S3)が行われるので、第1実施形態の有人無人フォークリフト1Aよりも早期に、第2有人走行制御ステップ(S5)に移行させることができる。
According to the traveling control method according to the present embodiment, the effectiveness determination (S3) is performed before the changeover switch 8 is operated by the operator, so that the second embodiment is earlier than the manned
[変形例]
以上、本発明に係る有人無人フォークリフトおよびその走行制御方法の実施形態について説明したが、本発明は上記実施形態に限定されるものではない。
[Modification example]
Although the embodiment of the manned unmanned forklift truck and the traveling control method thereof according to the present invention has been described above, the present invention is not limited to the above embodiment.
本発明に係る有人無人フォークリフトは、表示部と、位置推定部と、マップ作成部と、走行モード設定部と、判定部と、走行ルート生成部とを備えるのであれば、適宜構成を変更できる。 The configuration of the manned unmanned forklift according to the present invention can be appropriately changed as long as it includes a display unit, a position estimation unit, a map creation unit, a travel mode setting unit, a determination unit, and a travel route generation unit.
本発明の表示部は、有人無人フォークリフトの現在位置からレーザ誘導の実効性の高い第2領域への走行ルートを表示できるのであれば、適宜構成を変更できる。 The configuration of the display unit of the present invention can be appropriately changed as long as it can display the traveling route from the current position of the manned unmanned forklift to the second region where the laser guidance is highly effective.
本発明の位置推定部は、有人走行モード時に自己位置の推定を行うのであれば、適宜構成を変更できる。また、本発明のマップ作成部は、有人走行モード時に環境マップの作成を行うのであれば、適宜構成を変更できる。 The configuration of the position estimation unit of the present invention can be appropriately changed as long as the self-position is estimated in the manned driving mode. Further, the map creation unit of the present invention can appropriately change the configuration if the environment map is created in the manned driving mode.
本発明の走行モード設定部は、走行モードを有人走行モードまたは無人走行モードに設定し、かつ判定部により自己位置が第1領域に存在すると判定された場合に、走行モードを有人走行モードに設定したままにするのであれば、適宜構成を変更できる。 The driving mode setting unit of the present invention sets the driving mode to the manned driving mode or the unmanned driving mode, and sets the driving mode to the manned driving mode when the determination unit determines that the self-position exists in the first region. If you want to keep it, you can change the configuration as appropriate.
本発明の判定部は、有人走行モードから無人走行モードに切り替わるタイミングで、自己位置がレーザ誘導の実効性の低い第1領域に存在するかレーザ誘導の実効性の高い第2領域に存在するかの実効性判定を行うのであれば、適宜構成を変更できる。 The determination unit of the present invention determines whether the self-position exists in the first region where the effectiveness of laser guidance is low or in the second region where the effectiveness of laser guidance is high at the timing of switching from the manned running mode to the unmanned running mode. If the effectiveness of the above is judged, the configuration can be changed as appropriate.
本発明の走行ルート生成部は、判定部により自己位置が第1領域に存在すると判定された場合に、現在位置から第2領域へのルートを計算し、当該ルートを表示部に表示させるのであれば、適宜構成を変更できる。 When the determination unit determines that the self-position exists in the first region, the traveling route generation unit of the present invention calculates the route from the current position to the second region and displays the route on the display unit. If so, the configuration can be changed as appropriate.
本発明に係る走行制御方法は、有人無人フォークリフトの有人走行モード時に、有人無人フォークリフトに自己位置の推定および環境マップの作成を行わせる第1有人走行制御ステップと、有人走行モードから無人走行モードに切り替わるタイミングで、有人無人フォークリフトに実効性判定を行わせる判定ステップと、自己位置が第1領域に存在すると判定された場合に、走行モードを有人走行モードとし、かつ有人無人フォークリフトの表示部に現在位置から第2領域へのルートを表示させる第2有人走行制御ステップと、を含むのであれば、適宜構成を変更できる。 The traveling control method according to the present invention includes a first manned traveling control step for causing an unmanned forklift to estimate its own position and create an environmental map when the unmanned forklift is in the manned traveling mode, and from the manned traveling mode to the unmanned traveling mode. At the timing of switching, the judgment step to make the manned unmanned forklift perform the effectiveness judgment, and when it is judged that the self-position exists in the first area, the running mode is set to the manned running mode and the display part of the manned unmanned forklift is currently displayed. If a second manned travel control step for displaying a route from the position to the second region is included, the configuration can be changed as appropriate.
1A、1B 有人無人フォークリフト
2 車体
3 荷役装置
4 運転席
5 レバー類
6 ステアリングハンドル
7 表示部
8 切替スイッチ
9 ヘッドガード
10 レーザスキャナ装置
11A、11B 走行制御装置
12 記憶部
13 マップ作成部
14 位置推定部
15 走行モード設定部
16 判定部
17 走行ルート生成部
18 警告部
19 検出部
1A, 1B Manned
Claims (8)
表示部と、
前記有人走行モード時に、自己位置の推定を行う位置推定部と、
前記有人走行モード時に、環境マップの作成を行うマップ作成部と、
前記走行モードを前記有人走行モードまたは前記無人走行モードに設定する走行モード設定部と、
前記有人走行モードから前記無人走行モードに切り替わるタイミングで、前記自己位置が前記レーザ誘導の実効性の低い第1領域に存在するか前記レーザ誘導の実効性の高い第2領域に存在するかの実効性判定を行う判定部と、
前記表示部に走行ルートを表示させる走行ルート生成部と、
を備え、
前記判定部により前記自己位置が前記第1領域に存在すると判定された場合、
前記走行モード設定部は、前記走行モードを前記有人走行モードに設定したまま、
前記走行ルート生成部は、前記走行ルートとして現在位置から前記第2領域へのルートを計算し、当該ルートを前記表示部に表示させることを特徴とする有人無人フォークリフト。 It is a manned unmanned forklift that has a manned driving mode that runs manually by the operator and an unmanned running mode that automatically runs by laser guidance as the running mode.
Display and
In the manned driving mode, a position estimation unit that estimates its own position and
A map creation unit that creates an environment map in the manned driving mode,
A driving mode setting unit that sets the driving mode to the manned driving mode or the unmanned driving mode,
At the timing of switching from the manned running mode to the unmanned running mode, the effectiveness of whether the self-position exists in the first region where the laser guidance is less effective or in the second region where the laser guidance is more effective. Judgment unit that performs sex judgment and
A travel route generation unit that displays a travel route on the display unit,
With
When the determination unit determines that the self-position exists in the first region,
The travel mode setting unit keeps the travel mode set to the manned travel mode.
The traveling route generation unit is a manned unmanned forklift that calculates a route from the current position to the second region as the traveling route and displays the route on the display unit.
前記記憶部には、前記第1領域および前記第2領域を規定した基礎環境マップが格納されており、
前記マップ作成部は、前記基礎環境マップに基づいて前記環境マップの作成を行い、
前記判定部は、前記位置推定部で推定した前記自己位置と前記マップ作成部で作成した前記環境マップに基づいて前記実効性判定を行うことを特徴とする請求項1に記載の有人無人フォークリフト。 Further provided with a storage unit for storing the environment map
A basic environment map defining the first area and the second area is stored in the storage unit.
The map creation unit creates the environment map based on the basic environment map, and then creates the environment map.
The manned unmanned forklift according to claim 1, wherein the determination unit performs the effectiveness determination based on the self-position estimated by the position estimation unit and the environment map created by the map creation unit.
前記判定部は、前記検出部が前記オペレータの降車を検出したタイミングで、前記実効性判定を行うことを特徴とする請求項1〜3のいずれか一項に記載の有人無人フォークリフト。 Further provided with a detection unit for detecting the getting off of the operator
The manned unmanned forklift according to any one of claims 1 to 3, wherein the determination unit determines the effectiveness at the timing when the detection unit detects the operator's disembarkation.
前記有人走行モード時に、前記有人無人フォークリフトに自己位置の推定および環境マップの作成を行わせる第1有人走行制御ステップと、
前記有人走行モードから前記無人走行モードに切り替わるタイミングで、前記有人無人フォークリフトに、前記自己位置が前記レーザ誘導の実効性の低い第1領域に存在するか前記レーザ誘導の実効性の高い第2領域に存在するかの実効性判定を行わせる判定ステップと、
前記自己位置が前記第1領域に存在すると判定された場合に、前記走行モードを前記有人走行モードとし、かつ前記有人無人フォークリフトの表示部に現在位置から前記第2領域へのルートを表示させる第2有人走行制御ステップと、
を含むことを特徴とする走行制御方法。 It is a driving control method for a manned unmanned forklift that includes a manned driving mode in which the vehicle travels manually by an operator and an unmanned driving mode in which the vehicle automatically travels by laser guidance.
In the manned driving mode, the first manned driving control step for causing the manned unmanned forklift to estimate its own position and create an environmental map,
At the timing of switching from the manned traveling mode to the unmanned traveling mode, the manned unmanned forklift has its own position in the first region where the laser guidance is less effective or the second region where the laser guidance is highly effective. Judgment step to make the effectiveness judgment of existence in
When it is determined that the self-position exists in the first region, the traveling mode is set to the manned traveling mode, and the display unit of the manned unmanned forklift is made to display the route from the current position to the second region. 2 manned driving control steps and
A traveling control method comprising.
前記判定ステップでは、前記有人無人フォークリフトは前記自己位置および前記環境マップに基づいて前記実効性判定を行うことを特徴とする請求項5に記載の走行制御方法。 In the first manned traveling control step, the manned unmanned forklift creates the environment map based on the basic environment map defining the first region and the second region.
The travel control method according to claim 5, wherein in the determination step, the manned unmanned forklift performs the effectiveness determination based on the self-position and the environment map.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019069873A JP6725198B1 (en) | 2019-04-01 | 2019-04-01 | Manned and unmanned forklift and travel control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019069873A JP6725198B1 (en) | 2019-04-01 | 2019-04-01 | Manned and unmanned forklift and travel control method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP6725198B1 JP6725198B1 (en) | 2020-07-15 |
JP2020170237A true JP2020170237A (en) | 2020-10-15 |
Family
ID=71523951
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019069873A Active JP6725198B1 (en) | 2019-04-01 | 2019-04-01 | Manned and unmanned forklift and travel control method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6725198B1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7084098B1 (en) | 2021-03-12 | 2022-06-14 | 三菱ロジスネクスト株式会社 | Forklift and cargo handling system |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS633711A (en) * | 1986-06-25 | 1988-01-08 | 株式会社クボタ | Running control apparatus of automatic running working vehicle |
JP2015082193A (en) * | 2013-10-22 | 2015-04-27 | 日立建機株式会社 | Autonomous travel system of dump truck |
-
2019
- 2019-04-01 JP JP2019069873A patent/JP6725198B1/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS633711A (en) * | 1986-06-25 | 1988-01-08 | 株式会社クボタ | Running control apparatus of automatic running working vehicle |
JP2015082193A (en) * | 2013-10-22 | 2015-04-27 | 日立建機株式会社 | Autonomous travel system of dump truck |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7084098B1 (en) | 2021-03-12 | 2022-06-14 | 三菱ロジスネクスト株式会社 | Forklift and cargo handling system |
JP2022139495A (en) * | 2021-03-12 | 2022-09-26 | 三菱ロジスネクスト株式会社 | Fork lift and cargo handling system |
Also Published As
Publication number | Publication date |
---|---|
JP6725198B1 (en) | 2020-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6656673B2 (en) | Autonomous mobile system | |
KR101503418B1 (en) | Semiautomatic parking machine | |
JP6808017B2 (en) | Driving support device | |
WO2020203253A1 (en) | Weight estimation system | |
US11077847B2 (en) | Moving body | |
JP2010282568A (en) | Autonomous mobile body and mobile system using the same | |
EP2136275B1 (en) | Automatic driving system for automatically driving a motor vehicle along predefined paths | |
CN109835326A (en) | For assisting executing the method and mechanism of the reversing turn control of vehicle | |
JPWO2019187720A1 (en) | Parking support device | |
JP2016024766A (en) | Robot for guidance | |
JP6638348B2 (en) | Mobile robot system | |
JP2011141663A (en) | Automated guided vehicle and travel control method for the same | |
JP2000344005A (en) | Display device of peripheral surface of article on road | |
JP6725198B1 (en) | Manned and unmanned forklift and travel control method | |
JP6725199B1 (en) | Manned and unmanned forklift and travel control method | |
JP2021028266A (en) | Working machine and control method of working machine | |
JP2015128972A (en) | Display control method for inverted movable body | |
JP7336935B2 (en) | Vehicle control system and vehicle control method | |
US20220388822A1 (en) | Vehicle-to-Vehicle Communication for Trajectory Awareness of a Material Handling Vehicle | |
JP7126204B2 (en) | Conveyor | |
JP7017294B2 (en) | Manned unmanned forklift and cargo handling system | |
JP2019171954A (en) | Vehicle, display control device and recording medium | |
JP2023165211A (en) | Obstacle detection apparatus | |
US11851051B2 (en) | System and method for detecting an object in a turning alert zone of a vehicle | |
JP2024033377A (en) | System and method for controlling cargo handling vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20190402 |
|
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: 20200624 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20200624 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6725198 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |