[go: up one dir, main page]

JP2017228158A - Unmanned conveyance system - Google Patents

Unmanned conveyance system Download PDF

Info

Publication number
JP2017228158A
JP2017228158A JP2016124880A JP2016124880A JP2017228158A JP 2017228158 A JP2017228158 A JP 2017228158A JP 2016124880 A JP2016124880 A JP 2016124880A JP 2016124880 A JP2016124880 A JP 2016124880A JP 2017228158 A JP2017228158 A JP 2017228158A
Authority
JP
Japan
Prior art keywords
automatic guided
guided vehicle
pallet
sensor
distance
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP2016124880A
Other languages
Japanese (ja)
Inventor
伊藤 貴幸
Takayuki Ito
貴幸 伊藤
裕司 近藤
Yuji Kondo
裕司 近藤
敬大 大島
Takahiro Oshima
敬大 大島
慎治 北田
Shinji Kitada
慎治 北田
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.)
Nippon Sharyo Ltd
Mitsubishi Heavy Industries Ltd
Original Assignee
Nippon Sharyo Ltd
Mitsubishi Heavy Industries Ltd
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 Nippon Sharyo Ltd, Mitsubishi Heavy Industries Ltd filed Critical Nippon Sharyo Ltd
Priority to JP2016124880A priority Critical patent/JP2017228158A/en
Publication of JP2017228158A publication Critical patent/JP2017228158A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide an unmanned conveyance system comprising a guidance method having disturbance resistance.SOLUTION: In an unmanned conveyance system 500 having a pallet 200 comprising a base 210 and legs 220 and an unmanned carrier 100 comprising a lifter 140 lifting up and supporting the pallet 200, a travel device 120 and a control section 160 and causing the unmanned carrier 100 to travel to a prescribed position among the legs 220 of the pallet 200, an undersurface of the base 210 is provided with a bracket 230 protruding downward and extending so as to pass through a center line of the pallet 200. The unmanned carrier 100 comprises at least three laser sensors 150, and a control section 160 performing operation on the basis of data obtained from the laser sensors 150. A distance to the bracket 230 is detected by the laser sensors 150, an angle of the travel device 120 is adjusted on the basis of the data by the control section 160, and the unmanned carrier 100 is guided to an appropriate position.SELECTED DRAWING: Figure 7

Description

本発明は、無人搬送車の誘導に関する技術であり、特にパレットの脚部の設置位置によること無く、パレットの脚部間に無人搬送車を正確に誘導する技術に関する。   The present invention relates to a technique for guiding an automatic guided vehicle, and more particularly, to a technique for accurately guiding an automatic guided vehicle between legs of a pallet without depending on an installation position of a leg of the pallet.

工場内において、大型の搬送物が載置されたパレットを移動させる為に無人搬送車が用いられるケースがある。しかしながら、パレットが事前に定められた設置場所に精確に設置されていないケースもある。こうしたケースでは無人搬送車をパレットの脚部の間に移動させる為には、その運転経路を補正する必要がある。このため、作業者がペンダントスイッチ等のコントローラを用いて無人搬送車の操作を行い、正しくパレットの脚部の間に無人搬送車が収まるようにしていた。そして、パレットの脚部の間に無人搬送車を移動させた後、無人搬送車によってパレットを持ち上げ、そのまま搬送するといった運用がなされていた。   There are cases where an automated guided vehicle is used in a factory to move a pallet on which a large transported object is placed. However, there are cases in which the pallet is not accurately installed at a predetermined installation location. In such a case, in order to move the automatic guided vehicle between the pallet legs, it is necessary to correct the driving route. For this reason, an operator uses a controller such as a pendant switch to operate the automatic guided vehicle so that the automatic guided vehicle is properly placed between the pallet legs. Then, after the automatic guided vehicle is moved between the pallet legs, the pallet is lifted by the automatic guided vehicle and transported as it is.

しかしながら縦長のパレットの脚部の間は狭く、パレットに対して無人搬送車の進入角度が大きく付いている場合、パレットの脚部の間に無人搬送車を移動させる操作は困難である。このため、無人搬送車のコントローラを操作する作業者の他に、監視役の作業者を多数必要とし、無人搬送車を慎重に誘導するという作業が必要であった。このため、この問題を解消する技術が望まれていた。   However, it is difficult to move the automatic guided vehicle between the legs of the pallet when the legs of the vertically long pallet are narrow and the approach angle of the automatic guided vehicle is large with respect to the pallet. For this reason, in addition to the operator who operates the controller of the automatic guided vehicle, a large number of supervisory workers are required, and an operation of carefully guiding the automatic guided vehicle is necessary. For this reason, a technique for solving this problem has been desired.

特許文献1には、無人搬送システム及び無人搬送車に関する技術が開示されている。進入口からパレットの下方へ進入した無人搬送車は、第1及び第2レーザーセンサを用いてパレットの台部の下面に設けられている誘導体までの距離を測定する。そしてその測定値とレーザー測定メモリに記憶されている目標値とが一致するように走行方向に制御を行う。ここで、誘導体は脚部の設置状況とは無関係に台部の前後方向に伸びる中心線に沿って連続して設けられているので、脚部の設置状況によることなく無人搬送車を誘導することが出来る。   Patent Document 1 discloses a technique related to an automatic guided vehicle and an automatic guided vehicle. The automated guided vehicle that has entered the lower side of the pallet from the entrance measures the distance to the derivative provided on the lower surface of the pallet base using the first and second laser sensors. Then, control is performed in the traveling direction so that the measured value matches the target value stored in the laser measurement memory. Here, since the derivative is continuously provided along the center line extending in the front-rear direction of the pedestal regardless of the installation state of the legs, the guided vehicle is guided regardless of the installation conditions of the legs. I can do it.

特許文献2には、全方位走行無人搬送車の誘導走行方法に関する技術が開示されている。無人搬送車は前提条件として車体前部の誘導センサから前方に距離Lだけ離れた目標点を設定し、距離L及び誘導センサにより検出された誘導偏差に基づいて操舵輪の操舵角を計算によって求める。この際に、誘導偏差について距離Lの条件によって操舵角の補正をすることで、直進時の直進性及び収束性の向上を図っている。   Patent Document 2 discloses a technique related to a guided traveling method for an omnidirectional automatic guided vehicle. As a precondition, the automatic guided vehicle sets a target point that is a distance L away from the guidance sensor at the front of the vehicle body, and calculates the steering angle of the steered wheel by calculation based on the distance L and the guidance deviation detected by the guidance sensor. . At this time, the steering angle is corrected according to the condition of the distance L with respect to the induced deviation, thereby improving the straight traveling performance and convergence performance during straight traveling.

特許文献3には、無人搬送車の操舵駆動方法及び装置に関する技術が開示されている。無人搬送車の一方の対角位置には操舵駆動輪が設けられ、無人搬送車の他方の対角位置にはフリーキャスタが備えられている。そして、制御装置によって操舵駆動輪の操舵駆動制御を行うにあたり、無人搬送車の中心点を通る車幅方向の中心線であるX座標軸上に無人搬送車の旋回中心点を設定している。また、入力された前側の操舵駆動輪の操舵角と中心点における速度に基づいて、操舵駆動輪を操舵駆動する制御値を算出している。こうすることで半自動走行時における無人搬送車の操舵駆動の制御を行っている。   Patent Document 3 discloses a technique related to a steering drive method and apparatus for an automatic guided vehicle. A steering drive wheel is provided at one diagonal position of the automatic guided vehicle, and a free caster is provided at the other diagonal position of the automatic guided vehicle. Then, when performing steering drive control of the steering drive wheels by the control device, the turning center point of the automatic guided vehicle is set on the X coordinate axis that is the center line in the vehicle width direction passing through the central point of the automatic guided vehicle. Further, based on the input steering angle of the front steering drive wheel and the speed at the center point, a control value for steering the steering drive wheel is calculated. In this way, the steering drive of the automatic guided vehicle during semi-automatic travel is controlled.

特開2012−198756号公報JP 2012-198756 A 特許第4089344号公報Japanese Patent No. 4089344 特許第5407514号公報Japanese Patent No. 5407514

しかしながら、特許文献1に記載されるような無人搬送システムを用いた場合でも、無人搬送車を誘導する際に問題が生じることが分かった。無人搬送車を移動させる場所は、工場内でありコンクリートが打たれるなどして舗装されているものの、床面の荒れや小さな障害物によって外乱が発生する場合がある。この様な場合に、無人搬送車の誘導がうまく完了せず、誘導のやり直しなどの手間が発生する。   However, it has been found that there is a problem in guiding the automatic guided vehicle even when the automatic guided system described in Patent Document 1 is used. Although the place where the automatic guided vehicle is moved is paved by being struck by concrete or the like in a factory, disturbances may occur due to rough floors or small obstacles. In such a case, the guidance of the automatic guided vehicle is not completed successfully, and troubles such as re-guidance occur.

