JP2020107067A - Cruise controller and cruise control system - Google Patents
Cruise controller and cruise control system Download PDFInfo
- Publication number
- JP2020107067A JP2020107067A JP2018245211A JP2018245211A JP2020107067A JP 2020107067 A JP2020107067 A JP 2020107067A JP 2018245211 A JP2018245211 A JP 2018245211A JP 2018245211 A JP2018245211 A JP 2018245211A JP 2020107067 A JP2020107067 A JP 2020107067A
- Authority
- JP
- Japan
- Prior art keywords
- moving body
- guide line
- unit
- virtual
- section
- 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 description 38
- 238000004364 calculation method Methods 0.000 claims description 20
- 238000000034 method Methods 0.000 description 20
- 239000002245 particle Substances 0.000 description 13
- 238000006073 displacement reaction Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 4
- 230000006698 induction Effects 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000000342 Monte Carlo simulation Methods 0.000 description 1
- 238000012952 Resampling Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000001678 irradiating effect Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000010606 normalization Methods 0.000 description 1
- 238000013215 result calculation 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 travel control device and a travel control system.
従来の走行制御装置としては、例えば特許文献１に記載されているような技術が知られている。特許文献１に記載の走行制御装置は、装置本体と、この装置本体を走行させる走行部とを備えている。装置本体は、回転ファンビームを射出するｉＧＰＳトランスミッタを用いて装置本体の位置を推定する第１位置推定部と、画像処理用のＣＣＤカメラ、赤外線カメラ及びレーザレンジファインダ等のセンサにより取得されたデータと地図情報とをマッチングして装置本体の位置を推定する第２位置推定部と、装置本体の位置情報を取得する手段を第１位置推定部と第２位置推定部との間で切り替えて、走行部を制御することにより、装置本体を所定のルートに沿って進行させる制御部とを有している。 As a conventional traveling control device, for example, a technique described in Patent Document 1 is known. The traveling control device described in Patent Document 1 includes a device body and a traveling unit that causes the device body to travel. The device body is a first position estimation unit that estimates the position of the device body using an iGPS transmitter that emits a rotating fan beam, and data acquired by sensors such as a CCD camera for image processing, an infrared camera, and a laser range finder. And a map information are matched to estimate the position of the device body, and a means for acquiring the position information of the device body is switched between the first position estimation part and the second position estimation part. It has a control part which advances a main part of a device along a predetermined route by controlling a run part.
ところで、移動体を走行経路に沿って走行させる際に、例えば自己位置推定技術を用いて移動体の位置を推定し、その推定結果に基づいて移動体を仮想ガイド線に沿って走行させる誘導方式と、床面に設置された実ガイド線をセンサで検出し、その検出結果に基づいて移動体を実ガイド線に沿って走行させる誘導方式とを切り替えることがある。この場合、移動体の走行区間が仮想ガイド線が設定された区間から実ガイド線が設置された区間に切り替わったときに、実ガイド線がセンサにより検出されないと、移動体を実ガイド線に沿って走行させることができない。 By the way, when the moving body is caused to travel along the traveling route, the position of the moving body is estimated by using, for example, a self-position estimation technique, and the moving body is caused to travel along the virtual guide line based on the estimation result. In some cases, the sensor may detect an actual guide line installed on the floor surface, and based on the detection result, the guide system may be switched to drive the moving body along the actual guide line. In this case, when the traveling section of the moving body is switched from the section in which the virtual guide line is set to the section in which the actual guide line is installed, if the actual guide line is not detected by the sensor, the moving body is moved along the actual guide line. Cannot be driven.
本発明の目的は、移動体の走行区間が仮想ガイド線が設定された区間から実ガイド線が設置された区間に切り替わったときに、移動体を確実に実ガイド線に沿って走行させることができる走行制御装置及び走行制御システムを提供することである。 An object of the present invention is to ensure that the moving body travels along the real guide line when the traveling section of the moving body is switched from the section where the virtual guide line is set to the section where the real guide line is installed. A travel control device and a travel control system capable of performing the same are provided.
本発明の一態様は、データ上で仮想的に設定された仮想ガイド線と、データ上で仮想ガイド線に後続するように床面に設置され、物理的に検出可能な実ガイド線とを有する走行経路に沿って移動体を自動的に走行させる走行制御装置であって、走行経路の位置を記憶する記憶部と、移動体の位置を推定する位置推定部と、記憶部に記憶された仮想ガイド線の位置と位置推定部により推定された移動体の位置とに基づいて、仮想ガイド線と移動体とのずれ量を算出する第１算出部と、実ガイド線を検出する検出部と、検出部の検出値に基づいて、実ガイド線と移動体とのずれ量を算出する第２算出部と、第１算出部により算出された仮想ガイド線と移動体とのずれ量に基づいて、移動体を仮想ガイド線に沿って走行させるように移動体の駆動部を制御すると共に、第２算出部により算出された実ガイド線と移動体とのずれ量に基づいて、移動体を実ガイド線に沿って走行させるように駆動部を制御する走行制御部と、移動体の走行区間が仮想ガイド線が設定された第１誘導区間から実ガイド線が設置された第２誘導区間に切り替わっても、検出部により実ガイド線が検出されないときに、移動体を減速させるように駆動部を制御する速度制御部とを備える。 One embodiment of the present invention includes a virtual guide line that is virtually set on data, and a physically detectable real guide line that is installed on the floor so as to follow the virtual guide line on the data. A traveling control device for automatically traveling a moving body along a traveling route, comprising: a storage unit that stores the position of the traveling route; a position estimation unit that estimates the position of the moving body; and a virtual unit stored in the storage unit. A first calculating unit that calculates a shift amount between the virtual guide line and the moving body based on the position of the guide line and the position of the moving body estimated by the position estimating unit; and a detecting unit that detects the actual guide line, On the basis of the detection value of the detection unit, a second calculation unit that calculates the amount of deviation between the actual guide line and the moving body, and based on the amount of deviation between the virtual guide line and the moving body calculated by the first calculation unit, The drive unit of the moving body is controlled so that the moving body travels along the virtual guide line, and the moving body is actually guided based on the shift amount between the actual guide line and the moving body calculated by the second calculating unit. The traveling control unit that controls the drive unit so as to travel along the line, and the traveling section of the moving body is switched from the first guidance section where the virtual guide line is set to the second guidance section where the actual guide line is installed. Also includes a speed control unit that controls the drive unit so as to decelerate the moving body when the actual guide line is not detected by the detection unit.
このような走行制御装置においては、移動体が第１誘導区間を走行するときは、位置推定部により移動体の位置が推定され、仮想ガイド線と移動体とのずれ量が算出され、そのずれ量に基づいて移動体を仮想ガイド線に沿って走行させるように駆動部が制御される。その後、移動体が第２誘導区間を走行するときは、検出部により実ガイド線が検出され、実ガイド線と移動体とのずれ量が算出され、そのずれ量に基づいて移動体を実ガイド線に沿って走行させるように駆動部が制御される。ここで、移動体の走行区間が第１誘導区間から第２誘導区間に切り替わっても、検出部により実ガイド線が検出されないときは、移動体を減速させるように駆動部を制御することにより、位置推定部により単位距離当たりに実施される位置推定の回数が増えることになる。従って、位置推定部による単位距離当たりの位置の推定精度が高くなるため、検出部が実ガイド線に重なりやすくなり、検出部により実ガイド線が検出されやすくなる。これにより、移動体の走行区間が第１誘導区間から第２誘導区間に切り替わったときに、移動体を確実に実ガイド線に沿って走行させることができる。 In such a traveling control device, when the moving body travels in the first guidance section, the position estimating unit estimates the position of the moving body, calculates the amount of deviation between the virtual guide line and the moving body, and calculates the deviation. The drive unit is controlled so that the moving body travels along the virtual guide line based on the amount. After that, when the moving body travels in the second guidance section, the detection unit detects the actual guide line, calculates the deviation amount between the actual guide line and the moving body, and actually guides the moving body based on the deviation amount. The drive is controlled to drive along the line. Here, even if the traveling section of the moving body is switched from the first guiding section to the second guiding section, when the actual guide line is not detected by the detecting unit, the driving unit is controlled to decelerate the moving body, The number of position estimations performed by the position estimating unit per unit distance increases. Therefore, since the accuracy of estimating the position per unit distance by the position estimating unit is increased, the detecting unit easily overlaps the actual guide line, and the detecting unit easily detects the actual guide line. With this, when the traveling section of the moving body is switched from the first guiding section to the second guiding section, the moving body can be reliably traveled along the actual guide line.
速度制御部は、移動体を減速させるように駆動部を制御した後、検出部により実ガイド線が検出されたときは、移動体を加速させるように駆動部を制御してもよい。このような構成では、移動体が減速した後に、検出部により実ガイド線が検出されたときは、移動体の走行速度が上昇するため、移動体を目的地点に早く到達させることができる。 The speed control unit may control the drive unit to decelerate the moving body, and then control the drive unit to accelerate the moving body when the actual guide line is detected by the detection unit. In such a configuration, when the actual guide line is detected by the detection unit after the moving body decelerates, the traveling speed of the moving body increases, so that the moving body can reach the destination point quickly.
速度制御部は、移動体が第１誘導区間と第２誘導区間との切替地点から規定距離だけ走行しても、検出部により実ガイド線が検出されないときに、移動体を減速させるように駆動部を制御してもよい。このような構成では、移動体を実ガイド線に沿って走行させる誘導方式を実施できない状態であることを容易に且つ確実に検知することができる。 The speed control unit drives the mobile body so as to decelerate the mobile body when the actual guide line is not detected by the detection unit even when the mobile body travels a predetermined distance from the switching point between the first guidance section and the second guidance section. You may control a part. With such a configuration, it is possible to easily and surely detect that the guidance system in which the moving body travels along the actual guide line cannot be implemented.
実ガイド線は、磁気ガイド線であり、検出部は、磁気ガイド線を検出する磁気センサであってもよい。このような構成では、走行制御装置及び実ガイド線を具備したシステムを低コストで実現することができる。 The actual guide line may be a magnetic guide line, and the detection unit may be a magnetic sensor that detects the magnetic guide line. With such a configuration, a system including the traveling control device and the actual guide line can be realized at low cost.
本発明の他の態様は、移動体を走行経路に沿って自動的に走行させる走行制御装置を具備した走行制御システムであって、走行経路は、データ上で仮想的に設定された仮想ガイド線と、データ上で仮想ガイド線に後続するように床面に設置され、物理的に検出可能な実ガイド線とを有し、走行制御装置は、走行経路の位置を記憶する記憶部と、移動体の位置を推定する位置推定部と、記憶部に記憶された仮想ガイド線の位置と位置推定部により推定された移動体の位置とに基づいて、仮想ガイド線と移動体とのずれ量を算出する第１算出部と、実ガイド線を検出する検出部と、検出部の検出値に基づいて、実ガイド線と移動体とのずれ量を算出する第２算出部と、第１算出部により算出された仮想ガイド線と移動体とのずれ量に基づいて、移動体を仮想ガイド線に沿って走行させるように移動体の駆動部を制御すると共に、第２算出部により算出された実ガイド線と移動体とのずれ量に基づいて、移動体を実ガイド線に沿って走行させるように駆動部を制御する走行制御部と、移動体の走行区間が仮想ガイド線が設定された第１誘導区間から実ガイド線が設置された第２誘導区間に切り替わっても、検出部により実ガイド線が検出されないときに、移動体を減速させるように駆動部を制御する速度制御部とを備える。 Another aspect of the present invention is a travel control system including a travel control device that automatically travels a moving body along a travel route, wherein the travel route is a virtual guide line virtually set on data. And a physical guide line that is installed on the floor so as to follow the virtual guide line on the data and is physically detectable, and the travel control device includes a storage unit that stores the position of the travel route, and Based on the position estimation unit that estimates the position of the body and the position of the virtual guide line stored in the storage unit and the position of the moving body estimated by the position estimation unit, the amount of deviation between the virtual guide line and the moving body is calculated. A first calculating unit for calculating, a detecting unit for detecting an actual guide line, a second calculating unit for calculating a deviation amount between the actual guide line and the moving body based on a detection value of the detecting unit, and a first calculating unit. The drive unit of the moving body is controlled so that the moving body travels along the virtual guide line based on the shift amount between the virtual guide line and the moving body calculated by Based on the amount of deviation between the guide line and the moving body, a traveling control unit that controls the drive unit so that the moving body travels along the actual guide line, and a traveling section of the moving body in which a virtual guide line is set. A speed control unit that controls the drive unit so as to decelerate the moving body when the detection unit does not detect the actual guide line even if the first guidance period is switched to the second guidance period in which the actual guide line is installed. ..
このような走行制御システムにおいては、移動体が第１誘導区間を走行するときは、位置推定部により移動体の位置が推定され、仮想ガイド線と移動体とのずれ量が算出され、そのずれ量に基づいて移動体を仮想ガイド線に沿って走行させるように駆動部が制御される。その後、移動体が第２誘導区間を走行するときは、検出部により実ガイド線が検出され、実ガイド線と移動体とのずれ量が算出され、そのずれ量に基づいて移動体を実ガイド線に沿って走行させるように駆動部が制御される。ここで、移動体の走行区間が第１誘導区間から第２誘導区間に切り替わっても、検出部により実ガイド線が検出されないときは、移動体を減速させるように駆動部を制御することにより、位置推定部により単位距離当たりに実施される位置推定の回数が増えることになる。従って、位置推定部による単位距離当たりの位置の推定精度が高くなるため、検出部が実ガイド線に重なりやすくなり、検出部により実ガイド線が検出されやすくなる。これにより、移動体の走行区間が第１誘導区間から第２誘導区間に切り替わったときに、移動体を確実に実ガイド線に沿って走行させることができる。 In such a traveling control system, when the moving body travels in the first guidance section, the position estimating unit estimates the position of the moving body, calculates the deviation amount between the virtual guide line and the moving body, and calculates the deviation. The drive unit is controlled so that the moving body travels along the virtual guide line based on the amount. After that, when the moving body travels in the second guidance section, the detection unit detects the actual guide line, calculates the deviation amount between the actual guide line and the moving body, and actually guides the moving body based on the deviation amount. The drive is controlled to drive along the line. Here, even if the traveling section of the moving body is switched from the first guiding section to the second guiding section, when the actual guide line is not detected by the detecting unit, the driving unit is controlled to decelerate the moving body, The number of position estimations performed by the position estimating unit per unit distance increases. Therefore, since the accuracy of estimating the position per unit distance by the position estimating unit is increased, the detecting unit easily overlaps the actual guide line, and the detecting unit easily detects the actual guide line. With this, when the traveling section of the moving body is switched from the first guiding section to the second guiding section, the moving body can be reliably traveled along the actual guide line.
本発明によれば、移動体の走行区間が仮想ガイド線が設定された区間から実ガイド線が設置された区間に切り替わったときに、移動体を確実に実ガイド線に沿って走行させることができる。 According to the present invention, when a traveling section of a moving body is switched from a section in which a virtual guide line is set to a section in which a real guide line is installed, the moving body can be reliably run along the real guide line. it can.
以下、本発明の実施形態について図面を参照して詳細に説明する。 Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.
図１は、本発明の一実施形態に係る走行制御システムを示す概略構成図である。図１において、本実施形態の走行制御システム１は、例えばフォークリフト等の移動体２をスタート地点３Ａから目的地点３Ｂまで無人で走行させるシステムである。走行制御システム１は、移動体２をスタート地点３Ａから目的地点３Ｂまでの走行経路３に沿って自動的に走行させる走行制御装置１０を具備している。
FIG. 1 is a schematic configuration diagram showing a travel control system according to an embodiment of the present invention. In FIG. 1, the travel control system 1 of the present embodiment is a system that allows a moving
走行経路３は、データ上で仮想的に設定された仮想ガイド線４と、床面に実際に設置され、物理的に検出可能な実ガイド線である磁気ガイド線５とを有している。磁気ガイド線５は、データ上で仮想ガイド線４に後続するように仮想ガイド線４よりも目的地点３Ｂ側に設置されている。
The
仮想ガイド線４が設定された区間は、移動体２を仮想ガイド線４に沿って走行させる仮想誘導方式が実施される仮想誘導区間Ｐ（第１誘導区間）である。磁気ガイド線５が設置された区間は、移動体２を磁気ガイド線５に沿って走行させる磁気誘導方式が実施される磁気誘導区間Ｑ（第２誘導区間）である。
The section in which the
スタート地点３Ａ及び目的地点３Ｂを含む走行経路３の位置は、２次元座標（ＸＹ座標）で表されている。ここでは、スタート地点３Ａの２次元座標は、（０，０）である。目的地点３Ｂの２次元座標は、（１００，０）である。なお、図１では、走行経路３は、直線経路となっているが、曲線経路であってもよい。
The position of the
仮想誘導区間Ｐには、仮想マーク６が設定されている。磁気誘導区間Ｑの床面には、磁気マーク７が設置されている。仮想マーク６及び磁気マーク７は、移動体２が走行を行うための走行指示データを関連付けた走行指示用マーク８である。仮想マーク６は、データ上で仮想的に設定されたマークである。磁気マーク７は、物理的に検出可能なマークである。磁気マーク７は、床面における磁気ガイド線５の脇に埋設されている。ここでは、スタート地点３Ａから１つ目（１番）の走行指示用マーク８は、仮想マーク６である。スタート地点３Ａから２つ目（２番）及び３つ目（３番）の走行指示用マーク８は、磁気マーク７である。
A
図２は、走行制御装置１０の構成を示すブロック図である。図２において、走行制御装置１０は、移動体２に搭載されている。走行制御装置１０は、自己位置推定器１１と、２つの磁気ガイドセンサ１２と、磁気マークセンサ１３と、自動走行制御ユニット１４とを備えている。
FIG. 2 is a block diagram showing the configuration of the
自己位置推定器１１は、移動体２の位置を推定する位置推定部である。自己位置推定器１１は、ＳＬＡＭ（simultaneous localization andmapping）手法を用いて、移動体２の自己位置を推定する。ＳＬＡＭは、センサデータ及び地図データを使って自己位置推定を行う自己位置推定技術である。ＳＬＡＭは、レーザレンジスキャナー等を利用して、自己位置推定と環境地図の作成とを同時に行う。
The self-
自己位置推定器１１は、レーザセンサ１５と、エンコーダ１６と、ジャイロセンサ１７と、ＳＬＡＭコントローラ１８とを有している。レーザセンサ１５は、移動体２の周囲にレーザ光を照射し、その反射光を受光することにより、移動体２の周囲の物体までの距離を検出する。エンコーダ１６は、移動体２の位置を計測することにより、移動体２の移動量を検出する。ジャイロセンサ１７は、移動体２の角速度を計測することにより、移動体２の回動量を検出する。
The self-
ＳＬＡＭコントローラ１８は、ＣＰＵ、ＲＡＭ、ＲＯＭ及び入出力インターフェース等により構成されている。ＳＬＡＭコントローラ１８は、レーザセンサ１５により検出された移動体２の周囲の物体までの距離と移動体２の周囲の環境地図データとに基づいて、移動体２の自己位置の推定演算を行う。移動体２の位置は、２次元座標（ＸＹ座標）及び向きで表される。
The
このとき、ＳＬＡＭコントローラ１８は、エンコーダ１６により検出された移動体２の移動量とジャイロセンサ１７により検出された移動体２の回動量とに基づき、例えばパーティクルフィルタ（逐次モンテカルロ法）と呼ばれる時系列データの予測手法を用いて、移動体２の自己位置を確率的に推定する。
At this time, the
パーティクルフィルタでは、現状態から起こりうる多数の次状態を多数のパーティクル（粒子）で表現し、全パーティクルの尤度（追跡したい対象物らしさ）に従って算出された重みつき平均を次状態であると推測して追跡を行う。 In the particle filter, many possible next states from the current state are represented by many particles (particles), and the weighted average calculated according to the likelihood of all particles (likeliness of the object to be traced) is assumed to be the next state. And do the tracking.
具体的には、まず前フレームでの尤度（重み）に従って、パーティクルを撒き直す（リサンプリングステップ）。続いて、適当なモデルを使って現フレームにおける追跡対象の位置を推定し、パーティクルを少し動かす（推定ステップ）。続いて、現フレームにおける各パーティクルの尤度及び重み（正規化）を計算する（観測ステップ）。このとき、推定結果から得られた実際の追跡対象の位置に近いパーティクルの重みを大きくする。そして、重みが大きいパーティクルが集中している領域が追跡対象となる。 Specifically, first, the particles are redistributed according to the likelihood (weight) in the previous frame (resampling step). Then, the position of the tracking target in the current frame is estimated using an appropriate model, and the particles are slightly moved (estimation step). Then, the likelihood and weight (normalization) of each particle in the current frame are calculated (observation step). At this time, the weight of the particle close to the actual position of the tracking target obtained from the estimation result is increased. Then, a region where particles having a large weight are concentrated becomes a tracking target.
磁気ガイドセンサ１２は、移動体２の下部の前後にそれぞれ取り付けられている（図５参照）。なお、図５では、磁気ガイドセンサ１２の位置が概略的に示されている。磁気ガイドセンサ１２は、磁気ガイド線５を検出する磁気センサ（検出部）である。磁気ガイドセンサ１２は、移動体２の幅方向（左右方向）に延びている。磁気ガイドセンサ１２を移動体２に前後２つ設けることにより、移動体２と磁気ガイド線５との位置のずれ量だけでなく、移動体２と磁気ガイド線５との向きのずれ量も検知することができる。
The
磁気ガイドセンサ１２は、磁気ガイド線５に重なる位置に応じた電気信号を検出値として出力する。例えば、磁気ガイドセンサ１２の長手方向の中央部が磁気ガイド線５に重なる状態と、磁気ガイドセンサ１２の長手方向の端部が磁気ガイド線５に重なる状態とで、磁気ガイドセンサ１２の出力値（検出値）が異なる。従って、磁気ガイドセンサ１２の検出値によって、磁気ガイドセンサ１２と磁気ガイド線５との位置関係を判定することが可能である。
The
磁気マークセンサ１３は、特に図示はしないが、移動体２の下部に取り付けられている。磁気マークセンサ１３は、磁気マーク７を検出する磁気センサである。
The
自動走行制御ユニット１４は、自己位置推定器１１により推定された移動体２の位置と磁気ガイドセンサ１２及び磁気マークセンサ１３の検出値とに基づいて、所定の処理を行い、移動体２をスタート地点３Ａから目的地点３Ｂまで自動的に走行させるように走行モータ１９及び操舵モータ２０を制御する。
The automatic
走行モータ１９は、走行輪（図示せず）を回転駆動させるモータである。操舵モータ２０は、操舵輪（図示せず）を回転駆動させるモータである。走行モータ１９及び操舵モータ２０は、移動体２の駆動部を構成している。
The traveling
自動走行制御ユニット１４は、ＣＰＵ、ＲＡＭ、ＲＯＭ及び入出力インターフェース等により構成されている。自動走行制御ユニット１４は、記憶部２１と、第１ずれ量算出部２２（第１算出部）と、仮想マーク検知部２３と、第２ずれ量算出部２４（第２算出部）と、走行制御部２５と、速度制御部２６とを有している。
The automatic
記憶部２１は、走行経路３及び走行指示用マーク８の位置と走行指示データ等といった移動体２の走行に関する情報を記憶する。記憶部２１は、走行経路３及び走行指示用マーク８の位置を２次元座標として記憶している。走行指示データは、上述したように走行指示用マーク８に関連付けられている。走行指示データとしては、例えば加速指示、停止指示、右折指示及び左折指示等がある。
The
第１ずれ量算出部２２は、記憶部２１に記憶された仮想ガイド線４の位置と自己位置推定器１１により推定された移動体２の位置とに基づいて、仮想ガイド線４と移動体２とのずれ量を算出する。このとき、第１ずれ量算出部２２は、仮想ガイド線４の位置座標と移動体２の位置座標とのずれ量と、仮想ガイド線４の向きと移動体２の向きとのずれ量とを算出する。
The first shift
仮想マーク検知部２３は、記憶部２１に記憶された仮想マーク６の位置と自己位置推定器１１により推定された移動体２の位置とに基づいて、仮想マーク６を検知する。具体的には、仮想マーク検知部２３は、２次元座標上において移動体２が仮想マーク６に重なったとき、または２次元座標上において移動体２が仮想マーク６を通過したときに、仮想マーク６が検知されたと判定する。
The virtual
第２ずれ量算出部２４は、磁気ガイドセンサ１２の検出値に基づいて、磁気ガイド線５と移動体２とのずれ量を算出する。このとき、第２ずれ量算出部２４は、磁気ガイド線５の位置座標と移動体２の位置座標とのずれ量と、磁気ガイド線５の向きと移動体２の向きとのずれ量とを算出する。
The second shift
走行制御部２５は、第１ずれ量算出部２２により算出された仮想ガイド線４と移動体２とのずれ量に基づいて、移動体２を仮想ガイド線４に沿って走行させるように走行モータ１９及び操舵モータ２０を制御する。また、走行制御部２５は、第２ずれ量算出部２４により算出された磁気ガイド線５と移動体２とのずれ量に基づいて、移動体２を磁気ガイド線５に沿って走行させるように走行モータ１９及び操舵モータ２０を制御する。
The traveling
さらに、走行制御部２５は、仮想マーク検知部２３により仮想マーク６が検知されたときに、当該仮想マーク６に関連付けられた走行指示データに従って移動体２を走行させるように走行モータ１９及び操舵モータ２０を制御する。また、走行制御部２５は、磁気マークセンサ１３により磁気マーク７が検出されたときに、当該磁気マーク７に関連付けられた走行指示データに従って移動体２を走行させるように走行モータ１９及び操舵モータ２０を制御する。
Furthermore, the traveling
速度制御部２６は、移動体２の走行区間が仮想誘導区間Ｐから磁気誘導区間Ｑに切り替わっても、磁気ガイドセンサ１２により磁気ガイド線５が検出されないときに、移動体２を減速させるように走行モータ１９を制御する。また、速度制御部２６は、移動体２を減速させるように走行モータ１９を制御した後、磁気ガイドセンサ１２により磁気ガイド線５が検出されたときは、移動体２を加速させるように走行モータ１９を制御する。
Even if the traveling section of the moving
図３は、走行制御部２５により実行される制御処理手順の詳細を示すフローチャートである。本処理は、スタート地点３Ａから目的地点３Ｂに向けての移動体２の走行が開始されると、実行される。
FIG. 3 is a flowchart showing details of the control processing procedure executed by the traveling
図３において、走行制御部２５は、まず後述する誘導方式切替フラグが０であるかどうかを判断する（手順Ｓ１０１）。走行制御部２５は、誘導方式切替フラグが０であると判断したときは、仮想マーク検知部２３により仮想マーク６が検知されたかどうかを判断する（手順Ｓ１０２）。
In FIG. 3, the traveling
走行制御部２５は、仮想マーク６が検知されたと判断したときは、当該仮想マーク６に相当する走行指示用マーク８の番号に対応した走行指示データを記憶部２１から取得する（手順Ｓ１０３）。そして、走行制御部２５は、取得した走行指示データに応じた制御信号を走行モータ１９及び操舵モータ２０に出力する（手順Ｓ１０４）。走行制御部２５は、例えば取得した走行指示データが加速指示である場合には、走行モータ１９の回転速度を高くするような制御信号を走行モータ１９に出力する。これにより、移動体２の走行速度が上昇するようになる。
When the traveling
走行制御部２５は、手順Ｓ１０４が実行された後、または手順Ｓ１０２で仮想マーク６が検知されていないと判断したときは、第１ずれ量算出部２２により算出された仮想ガイド線４と移動体２とのずれ量を取得する（手順Ｓ１０５）。そして、走行制御部２５は、仮想ガイド線４と移動体２とのずれ量が０となるような制御信号を走行モータ１９及び操舵モータ２０に出力する（手順Ｓ１０６）。これにより、移動体２の位置座標及び向きが仮想ガイド線４に近づくようになる。
After performing step S104 or when determining that the
走行制御部２５は、手順Ｓ１０１で誘導方式切替フラグが０でない、つまり誘導方式切替フラグが１であると判断したときは、磁気マークセンサ１３により磁気マーク７が検出されたかどうかを判断する（手順Ｓ１０７）。
When it is determined in step S101 that the guidance system switching flag is not 0, that is, the guidance system switching flag is 1, the traveling
走行制御部２５は、磁気マーク７が検出されたと判断したときは、当該磁気マーク７に相当する走行指示用マーク８の番号に対応した走行指示データを記憶部２１から取得する（手順Ｓ１０８）。そして、走行制御部２５は、取得した走行指示データに応じた制御信号を走行モータ１９及び操舵モータ２０に出力する（手順Ｓ１０９）。走行制御部２５は、例えば取得した走行指示データが停止指示である場合には、走行モータ１９の回転を停止させるような制御信号を走行モータ１９に出力する。これにより、移動体２が停止するようになる。
When the traveling
走行制御部２５は、手順Ｓ１０９が実行された後、または手順Ｓ１０７で磁気マーク７が検出されていないと判断したときは、第２ずれ量算出部２４により算出された磁気ガイド線５と移動体２とのずれ量を取得する（手順Ｓ１１０）。そして、走行制御部２５は、磁気ガイド線５と移動体２とのずれ量が０となるような制御信号を走行モータ１９及び操舵モータ２０に出力する（手順Ｓ１１１）。これにより、移動体２の位置座標及び向きが磁気ガイド線５に近づくようになる。
After performing step S109 or when determining that the
走行制御部２５は、手順Ｓ１０６または手順Ｓ１１１が実行された後、移動体２が目的地点３Ｂに達したかどうかを判断する（手順Ｓ１１２）。走行制御部２５は、移動体２が目的地点３Ｂに達していないと判断したときは、手順Ｓ１０１を再び実行する。走行制御部２５は、移動体２が目的地点３Ｂに達したと判断したときは、本処理を終了する。
The traveling
図４は、速度制御部２６により実行される制御処理手順の詳細を示すフローチャートである。本処理も、走行制御部２５と同様に、スタート地点３Ａから目的地点３Ｂに向けての移動体２の走行が開始されると、実行される。なお、本処理の実行前は、誘導方式切替フラグは０にセットされている。
FIG. 4 is a flowchart showing details of the control processing procedure executed by the
図４において、速度制御部２６は、まず自己位置推定器１１により推定された移動体２の位置を取得する（手順Ｓ１２１）。続いて、速度制御部２６は、移動体２の推定位置に基づいて、移動体２の走行区間が仮想誘導区間Ｐから磁気誘導区間Ｑに切り替わったかどうかを判断する（手順Ｓ１２２）。速度制御部２６は、移動体２の走行区間が仮想誘導区間Ｐから磁気誘導区間Ｑに切り替わっていないと判断したときは、手順Ｓ１２１を再び実行する。
In FIG. 4, the
速度制御部２６は、移動体２の走行区間が仮想誘導区間Ｐから磁気誘導区間Ｑに切り替わったと判断したときは、磁気ガイドセンサ１２の検出値に基づいて、磁気ガイドセンサ１２により磁気ガイド線５が検出されたかどうかを判断する（手順Ｓ１２３）。
When the
このとき、速度制御部２６は、磁気ガイドセンサ１２の長手方向の中心を０、磁気ガイドセンサ１２の長手方向の両端を１としたときに、例えば磁気ガイドセンサ１２における比率が０．７以下となる領域が磁気ガイド線５に重なるときに、磁気ガイド線５が検出されたと判定する。これにより、磁気ガイドセンサ１２により磁気ガイド線５が検出されたかどうかを正確に判定することができる。
At this time, when the center of the
速度制御部２６は、磁気ガイドセンサ１２により磁気ガイド線５が検出されたと判断したときは、誘導方式切替フラグを１にセットする（手順Ｓ１２４）。誘導方式切替フラグは、移動体２の誘導方式を仮想誘導方式から磁気誘導方式に切り替えるためのフラグである。
When determining that the
速度制御部２６は、磁気ガイドセンサ１２により磁気ガイド線５が検出されていないと判断したときは、移動体２が仮想誘導区間Ｐと磁気誘導区間Ｑとの切替地点Ｒ（図１参照）から規定距離（例えば数ｍ）だけ走行したかどうかを判断する（手順Ｓ１２５）。
When the
速度制御部２６は、移動体２が切替地点Ｒから規定距離だけ走行したと判断したときは、移動体２を減速させるような制御信号を走行モータ１９に出力する（手順Ｓ１２６）。このとき、速度制御部２６は、例えば移動体２の走行速度を１／２以下とするような制御信号を走行モータ１９に出力する。これにより、移動体２の走行速度が下がるようになる。
When it is determined that the moving
その後、速度制御部２６は、磁気ガイドセンサ１２の検出値に基づいて、磁気ガイドセンサ１２により磁気ガイド線５が検出されたかどうかを判断する（手順Ｓ１２７）。速度制御部２６は、磁気ガイドセンサ１２により磁気ガイド線５が検出されたと判断したときは、移動体２を加速させるような制御信号を走行モータ１９に出力する（手順Ｓ１２８）。このとき、速度制御部２６は、移動体２が減速する直前の速度まで移動体２を加速させるような制御信号を走行モータ１９に出力する。この場合には、移動体２は、減速直前と同じ走行条件で走行することになる。そして、速度制御部２６は、誘導方式切替フラグを１にセットする（手順Ｓ１２４）。
After that, the
以上のように構成された走行制御システム１において、移動体２は、まず仮想誘導区間Ｐにおいて仮想誘導方式に従って走行する。つまり、移動体２は、自己位置推定器１１により推定された移動体２の位置に基づき、仮想ガイド線４に沿って走行する。その後、移動体２は、磁気誘導区間Ｑにおいて磁気誘導方式に従って走行する。つまり、移動体２は、磁気ガイドセンサ１２の検出値に基づき、磁気ガイド線５に沿って走行する。ここで、移動体２の走行区間が仮想誘導区間Ｐから磁気誘導区間Ｑに切り替えられたときは、移動体２の誘導方式を一定区間で仮想誘導方式から磁気誘導方式に切り替える必要がある。
In the travel control system 1 configured as described above, the moving
しかし、図５（ａ）に示されるように、磁気ガイドセンサ１２が磁気ガイド線５上に無いと、磁気ガイドセンサ１２により磁気ガイド線５が検出されないため、移動体２の誘導方式を磁気誘導方式に切り替えることができない。このため、移動体２が磁気誘導区間Ｑを走行しているにも関わらず、磁気ガイド線５を仮想ガイド線と仮定して、仮想誘導方式が実施されることになる。この場合、自己位置推定器１１による移動体２の位置推定の計算には時間がかかるため、移動体２の誘導方式を所望の区間で磁気誘導方式に切り替えることは困難である。
However, as shown in FIG. 5A, if the
そこで、移動体２の走行区間が仮想誘導区間Ｐから磁気誘導区間Ｑに切り替わっても、磁気ガイドセンサ１２により磁気ガイド線５が検出されないときは、移動体２を減速させるようにする。つまり、仮想誘導区間Ｐと磁気誘導区間Ｑにおける最初の区間とは、移動体２が通常速度で走行する通常速度区間Ｖ１である。磁気誘導区間Ｑにおける通常速度区間Ｖ１よりも後の区間は、移動体２が低速で走行する低速区間Ｖ２となる。なお、その後で移動体２を加速させたときは、磁気誘導区間Ｑにおける低速区間Ｖ２よりも後の区間は、再び通常速度区間Ｖ１となる。
Therefore, even if the traveling section of the moving
このように移動体２を減速させることにより、図５（ｂ）に示されるように、低速区間Ｖ２では、通常速度区間Ｖ１に比べて、自己位置推定器１１により単位距離当たりに実施される位置推定の回数が増えることになる。従って、自己位置推定器１１による単位距離当たりの位置の推定精度が高くなるため、磁気ガイドセンサ１２が磁気ガイド線５に重なる確率が高くなる。その理由は、以下の通りである。
By decelerating the moving
即ち、上述したように位置推定演算としてパーティクルフィルタを用いる場合は、推定ステップにおいてパーティクルを移動させる必要があるが、パーティクルの移動量はエンコーダ１６及びジャイロセンサ１７の検出値で決まる。このとき、推定位置の間隔が短いほど、エンコーダ１６及びジャイロセンサ１７の検出値の誤差量が少なくなるため、位置の推定精度が高くなる。また、推定位置の間隔が短いほど、推定位置付近での確率密度分布が真値に近づくため、位置の推定精度が高くなる。
That is, when the particle filter is used as the position estimation calculation as described above, it is necessary to move the particles in the estimation step, but the movement amount of the particles is determined by the detection values of the
以上のように本実施形態によれば、移動体２が仮想誘導区間Ｐを走行するときは、自己位置推定器１１により移動体２の位置が推定され、仮想ガイド線４と移動体２とのずれ量が算出され、そのずれ量に基づいて移動体２を仮想ガイド線４に沿って走行させるように走行モータ１９及び操舵モータ２０が制御される。その後、移動体２が磁気誘導区間Ｑを走行するときは、磁気ガイドセンサ１２により磁気ガイド線５が検出され、磁気ガイド線５と移動体２とのずれ量が算出され、そのずれ量に基づいて移動体２を磁気ガイド線５に沿って走行させるように走行モータ１９及び操舵モータ２０が制御される。ここで、移動体２の走行区間が仮想誘導区間Ｐから磁気誘導区間Ｑに切り替わっても、磁気ガイドセンサ１２により磁気ガイド線５が検出されないときは、移動体２を減速させるように走行モータ１９を制御することにより、自己位置推定器１１により単位距離当たりに実施される位置推定の回数が増えることになる。従って、自己位置推定器１１による単位距離当たりの位置の推定精度が高くなるため、磁気ガイドセンサ１２が磁気ガイド線５に重なりやすくなり、磁気ガイドセンサ１２により磁気ガイド線５が検出されやすくなる。これにより、移動体２の走行区間が仮想誘導区間Ｐから磁気誘導区間Ｑに切り替わったときに、移動体２を確実に磁気ガイド線５に沿って走行させることができる。
As described above, according to the present embodiment, when the moving
また、本実施形態では、移動体２が減速した後に、磁気ガイドセンサ１２により磁気ガイド線５が検出されたときは、移動体２を加速させることにより、移動体２の走行速度が上昇するため、移動体２を目的地点３Ｂに早く到達させることができる。
In addition, in the present embodiment, when the
また、本実施形態では、移動体２が仮想誘導区間Ｐと磁気誘導区間Ｑとの切替地点Ｒから規定距離だけ走行しても、磁気ガイドセンサ１２により磁気ガイド線５が検出されないときに、移動体２を減速させるので、移動体２を磁気ガイド線５に沿って走行させる磁気誘導方式を実施できない状態であることを容易に且つ確実に検知することができる。
In the present embodiment, the moving
また、本実施形態では、床面に磁気ガイド線５を設置し、その磁気ガイド線５を磁気ガイドセンサ１２により検出することにより、走行制御システム１を低コストで実現することができる。
Further, in the present embodiment, the travel control system 1 can be realized at low cost by installing the
なお、本発明は、上記実施形態には限定されない。例えば上記実施形態では、移動体２が仮想誘導区間Ｐと磁気誘導区間Ｑとの切替地点Ｒから規定距離だけ走行しても、磁気ガイドセンサ１２により磁気ガイド線５が検出されないときに、移動体２を減速させているが、特にその形態には限られず、移動体２の走行速度が予め決まっているのであれば、移動体２が仮想誘導区間Ｐと磁気誘導区間Ｑとの切替地点Ｒから所定時間だけ走行しても、磁気ガイドセンサ１２により磁気ガイド線５が検出されないときに、移動体２を減速させてもよい。
The present invention is not limited to the above embodiment. For example, in the above-described embodiment, when the
また、上記実施形態では、移動体２を減速させた後、磁気ガイドセンサ１２により磁気ガイド線５が検出されたときは、移動体２が減速する直前の速度まで移動体２を加速させているが、特にその形態には限られず、移動体２が減速する直前の速度よりも高い速度まで移動体２を加速させてもよいし、或いは移動体２が減速する直前の速度よりも低い速度まで移動体２を加速させてもよい。また、移動体２を減速させた後に、磁気ガイドセンサ１２により磁気ガイド線５が検出されても、移動体２を加速させなくてもよい。
Further, in the above-described embodiment, after decelerating the moving
また、上記実施形態では、磁気ガイド線５が物理的に検出可能な実ガイド線として床面に設置されているが、実ガイド線としては特にそれには限られず、例えば電磁ガイド線等であってもよい。実ガイド線としては電磁ガイド線を用いる場合は、電磁ガイド線を検出する電磁センサが使用される。
Further, in the above-described embodiment, the
また、上記実施形態では、自己位置推定器１１は、自己位置推定技術としてレーザを利用したＳＬＡＭ手法を用いて、移動体２の位置を推定しているが、自己位置推定技術としては、特にそれには限られず、カメラの撮像画像を利用したＳＬＡＭ手法または衛星を利用したＧＮＳＳ（globalnavigation satellite system）測位法等を用いてもよい。
Further, in the above embodiment, the self-
また、上記実施形態の走行制御装置１０は、移動体２としてフォークリフトを走行経路３に沿って自動的に走行させる装置であるが、本発明は、例えば搬送台車等のような自動走行可能な移動体全般に適用可能である。
Further, the traveling
１…走行制御システム、２…移動体、３…走行経路、４…仮想ガイド線、５…磁気ガイド線（実ガイド線）、１０…走行制御装置、１１…自己位置推定器（位置推定部）、１２…磁気ガイドセンサ（磁気センサ、検出部）、１９…走行モータ（駆動部）、２０…操舵モータ（駆動部）、２１…記憶部、２２…第１ずれ量算出部（第１算出部）、２４…第２ずれ量算出部（第２算出部）、２５…走行制御部、２６…速度制御部、Ｐ…仮想誘導区間（第１誘導区間）、Ｑ…磁気誘導区間（第２誘導区間）、Ｒ…切替地点。 DESCRIPTION OF SYMBOLS 1... Travel control system, 2... Moving body, 3... Travel route, 4... Virtual guide line, 5... Magnetic guide line (actual guide line), 10... Travel control device, 11... Self position estimator (position estimation part) , 12... Magnetic guide sensor (magnetic sensor, detecting unit), 19... Traveling motor (driving unit), 20... Steering motor (driving unit), 21... Storage unit, 22... First deviation amount calculating unit (first calculating unit) ), 24... Second deviation amount calculation section (second calculation section), 25... Travel control section, 26... Speed control section, P... Virtual guidance section (first guidance section), Q... Magnetic guidance section (second guidance) Section), R... Switching point.
Claims (5)
前記走行経路の位置を記憶する記憶部と、
前記移動体の位置を推定する位置推定部と、
前記記憶部に記憶された前記仮想ガイド線の位置と前記位置推定部により推定された前記移動体の位置とに基づいて、前記仮想ガイド線と前記移動体とのずれ量を算出する第１算出部と、
前記実ガイド線を検出する検出部と、
前記検出部の検出値に基づいて、前記実ガイド線と前記移動体とのずれ量を算出する第２算出部と、
前記第１算出部により算出された前記仮想ガイド線と前記移動体とのずれ量に基づいて、前記移動体を前記仮想ガイド線に沿って走行させるように前記移動体の駆動部を制御すると共に、前記第２算出部により算出された前記実ガイド線と前記移動体とのずれ量に基づいて、前記移動体を前記実ガイド線に沿って走行させるように前記駆動部を制御する走行制御部と、
前記移動体の走行区間が前記仮想ガイド線が設定された第１誘導区間から前記実ガイド線が設置された第２誘導区間に切り替わっても、前記検出部により前記実ガイド線が検出されないときに、前記移動体を減速させるように前記駆動部を制御する速度制御部とを備える走行制御装置。 Move along a travel route that has a virtual guide line that is virtually set on the data and a physically detectable real guide line that is installed on the floor so as to follow the virtual guide line on the data A traveling control device for automatically traveling the body,
A storage unit that stores the position of the travel route,
A position estimation unit that estimates the position of the moving body,
A first calculation for calculating a shift amount between the virtual guide line and the moving body based on the position of the virtual guide line stored in the storage unit and the position of the moving body estimated by the position estimating unit. Department,
A detection unit for detecting the real guide line,
A second calculation unit that calculates a shift amount between the actual guide line and the moving body based on a detection value of the detection unit;
Based on the amount of deviation between the virtual guide line and the moving body calculated by the first calculating unit, the drive unit of the moving body is controlled so that the moving body travels along the virtual guide line. A traveling control unit that controls the drive unit so that the moving body travels along the actual guide line based on the amount of deviation between the actual guide line and the moving body calculated by the second calculating unit. When,
When the actual guide line is not detected by the detection unit even when the traveling section of the moving body is switched from the first guide section in which the virtual guide line is set to the second guide section in which the actual guide line is installed, And a speed control unit that controls the drive unit so as to decelerate the moving body.
前記検出部は、前記磁気ガイド線を検出する磁気センサである請求項１〜３の何れか一項記載の走行制御装置。 The real guide line is a magnetic guide line,
The travel control device according to claim 1, wherein the detection unit is a magnetic sensor that detects the magnetic guide line.
前記走行経路は、データ上で仮想的に設定された仮想ガイド線と、データ上で前記仮想ガイド線に後続するように床面に設置され、物理的に検出可能な実ガイド線とを有し、
前記走行制御装置は、
前記走行経路の位置を記憶する記憶部と、
前記移動体の位置を推定する位置推定部と、
前記記憶部に記憶された前記仮想ガイド線の位置と前記位置推定部により推定された前記移動体の位置とに基づいて、前記仮想ガイド線と前記移動体とのずれ量を算出する第１算出部と、
前記実ガイド線を検出する検出部と、
前記検出部の検出値に基づいて、前記実ガイド線と前記移動体とのずれ量を算出する第２算出部と、
前記第１算出部により算出された前記仮想ガイド線と前記移動体とのずれ量に基づいて、前記移動体を前記仮想ガイド線に沿って走行させるように前記移動体の駆動部を制御すると共に、前記第２算出部により算出された前記実ガイド線と前記移動体とのずれ量に基づいて、前記移動体を前記実ガイド線に沿って走行させるように前記駆動部を制御する走行制御部と、
前記移動体の走行区間が前記仮想ガイド線が設定された第１誘導区間から前記実ガイド線が設置された第２誘導区間に切り替わっても、前記検出部により前記実ガイド線が検出されないときに、前記移動体を減速させるように前記駆動部を制御する速度制御部とを備える走行制御システム。 A travel control system comprising a travel control device for automatically traveling a moving body along a travel route,
The travel route has a virtual guide line that is virtually set on the data and a real guide line that is installed on the floor so as to follow the virtual guide line on the data and is physically detectable. ,
The traveling control device,
A storage unit that stores the position of the travel route,
A position estimation unit that estimates the position of the moving body,
A first calculation for calculating a shift amount between the virtual guide line and the moving body based on the position of the virtual guide line stored in the storage unit and the position of the moving body estimated by the position estimating unit. Department,
A detection unit for detecting the real guide line,
A second calculation unit that calculates a shift amount between the actual guide line and the moving body based on a detection value of the detection unit;
Based on the shift amount between the virtual guide line and the moving body calculated by the first calculating unit, the drive unit of the moving body is controlled so that the moving body travels along the virtual guide line. A traveling control unit that controls the drive unit so that the moving body travels along the actual guide line based on the amount of deviation between the actual guide line and the moving body calculated by the second calculating unit. When,
When the actual guide line is not detected by the detection unit even when the traveling section of the moving body is switched from the first guide section in which the virtual guide line is set to the second guide section in which the actual guide line is installed, And a speed control unit that controls the drive unit so as to decelerate the moving body.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018245211A JP7205220B2 (en) | 2018-12-27 | 2018-12-27 | Travel control device and travel control system |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2018245211A JP7205220B2 (en) | 2018-12-27 | 2018-12-27 | Travel control device and travel control system |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2020107067A true JP2020107067A (en) | 2020-07-09 |
| JP7205220B2 JP7205220B2 (en) | 2023-01-17 |
Family
ID=71450863
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2018245211A Active JP7205220B2 (en) | 2018-12-27 | 2018-12-27 | Travel control device and travel control system |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP7205220B2 (en) |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS545281U (en) * | 1977-06-15 | 1979-01-13 | ||
| JPS635412A (en) * | 1986-06-26 | 1988-01-11 | Fanuc Ltd | Traveling control device for unmanned carrying car |
| JPH09330122A (en) * | 1996-06-12 | 1997-12-22 | Bridgestone Corp | Returning method for unmanned carriage |
| JP2007183831A (en) * | 2006-01-06 | 2007-07-19 | Toyota Motor Corp | Vehicle control system |
| WO2017158973A1 (en) * | 2016-03-17 | 2017-09-21 | 本田技研工業株式会社 | Automatic guided vehicle |
-
2018
- 2018-12-27 JP JP2018245211A patent/JP7205220B2/en active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS545281U (en) * | 1977-06-15 | 1979-01-13 | ||
| JPS635412A (en) * | 1986-06-26 | 1988-01-11 | Fanuc Ltd | Traveling control device for unmanned carrying car |
| JPH09330122A (en) * | 1996-06-12 | 1997-12-22 | Bridgestone Corp | Returning method for unmanned carriage |
| JP2007183831A (en) * | 2006-01-06 | 2007-07-19 | Toyota Motor Corp | Vehicle control system |
| WO2017158973A1 (en) * | 2016-03-17 | 2017-09-21 | 本田技研工業株式会社 | Automatic guided vehicle |
Also Published As
| Publication number | Publication date |
|---|---|
| JP7205220B2 (en) | 2023-01-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106080601B (en) | Travel controlling system | |
| US11150649B2 (en) | Abnormality detection device | |
| JP6859907B2 (en) | Vehicle control unit | |
| KR101503418B1 (en) | Semiautomatic parking machine | |
| KR102085494B1 (en) | Vehicle control method and vehicle control device | |
| KR101049906B1 (en) | Autonomous mobile apparatus and method for avoiding collisions of the same | |
| CN109643128B (en) | Moving body and method for controlling moving body | |
| JP2020131787A (en) | Control device and vehicle control device | |
| JP2011141663A (en) | Automated guided vehicle and travel control method for the same | |
| JP2019066445A (en) | Position correction method, vehicle control method, and position correction device | |
| JP7205220B2 (en) | Travel control device and travel control system | |
| JP7135884B2 (en) | travel control device | |
| JP2016009246A (en) | Environmental map generation controller, mobile body and environmental map generation method | |
| JP7056591B2 (en) | Driving control system | |
| JP7205206B2 (en) | Travel control device and method | |
| JP7283085B2 (en) | travel control device | |
| JP6412207B2 (en) | Position identification device | |
| JP7180399B2 (en) | travel control device | |
| JP7151035B2 (en) | travel control device | |
| JP7275973B2 (en) | position estimator | |
| JP2021047670A (en) | Control system and control method of automatic guided vehicle | |
| JP7459733B2 (en) | Self-location estimation device | |
| JP2024056366A (en) | Information processing device, information processing method, and computer program | |
| JP2014182591A (en) | Movable body environment map generation controller, movable body and movable body environment map generation method | |
| JP2015056123A (en) | Environmental map generation control device of moving body, moving body, and environmental map generation method of moving body |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210319 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20220131 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220208 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220411 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220712 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220912 |
|
| 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: 20221129 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20221212 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 7205220 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |