JP2019105995A - Automatic operation forklift - Google Patents

Automatic operation forklift Download PDF

Info

Publication number
JP2019105995A
JP2019105995A JP2017237986A JP2017237986A JP2019105995A JP 2019105995 A JP2019105995 A JP 2019105995A JP 2017237986 A JP2017237986 A JP 2017237986A JP 2017237986 A JP2017237986 A JP 2017237986A JP 2019105995 A JP2019105995 A JP 2019105995A
Authority
JP
Japan
Prior art keywords
forklift
obstacle
height
detection
area
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2017237986A
Other languages
Japanese (ja)
Other versions
JP6866839B2 (en
Inventor
等 井上
Hitoshi Inoue
等 井上
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Industries Corp
Original Assignee
Toyota Industries Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Industries Corp filed Critical Toyota Industries Corp
Priority to JP2017237986A priority Critical patent/JP6866839B2/en
Publication of JP2019105995A publication Critical patent/JP2019105995A/en
Application granted granted Critical
Publication of JP6866839B2 publication Critical patent/JP6866839B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Forklifts And Lifting Vehicles (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

To provide an automatic operation forklift that does not require a lot of time without the need of a measure to provide RFID tags to all objects potentially becoming obstacles or so and can properly detect various obstacles existing in a traveling direction.SOLUTION: An automatic operation forklift 1 capable of unmanned autonomous travel has: an upper-obstacle detection device 23R, 23L capable of detecting whether or not there is an obstacle interfering with the automatic operation forklift 1 above a floor level and within an area (23R3, 23L3) up to a prescribed height in accordance with a height of a top end of the automatic operation forklift 1 and within an area (23R3, 23L3) up to a prescribed distance in a direction of travel, within a vehicle width W1 in a direction of forward and backward travel of the automatic operation forklift 1; a notification device 40; and a control unit that in the case of detecting an obstacle by using the upper-obstacle detection device, makes a notification by using the notification device.SELECTED DRAWING: Figure 5

Description

本発明は、無人で自律走行可能な自動運転フォークリフトに関する。   The present invention relates to an autonomous forklift that can travel autonomously.

近年では、種々の製品の製造工場等において、無人で部品や製品等を搬送する自律走行が可能な自動運転フォークリフトが利用されている。自動運転フォークリフトは、予め床面に貼られた磁気テープ等の誘導線に沿って、予めプログラムされた走行経路に従って自動的に移動する。そして自動運転フォークリフトは、プログラムされた位置にて荷物を取得して走行経路に従って移動(搬送)し、プログラムされた移動先の位置にて荷物を下ろす、等の動作を自動的に行う。このような製造工場内では、複数の誘導線が平行あるいは交差するように張り巡らされており、単数または複数の自動運転フォークリフトが、自身に搭載された制御装置のプログラムに従って、固有の走行経路で誘導線に沿って移動する。そして誘導線が交差する交差点では、自動運転フォークリフトは、自身に搭載された制御装置のプログラムに従って、左右にターンしたり直進したりしながら移動する。   2. Description of the Related Art In recent years, automatically operated forklifts capable of autonomous traveling for transporting parts, products and the like unmannedly are used in manufacturing factories of various products. The autonomous forklift moves automatically along a pre-programmed travel path along a guiding line such as magnetic tape previously affixed to the floor surface. Then, the automatically operated forklift automatically performs operations such as acquiring the package at the programmed position, moving (conveying) along the traveling path, and unloading the package at the programmed destination position. In such a manufacturing plant, a plurality of guide wires are arranged in parallel or in a cross, and one or more autonomous forklifts are operated in their own traveling paths according to a program of a control device mounted on their own. Move along the guiding line. Then, at an intersection where the guide lines intersect, the autonomous forklift moves while turning leftward or rightward according to the program of the control device mounted on itself.

自動運転フォークリフトが走行する走行経路の床面には、一時的に作業者が居たり、一時的に種々の物体が載置されていたりする場合がある。このような障害物(作業者、物体)を検出するために、自動運転フォークリフトには、例えば、床面から100[mm]〜250[mm]の高さにて床面に平行かつ進行方向に延びる、平面状の検出領域を有する障害物検出装置が設けられている場合がある。しかし、このような検出領域を有する自動運転フォークリフトでは、走行経路の側方から、例えば500[mm]程度の高さで床面に接触することなく走行経路の側へと突出している障害物を検出することができない。   A worker may be temporarily present on the floor surface of a travel route on which the forklift for automatic operation travels, or various objects may be temporarily placed. In order to detect such obstacles (workers, objects), for example, the automatically operated forklift is parallel to the floor surface in the traveling direction at a height of 100 [mm] to 250 [mm] from the floor surface. An obstacle detection device may be provided which has a planar detection area extending. However, in the case of an autonomous forklift having such a detection area, an obstacle protruding to the side of the traveling route without contacting the floor surface at a height of, for example, about 500 [mm] from the side of the traveling route. It can not be detected.

特許文献1には、作業者にRFIDタグが埋め込まれたIDカードを所持させ、構内の各種装置や危険個所等の障害物となる個所にRFIDタグを取り付け、作業車両の種々の位置にRFIDタグと通信するアンテナを設けた、作業車両管理システムが開示されている。作業車両には管理装置が搭載されており、管理装置は、検出したRFIDタグまでの距離に基づいて危険度の重み付けを算出している。   In Patent Document 1, an operator is allowed to possess an ID card in which an RFID tag is embedded, and the RFID tag is attached to an obstacle such as various devices in a premises or a dangerous place, and the RFID tag is installed at various positions of a work vehicle. A work vehicle management system is disclosed which is provided with an antenna in communication therewith. A management apparatus is mounted on the work vehicle, and the management apparatus calculates the weighting of the degree of danger based on the detected distance to the RFID tag.

また特許文献2には、図17に示すように、2次元の測定面S1、S2内における障害物までの距離を検出する2次元センサ111、112(障害物検出装置に相当)を用いて、前方の障害物を検出する移動車両101が開示されている。2次元センサ111、112は、移動車両の前方上端位置と、移動車両の前方下端位置に設けられている。前方上端位置に設けられた2次元センサ111は、車幅よりも少し広く設定された測定面S1が、移動車両101の前方所定距離dの床面位置と交差するように、移動車両101の横から見た際に所定傾斜角度θ1を有するように下方に向けて取り付けられている。前方下端位置に設けられた2次元センサ112は、車幅よりも少し広く設定された測定面S2が、移動車両101の横から見た際に所定傾斜角度θ2を有するように上方に向けて取り付けられている。つまり、前方上端位置に設けられた2次元センサ111の測定面S1は、移動車両101の上端から下方に向かう傾斜面とされており、前方下端位置に設けられた2次元センサ112の測定面S2は、移動車両101の下端から上方に向かう傾斜面とされて、それぞれの測定面S1、S2が交差している。これらの測定面S1、S2によって、移動車両101の前方の障害物までの距離を検出している。   In Patent Document 2, as shown in FIG. 17, two-dimensional sensors 111 and 112 (corresponding to obstacle detection devices) for detecting the distance to the obstacle in the two-dimensional measurement surfaces S1 and S2 are used. A mobile vehicle 101 is disclosed that detects an obstacle ahead. The two-dimensional sensors 111 and 112 are provided at the front upper end position of the mobile vehicle and at the front lower end position of the mobile vehicle. The two-dimensional sensor 111 provided at the front upper end position has a side surface of the moving vehicle 101 such that the measurement surface S1 set to be slightly wider than the vehicle width intersects with the floor surface position of the front predetermined distance d of the moving vehicle 101. It is attached downward so as to have a predetermined inclination angle θ1 when viewed from the side. The two-dimensional sensor 112 provided at the front lower end position is attached upward so that the measurement surface S2 set to be slightly wider than the vehicle width has a predetermined inclination angle θ2 when viewed from the side of the moving vehicle 101 It is done. That is, the measurement surface S1 of the two-dimensional sensor 111 provided at the front upper end position is an inclined surface directed downward from the upper end of the moving vehicle 101, and the measurement surface S2 of the two-dimensional sensor 112 provided at the front lower end position. Is an inclined surface directed upward from the lower end of the mobile vehicle 101, and the respective measurement surfaces S1 and S2 intersect with each other. The distance to the obstacle ahead of the mobile vehicle 101 is detected by these measurement surfaces S1 and S2.

特開2006−188353号公報JP, 2006-188353, A 特開2007−193495号公報JP 2007-193495 A

特許文献1に記載の作業車両管理システムでは、障害物となり得る作業者及び物体のすべてに、RFIDタグを所持させる、または取り付ける必要があり、非常に手間がかかるとともに、所持または取り付けが忘れられた作業者または物体は、障害物として検出されないので、好ましくない。   In the work vehicle management system described in Patent Document 1, it is necessary to bring or attach an RFID tag to all the workers and objects that can become obstacles, which is very time-consuming and forgotten to possess or attach. An operator or an object is not preferable because it is not detected as an obstacle.

特許文献2に記載の移動車両は、図17に示すように、障害物を検出するための測定面S1、S2が、互いに前方に向かう傾斜面であり、領域S3では移動方向において凹んだ状態となる。従って、例えば、走行経路の側方から、床面に接触することなく所定高さで走行経路の側へと突出している障害物が領域S3に有る場合、障害物の検出が遅れるので、適切に障害物を回避したり停止したりできない可能性がある。   In the mobile vehicle described in Patent Document 2, as shown in FIG. 17, the measurement surfaces S1 and S2 for detecting an obstacle are inclined surfaces facing each other in the forward direction, and in the region S3 are recessed in the moving direction Become. Therefore, for example, if there is an obstacle in the area S3 that protrudes to the side of the traveling route at a predetermined height from the side of the traveling route without contacting the floor, detection of the obstacle is delayed, so You may not be able to avoid or stop obstacles.

本発明は、このような点に鑑みて創案されたものであり、障害物となり得るすべてのものにRFIDタグを持たせる等の処置が不要で手間がなく、かつ、進行方向に存在する種々の障害物を適切に検出することができる自動運転フォークリフトを提供することを課題とする。   The present invention has been made in view of such a point, and it is unnecessary to take measures such as giving an RFID tag to all possible obstacles, and there is no effort, and various existing in the traveling direction It is an object of the present invention to provide an autonomous forklift that can appropriately detect an obstacle.

上記課題を解決するため、本発明の第1の発明は、無人で自律走行可能な自動運転フォークリフトであって、前記自動運転フォークリフトの前進または後進の進行方向における車幅内において、床面よりも上方、かつ、前記自動運転フォークリフトの上端の高さに応じた所定高さまでの検出領域内であって進行方向における所定距離までの前記検出領域内に、前記自動運転フォークリフトと干渉する障害物が有るか否かを検出可能な上方障害物検出装置と、報知装置と、前記上方障害物検出装置を用いて障害物を検出した場合、前記報知装置を用いて報知する制御装置と、を有している、自動運転フォークリフトである。   In order to solve the above-mentioned problems, a first invention of the present invention is an autonomous forklift capable of autonomous traveling without a person, which is more than a floor surface within a vehicle width in a forward or reverse traveling direction of the autonomous forklift. There is an obstacle that interferes with the automatic operation forklift within the detection region up to a predetermined height according to the height of the upper end of the automatic forklift, and within the detection region to a predetermined distance in the traveling direction An upper obstacle detection device capable of detecting whether or not an obstacle is detected, and a control device for notifying using the notification device when an obstacle is detected using the upper obstacle detection device; Yes, it is an automated forklift.

本発明の第2の発明は、上記第1の発明に係る自動運転フォークリフトであって、前記上方障害物検出装置は、前記進行方向と鉛直方向とを含む平面状の前記検出領域を有しており、当該検出領域内に存在する物体を障害物として検出可能である、自動運転フォークリフトである。   A second invention of the present invention is the automatic driving forklift according to the first invention, wherein the upper obstacle detection device has a planar detection area including the traveling direction and the vertical direction. It is an autonomous forklift that can detect an object present in the detection area as an obstacle.

本発明の第3の発明は、上記第2の発明に係る自動運転フォークリフトであって、前記検出領域として、複数の検出領域が設定されており、前記制御装置は、前記自動運転フォークリフトの運転状態に応じて、前記検出領域を切り替える、自動運転フォークリフトである。   A third invention of the present invention is the automatic driving forklift according to the second invention, wherein a plurality of detection areas are set as the detection area, and the control device is configured to operate the automatic forklift. It is an automatic operation forklift which switches the detection area according to.

本発明の第4の発明は、上記第3の発明に係る自動運転フォークリフトであって、前記制御装置は、前記自動運転フォークリフトの走行速度に応じて、前記検出領域を切り替える、自動運転フォークリフトである。   A fourth invention of the present invention is the automatic driving forklift according to the third invention, wherein the control device switches the detection area according to the traveling speed of the automatic driving forklift. .

本発明の第5の発明は、上記第3の発明に係る自動運転フォークリフトであって、前記制御装置から制御され、前記自動運転フォークリフトに設けられたマストに沿ってフォークを昇降させる昇降装置を有し、前記自動運転フォークリフトの上部には、前記自動運転フォークリフトの少なくとも一部を覆うヘッドガードを有しており、前記自動運転フォークリフトが前記フォークを用いて搬入または搬出する荷物の高さは、予め決められた高さであり、前記制御装置は、荷物の有無を検出する荷物検出装置と、前記フォークの高さを検出する昇降位置検出装置と、を有しており、前記荷物検出装置を用いて検出した荷物の有無と、前記荷物の高さと、前記昇降位置検出装置を用いて検出した前記フォークの高さと、前記フォークの高さに応じたマストの高さと、前記ヘッドガードの高さと、に基づいて求めた最上端高さに応じて、前記検出領域を切り替える、自動運転フォークリフトである。   A fifth aspect of the present invention is the automatic driving forklift according to the third aspect, including a lifting device that is controlled by the control device and lifts and lowers a fork along a mast provided on the automatic driving forklift. And a head guard covering at least a part of the autonomously operating forklift at an upper portion of the autonomously operating forklift, and a height of a load carried in or out of the autonomously operating forklift using the fork is previously determined. The control device has a package detection device that detects the presence or absence of a package, and an elevation position detection device that detects the height of the fork, and the control device uses the package detection device. According to the height of the load, the height of the load, the height of the fork detected using the elevation position detection device, and the height of the fork The height of the mast, the height of the head guard, depending on the uppermost height determined based on, switching the detection area, it is automatically operated forklift.

本発明の第6の発明は、上記第3の発明〜第5の発明のいずれか1つに係る自動運転フォークリフトであって、前記制御装置から制御されて前記自動運転フォークリフトを前進または後進にて走行させる駆動装置を有し、前記検出領域は、減速領域と停止領域を有しており、前記減速領域は、前記自動運転フォークリフトから遠い側に設定され、前記停止領域は、前記自動運転フォークリフトに近い側に設定され、前記制御装置は、前記減速領域に障害物を検出した場合、前記自動運転フォークリフトの走行速度を減速させるように前記駆動装置を制御し、前記停止領域に障害物を検出した場合、前記自動運転フォークリフトの走行を停止させるように前記駆動装置を制御する、自動運転フォークリフトである。   A sixth invention of the present invention is the automatic driving forklift according to any one of the third to fifth inventions, wherein the automatic driving forklift is controlled by the control device to advance or reverse the automatic forklift. It has a drive device for traveling, the detection area has a deceleration area and a stop area, the deceleration area is set on the side far from the automatic operation forklift, and the stop area is the automatic operation forklift It is set on the near side, and when the controller detects an obstacle in the deceleration area, the control device controls the drive device to reduce the traveling speed of the automatically operated forklift, and detects the obstacle in the stop area. In the case of the autonomously operating forklift, the drive device is controlled to stop the traveling of the autonomously operating forklift.

本発明の第7の発明は、上記第1の発明〜第5の発明のいずれか1つに係る自動運転フォークリフトであって、前記制御装置から制御されて前記自動運転フォークリフトを前進または後進にて走行させる駆動装置を有し、前記制御装置は、前記上方障害物検出装置を用いて障害物を検出した場合、前記自動運転フォークリフトの走行を停止させるように前記駆動装置を制御する、自動運転フォークリフトである。   A seventh invention of the present invention is the automatic driving forklift according to any one of the first to fifth inventions, wherein the automatic driving forklift is controlled by the control device to advance or reverse the automatic forklift. An autonomously operating forklift having a drive unit for traveling, wherein the control unit controls the drive unit to stop traveling of the autonomously operating forklift when the obstacle is detected using the upper obstacle detecting unit. It is.

本発明の第8の発明は、上記第1の発明〜第7の発明のいずれか1つに係る自動運転フォークリフトであって、前記上方障害物検出装置は、前記自動運転フォークリフトの上部において前記自動運転フォークリフトの車幅に対応する左右両端に一対で設けられている、自動運転フォークリフトである。   An eighth invention of the present invention is the automatic driving forklift according to any one of the first to seventh inventions, wherein the upper obstacle detecting device is provided at the upper portion of the automatic forklift. A pair of self-operated forklifts provided at the left and right ends corresponding to the width of the driving forklift.

本発明の第9の発明は、上記第6の発明または第7の発明に係る自動運転フォークリフトであって、予め設けられた受信設備に向けて所定の情報を無線にて送信可能な通信装置を有し、前記制御装置は、前記上方障害物検出装置を用いて障害物を検出して走行を停止させた場合、前記通信装置を用いて、障害物を検出して走行を停止していることを含む異常情報を、前記受信設備に送信する、自動運転フォークリフトである。   A ninth invention of the present invention is the automatically operated forklift according to the sixth invention or the seventh invention, which is a communication device capable of wirelessly transmitting predetermined information to a reception facility provided in advance. And the control device detects an obstacle using the communication device and stops traveling when the obstacle is detected using the upper obstacle detection device and the traveling is stopped. The automatic transmission forklift according to claim 1, wherein the automatic transmission forklift transmits abnormality information including the information to the reception facility.

第1の発明では、進行方向における車幅内において、床面よりも上方、かつ、自動運転フォークリフトの上端の高さに応じた所定高さまでの検出領域内であって進行方向における所定距離までの検出領域内に、自動運転フォークリフトと干渉する障害物が有るか否かを検出可能な上方障害物検出装置を有している。これにより、例えば、走行経路の側方から、床面に接触することなく所定高さで走行経路の側へと突出している障害物が存在しても、当該障害物を、進行方向における所定距離内にて適切に検出することができる。そして当該情報障害物検出装置にて、進行方向に存在する種々の障害物を適切に検出することができる。また、障害物となり得るすべてのものにRFIDタグを持たせる等の処置が不要で手間がない。   In the first invention, within the vehicle width in the traveling direction, it is within the detection area up to the predetermined height according to the height of the upper end of the automatically operated forklift within the vehicle width in the traveling direction and to the predetermined distance in the traveling direction There is an upper obstacle detection device capable of detecting whether or not there is an obstacle that interferes with the automatically operated forklift within the detection area. Thereby, for example, even if there is an obstacle projecting toward the traveling path at a predetermined height from the side of the traveling path without contacting the floor surface, the obstacle may be a predetermined distance in the traveling direction It can be detected properly inside. The information obstacle detection device can appropriately detect various obstacles present in the traveling direction. In addition, it is not necessary and time-consuming to take measures such as holding an RFID tag on all possible obstacles.

第2の発明によれば、上方障害物検出装置の検出領域を、進行方向と鉛直方向とを含む平面状の検出領域とすることで、適切な検出領域とすることができる。   According to the second aspect of the invention, by setting the detection area of the upper obstacle detection device as a flat detection area including the traveling direction and the vertical direction, an appropriate detection area can be obtained.

第3の発明によれば、運転状態に応じて検出領域を切り替えることで、運転状態に応じてより適切に障害物を検出することができる。   According to the third invention, by switching the detection area according to the driving state, it is possible to more appropriately detect an obstacle according to the driving state.

第4の発明によれば、自動運転フォークリフトの走行速度(運転状態に相当)に応じて検出領域を切り替えることで、自動運転フォークリフトの走行速度が変化しても、適切に障害物を検出することができる。   According to the fourth aspect of the invention, by switching the detection region according to the traveling speed (corresponding to the operating state) of the automatically operating forklift, the obstacle is appropriately detected even if the traveling speed of the automatically operated forklift changes. Can.

第5の発明によれば、自動運転フォークリフトの、フォークの高さ(運転状態に相当)、フォークの高さに応じたマストの高さ(運転状態に相当)、ヘッドガードの高さや、荷物の有無(運転状態に相当)と荷物の高さ、に基づいた最上端高さに応じて検出領域を切り替えることで、自動運転フォークリフトの高さが変化しても、適切に障害物を検出することができる。   According to the fifth invention, the height of the fork (corresponding to the operating state), the height of the mast according to the height of the fork (corresponding to the operating state), the height of the head guard, the height of the luggage Detecting an obstacle appropriately even if the height of the automatically operated forklift changes by switching the detection area according to the presence or absence (corresponding to the operating condition) and the height of the top end based on the height of the load Can.

第6の発明によれば、進行方向における障害物を検出する際、まず遠い側の減速領域で障害物が検出されるので、まず自動運転フォークリフトの速度を安全な速度へと減速できる。その後、近い側の停止領域で障害物が検出されるので、安全な速度に減速した自動運転フォークリフトを、安全に停止させることができる。   According to the sixth aspect, when detecting an obstacle in the traveling direction, the obstacle is first detected in the deceleration area on the far side, so that the speed of the automatically operated forklift can be first reduced to a safe speed. After that, since the obstacle is detected in the near stop area, it is possible to safely stop the automatically operated forklift that has been decelerated to a safe speed.

第7の発明によれば、上方障害物検出装置にて障害物を検出した場合に自動運転フォークリフトを停止させるので、障害物への衝突を適切に回避させることができる。   According to the seventh invention, when the obstacle is detected by the upper obstacle detection device, the automatically operated forklift is stopped, so that the collision with the obstacle can be appropriately avoided.

第8の発明によれば、適切な位置に、上方障害物検出装置を配置することができる。   According to the eighth invention, the upper obstacle detection device can be disposed at an appropriate position.

第9の発明によれば、作業者は、受信設備にて異常情報を確認することで、走行停止状態となって復旧を待っている自動運転フォークリフトが有ることを、容易に認識することが可能である。   According to the ninth aspect of the invention, the worker can easily recognize that there is an automatically operated forklift which is in the traveling stop state and is waiting for restoration by confirming the abnormality information in the reception facility. It is.

本発明の自動運転フォークリフトの外観の例を示す斜視図である。It is a perspective view showing the example of the appearance of the self-driving forklift of the present invention. 図1に示した自動運転フォークリフトの概略平面図であって、自動運転フォークリフトの各車輪の配置、及び走行を制御する制御装置に接続される各種の検出装置とアクチュエータ等の配置を説明する図である。FIG. 2 is a schematic plan view of the automatically driven forklift shown in FIG. 1, illustrating the arrangement of the wheels of the automatically operated forklift, and the arrangement of various detection devices and actuators connected to a control device for controlling traveling. is there. 障害物検出装置の外観と最大検出領域の例を説明する斜視図である。It is a perspective view explaining the appearance of an obstacle detection device, and the example of the maximum detection field. 障害物検出装置に対して、最大検出領域内において所望する検出領域を設定する例を説明する図である。It is a figure explaining an example which sets up a desired detection field in the maximum detection field to an obstacle detection device. 自動運転フォークリフトにおける各検出領域の例を説明する図である。It is a figure explaining the example of each detection field in an automatic operation forklift. 自動運転フォークリフトの運転状態(フォーク高さとマスト高さと荷物の有無)に応じた、上方障害物検出装置の検出領域の高さの例を説明する図である。It is a figure explaining the example of the height of the detection field of the upper obstacle detection device according to the operation state (fork height, mast height, and existence of luggage) of a forklift for automatic operation. 自動運転フォークリフトの運転状態(フォーク高さとマスト高さと荷物の有無)に応じた、上方障害物検出装置の検出領域の高さの例を説明する図である。It is a figure explaining the example of the height of the detection field of the upper obstacle detection device according to the operation state (fork height, mast height, and existence of luggage) of a forklift for automatic operation. 自動運転フォークリフトの運転状態(フォーク高さとマスト高さと荷物の有無)に応じた、上方障害物検出装置の検出領域の高さの例を説明する図である。It is a figure explaining the example of the height of the detection field of the upper obstacle detection device according to the operation state (fork height, mast height, and existence of luggage) of a forklift for automatic operation. 自動運転フォークリフトの運転状態(走行速度)に応じた、上方障害物検出装置の検出領域における進行方向の長さの例を説明する図である。It is a figure explaining the example of the length of the advancing direction in the detection field of the upper obstacle detection device according to the driving state (traveling speed) of an automatic operation forklift. 自動運転フォークリフトの運転状態(走行速度)に応じた、上方障害物検出装置の検出領域における進行方向の長さの例を説明する図である。It is a figure explaining the example of the length of the advancing direction in the detection field of the upper obstacle detection device according to the driving state (traveling speed) of an automatic operation forklift. 誘導線が張り巡らされた製造工場等の平面図の例であって、誘導線に沿って直進や左右のターンをしながら走行経路に従って自動運転フォークリフトが走行する例を説明する図である。It is an example of the top view of a manufacturing factory etc. where a guide line was stretched, and is a figure explaining an example which an automatically-operated forklift runs according to a run route, going straight along a guide line and turning right and left. 制御装置の処理手順の例を説明するフローチャートである。It is a flowchart explaining the example of the processing procedure of a control device. 図12に示すフローチャートにおけるSUB100の処理の詳細を説明するフローチャートである。It is a flowchart explaining the detail of a process of SUB100 in the flowchart shown in FIG. 走行経路の側方から、床面に接することなく走行経路の側に障害物が突出している例であって、上方障害物検出装置の検出領域が、障害物に達する手前の状態の例を説明する図である。An example in which an obstacle protrudes from the side of the traveling route to the side of the traveling route without touching the floor surface, and an example of a state before the detection region of the upper obstacle detection device reaches the obstacle is described. It is a figure to do. 図14に対して、上方障害物検出装置の検出領域における減速領域が、障害物に達している状態の例を説明する図である。FIG. 15 is a diagram for explaining an example of a state in which the deceleration region in the detection region of the upper obstacle detection device has reached the obstacle with respect to FIG. 14; 図15に対して、上方障害物検出装置の検出領域における停止領域が、障害物に達している状態の例を説明する図である。FIG. 16 is a diagram for explaining an example of a state in which the stop area in the detection area of the upper obstacle detection device has reached the obstacle with respect to FIG. 15; 従来の移動車両において、前方の障害物を検出する2次元センサの取付状態と測定面の例を説明する図である。In the conventional mobile vehicle, it is a figure explaining the example of the attachment state of a two-dimensional sensor which detects the obstacle of the front, and a measurement side.

以下に本発明を実施するための形態を図面を用いて説明する。なお、X軸とY軸とZ軸が記載されている図において、X軸とY軸とZ軸は互いに直交している。また、Z軸方向は鉛直上向き方向を示し、X軸方向は自動運転フォークリフトの前方向を示し、Y軸方向は自動運転フォークリフトの左方向を示している。   Hereinafter, an embodiment of the present invention will be described with reference to the drawings. In the drawing in which the X axis, the Y axis, and the Z axis are described, the X axis, the Y axis, and the Z axis are orthogonal to each other. Further, the Z-axis direction indicates a vertically upward direction, the X-axis direction indicates a forward direction of the autonomous forklift, and the Y-axis direction indicates a left direction of the autonomous forklift.

●[自動運転フォークリフト1の外観(図1)]
自動運転フォークリフト1には、用途や作業現場等に応じて種々の外観のものがあるが、本実施の形態の説明では図1に示すように、リーチ型フォークリフトの外観を有する自動運転フォークリフトを例として説明する。自動運転フォークリフト1は、車体3、リーチレグ10、マスト70、フォーク60、ヘッドガード9、右従動輪8R、左従動輪8L、駆動操舵輪8D、キャスタ輪8C等を有している。
● [Appearance of the automatically operated forklift 1 (Fig. 1)]
There are various appearances of the automatically operated forklift 1 according to the application, the work site, etc., but in the description of the present embodiment, as shown in FIG. 1, the example of the automatically operated forklift having the appearance of reach type forklift Explain as. The autonomous driving forklift 1 has a vehicle body 3, a reach leg 10, a mast 70, a fork 60, a head guard 9, a right driven wheel 8R, a left driven wheel 8L, a drive steering wheel 8D, a caster wheel 8C and the like.

リーチレグ10は左右一対で設けられており、車体3の下部から前方に突出するように設けられている。また一対のリーチレグ10の各々の前側部には、右従動輪8R、左従動輪8Lが設けられている。マスト70は左右一対で設けられており、リーチレグ10に沿って前後方向にスライド可能であるとともに、前後方向に傾斜可能である。フォーク60は左右一対で設けられており、マスト70に沿って上下方向にスライド可能(昇降可能)である。自動運転フォークリフト1の上部には、自動運転フォークリフト1の少なくとも一部を覆うヘッドガード9が設けられている。   The reach legs 10 are provided in a pair on the left and right, and are provided to project forward from the lower part of the vehicle body 3. Further, on the front side of each of the pair of reach legs 10, a right driven wheel 8R and a left driven wheel 8L are provided. The masts 70 are provided in a pair on the left and right, and can slide in the front-rear direction along the reach leg 10 and can tilt in the front-rear direction. The forks 60 are provided in a pair on the left and right, and can slide up and down along the mast 70 (liftable). At the upper part of the autonomous driving forklift 1, a head guard 9 covering at least a part of the autonomous driving forklift 1 is provided.

自動運転フォークリフト1の前下端には、障害物検出装置21Fが設けられ、車体3の後下端には、障害物検出装置21Bが設けられている。車体3の右下端には障害物検出装置22Rが設けられ、車体3の左下端には、障害物検出装置22Lが設けられている。そして車体3には、報知装置40が設けられている。また、ヘッドガード9には通信装置30が設けられ、ヘッドガード9の後右端には上方障害物検出装置23Rが設けられ、ヘッドガード9の後左端には上方障害物検出装置23Lが設けられている。つまり、上方障害物検出装置23R、23Lは、自動運転フォークリフト1の上部において、自動運転フォークリフト1の車幅に対応する左右両端に一対で設けられている。なお、上方障害物検出装置23R、23Lは、ヘッドガード9に設けられることなく、車体3に設けられたブラケット等にて、自動運転フォークリフト1の上部において、自動運転フォークリフト1の車幅に対応する左右両端に一対で設けられていてもよい。   An obstacle detection device 21 F is provided at the front lower end of the forklift 1 with an automatic operation, and an obstacle detection device 21 B is provided at the rear lower end of the vehicle body 3. An obstacle detection device 22R is provided at the lower right end of the vehicle body 3, and an obstacle detection device 22L is provided at the lower left end of the vehicle body 3. The vehicle body 3 is provided with a notification device 40. The head guard 9 is provided with a communication device 30, the head guard 9 is provided with an upper obstacle detection device 23R at the rear right end, and the head guard 9 is provided with an upper obstacle detection device 23L at the rear left end. There is. That is, the upper obstacle detection devices 23R and 23L are provided in a pair at the left and right ends corresponding to the vehicle width of the automatic operation forklift 1 in the upper part of the automatic operation forklift 1. The upper obstacle detection devices 23R and 23L correspond to the width of the automatically operated forklift 1 at the upper portion of the automatically operated forklift 1 by a bracket or the like provided on the vehicle body 3 without being provided on the head guard 9. It may be provided in a pair at the left and right ends.

右従動輪8Rは、右側のリーチレグ10の前端近傍に設けられており、自動運転フォークリフト1の前後方向(図1及び図2の例ではX軸方向)に向きが固定されて回転自在に設けられている。左従動輪8Lは、左側のリーチレグ10の前端近傍に設けられており、自動運転フォークリフト1の前後方向(図1及び図2の例ではX軸方向)に向きが固定されて回転自在に設けられている。本実施の形態の説明では、右従動輪8Rと左従動輪8Lが、左右一対で自動運転フォークリフト1の前方に設けられている例を説明する。   The right driven wheel 8R is provided in the vicinity of the front end of the reach leg 10 on the right side, and the direction is fixed in the front-rear direction of the autonomous forklift 1 (X axis direction in the example of FIGS. ing. The left driven wheel 8L is provided in the vicinity of the front end of the reach leg 10 on the left side, and the direction is fixed in the front-rear direction of the autonomous driving forklift 1 (X axis direction in the example of FIGS. ing. In the description of the present embodiment, an example in which the right driven wheel 8R and the left driven wheel 8L are provided in front of the automatic driving forklift 1 in a pair of right and left will be described.

駆動操舵輪8Dは、自動運転フォークリフト1の前後方向に対する角度(図2における中心軸線1Jに対する角度)を変更可能な操舵モータ52(図2参照)を有するとともに、駆動モータ51(駆動装置に相当、図2参照)によって回転駆動される。駆動モータ51は、制御装置50から制御され、自動運転フォークリフト1を前進または後進にて走行させる。また駆動操舵輪8Dは、左右方向において、右側と左側のどちらの側に配置されていてもよい。本実施の形態の説明では、駆動操舵輪8Dが、自動運転フォークリフト1の後方、かつ左側に設けられている例を説明する。   The drive steering wheel 8D has a steering motor 52 (see FIG. 2) capable of changing an angle (an angle to the central axis 1J in FIG. 2) with respect to the front-rear direction of the forklift 1 automatically driven. It is rotationally driven according to FIG. The drive motor 51 is controlled by the control device 50 and causes the autonomously operating forklift 1 to travel forward or backward. The drive steered wheels 8D may be disposed on either the right side or the left side in the left-right direction. In the description of the present embodiment, an example in which the drive steered wheels 8D are provided on the rear side and on the left side of the autonomous driving forklift 1 will be described.

キャスタ輪8Cは、図2に示すXY平面内において方向が自由に変わるように自動運転フォークリフト1に対して支持されているとともに、回転自在となるように自動運転フォークリフト1に支持された車輪である。本実施の形態の説明では、キャスタ輪8Cが、自動運転フォークリフト1の後方、かつ右側に設けられている例を説明する。   The caster wheel 8C is a wheel which is supported by the autonomously operating forklift 1 so as to change the direction freely in the XY plane shown in FIG. 2 and is also supported by the autonomously operating forklift 1 so as to be freely rotatable. . In the description of the present embodiment, an example in which the caster wheel 8C is provided at the rear and the right side of the autonomous driving forklift 1 will be described.

●[制御装置50に接続される各種の検出装置とアクチュエータの配置(図2)]
次に図2を用いて自動運転フォークリフト1の制御装置50に接続される各種の検出装置やアクチュエータの配置位置等について説明する。図2に示すように、自動運転フォークリフト1には、制御装置50、前側誘導線検出装置2A、後側誘導線検出装置2B、右マーカ検出装置2R、左マーカ検出装置2L、荷物検出装置2C、駆動モータ51、操舵モータ52、ポンプ用モータ61、油圧ポンプ62、通信装置30、報知装置40、障害物検出装置21F、21B、22R、22L、上方障害物検出装置23R、23L、昇降位置検出装置63等が設けられている。なお、自動運転フォークリフト1は、予め床面等に設けられた誘導線(例えば磁気テープ)に沿って走行し、複数が張り巡らされた誘導線の中から、予め設定された走行経路となる誘導線に従って、前進や後進、誘導線の交差点での左右のターン等を行いながら走行する。
[Arrangement of various detection devices and actuators connected to the control device 50 (FIG. 2)]
Next, with reference to FIG. 2, an arrangement position and the like of various detection devices and actuators connected to the control device 50 of the automatically operating forklift 1 will be described. As shown in FIG. 2, the control forklift 50 includes a control device 50, a front guiding wire detecting device 2A, a rear guiding wire detecting device 2B, a right marker detecting device 2R, a left marker detecting device 2L, and a luggage detecting device 2C. Drive motor 51, steering motor 52, pump motor 61, hydraulic pump 62, communication device 30, notification device 40, obstacle detection devices 21F, 21B, 22R, 22L, upper obstacle detection devices 23R, 23L, elevation position detection device 63 grade is provided. In addition, the automatic driving forklift 1 travels along a guiding line (for example, magnetic tape) provided in advance on a floor surface or the like, and guides a traveling path set in advance from among a plurality of guiding lines laid around. Follow the line and drive forward and backwards, turn left and right at the intersection of the guide line, etc.

前側誘導線検出装置2Aは、自動運転フォークリフト1の前方、かつ下方に配置されて、床面等にライン状に延びるように設けられた誘導線を検出し、検出信号を制御装置50に向けて出力する。例えば誘導線が磁気テープの場合、前側誘導線検出装置2Aは磁気センサであり、左右方向の幅2Awは、例えば20[cm]程度である。制御装置50は、前側誘導線検出装置2Aからの検出信号に基づいて、前側誘導線検出装置2Aの下方に存在する誘導線が、前側検出装置中心2Acから左右のどちらに、どれだけ離れた距離にあるか、を検出することができる。   The front side guiding wire detection device 2A is disposed in front of and below the autonomous forklift 1, detects a guiding wire provided to extend in a line shape on a floor surface or the like, and directs a detection signal to the control device 50. Output. For example, when the guide wire is a magnetic tape, the front guide wire detection device 2A is a magnetic sensor, and the width 2Aw in the left-right direction is, for example, about 20 cm. Control device 50 is based on the detection signal from front side guiding wire detection device 2A, how far away from the front side detection device center 2Ac the guiding wire existing below front side guiding wire detection device 2A is far enough Can be detected.

後側誘導線検出装置2Bは、自動運転フォークリフト1の後方、かつ下方に配置されて、床面等にライン状に延びるように設けられた誘導線を検出し、検出信号を制御装置50に向けて出力する。例えば誘導線が磁気テープの場合、後側誘導線検出装置2Bは磁気センサであり、左右方向の幅2Bwは、例えば20[cm]程度である。制御装置50は、後側誘導線検出装置2Bからの検出信号に基づいて、後側誘導線検出装置2Bの下方に存在する誘導線が、後側検出装置中心2Bcから左右のどちらに、どれだけ離れた距離にあるか、を検出することができる。   The rear guide wire detection device 2B is disposed behind and below the automatic operation forklift 1, detects a guide wire provided so as to extend in a line shape on a floor surface or the like, and directs a detection signal to the control device 50. Output. For example, when the guide wire is a magnetic tape, the rear guide wire detection device 2B is a magnetic sensor, and the width 2Bw in the left-right direction is, for example, about 20 cm. Based on the detection signal from rear guiding wire detection device 2B, control device 50 determines how many guiding wires exist below rear guiding wire detection device 2B from either rear detection device center 2Bc to the left or right. It can be detected whether it is at a distant distance.

右マーカ検出装置2Rは、後側誘導線検出装置2B(または前側誘導線検出装置2A)の右側、かつ下方に配置されて、床面等にスポット的に設けられたマーカ(誘導線の交差点の手前であることを示すマーカや一時停止を指示するマーカ等)を検出し、検出信号を制御装置50に向けて出力する。例えばマーカが磁気テープや磁石の場合、右マーカ検出装置2Rは磁気センサである。制御装置50は、右マーカ検出装置2Rからの検出信号に基づいて、右マーカ検出装置2Rの下方に、マーカがあるか否か、を検出することができる。なお、中心軸線1Jから右マーカ検出装置2Rまでの距離2Rwは、マーカの位置にあわせて適宜設定される。   The right marker detection device 2R is disposed to the right of and below the rear guide wire detection device 2B (or the front guide wire detection device 2A), and is provided with markers (spots at the intersections of the guide wires) A marker indicating that it is the front, a marker instructing a pause, etc. is detected, and a detection signal is output to the control device 50. For example, when the marker is a magnetic tape or a magnet, the right marker detection device 2R is a magnetic sensor. The control device 50 can detect whether there is a marker below the right marker detection device 2R based on the detection signal from the right marker detection device 2R. The distance 2Rw from the central axis 1J to the right marker detection device 2R is appropriately set in accordance with the position of the marker.

左マーカ検出装置2Lは、後側誘導線検出装置2B(または前側誘導線検出装置2A)の左側、かつ下方に配置されて、床面等にスポット的に設けられたマーカ(誘導線の交差点の手前であることを示すマーカや一時停止を指示するマーカ等)を検出し、検出信号を制御装置50に向けて出力する。例えばマーカが磁気テープや磁石の場合、左マーカ検出装置2Lは磁気センサである。制御装置50は、左マーカ検出装置2Lからの検出信号に基づいて、左マーカ検出装置2Lの下方に、マーカがあるか否か、を検出することができる。なお、中心軸線1Jから左マーカ検出装置2Lまでの距離2Lwは、マーカの位置にあわせて適宜設定される。   The left marker detection device 2L is disposed on the left side and the lower side of the rear guide wire detection device 2B (or the front guide wire detection device 2A), and is provided with markers (spots at the intersections of guide wires) A marker indicating that it is the front, a marker instructing a pause, etc. is detected, and a detection signal is output to the control device 50. For example, when the marker is a magnetic tape or a magnet, the left marker detection device 2L is a magnetic sensor. The control device 50 can detect whether or not there is a marker below the left marker detection device 2L based on the detection signal from the left marker detection device 2L. The distance 2Lw from the central axis 1J to the left marker detection device 2L is appropriately set in accordance with the position of the marker.

荷物検出装置2Cは、例えばフォーク60の上面に設けられた物体検出センサであり、フォーク60の上面の荷物の有無に応じた検出信号を制御装置50に向けて出力する。制御装置50は、荷物検出装置2Cからの検出信号に基づいて、自動運転フォークリフト1が荷物を持っている状態か、荷物を持っていない状態か、を検出することができる。   The package detection device 2C is an object detection sensor provided on the upper surface of the fork 60, for example, and outputs a detection signal according to the presence or absence of the package on the upper surface of the fork 60 to the control device 50. The control device 50 can detect, based on the detection signal from the package detection device 2C, whether the automatically operated forklift 1 has a package or does not have a package.

駆動モータ51は、駆動ギア等を介して駆動操舵輪8Dを回転駆動して、自動運転フォークリフト1を前進、後進、停止等する。制御装置50は、駆動モータ51に制御信号を出力して駆動操舵輪8Dを前進回転、後進回転、停止等の状態に制御することができる。また制御装置50は、図示省略したエンコーダ等の回転検出手段からの検出信号に基づいて、駆動モータ51の回転状態を検出し、自動運転フォークリフト1の走行速度を検出することができる。   The drive motor 51 rotationally drives the drive steered wheels 8D via a drive gear or the like to move the autonomously operating forklift 1 forward, reverse, stop or the like. The control device 50 can output a control signal to the drive motor 51 to control the drive steered wheel 8D to forward rotation, reverse rotation, stop, and the like. Further, the control device 50 can detect the rotational state of the drive motor 51 based on a detection signal from a rotation detection means such as an encoder (not shown), and can detect the traveling speed of the automatically operated forklift 1.

操舵モータ52は、操舵ギア等を介して駆動操舵輪8Dの操舵角度を変更して、自動運転フォークリフト1の進行方向を左右に変更する。制御装置50は、操舵モータ52に制御信号を出力して駆動操舵輪8Dの操舵角度(自動運転フォークリフト1の中心軸線1Jに対する角度)を制御することができる。また制御装置50は、図示省略したエンコーダ等の回転検出装置からの検出信号に基づいて、操舵モータ52の回転状態を検出し、駆動操舵輪8Dの操舵角度を検出することができる。   The steering motor 52 changes the steering angle of the drive steered wheels 8D via a steering gear or the like, and changes the traveling direction of the automatic driving forklift 1 to the left or right. The control device 50 can output a control signal to the steering motor 52 to control the steering angle of the drive steered wheels 8D (the angle with respect to the central axis 1J of the automatically operated forklift 1). Further, the control device 50 can detect the rotation state of the steering motor 52 based on a detection signal from a rotation detection device such as an encoder (not shown), and can detect the steering angle of the drive steering wheel 8D.

ポンプ用モータ61は、油圧ポンプ62を駆動するための電動モータである。制御装置50は、ポンプ用モータ61に制御信号を出力してポンプ用モータ61を介して油圧ポンプ62を駆動して、油圧を発生させることができる。制御バルブを介してスライドシリンダ(図示省略)に供給された作動油はマストをスライド駆動し、制御バルブを介してチルトシリンダ(図示省略)に供給された作動油はマストをチルト駆動し、制御バルブを介して昇降シリンダに供給された作動油はフォークを昇降させる。従って制御バルブや昇降シリンダは、マストに沿ってフォークを昇降させる昇降装置64に相当する。また、マストには、フォークの高さを検出する昇降位置検出装置63が設けられている。   The pump motor 61 is an electric motor for driving the hydraulic pump 62. The control device 50 can generate a hydraulic pressure by outputting a control signal to the pump motor 61 to drive the hydraulic pump 62 via the pump motor 61. The hydraulic oil supplied to the slide cylinder (not shown) via the control valve slides the mast, and the hydraulic oil supplied to the tilt cylinder (not shown) via the control valve tilts the mast, the control valve The hydraulic oil supplied to the elevating cylinder via the lowers raises and lowers the fork. Therefore, the control valve and the raising and lowering cylinder correspond to the raising and lowering device 64 for raising and lowering the fork along the mast. Further, the mast is provided with an elevation position detection device 63 for detecting the height of the fork.

通信装置30は、制御装置50から制御され、工場内等に予め設けられた受信設備90(図11参照)に向けて所定の情報を送信可能な装置である。例えば受信設備90は、工場内の製造ラインシステムの管理装置や制御盤や通信装置等を有しており、自動運転フォークリフト1から送信された情報を、通信装置を介して管理装置にて受信し、受信した情報を制御盤に表示することができる。報知装置40は、制御装置50から制御され、例えば報知表示ランプ、音声出力スピーカ、報知表示モニタ等、周囲の作業者に、自動運転フォークリフト1に異常が発生していることを報知する装置である。障害物検出装置21F、21B、22R、22L、上方障害物検出装置23R、23Lのそれぞれは、後述する平面状の検出領域をそれぞれ有し、検出領域内に存在する物体を障害物として検出し、検出信号を制御装置50に出力する。昇降位置検出装置63は、例えばマストに沿ったフォークの位置を検出する位置センサであり、フォーク60の高さに応じた検出信号を制御装置50に出力する。   The communication device 30 is a device which is controlled by the control device 50 and can transmit predetermined information to a reception facility 90 (see FIG. 11) provided in advance in a factory or the like. For example, the reception facility 90 includes a management device, a control panel, a communication device, and the like of a production line system in a factory, and receives information transmitted from the automatically operated forklift 1 by the management device via the communication device. The received information can be displayed on the control panel. The notification device 40 is a device that is controlled by the control device 50 and notifies, for example, a notification display lamp, an audio output speaker, a notification display monitor, and the like to surrounding workers that an abnormality has occurred in the automatically operated forklift 1. . Each of the obstacle detection devices 21F, 21B, 22R, 22L and the upper obstacle detection devices 23R, 23L has a planar detection area described later, and detects an object present in the detection area as an obstacle, The detection signal is output to the control device 50. The elevation position detection device 63 is, for example, a position sensor that detects the position of the fork along the mast, and outputs a detection signal corresponding to the height of the fork 60 to the control device 50.

制御装置50は、CPUと記憶装置を有しており、上述した各検出装置からの検出信号を取り込み、上述した各アクチュエータ(駆動モータ等)や報知装置40に制御信号を出力し、通信装置30を介して種々の情報を送受信する。   The control device 50 has a CPU and a storage device, takes in detection signals from the above-described detection devices, and outputs control signals to the above-described actuators (such as drive motors) and the notification device 40. Send and receive various information via

●[障害物検出装置の検出領域(図3、図4)]
障害物検出装置21F、21B、22R、22L、上方障害物検出装置23R、23Lは、いずれも同じ障害物センサであり、図3及び図4では、上方障害物検出装置23Rを例として説明する。図3は、上方障害物検出装置23Rの外観と、最大検出領域23RXの例を示しており、図4は、パーソナルコンピュータ等を用いて上方障害物検出装置23Rの最大検出領域23RX内において、所望する検出領域を指定している様子を示している。
● [Detection area of obstacle detection device (Figures 3 and 4)]
The obstacle detection devices 21F, 21B, 22R, 22L and the upper obstacle detection devices 23R, 23L are all the same obstacle sensor, and in FIGS. 3 and 4, the upper obstacle detection device 23R will be described as an example. FIG. 3 shows the appearance of the upper obstacle detection device 23R and an example of the maximum detection area 23RX. FIG. 4 shows a desired state in the maximum detection area 23RX of the upper obstacle detection device 23R using a personal computer or the like. It shows that the detection area to be selected is specified.

上方障害物検出装置23Rは、レーザ光を用いて2次元平面状の検出領域を有し、検出領域内の物体を検出可能である。例えば上方障害物検出装置23Rの検出領域の最大範囲となる最大検出領域23RXは、半径が約5[m]、中心角度が約270[°]の扇形である。上方障害物検出装置23Rまたは制御装置50には、複数の検出領域を設定(記憶)しておくことが可能である。作業者は、複数の検出領域を作成して上方障害物検出装置23Rまたは制御装置50に記憶させておき、制御装置50から検出領域の切り替えが可能である。作業者は、図4の例に示すように、パーソナルコンピュータ等にて検出領域作成用のプログラムを起動して、最大検出領域23RX内において所望する検出領域を指定(作成)することができる。   The upper obstacle detection device 23R has a two-dimensional planar detection area using laser light, and can detect an object in the detection area. For example, the maximum detection area 23RX, which is the maximum range of the detection area of the upper obstacle detection device 23R, is a fan having a radius of about 5 [m] and a center angle of about 270 [°]. A plurality of detection regions can be set (stored) in the upper obstacle detection device 23R or the control device 50. The worker creates a plurality of detection areas and stores them in the upper obstacle detection device 23R or the control device 50, and the control device 50 can switch the detection areas. As shown in the example of FIG. 4, the worker can start (detect) a desired detection area in the maximum detection area 23RX by activating a program for detecting the detection area on a personal computer or the like.

図4の例は、上方障害物検出装置23Rの最大検出領域23RX内において、減速領域23R1と停止領域23R2とを有する検出領域23R3を指定(作成)した例を示している。作業者は、作成した検出領域23R3を、上方障害物検出装置23Rや制御装置50に記憶させることができる。例えば作業者は、走行速度等の運転状態に応じた複数の検出領域を予め作成しておき、作成した複数の検出領域のそれぞれを、上方障害物検出装置23Rや制御装置50に記憶させることができる。   The example of FIG. 4 shows an example in which a detection area 23R3 having a deceleration area 23R1 and a stop area 23R2 is designated (created) in the maximum detection area 23RX of the upper obstacle detection device 23R. The worker can store the created detection area 23R3 in the upper obstacle detection device 23R or the control device 50. For example, the worker may create in advance a plurality of detection areas corresponding to the driving conditions such as the traveling speed, and store the plurality of detection areas thus created in the upper obstacle detection device 23R and the control device 50. it can.

●[障害物検出装置の配置位置と、検出領域のイメージ(図5)]
自動運転フォークリフト1の前下端に設けられた障害物検出装置21Fは、図5に示すように、例えば床面から100[mm]〜250[mm]の範囲内の高さに、車幅W1(または車幅よりも少し広い幅)を有して前方(X軸方向)に所定距離まで延びる平面状の検出領域21F3を有している。車体3の後下端に設けられた障害物検出装置21Bは、例えば床面から100[mm]〜250[mm]の範囲内の高さに、車幅W1(または車幅W1よりも少し広い幅)を有して後方(X軸方向とは反対方向)に所定距離まで延びる平面状の検出領域21B3を有している。検出領域21F3は、自動運転フォークリフト1から遠い側が減速領域21F1に設定され、自動運転フォークリフト1に近い側が停止領域21F2に設定されている。検出領域21B3は、自動運転フォークリフト1から遠い側が減速領域21B1に設定され、自動運転フォークリフト1に近い側が停止領域21B2に設定されている。
● [Position of obstacle detection device and image of detection area (Fig. 5)]
As shown in FIG. 5, the obstacle detection device 21F provided at the front lower end of the automatic forklift 1 has, for example, a vehicle width W1 (height in the range of 100 mm to 250 mm from the floor surface) Alternatively, it has a flat detection area 21F3 having a width slightly larger than the vehicle width and extending forward (in the X-axis direction) to a predetermined distance. The obstacle detection device 21B provided at the rear lower end of the vehicle body 3 has a width W1 (or a width slightly larger than the width W1), for example, at a height within a range of 100 mm to 250 mm from the floor surface. ) And has a planar detection area 21B3 extending backward (opposite to the X-axis direction) to a predetermined distance. The detection area 21F3 is set to the deceleration area 21F1 on the side far from the automatic driving forklift 1 and to the stop area 21F2 on the side close to the automatic driving forklift 1. The detection area 21B3 is set to the deceleration area 21B1 at the side far from the automatic driving forklift 1, and is set to the stop area 21B2 at the side closer to the automatic driving forklift 1.

車体3の右下端に設けられた障害物検出装置22Rは、図5に示すように、例えば床面から100[mm]〜250[mm]の範囲内の高さに、車体長さL1(または車体長さよりも少し長い長さ)を有して右方(Y軸方向とは反対方向)に所定距離まで延びる平面状の検出領域22R3を有している。車体3の左下端に設けられた障害物検出装置22Lは、例えば床面から100[mm]〜250[mm]の範囲内の高さに、車体長さL1を有して左方(Y軸方向)に所定距離まで延びる平面状の検出領域22L3を有している。検出領域22R3は、自動運転フォークリフト1から遠い側が減速領域22R1に設定され、自動運転フォークリフト1に近い側が停止領域22R2に設定されている。検出領域22L3は、自動運転フォークリフト1から遠い側が減速領域22L1に設定され、自動運転フォークリフト1に近い側が停止領域22L2に設定されている。   The obstacle detection device 22R provided at the lower right end of the vehicle body 3 has, for example, a vehicle length L1 (or a height within the range of 100 mm to 250 mm from the floor surface) as shown in FIG. It has a planar detection area 22R3 having a length slightly longer than the vehicle body length and extending to the right (a direction opposite to the Y-axis direction) to a predetermined distance. The obstacle detection device 22L provided at the lower left end of the vehicle body 3 has a vehicle length L1 at a height within a range of, for example, 100 mm to 250 mm from the floor surface to the left (Y axis Direction) and has a planar detection area 22L3 extending to a predetermined distance. The detection area 22R3 is set to the deceleration area 22R1 on the side far from the automatic driving forklift 1 and to the stop area 22R2 on the side close to the automatic driving forklift 1. The detection area 22L3 is set to the deceleration area 22L1 at the side far from the automatic driving forklift 1 and is set to the stop area 22L2 at the side close to the automatic driving forklift 1.

車体3(ヘッドガード9)の上右端に設けられた上方障害物検出装置23Rは、図5に示すように、後進した場合の進行方向(X軸方向とは反対方向)と鉛直方向とを含む平面状の検出領域23R3であって、床面よりも上方、かつ、自動運転フォークリフト1の上端の高さに応じた所定高さH1までの領域内であって後進の場合の進行方向における所定距離までの領域である検出領域23R3を有している。車体3(ヘッドガード9)の上左端に設けられた上方障害物検出装置23Lは、後進した場合の進行方向(X軸方向とは反対方向)と鉛直方向とを含む平面状の検出領域23L3であって、床面よりも上方、かつ、自動運転フォークリフト1の上端の高さに応じた所定高さH1までの領域内であって後進の場合の進行方向における所定距離までの領域である検出領域23L3を有している。また検出領域23R3、23L3は、後進の進行方向における車幅W1(または車幅よりも少し広い幅)内とされている。検出領域23R3は、自動運転フォークリフト1から遠い側が減速領域23R1に設定され、自動運転フォークリフト1に近い側が停止領域23R2に設定されている。検出領域23L3は、自動運転フォークリフト1から遠い側が減速領域23L1に設定され、自動運転フォークリフト1に近い側が停止領域23L2に設定されている。   The upper obstacle detection device 23R provided at the upper right end of the vehicle body 3 (head guard 9) includes, as shown in FIG. 5, a traveling direction (opposite to the X-axis direction) and a vertical direction when moving backward. A flat detection area 23R3 which is above the floor and within a range up to a predetermined height H1 according to the height of the upper end of the automatic operation forklift 1, and a predetermined distance in the direction of travel in the reverse direction It has a detection area 23R3 which is an area up to. The upper obstacle detection device 23L provided at the upper left end of the vehicle body 3 (head guard 9) is a planar detection area 23L3 including the traveling direction (opposite to the X-axis direction) and the vertical direction when moving backward. A detection area which is an area above the floor surface and up to a predetermined height H1 corresponding to the height of the upper end of the automatic forklift 1 and up to a predetermined distance in the traveling direction in the reverse direction. It has 23 L3. The detection areas 23R3 and 23L3 are within the vehicle width W1 (or a width slightly wider than the vehicle width) in the traveling direction of the reverse. The detection area 23R3 is set to the deceleration area 23R1 at the side far from the automatic driving forklift 1, and is set to the stop area 23R2 at the side closer to the automatic driving forklift 1. The detection area 23L3 is set to the deceleration area 23L1 at the side far from the automatic driving forklift 1, and is set to the stop area 23L2 at the side closer to the automatic driving forklift 1.

●[自動運転フォークリフト1の運転状態に応じた検出領域(図6〜図10)]
次に、自動運転フォークリフト1の運転状態に応じた検出領域の切り替えについて説明する。なお、図6〜図10では、進行方向(この場合、後進方向)における上方障害物検出装置23Lの検出領域23L3と障害物検出装置21Bの検出領域21B3のみを記載し、他の障害物検出装置21F、22R、22L、及び上方障害物検出装置23Rの検出領域については、記載を省略している。「運転状態」の具体的なものとしては、自動運転フォークリフト1の高さが変化する運転状態と、自動運転フォークリフト1の走行速度が変化する運転状態と、が有る。まず、自動運転フォークリフト1の高さが変化する運転状態について説明する。
● [Detection area according to the operating condition of the forklift truck 1 (Figures 6 to 10)]
Next, switching of the detection area in accordance with the operation state of the automatically operated forklift 1 will be described. 6 to 10, only the detection area 23L3 of the upper obstacle detection device 23L and the detection area 21B3 of the obstacle detection device 21B in the traveling direction (in this case, the backward direction) are described, and other obstacle detection devices The description of the detection regions 21F, 22R, 22L and the upper obstacle detection device 23R is omitted. Specific examples of the "operating state" include an operating state in which the height of the automatically operating forklift 1 changes and an operating state in which the traveling speed of the automatic operating forklift 1 changes. First, an operating state in which the height of the automatically operating forklift 1 changes will be described.

自動運転フォークリフトが搬入・搬出する荷物のサイズは予め判っており、制御装置50には、荷物高さHc(図6〜図8参照)が予め記憶されている。また、ヘッドガード9の高さであるヘッドガード高さHh(図6参照)も、予め判っており、制御装置50に記憶されている。さらに、図7に示すように、フォーク高さHfに応じて変化するマスト高さHmも、予め判っており、制御装置50に記憶されている。従って、制御装置50は、荷物aの有無、荷物aのサイズ(荷物高さHc)、フォーク高さHf、フォーク高さHfに応じて変化するマスト高さHm、ヘッドガード高さHh、に基づいて、最も高い最上端高さHmaxを求めることができる。例えば図6に示す例では、最上端高さHmax=ヘッドガード高さHhであり、図7に示す例では、最上端高さHmax=マスト高さHmであり、図8に示す例では、最上端高さHmax=高さHfc(フォーク高さHf+荷物高さHc)となる。なお、フォーク高さHf、フォーク高さHfに応じて変化するマスト高さHm、荷物aの有無、のそれぞれは「自動運転フォークリフト1の運転状態」の1つに相当している。   The size of the load carried in and out of the automatically operated forklift is known in advance, and the control device 50 stores in advance a load height Hc (see FIGS. 6 to 8). A head guard height Hh (see FIG. 6) which is the height of the head guard 9 is also known in advance and stored in the control device 50. Furthermore, as shown in FIG. 7, a mast height Hm that changes in accordance with the fork height Hf is also known in advance and stored in the control device 50. Therefore, the control device 50 is based on the presence or absence of the load a, the size of the load a (load height Hc), the fork height Hf, and the mast height Hm and the head guard height Hh which change according to the fork height Hf. Thus, the highest top end height Hmax can be determined. For example, in the example shown in FIG. 6, the top end height Hmax = head guard height Hh, and in the example shown in FIG. 7, the top end height Hmax = mast height Hm, and in the example shown in FIG. The upper end height Hmax = height Hfc (fork height Hf + load height Hc). Note that each of the fork height Hf, the mast height Hm that changes according to the fork height Hf, and the presence or absence of the luggage a corresponds to one of the “operation states of the automatically operated forklift 1”.

上方障害物検出装置23R、23L(図5参照)用の検出領域としては、最上端高さHmaxに応じて、複数の検出領域が、上方障害物検出装置23R、23Lや制御装置50に記憶されている。例えば上方障害物検出装置23Lの検出領域として、図6に示す最上端高さHmax=ヘッドガード高さHhに対応させて、ヘッドガード高さHhよりも少し高い検出領域高さH11(所定高さに相当)を有する検出領域23L3が、上方障害物検出装置23Lや制御装置50に記憶されている。同様に、図7に示す最上端高さHmax=マスト高さHmに対応させて、マスト高さHmよりも少し高い検出領域高さH12(所定高さに相当)を有する検出領域23L3が、上方障害物検出装置23Lや制御装置50に記憶されている。同様に、図8に示す最上端高さHmax=フォーク高さHf+荷物高さHcに対応させて、フォーク高さHf+荷物高さHcよりも少し高い検出領域高さH13(所定高さに相当)を有する検出領域23L3が、上方障害物検出装置23Lや制御装置50に記憶されている。また、上方障害物検出装置23Rの検出領域として、上記と同様の検出領域が、上方障害物検出装置23Rまたは制御装置50に記憶されている。なお、図6〜図8に示す検出領域23L3における床面からの高さH21〜H23は、例えば100[mm]〜250[mm]程度に設定されている。なお、障害物検出装置21Bの検出領域21B3は、進行方向(この場合、後進方向)の長さが、検出領域23L3と同等とされ、進行方向における減速領域21B1と停止領域21B2との境界位置は、進行方向における減速領域23L1と停止領域23L2との境界位置と同等とされている。   As the detection areas for the upper obstacle detection devices 23R and 23L (see FIG. 5), a plurality of detection areas are stored in the upper obstacle detection devices 23R and 23L and the control device 50 according to the top end height Hmax. ing. For example, as a detection area of the upper obstacle detection device 23L, a detection area height H11 (a predetermined height which is slightly higher than the head guard height Hh corresponding to the uppermost end height Hmax = head guard height Hh shown in FIG. And the upper obstacle detection device 23L and the control device 50. Similarly, a detection area 23L3 having a detection area height H12 (corresponding to a predetermined height) slightly higher than the mast height Hm is made to correspond to the uppermost end height Hmax = mast height Hm shown in FIG. It is stored in the obstacle detection device 23L and the control device 50. Similarly, in correspondence with the top end height Hmax = fork height Hf + load height Hc shown in FIG. 8, a detection area height H13 (corresponding to a predetermined height) slightly higher than the fork height Hf + load height Hc A detection area 23L3 having the above is stored in the upper obstacle detection device 23L and the control device 50. In addition, as the detection area of the upper obstacle detection device 23R, a detection area similar to the above is stored in the upper obstacle detection device 23R or the control device 50. The heights H21 to H23 from the floor surface in the detection area 23L3 shown in FIGS. 6 to 8 are set to, for example, about 100 [mm] to 250 [mm]. In the detection area 21B3 of the obstacle detection device 21B, the length in the traveling direction (in this case, the backward direction) is equal to that of the detection area 23L3, and the boundary position between the deceleration area 21B1 and the stop area 21B2 in the traveling direction is This is equivalent to the boundary position between the deceleration area 23L1 and the stop area 23L2 in the traveling direction.

次に、自動運転フォークリフト1の走行速度が変化する運転状態について説明する。上方障害物検出装置23R、23L(図5参照)用の検出領域としては、後進の際の走行速度に応じて、複数の検出領域が、上方障害物検出装置23R、23Lや制御装置50に記憶されている。例えば図9及び図10に示すように、走行速度(大)の場合(所定速度よりも速い場合)の上方障害物検出装置23Lの検出領域として、進行方向への検出領域長さL11(所定距離に相当)を有する比較的長い検出領域23L3が、上方障害物検出装置23Lまたは制御装置50に記憶されている。また、走行速度(小)の場合(所定速度よりも遅い場合)の上方障害物検出装置23Lの検出領域として、進行方向への検出領域長さL12(所定距離に相当)を有する比較的短い検出領域23L3が、上方障害物検出装置23Lまたは制御装置50に記憶されている。また、上方障害物検出装置23Rの検出領域として、上記と同様の検出領域が、上方障害物検出装置23Rまたは制御装置50に記憶されている。なお、障害物検出装置21Bの検出領域21B3は、進行方向(この場合、後進方向)の長さが、検出領域23L3と同等とされ、進行方向における減速領域21B1と停止領域21B2との境界位置は、進行方向における減速領域23L1と停止領域23L2との境界位置と同等とされている。   Next, an operating state in which the traveling speed of the automatically operating forklift 1 changes will be described. As the detection areas for the upper obstacle detection devices 23R and 23L (see FIG. 5), a plurality of detection areas are stored in the upper obstacle detection devices 23R and 23L or the control device 50 in accordance with the traveling speed at the time of reverse travel. It is done. For example, as shown in FIG. 9 and FIG. 10, as a detection area of the upper obstacle detection device 23L in the case of traveling speed (high) (when faster than a predetermined speed), detection area length L11 in the traveling direction (predetermined distance Of the upper obstacle detection device 23L or the control device 50. In addition, as a detection area of the upper obstacle detection device 23L in the case of a traveling speed (small) (when it is slower than a predetermined speed), a relatively short detection having a detection area length L12 (corresponding to a predetermined distance) in the traveling direction The area 23L3 is stored in the upper obstacle detection device 23L or the control device 50. In addition, as the detection area of the upper obstacle detection device 23R, a detection area similar to the above is stored in the upper obstacle detection device 23R or the control device 50. In the detection area 21B3 of the obstacle detection device 21B, the length in the traveling direction (in this case, the backward direction) is equal to that of the detection area 23L3, and the boundary position between the deceleration area 21B1 and the stop area 21B2 in the traveling direction is This is equivalent to the boundary position between the deceleration area 23L1 and the stop area 23L2 in the traveling direction.

つまり、上方障害物検出装置23R、23Lの検出領域として、図6〜図8の例に示した最上端高さHmaxに応じた複数の検出領域が、さらに、走行速度に応じて複数用意されて、上方障害物検出装置23R、23Lまたは制御装置50に記憶されている。また、図5に示す障害物検出装置21F、21B、22R、22Lのそれぞれの検出領域が、進行方向及び走行速度に応じて複数用意されて、障害物検出装置21F、21B、22R、22Lまたは制御装置50に記憶されている。   That is, as the detection areas of the upper obstacle detection devices 23R and 23L, a plurality of detection areas corresponding to the top end height Hmax shown in the examples of FIGS. , Upper obstacle detection devices 23R, 23L or the control device 50 are stored. Further, a plurality of detection areas for each of the obstacle detection devices 21F, 21B, 22R, 22L shown in FIG. 5 are prepared according to the traveling direction and the traveling speed, and the obstacle detection devices 21F, 21B, 22R, 22L or It is stored in the device 50.

●[誘導線の例と、走行経路の例(図11)]
図11は、誘導線が床面に張り巡らされた製造工場等の平面図の例を示している。図11においてXX軸とYY軸とZZ軸は互いに直交しており、ZZ軸方向は鉛直上方向を示し、XX軸方向とYY軸方向は水平方向を示している。床面には、図11におけるXX軸方向に沿って誘導線X1、X2が設けられており、図11におけるYY軸方向に誘導線Y1、Y2が設けられている。また図11では、誘導線X1と誘導線Y1とが交差する位置を交差点X1Y1、誘導線X1と誘導線Y2とが交差する位置を交差点X1Y2、誘導線X2と誘導線Y1とが交差する位置を交差点X2Y1、誘導線X2と誘導線Y2とが交差する位置を交差点X2Y2、にて示している。
● [Example of guide line and example of travel route (Fig. 11)]
FIG. 11 shows an example of a plan view of a manufacturing plant or the like in which a guiding wire is laid around a floor surface. In FIG. 11, the XX axis, the YY axis, and the ZZ axis are orthogonal to each other, the ZZ axis direction indicates a vertically upward direction, and the XX axis direction and the YY axis direction indicate a horizontal direction. On the floor surface, guide wires X1 and X2 are provided along the XX axis direction in FIG. 11, and guide wires Y1 and Y2 are provided in the YY axis direction in FIG. Further, in FIG. 11, the position where the induction line X1 and the induction line Y1 intersect is the intersection X1Y1, the position where the induction line X1 and the induction line Y2 intersect is the intersection X1Y2, the position where the induction line X2 and the induction line Y1 intersect. The intersection point X2Y1, the position where the induction line X2 intersects with the induction line Y2 is indicated by an intersection point X2Y2.

走行経路K1は、自動運転フォークリフト1の制御装置に予めプログラムされている。図11に点線にて示す走行経路K1の例では、自動運転フォークリフト1は、例えば以下のように走行する。なお、本実施の形態における自動運転フォークリフト1は、安全のために普段は後進し、荷物の搬入・搬出のときのみ前進するようにプログラムされている。
(1)誘導線X2の左端から荷物aを保持してスタートし、プログラムされた走行経路に基づいて、誘導線X2に沿って右方向に後進する。
(2)左マーカML1を検出して、プログラムされた走行経路に基づいて、次の交差点X2Y1にて左90°ターンして、誘導線Y1に沿って図11における上方向に後進する。
(3)停止マーカMS1を検出して、プログラムされた走行経路に基づいて、設備SE1の手前で180°方向転換して停止し、保持している荷物aを、加工受入部に降ろす(搬入する)。
(4)プログラムされた走行経路に基づいて、誘導線Y1に沿って図11における下方向に後進する。
(5)左マーカML2を検出して、プログラムされた走行経路に基づいて、次の交差点X1Y1にて左90°ターンして、誘導線X1に沿って図11における右方向に後進する。
(6)左マーカML3を検出して、プログラムされた走行経路に基づいて、次の交差点X1Y2にて左90°ターンして、誘導線Y2に沿って図11における上方向に後進する。
(7)停止マーカMS2を検出して、プログラムされた走行経路に基づいて、設備SE1の手前で180°方向転換して停止し、加工払出部の荷物bを保持する(搬出する)。
(8)プログラムされた走行経路に基づいて、誘導線Y2に沿って図11における下方向に後進する。
(9)左マーカML4を検出して、プログラムされた走行経路に基づいて、次の交差点X1Y2にて左90°ターンして、誘導線X1に沿って図11における右方向に後進する。
The travel route K1 is pre-programmed in the control device of the automatically operated forklift 1. In the example of the travel route K1 shown by a dotted line in FIG. 11, the autonomous driving forklift 1 travels, for example, as follows. The automated forklift 1 in the present embodiment is normally programmed to move backward for safety, and to move forward only when carrying in / out a load.
(1) Start holding the package a from the left end of the guiding line X2, and reverse the right direction along the guiding line X2 based on the programmed traveling path.
(2) The left marker ML1 is detected, and based on the programmed travel path, the vehicle turns 90 ° left at the next intersection point X2Y1 and reverses upward in FIG. 11 along the guiding line Y1.
(3) The stop marker MS1 is detected, the direction of 180 ° is changed and stopped in front of the equipment SE1 based on the programmed travel path, and the held load a is lowered to the processing receiving unit (imported ).
(4) Reverse the downward direction in FIG. 11 along the guiding line Y1 based on the programmed traveling route.
(5) The left marker ML2 is detected and turned 90 ° left at the next intersection point X1Y1 based on the programmed traveling route, and reverses rightward in FIG. 11 along the guiding line X1.
(6) The left marker ML3 is detected and turned 90 ° left at the next intersection point X1Y2 based on the programmed travel route, and reverses upward in FIG. 11 along the guiding line Y2.
(7) The stop marker MS2 is detected, the direction of 180 ° is changed and stopped in front of the equipment SE1 based on the programmed travel route, and the package b of the processing and dispensing unit is held (unloaded).
(8) Based on the programmed travel route, move backward along the guiding line Y2 in FIG.
(9) The left marker ML4 is detected and turned 90 ° left at the next intersection point X1Y2 based on the programmed travel route, and reverses rightward in FIG. 11 along the guiding line X1.

以上に説明した走行経路K1に従って走行する自動運転フォークリフト1は、前進または後進の進行方向に障害物を検出した場合、安全に停止させることが好ましい。以下では、図5に示す障害物検出装置21F、21B、22R、22L、上方障害物検出装置23R、23Lを用いて、進行方向における障害物を適切に検出し、安全に停止させるための制御装置50の処理手順の例について説明する。   It is preferable that the automatically operated forklift 1 traveling along the traveling path K1 described above safely stop when an obstacle is detected in the forward or reverse traveling direction. In the following, using the obstacle detection devices 21F, 21B, 22R, 22L, and the upper obstacle detection devices 23R, 23L shown in FIG. 5, a control device for appropriately detecting an obstacle in the traveling direction and safely stopping the obstacle. An example of the 50 processing procedures will be described.

●[制御装置50の処理手順(図12、図13)]
次に図12及び図13を用いて、制御装置50の処理手順について説明する。制御装置50は、例えば所定時間間隔(例えば数[ms]〜数10[ms]間隔)にて、図12に示す処理を起動し、起動するとステップS10へと処理を進める。なお、図12及び図13に示す処理は、誘導線やマーカ等に従った自動運転の動作(ステップS36C、36B、SUB130A等)も含んでいるが、自動運転の詳細については説明を省略する。
[Processing procedure of control device 50 (FIG. 12, FIG. 13)]
Next, the processing procedure of the control device 50 will be described using FIGS. 12 and 13. The control device 50 activates the process shown in FIG. 12 at predetermined time intervals (for example, several [ms] to several 10 [ms] intervals), and advances the process to step S10 when activated. Although the process shown in FIGS. 12 and 13 includes the operation of the automatic operation (steps S36C, 36B, SUB 130A, etc.) according to the guide wire, the marker, etc., the description of the details of the automatic operation will be omitted.

ステップS10にて制御装置50は、駆動モータの回転方向と回転速度から自動運転フォークリフトの進行方向と走行速度を検出して記憶し、荷物検出装置の検出信号に基づいて荷物の有無を検出して記憶し、昇降位置検出装置からの検出信号に基づいてフォーク高さを検出して記憶する。そして制御装置50は、上述した最上端高さHmaxを求めて記憶し、ステップS12へと処理を進める。   In step S10, the control device 50 detects and stores the traveling direction and traveling speed of the automatically operated forklift from the rotational direction and rotational speed of the drive motor, and detects the presence or absence of the luggage based on the detection signal of the luggage detection device. The fork height is detected and stored based on the detection signal from the elevation position detection device. Then, the control device 50 obtains and stores the top end height Hmax described above, and advances the process to step S12.

ステップS12にて制御装置50は、自動運転フォークリフト1の進行方向と走行速度、及び最上端高さHmax(図6〜図8参照)に基づいて、各障害物検出装置の検出領域を選択して、ステップS14へと処理を進める。なお、各障害物検出装置とは、図5に示す障害物検出装置21F、21B、22R、22L、上方障害物検出装置23R、23Lを指す。   In step S12, the control device 50 selects the detection region of each obstacle detection device based on the traveling direction and traveling speed of the automatically operated forklift 1 and the top end height Hmax (see FIGS. 6 to 8). The process proceeds to step S14. The obstacle detection devices refer to the obstacle detection devices 21F, 21B, 22R, 22L and the upper obstacle detection devices 23R, 23L shown in FIG.

ステップS14にて制御装置50は、選択した各検出領域を用いて、各障害物検出装置を動作させ、ステップS16へと処理を進める。なお、各障害物検出装置とは、図5に示す障害物検出装置21F、21B、22R、22L、上方障害物検出装置23R、23Lを指す。   In step S14, the control device 50 operates each obstacle detection device using each selected detection area, and advances the process to step S16. The obstacle detection devices refer to the obstacle detection devices 21F, 21B, 22R, 22L and the upper obstacle detection devices 23R, 23L shown in FIG.

ステップS16にて制御装置50は、各障害物検出装置からの検出信号を取得して、ステップS20へと処理を進める。   In step S16, the control device 50 acquires detection signals from each obstacle detection device, and advances the process to step S20.

ステップS20にて制御装置50は、いずれかの障害物検出装置(少なくとも1つの障害物検出装置)にて停止領域に障害物を検出したか否かを判定し、いずれかの障害物検出装置の停止領域に障害物を検出している場合(Yes)はステップS24Cに処理を進め、すべての障害物検出装置の停止領域に障害物を検出していない場合(No)はステップS22に処理を進める。なお、自動運転フォークリフトは、上述したように、安全のため、普段の進行方向は後進であり、荷物の搬入・搬出を行うときのみ前進としている。従って、進行方向が前進の場合は、荷物の搬入・搬出を行っている場合であるので、この場合では、障害物検出装置21F(前下端に配置した障害物検出装置、図5参照)にて検出した障害物は無視する。あるいは、荷役時用の停止領域21F2(図5参照)として、荷役時において棚などの障害物まで接近する距離よりも短い距離や狭い範囲とした荷役用停止領域を用意して、予め障害物検出装置21F(図5参照)や制御装置50に記憶させておき、荷役時における停止領域21F2(図5参照)を、荷役用停止領域に切り替えるようにしてもよい。   In step S20, the control device 50 determines whether any obstacle detection device (at least one obstacle detection device) has detected an obstacle in the stop area, and one of the obstacle detection devices is detected. If an obstacle is detected in the stop area (Yes), the process proceeds to step S24C. If no obstacle is detected in the stop area of all obstacle detection devices (No), the process proceeds to step S22. . In addition, as described above, in order to be safe, the automatically driven forklift normally travels in the reverse direction, and is advanced only when carrying in / out the load. Therefore, when the traveling direction is forward, it is a case where carrying in / out of the package is performed, and in this case, in the obstacle detection device 21F (an obstacle detection device disposed at the front lower end, see FIG. 5) Ignore detected obstacles. Alternatively, as the stop area 21F2 for cargo handling (see FIG. 5), prepare a stop area for cargo handling with a distance or a narrower range shorter than the distance to approach an obstacle such as a shelf at the time of cargo handling. The stop area 21F2 (see FIG. 5) at the time of loading may be switched to the loading stop area by storing in the device 21F (see FIG. 5) or the control device 50.

ステップS22に処理を進めた場合、制御装置50は、いずれかの障害物検出装置(少なくとも1つの障害物検出装置)にて減速領域に障害物を検出したか否かを判定し、いずれかの障害物検出装置の減速領域に障害物を検出している場合(Yes)はステップS24Bに処理を進め、すべての障害物検出装置の減速領域に障害物を検出していない場合(No)はステップS24Aに処理を進める。なお、自動運転フォークリフトは、上述したように、安全のため、普段の進行方向は後進であり、荷物の搬入・搬出を行うときのみ前進としている。従って、進行方向が前進の場合は、荷物の搬入・搬出を行っている場合であるので、この場合では、障害物検出装置21F(前下端に配置した障害物検出装置、図5参照)にて検出した障害物は無視する。   When the process proceeds to step S22, the control device 50 determines whether or not an obstacle is detected in the deceleration area with any obstacle detection device (at least one obstacle detection device), and any one of If an obstacle is detected in the deceleration area of the obstacle detection device (Yes), the process proceeds to step S24B, and if an obstacle is not detected in the deceleration area of all obstacle detection devices (No), the step The process proceeds to S24A. In addition, as described above, in order to be safe, the automatically driven forklift normally travels in the reverse direction, and is advanced only when carrying in / out the load. Therefore, when the traveling direction is forward, it is a case where carrying in / out of the package is performed, and in this case, in the obstacle detection device 21F (an obstacle detection device disposed at the front lower end, see FIG. 5) Ignore detected obstacles.

ステップS24Aに処理を進めた場合、制御装置50は、運転制限(例えばRAM)に「制限なし」を記憶してステップS30へと処理を進める。   When the process proceeds to step S24A, the control device 50 stores "no restriction" in the operation restriction (for example, the RAM), and proceeds the process to step S30.

ステップS24Bに処理を進めた場合、制御装置50は、運転制限に「減速」を記憶してステップS30へと処理を進める。   When the process proceeds to step S24B, control device 50 stores "deceleration" in the operation restriction, and proceeds the process to step S30.

ステップS24Cに処理を進めた場合、制御装置50は、運転制限に「停止」を記憶してステップS30へと処理を進める。   When the process proceeds to step S24C, the control device 50 stores "stop" in the operation restriction and proceeds the process to step S30.

ステップS30に処理を進めた場合、制御装置50は、走行経路K1(図11参照)に沿った自身の位置に応じた目標走行速度を算出してステップS32へと処理を進める。   When the process proceeds to step S30, control device 50 calculates a target traveling speed according to the position of itself along traveling path K1 (see FIG. 11), and proceeds the process to step S32.

ステップS32にて制御装置50は、運転制限に「停止」が記憶されているか否かを判定し、「停止」が記憶されている場合(Yes)はステップS36Cに処理を進め、「停止」が記憶されていない場合(No)はステップS34へと処理を進める。   In step S32, control device 50 determines whether or not "stop" is stored in the operation restriction, and if "stop" is stored (Yes), the process proceeds to step S36C, and "stop" is If not stored (No), the process proceeds to step S34.

ステップS34に処理を進めた場合、制御装置50は、運転制限に「減速」が記憶されているか否かを判定し、「減速」が記憶されている場合(Yes)はステップS36Bへと処理を進め、「減速」が記憶されていない場合(No)はステップS36Aへと処理を進める。   If the process proceeds to step S34, the control device 50 determines whether "deceleration" is stored in the operation restriction, and if "deceleration" is stored (Yes), the process proceeds to step S36B. If the "deceleration" is not stored (No), the process proceeds to step S36A.

ステップS36Aに処理を進めた場合、制御装置50は、図13に示す「SUB100」の処理を実行してステップS40へと処理を進める。なお、SUB100の処理の詳細については後述する。   When the process proceeds to step S36A, control device 50 executes the process of "SUB 100" shown in FIG. 13 and proceeds the process to step S40. The details of the processing of the SUB 100 will be described later.

ステップS36Bに処理を進めた場合、制御装置50は、自動運転フォークリフトの走行速度が、目標走行速度よりも低い速度であって安全に停止することが可能な速度である徐行速度等となるように、走行速度を徐々に減速させながら、誘導線、マーカ等に従った自動運転を行い、ステップS38Bへと処理を進める。つまり、制御装置50は、減速領域に障害物を検出した場合、自動運転フォークリフトの走行速度を、徐行速度等に減速させるように駆動モータ(駆動装置)を制御する。   When the process proceeds to step S36B, control device 50 causes the traveling speed of the automatically operated forklift to be a slowing speed or the like which is a speed lower than the target traveling speed and which can be safely stopped. While gradually reducing the traveling speed, automatic operation is performed according to the guide wire, marker, etc., and the process proceeds to step S38B. That is, when an obstacle is detected in the deceleration region, the control device 50 controls the drive motor (drive device) so as to reduce the traveling speed of the automatically operated forklift to a creeping speed or the like.

ステップS38Bにて制御装置50は、報知装置40に「減速」状態であることを示す報知信号を出力させ、ステップS40へと処理を進める。例えば報知装置40が、ランプやスピーカ等を有している場合、長い周期でランプを点滅させたり、「減速します」と音声出力したりする。   At step S38B, control device 50 causes notification device 40 to output a notification signal indicating that it is in the "deceleration" state, and the process proceeds to step S40. For example, when the notification device 40 has a lamp, a speaker, or the like, it blinks the lamp in a long cycle or outputs a voice as "decelerate".

ステップS36Cに処理を進めた場合、制御装置50は、自動運転フォークリフトが走行を停止するように減速させながら、誘導線、マーカ等に従った自動運転を行い、ステップS38Cへと処理を進める。つまり、制御装置50は、停止領域に障害物を検出した場合、自動運転フォークリフトの走行を、停止させるように駆動モータ(駆動装置)を制御する。   When the process proceeds to step S36C, the control device 50 performs the automatic operation according to the guiding wire, the marker, and the like while decelerating so that the automatically operated forklift stops traveling, and proceeds the process to step S38C. That is, when an obstacle is detected in the stop area, the control device 50 controls the drive motor (drive device) so as to stop the traveling of the automatically operated forklift.

ステップS38Cにて制御装置50は、報知装置40に「停止」状態であることを示す報知信号を出力させ、ステップS40へと処理を進める。例えば報知装置40が、ランプやスピーカ等を有している場合、「減速」状態よりも短い周期でランプを点滅させたり、「停止します」と音声出力したりする。   At step S38C, control device 50 causes notification device 40 to output a notification signal indicating that the state is the "stop" state, and the process proceeds to step S40. For example, when the notification device 40 has a lamp, a speaker, or the like, it blinks the lamp in a cycle shorter than that in the "deceleration" state, or outputs a voice "stop".

ステップS40に処理を進めた場合、制御装置50は、運転制限に「停止」が記憶されており、かつ、自動運転フォークリフトの走行速度がゼロ(走行停止状態)であるか否かを判定し、条件を満足している場合(Yes)はステップS42へと処理を進め、条件を満足していない場合(No)はステップS48へと処理を進める。   When the process proceeds to step S40, the control device 50 determines whether “stop” is stored in the operation restriction and whether the traveling speed of the automatically operated forklift is zero (the traveling stop state), If the condition is satisfied (Yes), the process proceeds to step S42. If the condition is not satisfied (No), the process proceeds to step S48.

ステップS42に処理を進めた場合、制御装置50は、復帰タイマ(RAM)をリセットしてステップS43へと処理を進める。ステップS43にて制御装置50は、送信タイマ(RAM)をカウントしてステップS44へと処理を進める。   When the process proceeds to step S42, the control device 50 resets the recovery timer (RAM) and proceeds the process to step S43. At step S43, control device 50 counts the transmission timer (RAM) and advances the process to step S44.

ステップS44にて制御装置50は、送信タイマが、送信待ち時間を超えているか否かを判定し、送信待ち時間を超えている場合(Yes)はステップS46へと処理を進め、送信待ち時間を超えていない場合(No)は処理を終了する。ステップS44にて、制御装置50は、設定した送信待ち時間に応じて、例えば、数秒毎に異常情報を受信設備に送信することができる。   At step S44, control device 50 determines whether or not the transmission timer exceeds the transmission waiting time. If it exceeds the transmission waiting time (Yes), the process proceeds to step S46 to set the transmission waiting time to If it does not exceed (No), the process ends. In step S44, the control device 50 can transmit abnormality information to the receiving equipment, for example, every several seconds, in accordance with the set transmission waiting time.

ステップS46に処理を進めた場合、制御装置50は、自身が搭載されている自動運転フォークリフトの識別情報(台車番号など)、走行経路K1(図11参照)上における停止位置に関する位置情報、障害物を検出して走行停止していることを示す停止情報等を含む異常情報を作成し、作成した異常情報を、通信装置30(図2参照)を介して無線にて、受信設備90(図11参照)に送信し、ステップS48へと処理を進める。   When the process proceeds to step S46, the control device 50 identifies the identification information (such as the bogie number) of the automatically operated forklift on which the control device 50 is mounted, the position information on the stop position on the traveling route K1 (see FIG. 11), the obstacle Detection information indicating that the vehicle has stopped traveling and the like are created, and the created anomaly information is wirelessly transmitted via the communication device 30 (see FIG. 2) to the receiving facility 90 (FIG. 11). (See reference) and the process proceeds to step S48.

ステップS48に処理を進めた場合、制御装置50は、送信タイマをリセットして処理を終了する。   When the process proceeds to step S48, the control device 50 resets the transmission timer and ends the process.

●[SUB100の処理の詳細(図13)]
次に図13を用いて、図12のフローチャート中におけるステップS36Aの「SUB100」の処理の詳細について説明する。
[Details of processing of SUB 100 (FIG. 13)]
Next, with reference to FIG. 13, the details of the process of “SUB 100” in step S36A in the flowchart of FIG. 12 will be described.

SUB100に処理を進めた場合、制御装置50は、図13に示すステップSUB110へと処理を進める。SUB110にて制御装置50は、復帰タイマをカウントしてステップSUB115へと処理を進める。   When the process proceeds to SUB 100, control device 50 proceeds to step SUB 110 shown in FIG. At SUB 110, the control device 50 counts the recovery timer and advances the process to step SUB 115.

ステップSUB115にて制御装置50は、復帰タイマが、第1復帰待機時間未満であるか否かを判定し、第1復帰待機時間未満である場合(Yes)はステップSUB130Cへと処理を進め、第1復帰待機時間以上である場合(No)はステップSUB120へと処理を進める。   At step SUB115, the control device 50 determines whether or not the recovery timer is less than the first recovery standby time, and if it is less than the first recovery standby time (Yes), the process proceeds to step SUB130C. If 1 return waiting time or more (No), the process proceeds to step SUB120.

ステップSUB120に処理を進めた場合、制御装置50は、復帰タイマが、第1復帰待機時間よりも長い第2復帰待機時間未満であるか否かを判定し、第2復帰待機時間未満である場合(Yes)はステップSUB130Bへと処理を進め、第2復帰待機時間以上である場合(No)はステップSUB130Aへと処理を進める。   When the process proceeds to step SUB120, the control device 50 determines whether the return timer is less than the second return standby time longer than the first return standby time, and is less than the second return standby time (Yes) proceeds the process to step SUB130B, and if it is not less than the second return waiting time (No), the process proceeds to step SUB130A.

ステップSUB130Cに処理を進めた場合は、走行を停止した後に運転制限が「制限なし」となってからの経過時間が第1復帰待機時間未満の期間であり、制御装置50は、走行停止を維持してステップSUB135Cへと処理を進める。   If the process proceeds to step SUB130C, the elapsed time from the operation restriction becoming “no restriction” after stopping the traveling is a period less than the first return waiting time, and the control device 50 maintains the traveling stop Then, the process proceeds to step SUB135C.

ステップSUB135Cにて制御装置50は、報知装置40に「停止」状態であることを示す報知信号を出力させ、リターンする(図12のステップS40へ処理を進める)。例えば報知装置40が、ランプやスピーカ等を有している場合、「減速」状態よりも短い周期でランプを点滅させ、「障害物が無くなりました。」と音声出力したりする。   At step SUB135C, the control device 50 causes the notification device 40 to output a notification signal indicating the "stop" state, and returns (returns the process to step S40 of FIG. 12). For example, when the notification device 40 has a lamp, a speaker, or the like, it blinks the lamp in a cycle shorter than that in the "deceleration" state, and outputs an audio as "an obstacle is lost".

ステップSUB130Bに処理を進めた場合は、走行を停止した後に運転制限が「制限なし」となってからの経過時間が第1復帰待機時間以上かつ第2復帰待機時間未満の期間であり、制御装置50は、走行停止を維持してステップSUB135Bへと処理を進める。   If the process proceeds to step SUB130B, the elapsed time since the driving restriction is “no restriction” after stopping the traveling is a period equal to or more than the first return standby time and less than the second return standby time, and the control device 50 keeps the traveling stop and advances the process to step SUB135B.

ステップSUB135Bにて制御装置50は、報知装置40に「停止」状態であることを示す報知信号を出力させ、走行開始を予告する音声を出力してリターンする(図12のステップS40へ処理を進める)。例えば報知装置40が、ランプやスピーカ等を有している場合、「減速」状態よりも短い周期でランプを点滅させ、「走行を開始します。注意してください。」と音声出力したりする。   At step SUB135B, control device 50 causes notification device 40 to output a notification signal indicating that the vehicle is in the “stop” state, outputs a voice for giving a notice of the start of traveling, and returns (return to step S40 in FIG. 12) ). For example, when the notification device 40 has a lamp, a speaker, etc., the lamp blinks in a cycle shorter than that in the "deceleration" state, and outputs an audio message such as "Start running. .

ステップSUB130Aに処理を進めた場合は、走行を停止した後に運転制限が「制限なし」となってからの経過時間が第2復帰待機時間以上の期間であり、制御装置50は、目標速度に向けて走行を開始して、誘導線、マーカ等に従って自動運転して、ステップSUB135Aへと処理を進める。   If the process proceeds to step SUB130A, the elapsed time from the operation restriction becoming “no restriction” after stopping the traveling is a period longer than the second return standby time, and the control device 50 proceeds to the target speed. Driving is started, and automatic operation is performed according to the guide line, marker, etc., and the process proceeds to step SUB135A.

ステップSUB135Aにて制御装置50は、報知装置40からの報知出力を解除してリターンする(図12のステップS40へ処理を進める)。例えば報知装置40の、ランプやスピーカ等を有している場合、これらからの出力を停止させる。   In step SUB135A, the control device 50 cancels the notification output from the notification device 40 and returns (the process proceeds to step S40 in FIG. 12). For example, when the notification device 40 has a lamp, a speaker, and the like, the output from these is stopped.

以上に説明したように、SUB100の処理では、制御装置50は、障害物を検出して走行停止している状態から、障害物が無くなって走行を再開する際、即座に走行を再開するのでなく、障害物が無くなってから第1復帰待機時間の間では、障害物が無くなったことを報知する(ステップSUB135C)が停止状態を維持する。そして、第1復帰待機時間から第2復帰待機時間の間では、走行の再開を予告する走行再開予告報知をする(ステップSUB135B)が停止状態を維持する。これにより、周囲の作業者に対して安全に走行を再開することができる。   As described above, in the processing of the SUB 100, the control device 50 does not immediately restart traveling when resuming traveling when the obstacle disappears from the state where traveling is stopped after detecting the obstacle. During the first return waiting time after the obstacle disappears, a notification that the obstacle disappears (step SUB 135C) maintains the stop state. Then, between the first return standby time and the second return standby time, the travel resumption notice for notifying resumption of travel is notified (step SUB135B), but the stopped state is maintained. Thus, traveling can be safely resumed for surrounding workers.

以上に説明した処理手順により、例えば走行経路の側方から、床面に接触することなく所定高さで走行経路の側へと突出した障害物が存在する場合、自動運転フォークリフト1は、図14〜図16に示すように自律走行する。なお、図14〜図16では、進行方向(この場合、後進方向)における上方障害物検出装置23Lの検出領域23L3と障害物検出装置21Bの検出領域21B3のみを記載し、他の障害物検出装置21F、22R、22L、及び上方障害物検出装置23Rの検出領域については、記載を省略している。図14に示すように、走行速度が大きい場合(例えば所定速度以上の目標速度)では、制御装置は、進行方向への長さL21が長い検出領域23L3を用いて障害物を検出する。減速領域23L1にて障害物を検出した場合(障害物が減速領域23L1に達した場合)、図15に示すように、制御装置は、走行速度を徐行速度に向けて減速し、走行速度が小さくなった場合(所定速度未満)では、進行方向への長さL22が短い検出領域23L3を用いて障害物を検出する。そして停止領域23L2にて障害物を検出した場合(障害物が停止領域23L2に達した場合)、図16に示すように、制御装置は、自動運転フォークリフト1を徐行速度から安全に停止させる。以上に説明したように、本実施の形態にて説明した自動運転フォークリフト1は、障害物となり得るすべてのものにRFIDタグを持たせる等の処置が不要で手間がなく、かつ、進行方向に存在する種々の障害物を適切に検出し、より安全な自動運転フォークリフトを実現することができる。   According to the processing procedure described above, for example, when there is an obstacle projecting to the side of the traveling route at a predetermined height without contacting the floor surface from the side of the traveling route, the automatically operating forklift 1 is shown in FIG. The vehicle travels autonomously as shown in FIG. 14 to 16, only the detection area 23L3 of the upper obstacle detection device 23L and the detection area 21B3 of the obstacle detection device 21B in the traveling direction (in this case, the backward direction) are described, and other obstacle detection devices The description of the detection regions 21F, 22R, 22L and the upper obstacle detection device 23R is omitted. As shown in FIG. 14, when the traveling speed is high (for example, a target speed equal to or higher than a predetermined speed), the control device detects an obstacle using the detection area 23L3 in which the length L21 in the traveling direction is long. When an obstacle is detected in the deceleration area 23L1 (when the obstacle reaches the deceleration area 23L1), as shown in FIG. 15, the control device decelerates the traveling speed toward the creeping speed, and the traveling speed is small. If it becomes (less than the predetermined speed), the obstacle is detected using the detection area 23L3 having a short length L22 in the traveling direction. Then, when an obstacle is detected in the stop area 23L2 (when the obstacle reaches the stop area 23L2), as shown in FIG. 16, the control device safely stops the automatically operating forklift 1 from the creeping speed. As described above, the automatically operated forklift 1 described in the present embodiment does not require any treatment such as providing an RFID tag to all possible obstacles, hassle-free operation, and exists in the traveling direction It is possible to properly detect various obstacles and realize safer automated forklifts.

また、障害物を検出して走行停止した自動運転フォークリフトから送信される異常情報には、自動運転フォークリフトの識別情報(台車番号など)、走行経路K1(図11参照)上における停止位置に関する位置情報、走行を停止していることを示す停止情報等が含まれている。障害物を検出して走行停止している自動運転フォークリフトは、速やかに復旧される(走行が再開される)べきである。作業者は、図11に示す受信設備90にて、走行停止している自動運転フォークリフトからの異常情報を確認することで、どの自動運転フォークリフトが、どこで停止しているか、を確認することができるので、速やかに自動運転フォークリフトを復旧させることができる。   Further, in the abnormality information transmitted from the automatically driven forklift which has detected the obstacle and stopped to travel, identification information (such as a bogie number) of the automatically operated forklift and position information on the stop position on the traveling route K1 (see FIG. 11) And stop information indicating that the vehicle is stopped. The automatically operated forklift that has detected an obstacle and stopped traveling should be restored promptly (restarting traveling). The operator can confirm which automatically operated forklift is stopped where by using the receiving equipment 90 shown in FIG. 11 to confirm the abnormality information from the automatically operated forklift whose traveling is stopped. Therefore, it is possible to quickly restore the forklift for automatic operation.

本発明の自動運転フォークリフト1は、本実施の形態で説明した構成、構造、外観、形状、処理手順等に限定されず、本発明の要旨を変更しない範囲で種々の変更、追加、削除が可能である。   The automated forklift 1 of the present invention is not limited to the configuration, structure, appearance, shape, processing procedure, etc. described in the present embodiment, and various changes, additions, and deletions can be made without departing from the scope of the present invention. It is.

本実施の形態の説明では、上方障害物検出装置23R、23Lを、後方に向けて配置した例を説明したが、フォークや荷物に検出領域が遮断されないようにブラケット等を用いて、前方に向けて適切な位置に配置するようにしてもよい。また本実施の形態の説明では、上方障害物検出装置23R、23Lを左右両端に一対で設けた例を説明したが、例えば自動運転フォークリフトが壁に沿って移動する走行経路の場合、壁と反対側のみに上方障害物検出装置を設ければよい。   Although the upper obstacle detection devices 23R and 23L are disposed rearwardly in the description of the present embodiment, they are directed forward using a bracket or the like so that the detection area is not blocked by forks or luggage. It may be arranged at an appropriate position. Although the upper obstacle detection devices 23R and 23L are provided as a pair at the left and right ends in the description of the present embodiment, for example, in the case of a traveling route along which an autonomous forklift moves along a wall, the opposite to the wall An upper obstacle detection device may be provided only on the side.

本実施の形態の説明では、上方障害物検出装置の検出領域を、減速領域と停止領域に分けた例を説明したが、減速領域と停止領域を分けず、検出領域に障害物を検出した場合に、自動運転フォークリフト1を停止させる(徐々に減速して停止させる)ようにしてもよい。また、本実施の形態の説明では、上方障害物検出装置の検出領域を、自動運転フォークリフト1の運転状態に応じて切り替える例を説明したが、検出領域を切り替えないようにしてもよい。   In the description of the present embodiment, an example in which the detection area of the upper obstacle detection device is divided into the deceleration area and the stop area has been described, but an obstacle is detected in the detection area without dividing the deceleration area and the stop area. Alternatively, the automatically operating forklift 1 may be stopped (the vehicle may be gradually decelerated and stopped). Moreover, although the example which switches the detection area | region of an upper obstacle detection apparatus according to the driving | running state of the automatic-operation forklift 1 was demonstrated in description of this Embodiment, you may make it not switch a detection area.

本実施の形態にて説明した自動運転フォークリフト1は、無人で自律走行可能であるが、車体3の運転席に乗員検出装置(例えば、運転席の床面に設けた重量検知センサ)を設け、乗員を検出した場合に自律走行を停止して乗員の操作に従う、無人及び有人で走行可能な自動運転フォークリフトとしてもよい。   Although the autonomous driving forklift 1 described in the present embodiment is capable of autonomously traveling autonomously, the driver's seat of the vehicle body 3 is provided with an occupant detection device (for example, a weight detection sensor provided on the floor surface of the driver's seat) When a passenger is detected, the autonomous traveling may be stopped to be an unmanned and manned self-driven forklift which stops according to the operation of the passenger.

また、本発明の自動運転フォークリフト1は、製造工場内での製品または部品の搬送の利用に限定されず、種々の用途で利用される種々の自動運転フォークリフト1に適用することが可能である。   Moreover, the automatic driving forklift 1 of the present invention is not limited to the use of transportation of products or parts in a manufacturing plant, and can be applied to various automatic driving forklifts 1 used in various applications.

また、本実施の形態の説明に用いた数値は一例であり、この数値に限定されるものではない。   Further, the numerical values used in the description of the present embodiment are an example, and the present invention is not limited to these numerical values.

1 自動運転フォークリフト
1J 中心軸線
2A 前側誘導線検出装置
2Ac 前側検出装置中心
2B 後側誘導線検出装置
2Bc 後側検出装置中心
2C 荷物検出装置
2L 左マーカ検出装置
2R 右マーカ検出装置
3 車体
8C キャスタ輪
8D 駆動操舵輪
8L 左従動輪
8R 右従動輪
9 ヘッドガード
10 リーチレグ
21F、21B、22R、22L 障害物検出装置
21F1、21B1、22R1、22L1 減速領域
21F2、21B2、22R2、22L2 停止領域
21F3、21B3、22R3、22L3 検出領域
23R、23L 上方障害物検出装置
23R1、23L1 減速領域
23R2、23L2 停止領域
23R3、23L3 検出領域
23RX 最大検出領域
30 通信装置
40 報知装置
50 制御装置
51 駆動モータ(駆動装置)
52 操舵モータ
60 フォーク
61 ポンプ用モータ
62 油圧ポンプ
63 昇降位置検出装置
64 昇降装置
70 マスト
90 受信設備
a、b 荷物
H11、H12、H13 検出領域高さ(所定高さ)
Hc 荷物高さ
Hf フォーク高さ
Hh ヘッドガード高さ
Hm マスト高さ
Hmax 最上端高さ
K1 走行経路
L11、L12 検出領域長さ(所定距離)
ML1〜ML4 左マーカ
MS1、MS2 停止マーカ
SE1 設備
X1、X2 誘導線
Y1、Y2 誘導線
X1Y1、X1Y2、X2Y1、X2Y2 交差点

1 Automatic Operation Forklift 1J Center Axis 2A Front Guide Line Detector 2Ac Front Detection Center 2B Rear Guide Line Detection 2Bc Rear Side Detection Center 2C Package Detection Unit 2L Left Marker Detection Unit 2R Right Marker Detection Unit 3 Car Body 8C Castor Wheel 8D Drive steering wheel 8L Left driven wheel 8R Right driven wheel 9 Head guard 10 Reach leg 21F, 21B, 22R, 22L Obstacle detection device 21F1, 21B1, 22R1, 22L1 Deceleration area 21F2, 21B2, 22R2, 22L2 Stop area 21F3, 21B3, 22R3, 22L3 detection area 23R, 23L upper obstacle detection device 23R1, 23L1 deceleration area 23R2, 23L2 stop area 23R3, 23L3 detection area 23RX maximum detection area 30 communication device 40 notification device 50 control device 51 drive motor Drive)
52 Steering motor 60 Fork 61 Pump motor 62 Hydraulic pump 63 Lifting position detection device 64 Lifting device 70 Mast 90 Reception facility a, b Luggage H11, H12, H13 Detection area height (predetermined height)
Hc Luggage height Hf Fork height Hh Head guard height Hm Mast height Hmax Top end height K1 Travel path L11, L12 Detection area length (predetermined distance)
ML1 to ML4 Left marker MS1, MS2 Stop marker SE1 Equipment X1, X2 Leading wire Y1, Y2 Leading wire X1Y1, X1Y2, X2Y1, X2Y2 Intersection

Claims (9)

無人で自律走行可能な自動運転フォークリフトであって、
前記自動運転フォークリフトの前進または後進の進行方向における車幅内において、床面よりも上方、かつ、前記自動運転フォークリフトの上端の高さに応じた所定高さまでの検出領域内であって進行方向における所定距離までの前記検出領域内に、前記自動運転フォークリフトと干渉する障害物が有るか否かを検出可能な上方障害物検出装置と、
報知装置と、
前記上方障害物検出装置を用いて障害物を検出した場合、前記報知装置を用いて報知する制御装置と、
を有している、
自動運転フォークリフト。
It is an unmanned autonomous forklift that can travel autonomously,
Within the vehicle width in the forward or reverse traveling direction of the automatically operated forklift, in a detection area above the floor and up to a predetermined height corresponding to the height of the upper end of the automatically operated forklift, in the traveling direction An upper obstacle detection device capable of detecting whether or not there is an obstacle that interferes with the automated driving forklift within the detection area up to a predetermined distance;
A notification device;
A control device for notifying using the notification device when an obstacle is detected using the upper obstacle detection device;
have,
Automatic operation forklift.
請求項1に記載の自動運転フォークリフトであって、
前記上方障害物検出装置は、
前記進行方向と鉛直方向とを含む平面状の前記検出領域を有しており、当該検出領域内に存在する物体を障害物として検出可能である、
自動運転フォークリフト。
An automated forklift according to claim 1, wherein
The upper obstacle detection device
The planar detection area includes the traveling direction and the vertical direction, and an object present in the detection area can be detected as an obstacle.
Automatic operation forklift.
請求項2に記載の自動運転フォークリフトであって、
前記検出領域として、複数の検出領域が設定されており、
前記制御装置は、
前記自動運転フォークリフトの運転状態に応じて、前記検出領域を切り替える、
自動運転フォークリフト。
It is an automatic operation forklift according to claim 2,
A plurality of detection areas are set as the detection area,
The controller is
The detection area is switched according to the operation state of the automatically driven forklift.
Automatic operation forklift.
請求項3に記載の自動運転フォークリフトであって、
前記制御装置は、
前記自動運転フォークリフトの走行速度に応じて、前記検出領域を切り替える、
自動運転フォークリフト。
The automated forklift according to claim 3, wherein
The controller is
Switching the detection area according to the traveling speed of the automatically operated forklift,
Automatic operation forklift.
請求項3に記載の自動運転フォークリフトであって、
前記制御装置から制御され、前記自動運転フォークリフトに設けられたマストに沿ってフォークを昇降させる昇降装置を有し、
前記自動運転フォークリフトの上部には、前記自動運転フォークリフトの少なくとも一部を覆うヘッドガードを有しており、
前記自動運転フォークリフトが前記フォークを用いて搬入または搬出する荷物の高さは、予め決められた高さであり、
前記制御装置は、
荷物の有無を検出する荷物検出装置と、前記フォークの高さを検出する昇降位置検出装置と、を有しており、
前記荷物検出装置を用いて検出した荷物の有無と、前記荷物の高さと、前記昇降位置検出装置を用いて検出した前記フォークの高さと、前記フォークの高さに応じたマストの高さと、前記ヘッドガードの高さと、に基づいて求めた最上端高さに応じて、前記検出領域を切り替える、
自動運転フォークリフト。
The automated forklift according to claim 3, wherein
It has a lifting device controlled by the control device and configured to lift and lower a fork along a mast provided on the autonomous forklift.
The upper part of the autonomously operating forklift has a head guard which covers at least a part of the autonomously operating forklift.
The height of the load carried in or out of the automatically operated forklift using the fork is a predetermined height,
The controller is
It has a package detection device that detects the presence or absence of a package, and an elevation position detection device that detects the height of the fork,
The presence or absence of a load detected using the load detection device, the height of the load, the height of the fork detected using the elevation position detection device, the height of the mast according to the height of the fork, and The detection area is switched according to the height of the head guard and the top end height obtained based on the height of the head guard,
Automatic operation forklift.
請求項3〜5のいずれか一項に記載の自動運転フォークリフトであって、
前記制御装置から制御されて前記自動運転フォークリフトを前進または後進にて走行させる駆動装置を有し、
前記検出領域は、
減速領域と停止領域を有しており、前記減速領域は、前記自動運転フォークリフトから遠い側に設定され、前記停止領域は、前記自動運転フォークリフトに近い側に設定され、
前記制御装置は、
前記減速領域に障害物を検出した場合、前記自動運転フォークリフトの走行速度を減速させるように前記駆動装置を制御し、
前記停止領域に障害物を検出した場合、前記自動運転フォークリフトの走行を停止させるように前記駆動装置を制御する、
自動運転フォークリフト。
The automatically operated forklift according to any one of claims 3 to 5, wherein
It has a drive which is controlled by the control unit and causes the autonomous forklift to travel forward or backward.
The detection area is
A deceleration area and a stop area are provided, wherein the deceleration area is set on the side far from the automated forklift and the stop area is set on the side closer to the automated forklift.
The controller is
When the obstacle is detected in the deceleration area, the drive device is controlled to reduce the traveling speed of the automatically operated forklift.
When the obstacle is detected in the stop area, the drive device is controlled to stop the traveling of the automatically operated forklift.
Automatic operation forklift.
請求項1〜5のいずれか一項に記載の自動運転フォークリフトであって、
前記制御装置から制御されて前記自動運転フォークリフトを前進または後進にて走行させる駆動装置を有し、
前記制御装置は、
前記上方障害物検出装置を用いて障害物を検出した場合、前記自動運転フォークリフトの走行を停止させるように前記駆動装置を制御する、
自動運転フォークリフト。
It is an automatically operated forklift according to any one of claims 1 to 5,
It has a drive which is controlled by the control unit and causes the autonomous forklift to travel forward or backward.
The controller is
When the obstacle is detected using the upper obstacle detection device, the drive device is controlled to stop the traveling of the automatically operated forklift.
Automatic operation forklift.
請求項1〜7のいずれか一項に記載の自動運転フォークリフトであって、
前記上方障害物検出装置は、前記自動運転フォークリフトの上部において前記自動運転フォークリフトの車幅に対応する左右両端に一対で設けられている、
自動運転フォークリフト。
It is an automatic operation forklift according to any one of claims 1 to 7,
The upper obstacle detection device is provided in a pair at the left and right ends corresponding to the vehicle width of the automatically operated forklift at the upper portion of the automatically operated forklift.
Automatic operation forklift.
請求項6または7に記載の自動運転フォークリフトであって、
予め設けられた受信設備に向けて所定の情報を無線にて送信可能な通信装置を有し、
前記制御装置は、
前記上方障害物検出装置を用いて障害物を検出して走行を停止させた場合、前記通信装置を用いて、障害物を検出して走行を停止していることを含む異常情報を、前記受信設備に送信する、
自動運転フォークリフト。

It is an automatic operation forklift according to claim 6 or 7,
It has a communication device capable of wirelessly transmitting predetermined information to a reception facility provided in advance.
The controller is
When an obstacle is detected using the upper obstacle detection device and traveling is stopped, the communication device is used to detect an obstacle and receive abnormality information including stopping traveling, Send to equipment,
Automatic operation forklift.

JP2017237986A 2017-12-12 2017-12-12 Self-driving forklift Active JP6866839B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2017237986A JP6866839B2 (en) 2017-12-12 2017-12-12 Self-driving forklift

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2017237986A JP6866839B2 (en) 2017-12-12 2017-12-12 Self-driving forklift

Publications (2)

Publication Number Publication Date
JP2019105995A true JP2019105995A (en) 2019-06-27
JP6866839B2 JP6866839B2 (en) 2021-04-28

Family

ID=67061295

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2017237986A Active JP6866839B2 (en) 2017-12-12 2017-12-12 Self-driving forklift

Country Status (1)

Country Link
JP (1) JP6866839B2 (en)

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2021028266A (en) * 2019-08-09 2021-02-25 株式会社小松製作所 Working machine and control method of working machine
JP2021143039A (en) * 2020-03-11 2021-09-24 三菱ロジスネクスト株式会社 Unmanned forklift
JP2021149215A (en) * 2020-03-16 2021-09-27 住友ナコ フォ−クリフト株式会社 Carrying system, carrying vehicle, control program and recording medium recording therein control program
JP2021149177A (en) * 2020-03-16 2021-09-27 三菱重工業株式会社 Control device, moving body, movement control system, control method and program
JP6997272B1 (en) 2020-09-28 2022-01-17 三菱ロジスネクスト株式会社 Reach forklift
JP2022133832A (en) * 2021-03-02 2022-09-14 住友ナコ フォ-クリフト株式会社 Periphery monitoring device for work vehicle, and work vehicle
US20220411246A1 (en) * 2019-12-03 2022-12-29 Kabushiki Kaisha Toyota Jidoshokki Industrial vehicle
DE102021130254A1 (en) 2021-11-19 2023-05-25 Jungheinrich Aktiengesellschaft PROCEDURE FOR HANDLING TRUCK FAULTS
JP2023109332A (en) * 2022-01-27 2023-08-08 三菱ロジスネクスト株式会社 Remote operation system
JP7450083B2 (en) 2018-09-28 2024-03-14 株式会社小松製作所 Surrounding monitoring system and surrounding monitoring method

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5927314A (en) * 1982-08-05 1984-02-13 Toyoda Autom Loom Works Ltd Operation controlling method in detecting obstacle, of unattended cargo work vehicle
JPH04341499A (en) * 1991-05-16 1992-11-27 Toyota Autom Loom Works Ltd Equipment for controlling cargo-handling in unmanned fork lift truck
JP2005075616A (en) * 2003-09-03 2005-03-24 Nippon Yusoki Co Ltd Safety device for cargo handling vehicle
JP2005128722A (en) * 2003-10-23 2005-05-19 Matsushita Electric Works Ltd Vehicle with obstruction avoidance function
JP2006076727A (en) * 2004-09-10 2006-03-23 Nippon Yusoki Co Ltd Order picking truck
CN104442452A (en) * 2014-11-14 2015-03-25 杨鹏波 Unmanned electric trackless three-direction stacking forklift truck
JP2015081877A (en) * 2013-10-24 2015-04-27 日立建機株式会社 Reverse travelling support system
JP2015084129A (en) * 2013-10-25 2015-04-30 日本精工株式会社 Guidance robot
JP2015170284A (en) * 2014-03-10 2015-09-28 株式会社日立製作所 Forklift type unmanned carrier vehicle, control method of the same, and control device of the same
JP2015227223A (en) * 2014-05-30 2015-12-17 ニチユ三菱フォークリフト株式会社 Cargo vehicle
US20180057329A1 (en) * 2016-08-26 2018-03-01 Crown Equipment Corporation Multi-field scanning tools in materials handling vehicles

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5927314A (en) * 1982-08-05 1984-02-13 Toyoda Autom Loom Works Ltd Operation controlling method in detecting obstacle, of unattended cargo work vehicle
JPH04341499A (en) * 1991-05-16 1992-11-27 Toyota Autom Loom Works Ltd Equipment for controlling cargo-handling in unmanned fork lift truck
JP2005075616A (en) * 2003-09-03 2005-03-24 Nippon Yusoki Co Ltd Safety device for cargo handling vehicle
JP2005128722A (en) * 2003-10-23 2005-05-19 Matsushita Electric Works Ltd Vehicle with obstruction avoidance function
JP2006076727A (en) * 2004-09-10 2006-03-23 Nippon Yusoki Co Ltd Order picking truck
JP2015081877A (en) * 2013-10-24 2015-04-27 日立建機株式会社 Reverse travelling support system
JP2015084129A (en) * 2013-10-25 2015-04-30 日本精工株式会社 Guidance robot
JP2015170284A (en) * 2014-03-10 2015-09-28 株式会社日立製作所 Forklift type unmanned carrier vehicle, control method of the same, and control device of the same
JP2015227223A (en) * 2014-05-30 2015-12-17 ニチユ三菱フォークリフト株式会社 Cargo vehicle
CN104442452A (en) * 2014-11-14 2015-03-25 杨鹏波 Unmanned electric trackless three-direction stacking forklift truck
US20180057329A1 (en) * 2016-08-26 2018-03-01 Crown Equipment Corporation Multi-field scanning tools in materials handling vehicles

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7450083B2 (en) 2018-09-28 2024-03-14 株式会社小松製作所 Surrounding monitoring system and surrounding monitoring method
JP7370189B2 (en) 2019-08-09 2023-10-27 株式会社小松製作所 Work machines and work machine control methods
JP2021028266A (en) * 2019-08-09 2021-02-25 株式会社小松製作所 Working machine and control method of working machine
US20220411246A1 (en) * 2019-12-03 2022-12-29 Kabushiki Kaisha Toyota Jidoshokki Industrial vehicle
JP2021143039A (en) * 2020-03-11 2021-09-24 三菱ロジスネクスト株式会社 Unmanned forklift
JP7300413B2 (en) 2020-03-16 2023-06-29 三菱重工業株式会社 Control device, moving body, movement control system, control method and program
JP2021149177A (en) * 2020-03-16 2021-09-27 三菱重工業株式会社 Control device, moving body, movement control system, control method and program
JP2021149215A (en) * 2020-03-16 2021-09-27 住友ナコ フォ−クリフト株式会社 Carrying system, carrying vehicle, control program and recording medium recording therein control program
JP7548713B2 (en) 2020-03-16 2024-09-10 住友ナコ フォ-クリフト株式会社 TRANSPORT SYSTEM, CONTROL PROGRAM, AND RECORDING MEDIUM ON WHICH THE CONTROL PROGRAM IS RECORDED
JP2022054732A (en) * 2020-09-28 2022-04-07 三菱ロジスネクスト株式会社 Reach forklift
JP6997272B1 (en) 2020-09-28 2022-01-17 三菱ロジスネクスト株式会社 Reach forklift
JP2022133832A (en) * 2021-03-02 2022-09-14 住友ナコ フォ-クリフト株式会社 Periphery monitoring device for work vehicle, and work vehicle
DE102021130254A1 (en) 2021-11-19 2023-05-25 Jungheinrich Aktiengesellschaft PROCEDURE FOR HANDLING TRUCK FAULTS
JP2023109332A (en) * 2022-01-27 2023-08-08 三菱ロジスネクスト株式会社 Remote operation system

Also Published As

Publication number Publication date
JP6866839B2 (en) 2021-04-28

Similar Documents

Publication Publication Date Title
JP6866839B2 (en) Self-driving forklift
US10596705B2 (en) Mobile robot with collision anticipation
JP6020265B2 (en) Goods transport equipment
KR102144781B1 (en) Object tracking and steer maneuvers for materials handling vehicles
CN107636546B (en) Autonomous moving system
EP2685337B1 (en) Steer correction for a remotely operated materials handling vehicle
EP2766781B1 (en) Steer control maneuvers for materials handling vehicles
US8452464B2 (en) Steer correction for a remotely operated materials handling vehicle
JP2015170284A (en) Forklift type unmanned carrier vehicle, control method of the same, and control device of the same
KR20110098771A (en) Multiple zone sensing for materials handling vehicles
WO2019053798A1 (en) Autonomous traveling robot system
CN114901585B (en) Positioning assistance system for a materials handling vehicle
US11667502B2 (en) Industrial truck, configured for driverless, autonomously acting operation for a load to be transported
JP2022086361A (en) Vehicle control device and method
CN112631289B (en) Automatic safety obstacle avoidance system and method for laser navigation forklift
KR102007568B1 (en) System and Method for Safe Driving of Crane
KR102515061B1 (en) Method for preventing collision of automated guided vehicle for automated guided vehicle system
EP4339727A1 (en) Navigation alignment systems and methods for a material handling vehicle
JP2024113917A (en) MOBILE BODY CONTROL METHOD, PROGRAM, AND INFORMATION PROCESSING APPARATUS
JP6722432B2 (en) Mobile devices and systems

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20200306

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20210226

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210322

R151 Written notification of patent or utility model registration

Ref document number: 6866839

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151