特許文献1には、パレットの前後方向に伸びる中心線に沿って設けられた誘導体と、無人搬送車の中心線とを重ねるように誘導するという手法は提案されているが、例えば無人搬送車と、パレット中央に設けたブラケットとの角度のずれ、及び無人搬送車とブラケットまでの距離を求め、角度ずれや距離が小さくなるよう修正する場合、特許文献2や特許文献3に示すような計算方法が考えられる。しかしながら、いずれの技術でも旋回中心の位置が限定される上、複雑な計算を必要とする為に、無人搬送車を適切に誘導できない虞がある。   Patent Document 1 proposes a method of guiding the derivative provided along the center line extending in the front-rear direction of the pallet and the center line of the automatic guided vehicle, but for example, an automatic guided vehicle When the angle deviation from the bracket provided at the center of the pallet and the distance between the automatic guided vehicle and the bracket are obtained and the angle deviation and the distance are corrected to be small, the calculation methods as shown in Patent Document 2 and Patent Document 3 Can be considered. However, in any technique, the position of the turning center is limited and complicated calculation is required, so that there is a possibility that the automatic guided vehicle cannot be guided appropriately.

そこで、本発明はこの様な課題を解決する為に、外乱に強い誘導方法を備えた無人搬送システムを提供することを目的とする。   Accordingly, an object of the present invention is to provide an unmanned conveyance system equipped with a guidance method that is resistant to disturbances in order to solve such problems.

前記目的を達成するために、本発明の一態様による無人搬送システムは、以下のような特徴を有する。   In order to achieve the above object, an unmanned conveyance system according to an aspect of the present invention has the following characteristics.

(1)搬送物を載置する台部と、該台部を支持する脚部と、を備えるパレットと、該パレットを持ち上げ支持する持上手段と、複数の独立制御可能な走行装置と、該走行装置を制御する制御手段と、を備える無人搬送車と、を有し、前記無人搬送車を、前記持上手段により前記パレットを持ち上げ可能な前記脚部の間の位置まで走行させる無人搬送システムにおいて、前記台部の下面には、下方に突出し前記パレットの中心線を貫くように延配される被検出体が備えられ、前記無人搬送車には、少なくとも3つの距離測定手段が備えられ、該距離測定手段から得られたデータを元に前記制御手段によって前記距離測定手段で前記被検出体までの距離を検出し、前記制御手段により前記データに基づいて前記走行装置の舵角を調整し、前記無人搬送車を適切な位置に誘導すること、を特徴とする。 (1) A pallet comprising a platform for placing a conveyed product, and a leg that supports the platform, lifting means for lifting and supporting the pallet, a plurality of independently controllable traveling devices, An automatic guided vehicle comprising: a control unit that controls a traveling device; and the automatic guided vehicle travels the automatic guided vehicle to a position between the legs that can lift the pallet by the lifting unit. In the lower surface of the pedestal portion, a detected body that protrudes downward and extends so as to penetrate the center line of the pallet is provided, and the automatic guided vehicle is provided with at least three distance measuring means, Based on the data obtained from the distance measuring means, the control means detects the distance to the detected object by the distance measuring means, and the control means adjusts the steering angle of the traveling device based on the data. The unmanned Inducing Okukuruma in position, characterized by.

上記(1)に記載の態様により、3つの距離測定手段を備えて無人搬送車を誘導するため、外乱の影響を抑えて適切な誘導が可能となる。   According to the aspect described in the above (1), since the automatic guided vehicle is guided by including the three distance measuring means, it is possible to appropriately guide while suppressing the influence of the disturbance.

(2)(1)に記載の無人搬送システムにおいて、前記距離測定手段は、特定の波長を出してその反射波を測定することにより距離を算出する距離センサを用いたものであり、3つの前記距離測定手段は、第1距離センサ、第2距離センサ、及び第3距離センサよりなり、前記第1距離センサが前記無人搬送車の前端付近に、前記第2距離センサが前記第1距離センサの近傍であって前記無人搬送車の中央より前に、前記第3距離センサが前記無人搬送車の中央より後方で後端より前方に配置され、前記第1距離センサと前記第2距離センサ、又は前記第1距離センサと前記第3距離センサより得られた前記データを用い、前記制御手段に備える演算装置により前記無人搬送車の旋回中心を算出し、該旋回中心からの距離である旋回半径から前記走行装置の舵角を算出すること、が好ましい。 (2) In the unmanned conveyance system according to (1), the distance measuring unit uses a distance sensor that calculates a distance by emitting a specific wavelength and measuring a reflected wave thereof. The distance measuring means includes a first distance sensor, a second distance sensor, and a third distance sensor, wherein the first distance sensor is near the front end of the automatic guided vehicle, and the second distance sensor is the first distance sensor. The third distance sensor is arranged in the vicinity and in front of the center of the automatic guided vehicle, behind the center of the automatic guided vehicle and in front of the rear end, and the first distance sensor and the second distance sensor, or Using the data obtained from the first distance sensor and the third distance sensor, a turning center of the automatic guided vehicle is calculated by an arithmetic unit provided in the control means, and a turning radius that is a distance from the turning center is calculated. Calculating a steering angle of the serial traveling device, it is preferable.

上記(2)に記載の態様により、距離センサを用いてパレットに取り付けられた被検出体までの距離を検出し、その距離に応じて走行装置の舵角を決定して無人搬送車を制御することが可能となる。この際に、第1距離センサが前端付近に設けられ、第2距離センサが第1距離センサより後方であって、第1距離センサの近傍であって前記無人搬送車の中央より前に配置され、第3距離センサは無人搬送車の中央より後方で後端より前方に配置される。このため、第2距離センサは無人搬送車の進入初期の位置検出を行い、第3距離センサは無人搬送車の進入中期以降の位置検出に用いて、より検出精度を高めることが可能となる。   According to the aspect described in (2) above, the distance to the detected object attached to the pallet is detected using a distance sensor, and the rudder angle of the traveling device is determined according to the distance to control the automatic guided vehicle. It becomes possible. At this time, the first distance sensor is provided in the vicinity of the front end, and the second distance sensor is disposed behind the first distance sensor, in the vicinity of the first distance sensor, and in front of the center of the automatic guided vehicle. The third distance sensor is arranged behind the center of the automatic guided vehicle and ahead of the rear end. For this reason, the second distance sensor detects the position of the automatic guided vehicle at the initial stage of entry, and the third distance sensor can be used for position detection after the intermediate stage of the automatic guided vehicle to improve detection accuracy.

また、前記目的を達成するために、本発明の別の態様による無人搬送システムは、以下のような特徴を有する。   Moreover, in order to achieve the said objective, the automatic guided system by another aspect of this invention has the following characteristics.

(3)搬送物を載置する台部と、該台部を支持する脚部と、を備えるパレットと、該パレットを持ち上げ支持する持上手段と、複数の独立制御可能な走行装置と、該走行装置を制御する制御手段と、を備える無人搬送車と、を有し、前記無人搬送車を、前記持上手段により前記パレットを持ち上げ可能な前記脚部の間の位置まで走行させる無人搬送システムにおいて、前記無人搬送車の中心線上に仮想原点を定め、該仮想原点が前記パレットの中心線の直下に位置するように前記無人搬送車の走行位置を補正すること、を特徴とする。 (3) A pallet including a platform portion on which a conveyed product is placed; a leg portion that supports the platform portion; lifting means that lifts and supports the pallet; a plurality of independently controllable traveling devices; An automatic guided vehicle comprising: a control unit that controls a traveling device; and the automatic guided vehicle travels the automatic guided vehicle to a position between the legs that can lift the pallet by the lifting unit. In which a virtual origin is defined on the center line of the automatic guided vehicle, and the travel position of the automatic guided vehicle is corrected so that the virtual origin is located immediately below the center line of the pallet.

上記(3)に記載の態様により、仮想原点を定めて旋回中心を決定するという比較的単純な計算によって旋回中心を決定出来る。この結果、無人搬送車の誘導にあたって、複雑な計算を高速で演算処理する必要が無いために、比較的安価に精度の高い誘導を実現することができる。   According to the aspect described in (3) above, the turning center can be determined by a relatively simple calculation of determining the virtual origin and determining the turning center. As a result, since there is no need to perform complicated calculation at high speed when guiding the automatic guided vehicle, highly accurate guidance can be realized at a relatively low cost.

本実施形態の、無人搬送システムの側面図である。It is a side view of the automatic guided system of this embodiment. 本実施形態の、無人搬送システムの上面図である。It is a top view of the unmanned conveyance system of this embodiment. 本実施形態の、無人搬送システムの図1のAA矢視図である。It is an AA arrow line view of FIG. 1 of the automatic guided system of this embodiment. 本実施形態の、無人搬送車の底面図である。It is a bottom view of the automatic guided vehicle of this embodiment. 本実施形態の、無人搬送システムの制御に関するフローチャートである。It is a flowchart regarding control of the unmanned conveyance system of this embodiment. 本実施形態の、仮想原点位置ずれ計算に用いた仮想点と距離に関する説明図である。It is explanatory drawing regarding the virtual point and distance used for the virtual origin position shift calculation of this embodiment. 本実施形態の、パレットに対して無人搬送車を誘導する様子を示すグラフである。It is a graph which shows a mode that an automatic guided vehicle is guided with respect to the pallet of this embodiment. 本実施形態の、距離センサによるブラケットとの計測距離に関するグラフである。It is a graph regarding the measurement distance with the bracket by a distance sensor of this embodiment. 本実施形態の、走行軸の舵角に関するグラフである。It is a graph regarding the rudder angle of a travel axis of this embodiment. 比較のために用意した、従来技術における外乱が発生した場合の走行軸の舵角に関するグラフである。It is the graph regarding the rudder angle of the travel axis | shaft at the time of the disturbance in the prior art prepared for the comparison. 本実施形態の、外乱が発生した場合の走行軸の舵角に関するグラフである。It is a graph regarding the rudder angle of the traveling axis when a disturbance occurs in the present embodiment.

まず、本発明の実施形態について図面を用いて説明を行う。図1に、本実施形態の無人搬送システム500の側面図を示す。図2に、無人搬送システム500の上面視図を示す。なお、図2ではリフタ140は省略されている。図3に、無人搬送システム500のAA矢視図を示す。図1のAA矢視図に相当する。本実施形態の無人搬送システム500は、無人搬送車100とパレット200よりなる。   First, an embodiment of the present invention will be described with reference to the drawings. In FIG. 1, the side view of the unmanned conveyance system 500 of this embodiment is shown. FIG. 2 shows a top view of the automatic transport system 500. In FIG. 2, the lifter 140 is omitted. In FIG. 3, the AA arrow line view of the unmanned conveyance system 500 is shown. It corresponds to the AA arrow view of FIG. The automatic guided system 500 of this embodiment includes an automatic guided vehicle 100 and a pallet 200.

無人搬送車100は、車体110と複数の走行装置120と複数のリフタ140と複数の距離測定手段であるレーザーセンサ150とを有している。車体110は、無人搬送車100の進行方向に向かって細く形成されている。この形状は、パレット200の形状にあわせている。   The automatic guided vehicle 100 includes a vehicle body 110, a plurality of traveling devices 120, a plurality of lifters 140, and a plurality of laser sensors 150 that are distance measuring means. The vehicle body 110 is formed narrower in the traveling direction of the automatic guided vehicle 100. This shape matches the shape of the pallet 200.

図4に、無人搬送車100の底面図を示す。走行装置120は、第1走行装置121、第2走行装置122、第3走行装置123、第4走行装置124、第5走行装置125、第6走行装置126、第7走行装置127、第8走行装置128、第9走行装置129、及び第10走行装置130の10個の走行装置よりなる。それぞれの走行装置120は、車体110の下面に配置されて車体110の長手方向をX軸とするとZ軸に回転軸を有し、任意にその角度を変更することが可能である。また、走行装置120はそれぞれが2つの車輪を備えており、その車輪は車軸によって繋がれている。そして走行装置120のうち少なくとも幾つかは駆動輪とされている。本実施形態では、第1走行装置121、第2走行装置122、第5走行装置125、第6走行装置126、第9走行装置129、第10走行装置130が駆動輪となっている。また、それぞれの走行装置120の舵角は任意に制御可能な構成となっている。   In FIG. 4, the bottom view of the automatic guided vehicle 100 is shown. The travel device 120 includes a first travel device 121, a second travel device 122, a third travel device 123, a fourth travel device 124, a fifth travel device 125, a sixth travel device 126, a seventh travel device 127, and an eighth travel. It consists of 10 traveling devices: a device 128, a ninth traveling device 129, and a tenth traveling device 130. Each traveling device 120 is disposed on the lower surface of the vehicle body 110 and has a rotation axis on the Z axis when the longitudinal direction of the vehicle body 110 is an X axis, and the angle can be arbitrarily changed. Moreover, each traveling device 120 includes two wheels, and the wheels are connected by an axle. At least some of the traveling devices 120 are drive wheels. In the present embodiment, the first traveling device 121, the second traveling device 122, the fifth traveling device 125, the sixth traveling device 126, the ninth traveling device 129, and the tenth traveling device 130 are drive wheels. In addition, the steering angle of each traveling device 120 can be arbitrarily controlled.

第1走行装置121と第2走行装置122は、車体110の一番前、第1列に並んで配置される。第3走行装置123と第4走行装置124は、その後方に少し離れて第2列に並べて配置され、第5走行装置125と第6走行装置126は、第2列の直ぐ後方の第3列に並べて配置される。第7走行装置127と第8走行装置128は、第3列の後方に少し離れて第4列に並べて配置され、第9走行装置129と第10走行装置130は、第4列の直ぐ後方の第5列に並べて配置される。   The first traveling device 121 and the second traveling device 122 are arranged in front of the vehicle body 110 in the first row. The third traveling device 123 and the fourth traveling device 124 are arranged in a second row a little behind them, and the fifth traveling device 125 and the sixth traveling device 126 are the third row immediately behind the second row. Are arranged side by side. The seventh traveling device 127 and the eighth traveling device 128 are arranged in the fourth row with a little separation behind the third row, and the ninth traveling device 129 and the tenth traveling device 130 are located immediately behind the fourth row. Arranged side by side in the fifth column.

リフタ140は、車体110の上面の6箇所に設けられている。リフタ140は図示しない油圧機構を備え、後述の制御部160等によって制御されて無人搬送車100の高さ方向に昇降する。リフタ140は、パレット200の下に無人搬送車100が移動した後、パレット200の下面にリフタ140の上面が当接して押し上げ、パレット200を持ち上げるのに利用される。車体110には、このほかに演算装置などを備えた制御部160を備えており、この制御部160には有線で図示しない操作用ペンダントが接続されている。操作用ペンダントで無人搬送車100の誘導が可能である。   The lifters 140 are provided at six locations on the upper surface of the vehicle body 110. The lifter 140 includes a hydraulic mechanism (not shown), and is lifted up and down in the height direction of the automatic guided vehicle 100 under the control of a control unit 160 and the like described later. The lifter 140 is used to lift the pallet 200 after the automatic guided vehicle 100 moves under the pallet 200 and the upper surface of the lifter 140 comes into contact with the lower surface of the pallet 200 to push it up. In addition, the vehicle body 110 includes a control unit 160 including an arithmetic device, and an operation pendant (not shown) is connected to the control unit 160 via a wire. The automatic guided vehicle 100 can be guided by the operation pendant.

レーザーセンサ150は、図4に示されるように2個ずつ3列に設けられ、合計6個が車体110の上面に取り付けられる。レーザーセンサ150は図3に示すように、無人搬送車100の少なくとも一部がパレット200の下方に進入した際に、パレット200のベース210の中央下部に設けられるブラケット230を検出するように、レーザー光Lが一定の角度をもって照射されるように車体110に固定されている。   As shown in FIG. 4, two laser sensors 150 are provided in three rows, and a total of six laser sensors 150 are attached to the upper surface of the vehicle body 110. As shown in FIG. 3, the laser sensor 150 detects the bracket 230 provided at the lower center of the base 210 of the pallet 200 when at least a part of the automatic guided vehicle 100 enters the lower side of the pallet 200. It is fixed to the vehicle body 110 so that the light L is emitted at a constant angle.

レーザーセンサ150は、第1センサ151、第2センサ152、第3センサ153、第4センサ154、第5センサ155、及び第6センサ156の6個よりなる。そして、第1距離センサに相当する第1センサ151と第2センサ152とで対となり、第2距離センサに相当する第3センサ153と第4センサ154とで対になり、第3距離センサに相当する第5センサ155と第6センサ156とで対になって運用される。   The laser sensor 150 includes six sensors: a first sensor 151, a second sensor 152, a third sensor 153, a fourth sensor 154, a fifth sensor 155, and a sixth sensor 156. The first sensor 151 corresponding to the first distance sensor and the second sensor 152 make a pair, the third sensor 153 corresponding to the second distance sensor and the fourth sensor 154 make a pair, and the third distance sensor The corresponding fifth sensor 155 and sixth sensor 156 are used in pairs.

第1センサ151と第2センサ152は車体110の前端付近の左右、つまり第1ラインL1上に取り付けられる。第3センサ153と第4センサ154は、車体110の前進側であって車体110の上から見て走行装置120の第1列と同じ位置、つまり第2ラインL2上に並んで左右に配置されている。第5センサ155と第6センサ156は、車体110の中央より後ろ側、走行装置120の第3列より後ろに並んで左右、つまり第3ラインL3上に配置されている。   The first sensor 151 and the second sensor 152 are attached to the left and right near the front end of the vehicle body 110, that is, on the first line L1. The third sensor 153 and the fourth sensor 154 are arranged on the left and right sides of the forward side of the vehicle body 110 and at the same position as the first row of the traveling device 120 as viewed from above the vehicle body 110, that is, aligned on the second line L2. ing. The fifth sensor 155 and the sixth sensor 156 are arranged on the left and right sides, that is, on the third line L3, side by side behind the center of the vehicle body 110 and behind the third row of the traveling device 120.

よって、第1ラインL1、第2ラインL2、第3ラインL3はそれぞれレーザーセンサ150の光軸の通るラインであるとも言える。つまり、この線上にレーザー光Lが重なることとなる。なお、各センサは車体110の幅方向中心(中心線CL)からの距離が等しくなるように配置されている。   Therefore, it can be said that the first line L1, the second line L2, and the third line L3 are lines through which the optical axis of the laser sensor 150 passes. That is, the laser beam L overlaps on this line. Each sensor is arranged so that the distance from the center in the width direction (center line CL) of the vehicle body 110 is equal.

パレット200は、図1に示されるように略台形の板材で構成されるベース210と、ベース210の下方に突出するよう固定されて設けられる脚部220、そして、ベース210の下面にブラケット230が備えられる。ベース210の上面には、ワーク280が載置される。ベース210の下面には台形の上辺と下辺の中心を貫くようにブラケット230が取り付けられている。このブラケット230はレーザーセンサ150から出るレーザーを良好に反射するような金属部材よりなり、ベース210の長手方向に均一な高さで突出するよう構成することが望ましい。なお、ブラケット230の材質は金属に限定されるものではなく、レーザーを良好に反射するものであれば良い。   As shown in FIG. 1, the pallet 200 includes a base 210 formed of a substantially trapezoidal plate material, leg portions 220 fixedly provided so as to protrude below the base 210, and a bracket 230 on the lower surface of the base 210. Provided. A work 280 is placed on the upper surface of the base 210. A bracket 230 is attached to the lower surface of the base 210 so as to penetrate the centers of the upper and lower sides of the trapezoid. The bracket 230 is preferably made of a metal member that reflects the laser emitted from the laser sensor 150 well and protrudes at a uniform height in the longitudinal direction of the base 210. Note that the material of the bracket 230 is not limited to metal, and any material can be used as long as it reflects the laser well.

脚部220は、ベース210の下方に突出するよう固定されて設けられている。脚部220は、ワーク280が載せられたベース210を支持する機能を有する。ベース210の斜辺部分に沿って合計10本の脚部220が備えられているが、この脚部220の数は特に限定されるものではない。   The leg portion 220 is provided so as to protrude below the base 210. The leg part 220 has a function of supporting the base 210 on which the work 280 is placed. A total of ten leg portions 220 are provided along the hypotenuse portion of the base 210, but the number of the leg portions 220 is not particularly limited.

次に、無人搬送システム500の制御について説明する。図5に、無人搬送システム500の制御に関するフローチャートを示す。以下その内容を大まかに説明する。   Next, control of the automatic transport system 500 will be described. FIG. 5 shows a flowchart relating to control of the automatic transport system 500. The contents are roughly described below.

まず、S10にてレーザーセンサ150の測定結果を取得する。上述の6つのレーザーセンサ150の計測データを読み取り値として、制御部160に渡す。そしてS11にて、第1ラインL1における読み取り値が「条件」を満足しているかを判断する。第1ラインL1には前述の通り第1センサ151と第2センサ152が配置されており、その第1センサ151と第2センサ152の読み取り値が「条件」を満足すればS12に移行し、「条件」を満足しなければS21に移行する。   First, the measurement result of the laser sensor 150 is acquired in S10. The measurement data of the six laser sensors 150 described above is passed to the control unit 160 as a read value. In S11, it is determined whether or not the read value in the first line L1 satisfies the “condition”. As described above, the first sensor 151 and the second sensor 152 are arranged in the first line L1, and if the read values of the first sensor 151 and the second sensor 152 satisfy the “condition”, the process proceeds to S12. If the “condition” is not satisfied, the process proceeds to S21.

その「条件」は、具体的には第1センサ151と第2センサ152の読み取り値が異常であるかを調べる他、第1センサ151又は第2センサ152の読み取り値の変化が20mm以下か、或いは第1センサ151又は第2センサ152の読み取り値が1m以上か、をチェックする。第1センサ151又は第2センサ152の読み取り値の変化は、レーザーセンサ150のスキャンタイミングと無人搬送車100の速度とに関連するが、本実施形態では無人搬送車100の変化が20mmを超える事を想定していないため、異常と判定する。   Specifically, the “condition” is to check whether the reading values of the first sensor 151 and the second sensor 152 are abnormal, or whether the change in the reading value of the first sensor 151 or the second sensor 152 is 20 mm or less, Alternatively, it is checked whether the reading value of the first sensor 151 or the second sensor 152 is 1 m or more. The change in the reading value of the first sensor 151 or the second sensor 152 is related to the scan timing of the laser sensor 150 and the speed of the automatic guided vehicle 100, but in this embodiment, the change of the automatic guided vehicle 100 exceeds 20 mm. Therefore, it is determined as abnormal.

また、本実施形態では第1センサ151又は第2センサ152から無人搬送車100の中心までの距離を2mとしており、ブラケット230の位置が無人搬送車100の中心から1m以上離れたら、無人搬送車100がパレット200に接触、つまり異常と判定する。   In the present embodiment, the distance from the first sensor 151 or the second sensor 152 to the center of the automatic guided vehicle 100 is 2 m, and when the position of the bracket 230 is 1 m or more away from the center of the automatic guided vehicle 100, the automatic guided vehicle 100 is in contact with the pallet 200, that is, it is determined as abnormal.

S12にて、第1ポジションデータLZS1の取得を行う。ここで、第1ポジションデータLZS1とは、第1ラインL1における車体110の中心からブラケット230までの距離と定義しており、第1ラインL1に配置された第1センサ151と第2センサ152の読み取り値の少なくとも一方から算出する。   In S12, the first position data LZS1 is acquired. Here, the first position data LZS1 is defined as the distance from the center of the vehicle body 110 to the bracket 230 in the first line L1, and the first sensor 151 and the second sensor 152 arranged in the first line L1. Calculate from at least one of the readings.

S13にて、第3ラインL3における読み取り値が「条件」を満足しているかを判断する。第3ラインL3には上述したように、第5センサ155と第6センサ156が配置されている。なお、ここでの「条件」も、S11と同様に設定されている。第5センサ155と第6センサ156の読み取り値が条件を満足すればS14に移行し、条件を満足しなければS16に移行する。   In S13, it is determined whether the read value in the third line L3 satisfies the “condition”. As described above, the fifth sensor 155 and the sixth sensor 156 are arranged in the third line L3. The “condition” here is also set in the same manner as in S11. If the reading values of the fifth sensor 155 and the sixth sensor 156 satisfy the condition, the process proceeds to S14, and if the condition does not satisfy the condition, the process proceeds to S16.

第5センサ155と第6センサ156の読み取り値が条件を満足していれば、S14にて、第3ポジションデータLZS3を取得する。ここで第3ポジションデータLZS3とは、第3ラインL3における車体110の中心からブラケット230までの距離と定義しており、第3ラインL3に配置された第5センサ155と第6センサ156の読み取り値の少なくとも一方から算出する。   If the reading values of the fifth sensor 155 and the sixth sensor 156 satisfy the condition, the third position data LZS3 is acquired in S14. Here, the third position data LZS3 is defined as the distance from the center of the vehicle body 110 to the bracket 230 on the third line L3, and is read by the fifth sensor 155 and the sixth sensor 156 arranged on the third line L3. Calculate from at least one of the values.

S15にて、第1ポジションデータLZS1と第3ポジションデータLZS3より旋回中心ARを算出する。

Figure 2017228158

数式1に用いられるLZSnは、第1ポジションデータLZS1、第2ポジションデータLZS2、第3ポジションデータLZS3の何れかである。また、L1は車体110の先端から第1ラインL1までの距離であり、L2は車体110の先端から第2ラインL2までの距離である。θは仮想原点VPnと旋回中心ARを結ぶ直線と、旋回中心ARから車体110の幅方向の中心線CLに引いた垂線がなす角である。図6に、仮想原点位置ずれ計算に用いた仮想点と距離に関する説明図を示す。 In S15, the turning center AR is calculated from the first position data LZS1 and the third position data LZS3.
Figure 2017228158

LZSn used in Equation 1 is any one of the first position data LZS1, the second position data LZS2, and the third position data LZS3. Further, L s 1 is a distance from the front end of the vehicle body 110 to the first line L1, and L s 2 is a distance from the front end of the vehicle body 110 to the second line L2. θ n is an angle formed by a straight line connecting the virtual origin VPn and the turning center AR and a perpendicular drawn from the turning center AR to the center line CL in the width direction of the vehicle body 110. FIG. 6 is an explanatory diagram regarding virtual points and distances used for calculating the virtual origin position deviation.

第1仮想原点VP1と旋回中心ARを結ぶ直線と、旋回中心ARと車体110の幅方向の中心線CLに引いた垂線PLがなす第1角θは、第1仮想原点VP1と旋回中心ARを結ぶ直線と直角に交わり第1仮想原点VP1を通過する直線と中心線CLとがなす角度と同じとなる。これは第1三角形Aと第2三角形Aとが相似関係にある為に成立する。図6に示す旋回中心ARを頂点とする第1三角形Aは、第1仮想原点VP1を頂点とする第2三角形Aと相似関係だと言えるので、各々の角度も等しくなる。 A first angle θ 1 formed by a straight line connecting the first virtual origin VP1 and the turning center AR and a perpendicular PL drawn to the turning center AR and the center line CL in the width direction of the vehicle body 110 is the first virtual origin VP1 and the turning center AR. Is equal to the angle formed by the straight line intersecting the straight line passing through the first virtual origin VP1 and the center line CL. This holds true for the first triangle A 1 and the second triangle A 2 is in a similar relationship. The first triangle A 1 whose vertices pivot AR shown in FIG. 6, since the first virtual home VP1 say that it second triangle A 2 and similar relation to the apex, each of the angles equal.

また、旋回中心ARと第3仮想原点VP3を結ぶ直線と垂線PLがなす第3角θは、旋回中心ARと第3仮想原点VP3を通過する直線と直角に交る直線と中心線CLとがなす角度と同じとなる。これは第3三角形Bと第4三角形Bとが相似関係にある為に成立する。図6に示す旋回中心ARを頂点とする第3三角形Bと第3仮想原点VP3を頂点とする第4三角形Bと相似関係と言えるので、各々の角度も等しい。数式1はこの関係を利用してθを求めている。 The third angle θ 3 formed by the perpendicular line PL and the straight line connecting the turning center AR and the third virtual origin VP3 is a straight line intersecting the turning center AR and the straight line passing through the third virtual origin VP3 and the center line CL. Is the same as the angle formed by. This holds for the third triangle B 1 and the fourth triangle B 2 are in similar relationship. Since it can be said the turning center AR shown in FIG. 6 and the third triangle B 1 whose vertices third virtual origin VP3 and fourth triangle B 2 whose apexes and similar relationships, each of the angles are equal. Equation 1 uses this relationship to determine θ n .

Figure 2017228158
次に、数式2を用いて中心線CLから旋回中心ARまでの距離Aを算出する。数式2も、旋回中心ARを頂点とする第1三角形Aは第1仮想原点VP1を頂点とする第2三角形Aと、旋回中心ARを頂点とする第3三角形Bは第3仮想原点VP3を頂点とする第4三角形Bと、それぞれ相似関係にある為、これを利用して距離Aを算出できる。なお、数式2の場合は、中心線CLに対して左側に第2三角形Aが位置し、中心線CLに対して右側に第4三角形Bが位置しているので、数式2で距離Aを求められるが、この位置関係によっては符合を変化させる必要がある。
Figure 2017228158
Next, a distance A from the center line CL to the turning center AR is calculated using Formula 2. In Equation 2, the first triangle A 1 having the turning center AR as the vertex is the second triangle A 2 having the first virtual origin VP1 as the vertex, and the third triangle B 1 having the turning center AR as the vertex is the third virtual origin. a fourth triangle B 2 whose vertices VP3, since in the similar relationship each can calculate the distance a by using this. In the case of Equation 2, the second triangle A 2 is located on the left side with respect to the center line CL, and the fourth triangle B 2 is located on the right side with respect to the center line CL. However, depending on the positional relationship, it is necessary to change the sign.

Figure 2017228158
そして、数式3を用いて、旋回中心ARから第1走行装置121または第2走行装置122までの車体110の長手方向の距離、すなわち垂線PLから第2ラインL2までの第1距離FBを求める。こうして距離Aと第1距離FBより旋回中心ARが算出される。
Figure 2017228158
Then, using Formula 3, a longitudinal distance of the vehicle body 110 from the turning center AR to the first traveling device 121 or the second traveling device 122, that is, a first distance FB from the perpendicular PL to the second line L2 is obtained. Thus, the turning center AR is calculated from the distance A and the first distance FB.

Figure 2017228158
また、数式4を用いて、旋回中心ARから第9走行装置129又は第10走行装置130までの車体110の長手方向の第2距離RBを算出できる。ここで、距離WBは第1走行装置と第2走行装置の配置されている第1列から第9走行装置と第10走行装置の配置される第5列までの距離を示している。
Figure 2017228158
Further, the second distance RB in the longitudinal direction of the vehicle body 110 from the turning center AR to the ninth traveling device 129 or the tenth traveling device 130 can be calculated using Formula 4. Here, the distance WB indicates the distance from the first row where the first traveling device and the second traveling device are arranged to the fifth row where the ninth traveling device and the tenth traveling device are arranged.

第5センサ155で第6センサ156の読み取り値が条件を満足していなければ、S16にて、第2ラインL2における読み取り値が「条件」を満足しているかを判断する。第2ラインL2には前述の通り第3センサ153と第4センサ154が配置されている。ここで言う「条件」は、S11と同様に設定されている。第3センサ153と第4センサ154の読み取り値が「条件」を満足すればS17に移行し、「条件」を満足しなければS21に移行する。   If the reading value of the sixth sensor 156 does not satisfy the condition in the fifth sensor 155, it is determined in S16 whether the reading value in the second line L2 satisfies the “condition”. As described above, the third sensor 153 and the fourth sensor 154 are arranged in the second line L2. The “condition” here is set in the same manner as in S11. If the read values of the third sensor 153 and the fourth sensor 154 satisfy the “condition”, the process proceeds to S17, and if the read value does not satisfy the “condition”, the process proceeds to S21.

S17にて、第2ポジションデータLZS2を取得する。ここで第2ポジションデータLZS2とは、第2ラインL2における車体の中心からブラケット230までの距離と定義しており、第2ラインL2に配置された第3センサ153と第4センサ154の読み取り値の少なくとも一方より算出する。   In S17, second position data LZS2 is acquired. Here, the second position data LZS2 is defined as a distance from the center of the vehicle body to the bracket 230 in the second line L2, and reading values of the third sensor 153 and the fourth sensor 154 arranged in the second line L2. It calculates from at least one of these.

S18にて、第1ポジションデータLZS1と第2ポジションデータLZS2より旋回中心ARを算出する。旋回中心ARの算出は数式1、数式3、数式4及び下記の数式5を用いる。

Figure 2017228158
S19にて、各走行装置の舵角δと速度Vを算出する。S15又はS18で旋回中心ARを算出した後、第1走行装置121乃至第10走行装置130の各軸の舵角δを、三角関数を用いて算出する。 In S18, the turning center AR is calculated from the first position data LZS1 and the second position data LZS2. Calculation of the turning center AR uses Formula 1, Formula 3, Formula 4, and Formula 5 below.
Figure 2017228158
In S19, the steering angle δ n and the speed V n of each traveling device are calculated. After calculating the turning center AR in S15 or S18, the steering angle δ n of each axis of the first traveling device 121 to the tenth traveling device 130 is calculated using a trigonometric function.

また、各軸の旋回半径Rも舵角δと三平方の定理を用いて計算が可能である。何れも数式は省略する。速度Vは以下の式を用いて算出できる。

Figure 2017228158
数式6に用いられるVは、ユーザーが任意に定める。またRmaxはRnの最大値を用いている。この数式6によって、走行装置120である、第1走行装置121、第2走行装置122、第5走行装置125、第6走行装置126、第9走行装置129、及び第10走行装置130の各軸の速度が決定される。そしてS20にて算出した舵角δと速度Vの通り、各走行装置を制御する。 Also, the turning radius R n of each axis can be calculated using the steering angle δ n and the three-square theorem. In either case, mathematical expressions are omitted. The speed V n can be calculated using the following equation.
Figure 2017228158
V used in Equation 6 is arbitrarily determined by the user. R max is the maximum value of Rn. According to Equation 6, each axis of the first traveling device 121, the second traveling device 122, the fifth traveling device 125, the sixth traveling device 126, the ninth traveling device 129, and the tenth traveling device 130, which is the traveling device 120. The speed is determined. Then, each traveling device is controlled according to the steering angle δ n and the speed V n calculated in S20.

本実施形態の無人搬送システム500では、上記流れでパレット200の下に無人搬送車100を誘導する。   In the automatic guided system 500 of the present embodiment, the automatic guided vehicle 100 is guided under the pallet 200 in the above flow.

考え方としては、無人搬送車100の車体110の中心線CL上の任意の2点を仮想原点とする。本実施形態では、第1仮想原点VP1及び第3仮想原点VP3とし、第1仮想原点VP1及び第3仮想原点VP3をブラケット230に重なるように無人搬送車100を誘導することで,車体110を目的の位置に移動させることが可能としている。   As a concept, two arbitrary points on the center line CL of the vehicle body 110 of the automatic guided vehicle 100 are set as the virtual origin. In the present embodiment, the vehicle body 110 is provided by guiding the automatic guided vehicle 100 so that the first virtual origin VP1 and the third virtual origin VP3 are overlapped with the bracket 230 so that the first virtual origin VP1 and the third virtual origin VP3 overlap each other. It is possible to move to the position.

そして、仮想原点の進行方向を仮想原点の旋回軌跡の接線方向とすると、仮想原点から引いた垂線上に旋回中心は存在する。従って2つの仮想原点である第1仮想原点VP1及び第3仮想原点VP3の旋回中心が一致する点は2つの垂線の交点となり、無人搬送車100の旋回中心ARが決定できる。なお、本実施形態では、第1ポジションデータLZS1と第3ポジションデータLZS3を用いた例を示しているため、第1仮想原点VP1及び第3仮想原点VPを仮想原点としている。よって、第2ポジションデータLZS2を利用する場合には、第2仮想原点VP2を設定することになる。   Then, if the traveling direction of the virtual origin is the tangential direction of the turning locus of the virtual origin, the turning center exists on the perpendicular drawn from the virtual origin. Therefore, the point at which the turning centers of the first virtual origin VP1 and the third virtual origin VP3, which are the two virtual origins, coincide with each other, and the turning center AR of the automatic guided vehicle 100 can be determined. In the present embodiment, since an example using the first position data LZS1 and the third position data LZS3 is shown, the first virtual origin VP1 and the third virtual origin VP are used as the virtual origin. Therefore, when using the second position data LZS2, the second virtual origin VP2 is set.

本実施形態の無人搬送システム500は上記に説明した構成であるため、以下に説明するような効果及び作用を奏する。まず、本実施形態における無人搬送システム500を備えるため、無人搬送車100の外乱に強い誘導方法を提供することが可能である。   Since the unmanned conveyance system 500 of the present embodiment has the configuration described above, the following effects and operations are achieved. First, since the automatic guided system 500 in this embodiment is provided, it is possible to provide a guidance method that is strong against disturbance of the automatic guided vehicle 100.

これは、本実施形態の無人搬送システム500が、ワーク280を載置するベース210と、ベース210を支持する脚部220と、を備えるパレット200と、パレット200を持ち上げ支持するリフタ140と、複数の独立制御可能な走行装置120を備える無人搬送車100と、を有し、無人搬送車100を、リフタ140によりパレット200を持ち上げ可能な脚部220の間の位置まで走行させる無人搬送システム500において、ベース210の下面には、下方に突出しパレット200の中心線を貫くように延配されるブラケット230が備えられ、無人搬送車100には、少なくとも3つのレーザーセンサ150と、レーザーセンサ150から得られたデータを元に運転を行う制御部160が備えられ、レーザーセンサ150でブラケット230までの距離を検出し、制御部160によりデータに基づいて走行装置120の角度を調整し、無人搬送車100を適切な位置に誘導するものだからである。   This is because the unmanned conveyance system 500 of the present embodiment includes a pallet 200 that includes a base 210 on which the workpiece 280 is placed and a leg portion 220 that supports the base 210, a lifter 140 that lifts and supports the pallet 200, and a plurality of lifters 140. An automatic guided vehicle 100 including a traveling device 120 that can be independently controlled, and the automatic guided vehicle 100 travels to a position between legs 220 that can lift the pallet 200 by a lifter 140. A bracket 230 is provided on the lower surface of the base 210 so as to protrude downward and extend through the center line of the pallet 200. The automatic guided vehicle 100 includes at least three laser sensors 150 and the laser sensor 150. A controller 160 for operating based on the received data, and a laser sensor 150 Detecting the distance to the bracket 230 to adjust the angle of the traveling device 120 based on the data by the control unit 160, is because those which induce AGV 100 in position.

図7に、パレット200に対して無人搬送車100を自動で誘導する様子をグラフに示す。無人搬送車100の移動の様子を5秒ごとに重ねて書き表していて、図7の初期位置ではパレット200の中心に対して無人搬送車100の中心がズレ角θ0だけズレている。この状態から、無人搬送車100を自動で誘導し、パレット200の下に収まる様子が示されている。図8には、距離センサによるブラケットとの計測距離に関するグラフを示す。縦軸にレーザーセンサ150の位置(m)を、横軸に経過時間(秒)を示す。図9には、走行装置の舵角に関するグラフを示す。縦軸に角度(deg)を、横軸に経過時間(秒)を示す。 FIG. 7 is a graph showing how the automatic guided vehicle 100 is automatically guided with respect to the pallet 200. The state of the movement of the automatic guided vehicle 100 is overwritten every 5 seconds, and the center of the automatic guided vehicle 100 is shifted from the center of the pallet 200 by a deviation angle θ 0 at the initial position in FIG. From this state, the state where the automatic guided vehicle 100 is automatically guided and fits under the pallet 200 is shown. In FIG. 8, the graph regarding the measurement distance with the bracket by a distance sensor is shown. The vertical axis represents the position (m) of the laser sensor 150, and the horizontal axis represents the elapsed time (seconds). In FIG. 9, the graph regarding the steering angle of a traveling apparatus is shown. The vertical axis represents the angle (deg), and the horizontal axis represents the elapsed time (seconds).

車体110に取り付けたレーザーセンサ150は、第1ラインL1上に設けられた第1センサ151、第2センサ152と、第2ラインL2上に設けられた第3センサ153、第4センサ154がセットになって、或いは、第1ラインL1上に設けられた第1センサ151、第2センサ152と、第3ラインL3上に設けられた第5センサ155、第6センサ156がセットになって運用される。図4に示すように、第1ラインL1は車体110の先端に設けられるが、センサ保護などの観点から先端より少し後ろ側に配置しても良い。ただし、第1ラインL1に配置される第1センサ151と第2センサ152は車体110がパレット200に入った時に真っ先に検知する機能を担うため、出来るだけ車体110の先端に近い位置に配置されることが望ましい。   The laser sensor 150 attached to the vehicle body 110 includes a first sensor 151 and a second sensor 152 provided on the first line L1, and a third sensor 153 and a fourth sensor 154 provided on the second line L2. Alternatively, the first sensor 151 and the second sensor 152 provided on the first line L1 and the fifth sensor 155 and the sixth sensor 156 provided on the third line L3 are used as a set. Is done. As shown in FIG. 4, the first line L1 is provided at the front end of the vehicle body 110, but may be disposed slightly behind the front end from the viewpoint of sensor protection. However, since the first sensor 151 and the second sensor 152 arranged in the first line L1 have a function of detecting the vehicle body 110 when it enters the pallet 200, the first sensor 151 and the second sensor 152 are arranged as close to the tip of the vehicle body 110 as possible. It is desirable.

第2ラインL2は、上述した通り走行装置の1列目、即ち第1走行装置121及び第2走行装置122の上辺りに設けられる。この位置は第1ラインに近い方が良いため、角度検出に支障が無いレベルで、車体110の先端寄りで、車体110の中央より前に配置されるのが好ましい。これは、センサ150を用いた車体110の位置検出を出来るだけ早い段階で行いたいという要望による。本実施形態の構成であれば、第1ラインL1及び第2ラインL2の両方がブラケット230に交差する位置から誘導が開始出来る。   As described above, the second line L <b> 2 is provided in the first row of the traveling devices, that is, around the first traveling device 121 and the second traveling device 122. Since this position should be closer to the first line, it is preferable that the position be located near the tip of the vehicle body 110 and in front of the center of the vehicle body 110 at a level that does not hinder the angle detection. This is due to the desire to detect the position of the vehicle body 110 using the sensor 150 as early as possible. With the configuration of the present embodiment, guidance can be started from a position where both the first line L1 and the second line L2 intersect the bracket 230.

一方で、第3ラインL3は、第5走行装置125、第6走行装置126より後ろ、車体110の中心よりも後ろに設けられているので、第3ラインL3がブラケット230と交差する位置に移動した後、無人搬送車100の誘導に使うことが出来る。その結果が図8に示される第2ポジションデータLZS2の使用の範囲と第3ポジションデータLZS3の使用の範囲となる。なお、第3ラインL3の設定は、車体110の補正を考えると出来るだけ車体110の先頭から離れた位置が望ましいが、あまり車体110の後方に配置しすぎると、車体110の大半がパレット200の下に収まってしまい、誘導に使える区間が短くなる。このため、本実施形態では第3ラインL3を車体110の先端から中程より少し後方に位置するように配置している。   On the other hand, since the third line L3 is provided behind the fifth traveling device 125 and the sixth traveling device 126 and behind the center of the vehicle body 110, the third line L3 moves to a position where it intersects the bracket 230. After that, it can be used for guiding the automatic guided vehicle 100. The result is the range of use of the second position data LZS2 and the range of use of the third position data LZS3 shown in FIG. The setting of the third line L3 is preferably a position as far as possible from the top of the vehicle body 110 in consideration of correction of the vehicle body 110. However, if the vehicle is placed too far behind the vehicle body 110, most of the vehicle body 110 is placed on the pallet 200. The section that can be used for guidance is shortened because it falls below. For this reason, in the present embodiment, the third line L3 is disposed so as to be located slightly rearward from the center of the vehicle body 110.

車体110の傾きは第1センサ151及び第2センサ152からより離れている第5センサ155及び第6センサ156の方が優位に検出することが出来る。これは、レーザーセンサ150が距離を検出する為、無人搬送車100の先頭から距離がある方が差は大きく開く傾向にある為である。そして、図9に示す各軸の舵角に関するグラフでも同様の傾向を示している。各軸の舵角δも時間経過と共に角度0に収束する事が分かる。つまり、第2ポジションデータLZS2より第3ポジションデータLZS3を用いた方が検出に有利だと言える。この結果、無人搬送車100の誘導に対しても有利となる。 The inclination of the vehicle body 110 can be detected more preferentially by the fifth sensor 155 and the sixth sensor 156 that are further away from the first sensor 151 and the second sensor 152. This is because the laser sensor 150 detects the distance, and therefore the difference tends to increase greatly when the distance from the head of the automatic guided vehicle 100 is increased. And the graph regarding the steering angle of each axis | shaft shown in FIG. 9 also shows the same tendency. It can be seen that the rudder angle δ n of each axis also converges to an angle of 0 over time. That is, it can be said that the third position data LZS3 is more advantageous for detection than the second position data LZS2. As a result, it is advantageous for guiding the automatic guided vehicle 100.

次に、無人搬送車100に対して外乱が加えられた時の状況について説明する。外乱は、無人搬送車100が通過する路面に凹凸があったり、レーザーセンサ150にノイズが発生したりした場合に発生することが考えられ、実際の運用時には想定される事態である。図10には、従来技術における比較のために用意した外乱が発生した場合の、走行装置120の舵角に関するグラフを示す。図10では、第3ラインL3に備えるセンサ、つまり第5センサ155、第6センサ156を使わなかった場合を示している。図11には、本実施形態の、外乱が発生した場合の、走行装置120の舵角に関するグラフを示す。図10、図11共に誘導開始から50秒後に外乱が加わった場合の様子を示している。何れも同じ条件での外乱付与で比較した。   Next, the situation when a disturbance is applied to the automatic guided vehicle 100 will be described. The disturbance may occur when the road surface on which the automatic guided vehicle 100 passes is uneven or noise is generated in the laser sensor 150, and is a situation assumed in actual operation. In FIG. 10, the graph regarding the steering angle of the traveling apparatus 120 when the disturbance prepared for the comparison in a prior art generate | occur | produces is shown. FIG. 10 shows a case where the sensors provided in the third line L3, that is, the fifth sensor 155 and the sixth sensor 156 are not used. In FIG. 11, the graph regarding the steering angle of the traveling apparatus 120 when the disturbance generate | occur | produces of this embodiment is shown. FIG. 10 and FIG. 11 both show the situation when a disturbance is applied 50 seconds after the start of guidance. All were compared by applying disturbance under the same conditions.

比較して分かるように、第3ラインL3に備えるセンサ、つまり第5センサ155、第6センサ156を使わなかった場合には、各軸の舵角が大きく乱れている事が分かるが、本実施例によれば、大きく乱れること無く位置を修正することが出来ている。すなわち外乱が発生するような場合にも、本実施形態による無人搬送車100であれば素早く位置修正が可能である。   As can be seen from the comparison, when the sensors provided for the third line L3, that is, the fifth sensor 155 and the sixth sensor 156 are not used, it can be seen that the steering angle of each axis is greatly disturbed. According to the example, the position can be corrected without being greatly disturbed. That is, even when a disturbance occurs, the position can be quickly corrected with the automatic guided vehicle 100 according to the present embodiment.

なお、第1ポジションデータLZS1乃至第3ポジションデータLZS3はそれぞれ2つずつのレーザーセンサ150を用いている。距離計測はこの何れを使っても良いが、相互にデータを補完し合うのが望ましい。そうすることで外乱があった場合等でも対応が可能となる。その結果、車体110の正確な位置把握が可能となり、無人搬送車100の正確な誘導に貢献することができる。もちろん、外乱が発生しない場合には、第2ラインL2の第3センサ153及び第4センサ154、又は第3ラインL3の第5センサ155及び第6センサ156の何れかだけを用いて、無人搬送車100を誘導することが可能である。   The first position data LZS1 to the third position data LZS3 use two laser sensors 150 each. Any of these may be used for distance measurement, but it is desirable to complement the data with each other. By doing so, it is possible to cope with a disturbance. As a result, it is possible to accurately grasp the position of the vehicle body 110 and contribute to accurate guidance of the automatic guided vehicle 100. Of course, when no disturbance occurs, unmanned conveyance using only the third sensor 153 and the fourth sensor 154 of the second line L2, or the fifth sensor 155 and the sixth sensor 156 of the third line L3. The car 100 can be guided.

また、無人搬送システムの課題として、特許文献1に示すような無人搬送システムは従来から考案されていたものの、実際の現場ではコストに見合わないとして無人搬送車の誘導は行われてこなかった。   In addition, as an unmanned transport system, an unmanned transport system such as that shown in Patent Document 1 has been devised in the past. However, in the actual site, the automatic guided vehicle has not been guided because it does not meet the cost.

しかし本実施形態では、搬送物を載置する台部と、該台部を支持する脚部と、を備えるパレットと、該パレットを持ち上げ支持する持上手段と、複数の独立制御可能な走行装置と、該走行装置を制御する制御手段と、を備える無人搬送車と、を有し、前記無人搬送車を、前記持上手段により前記パレットを持ち上げ可能な前記脚部の間の位置まで走行させる無人搬送システムにおいて、前記無人搬送車の中心線上に仮想原点を定め、該仮想原点が前記パレットの中心線の直下に位置するように前記無人搬送車の走行位置を補正すること、を特徴とする無人搬送システムを提案している。   However, in the present embodiment, a pallet including a pedestal portion on which a conveyed product is placed, a leg portion that supports the pedestal portion, lifting means that lifts and supports the pallet, and a plurality of independently controllable traveling devices. And a control means for controlling the traveling device, and the automatic guided vehicle travels to a position between the leg portions where the pallet can be lifted by the lifting means. In the automatic guided system, a virtual origin is defined on the center line of the automatic guided vehicle, and the traveling position of the automatic guided vehicle is corrected so that the virtual origin is located immediately below the center line of the pallet. It proposes an automated transport system.

つまり、ワーク280を載置するベース210と、ベース210を支持する脚部220と、を備えるパレット200と、パレット200を持ち上げ支持するリフタ140と、複数の独立制御可能な走行装置120を備える無人搬送車100と、を有し、無人搬送車100を、リフタ140によりパレット200を持ち上げ可能な脚部220の間の位置まで走行させる無人搬送システム500において、無人搬送車100の中心線上に仮想原点を定め、該仮想原点がパレット200の中心線の直下に位置するように無人搬送車100の走行位置を補正している。   That is, the pallet 200 including the base 210 on which the work 280 is placed, the leg portion 220 that supports the base 210, the lifter 140 that lifts and supports the pallet 200, and a plurality of independently controllable traveling devices 120 are provided. In the unmanned transport system 500 that includes the transport vehicle 100 and travels the unmanned transport vehicle 100 to a position between the leg portions 220 where the pallet 200 can be lifted by the lifter 140, a virtual origin is set on the center line of the unmanned transport vehicle 100. And the traveling position of the automatic guided vehicle 100 is corrected so that the virtual origin is located immediately below the center line of the pallet 200.

この結果、例えば図6に示される仮想原点である第1仮想原点VP1及び第3仮想原点VP3を車体110の中心線CL上の任意の2点に定め、これを元に第1三角形Aと第2三角形A及び第3三角形Bと第4三角形Bが設定される。そして、これらの三角形の相似性を利用して、旋回中心ARを求めている。そうして、無人搬送車100を求められた旋回中心ARや旋回半径を実現するように、各軸の舵角δを決定して移動することで、無人搬送車100をパレット200の下の所定の位置に誘導が可能となる。 As a result, for example, the first virtual origin VP1 and the third virtual origin VP3, which are the virtual origins shown in FIG. 6, are determined as two arbitrary points on the center line CL of the vehicle body 110, and based on this, the first triangle A 1 and the second triangle a 2 and the third triangle B 1 and the fourth triangle B 2 is set. Then, using the similarity of these triangles, the turning center AR is obtained. Then, the automatic guided vehicle 100 is moved to a predetermined position under the pallet 200 by determining and moving the rudder angle δ of each axis so as to realize the required turning center AR and turning radius. It is possible to guide to the position.

以上、本発明に係る無人搬送システム500の実施形態を説明したが、本発明はこれに限定されるわけではなく、その趣旨を逸脱しない範囲で様々な変更が可能である。例えば、本実施形態で示す無人搬送車100の車体110の形状は、略台形の形状をしているが、この形状に限定されるものではなく例えば特許文献1の様な形状でも適用が可能である。また、パレット200の形状などもこれに限定されるものではない。また、本実施形態では走行装置120の駆動輪を6箇所としているが、これを増減することを妨げない。   As mentioned above, although embodiment of the automatic guided system 500 concerning this invention was described, this invention is not necessarily limited to this, A various change is possible in the range which does not deviate from the meaning. For example, the shape of the vehicle body 110 of the automatic guided vehicle 100 shown in the present embodiment has a substantially trapezoidal shape. However, the shape is not limited to this shape, and for example, a shape as in Patent Document 1 can be applied. is there. Further, the shape of the pallet 200 is not limited to this. Further, in the present embodiment, there are six driving wheels of the traveling device 120, but it is not hindered to increase or decrease these.

また、本実施形態では仮想原点を第1仮想原点VP1及び第3仮想原点VP3として計算しているが、前述したように第2仮想原点を用いても計算できる。仮想原点は、前述の通りに無人搬送車100の車体110の中心線CL上の任意の2点を仮想原点とすれば良く、第1仮想原点VP1乃至第3仮想原点VP3以外を用いることでも、無人搬送車100の誘導が可能である。   In this embodiment, the virtual origin is calculated as the first virtual origin VP1 and the third virtual origin VP3. However, as described above, the virtual origin can also be calculated using the second virtual origin. As described above, the virtual origin may be any two points on the center line CL of the vehicle body 110 of the automatic guided vehicle 100 as the virtual origin, and by using other than the first virtual origin VP1 to the third virtual origin VP3, The automatic guided vehicle 100 can be guided.

このほか、本実施形態においては第1仮想原点VP1を第2ラインL2と無人搬送車100の中心線CLの交点に定めると共に、第2仮想原点VP2から第2ラインL2までの距離、及び第3仮想原点VP3から第3ラインL3までの距離が第1仮想原点VP1から第1ラインL1までの距離と等しくなるように仮想原点を定めているが、仮想原点の位置はこれに限定されるものではない。この場合でも、仮想原点の進行方向を仮想原点の旋回軌跡の接線方向とすると、仮想原点から引いた垂線上に旋回中心が存在するように設定する事で無人搬送車100の誘導を行う。   In addition, in the present embodiment, the first virtual origin VP1 is determined at the intersection of the second line L2 and the center line CL of the automatic guided vehicle 100, the distance from the second virtual origin VP2 to the second line L2, and the third The virtual origin is determined so that the distance from the virtual origin VP3 to the third line L3 is equal to the distance from the first virtual origin VP1 to the first line L1, but the position of the virtual origin is not limited to this. Absent. Even in this case, if the traveling direction of the virtual origin is the tangential direction of the turning locus of the virtual origin, the automatic guided vehicle 100 is guided by setting so that the turning center exists on the perpendicular drawn from the virtual origin.

100 無人搬送車
110 車体
120 走行装置
140 リフタ
150 レーザーセンサ
200 パレット
210 ベース
220 脚部
230 ブラケット
280 ワーク
500 無人搬送システム
100 automatic guided vehicle 110 vehicle body 120 traveling device 140 lifter 150 laser sensor 200 pallet 210 base 220 leg 230 bracket 280 work 500 automatic guided system

Claims (3)

搬送物を載置する台部と、該台部を支持する脚部と、を備えるパレットと、
該パレットを持ち上げ支持する持上手段と、複数の独立制御可能な走行装置と、該走行装置を制御する制御手段と、を備える無人搬送車と、を有し、
前記無人搬送車を、前記持上手段により前記パレットを持ち上げ可能な前記脚部の間の位置まで走行させる無人搬送システムにおいて、
前記台部の下面には、下方に突出し前記パレットの中心線を貫くように延配される被検出体が備えられ、
前記無人搬送車には、少なくとも3つの距離測定手段が備えられ、該距離測定手段から得られたデータを元に前記制御手段によって前記距離測定手段で前記被検出体までの距離を検出し、前記制御手段により前記データに基づいて前記走行装置の舵角を調整し、前記無人搬送車を適切な位置に誘導すること、
を特徴とする無人搬送システム。
A pallet comprising a platform on which the object is placed and a leg that supports the platform;
A lifting means for lifting and supporting the pallet, a plurality of independently controllable traveling devices, and a control means for controlling the traveling device, and an automatic guided vehicle,
In the unmanned transport system that travels the automatic guided vehicle to a position between the legs that can lift the pallet by the lifting means,
On the lower surface of the pedestal portion, a detected object is provided that protrudes downward and extends through the center line of the pallet,
The automatic guided vehicle is provided with at least three distance measuring means, and the distance to the detected object is detected by the distance measuring means by the control means based on data obtained from the distance measuring means, Adjusting the steering angle of the traveling device based on the data by the control means, and guiding the automatic guided vehicle to an appropriate position;
Unmanned transport system.
請求項1に記載の無人搬送システムにおいて、
前記距離測定手段は、特定の波長を出してその反射波を測定することにより距離を算出する距離センサを用いたものであり、
3つの前記距離測定手段は、第1距離センサ、第2距離センサ、及び第3距離センサよりなり、
前記第1距離センサが前記無人搬送車の前端付近に、前記第2距離センサが前記第1距離センサの近傍であって前記無人搬送車の中央より前に、前記第3距離センサが前記無人搬送車の中央より後方で後端より前方に配置され、
前記第1距離センサと前記第2距離センサ、又は前記第1距離センサと前記第3距離センサより得られた前記データを用い、前記制御手段に備える演算装置により前記無人搬送車の旋回中心を算出し、該旋回中心からの距離である旋回半径から前記走行装置の舵角を算出すること、
を特徴とする無人搬送システム。
In the unmanned conveyance system of Claim 1,
The distance measuring means uses a distance sensor that calculates a distance by emitting a specific wavelength and measuring a reflected wave thereof,
The three distance measuring means comprise a first distance sensor, a second distance sensor, and a third distance sensor,
The first distance sensor is in the vicinity of the front end of the automatic guided vehicle, the second distance sensor is in the vicinity of the first distance sensor and before the center of the automatic guided vehicle, and the third distance sensor is in the automatic guided vehicle. Located behind the center of the car and ahead of the rear end,
Using the data obtained from the first distance sensor and the second distance sensor, or the first distance sensor and the third distance sensor, the turning center of the automatic guided vehicle is calculated by an arithmetic unit provided in the control means. And calculating the steering angle of the traveling device from a turning radius that is a distance from the turning center,
Unmanned transport system.
搬送物を載置する台部と、該台部を支持する脚部と、を備えるパレットと、
該パレットを持ち上げ支持する持上手段と、複数の独立制御可能な走行装置と、該走行装置を制御する制御手段と、を備える無人搬送車と、を有し、
前記無人搬送車を、前記持上手段により前記パレットを持ち上げ可能な前記脚部の間の位置まで走行させる無人搬送システムにおいて、
前記無人搬送車の中心線上に仮想原点を定め、該仮想原点が前記パレットの中心線の直下に位置するように前記無人搬送車の走行位置を補正すること、
を特徴とする無人搬送システム。
A pallet comprising a platform on which the object is placed and a leg that supports the platform;
A lifting means for lifting and supporting the pallet, a plurality of independently controllable traveling devices, and a control means for controlling the traveling device, and an automatic guided vehicle,
In the unmanned transport system that travels the automatic guided vehicle to a position between the legs that can lift the pallet by the lifting means,
A virtual origin is defined on the center line of the automatic guided vehicle, and the travel position of the automatic guided vehicle is corrected so that the virtual origin is located immediately below the center line of the pallet;
Unmanned transport system.
JP2016124880A 2016-06-23 2016-06-23 Unmanned conveyance system Pending JP2017228158A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2016124880A JP2017228158A (en) 2016-06-23 2016-06-23 Unmanned conveyance system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2016124880A JP2017228158A (en) 2016-06-23 2016-06-23 Unmanned conveyance system

Publications (1)

Publication Number Publication Date
JP2017228158A true JP2017228158A (en) 2017-12-28

Family

ID=60891896

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2016124880A Pending JP2017228158A (en) 2016-06-23 2016-06-23 Unmanned conveyance system

Country Status (1)

Country Link
JP (1) JP2017228158A (en)

Similar Documents

Publication Publication Date Title
US10414640B2 (en) Forklift
JP6507894B2 (en) Travel control method at unloading in unmanned forklift and travel control device at unloading
JP4823858B2 (en) Mobility performance test equipment
JP7533270B2 (en) Forklift and method for controlling forklift
JP2009525553A (en) Automatic guided vehicle with variable travel path
JP7047659B2 (en) Control device and control method for automatic guided vehicle
JP5218479B2 (en) Mobile system
JP2017199257A (en) Autonomous travel vehicle
JPH0895638A (en) Travel control device for mobile work robot
JP7268336B2 (en) Travel control device for unmanned forklift, travel control method for unmanned forklift, travel control device for unmanned towing vehicle, travel control method for unmanned towing vehicle
JP2021028796A (en) Travel control apparatus
JP2002182744A (en) Guidance device for unmanned guided vehicles on pallets
JP6545978B2 (en) Work vehicle guidance system
JP4427360B2 (en) Method and device for guiding entry of automatic guided vehicle into pallet
JP6264541B2 (en) Approach control method and automatic guided equipment for automatic guided vehicle
JP2017228158A (en) Unmanned conveyance system
JP4193928B2 (en) Travel control system for self-propelled portal crane
JP6111684B2 (en) Automated guided vehicle
JP7561536B2 (en) Automated guided vehicles
JP2000330635A (en) Automatic guided vehicle
JPH07281747A (en) Drive control device for automated guided vehicles
US20250362690A1 (en) Method for determining the pose of a pallet relative to an industrial truck, and industrial truck
JP6332510B2 (en) Position detection method for automated guided vehicles
JP5785749B2 (en) Automated transport system and automated guided vehicle
JP7518363B2 (en) Pallet carrier vehicle and method for guiding pallet carrier vehicle