JP5689278B2 - Control method of automatic guided vehicle - Google Patents

Control method of automatic guided vehicle Download PDF

Info

Publication number
JP5689278B2
JP5689278B2 JP2010237594A JP2010237594A JP5689278B2 JP 5689278 B2 JP5689278 B2 JP 5689278B2 JP 2010237594 A JP2010237594 A JP 2010237594A JP 2010237594 A JP2010237594 A JP 2010237594A JP 5689278 B2 JP5689278 B2 JP 5689278B2
Authority
JP
Japan
Prior art keywords
traveling
conductor
guided vehicle
drive unit
new
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.)
Active
Application number
JP2010237594A
Other languages
Japanese (ja)
Other versions
JP2012089078A (en
Inventor
陸生 波多野
陸生 波多野
光宇 孫
光宇 孫
正浩 小澤
正浩 小澤
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.)
Shintec Hozumi Co Ltd
Original Assignee
Shintec Hozumi Co 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 Shintec Hozumi Co Ltd filed Critical Shintec Hozumi Co Ltd
Priority to JP2010237594A priority Critical patent/JP5689278B2/en
Priority to CN201110078816.2A priority patent/CN102452400B/en
Publication of JP2012089078A publication Critical patent/JP2012089078A/en
Application granted granted Critical
Publication of JP5689278B2 publication Critical patent/JP5689278B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、予め定められた経路に沿って自動で走行して物品等を搬送する自動搬送車の制御方法に関する。   The present invention relates to a control method for an automatic transport vehicle that automatically travels along a predetermined route to transport articles and the like.

従来より、例えば、工場内の予め設定された経路に沿って走行する自動搬送車が知られている。自動搬送車は、駆動用のモータやバッテリ等を備えているほか、床面に敷設された磁気テープ等の導線を検出するための検出センサを備えている。このような自動搬送車にワークを積載すれば、導線が敷設された所定の経路に沿って無人でワークを搬送できる。   Conventionally, for example, an automated guided vehicle that travels along a preset route in a factory is known. The automatic transport vehicle includes a drive motor, a battery, and the like, and a detection sensor for detecting a conducting wire such as a magnetic tape laid on the floor surface. If a workpiece is loaded on such an automatic conveyance vehicle, the workpiece can be unmannedly conveyed along a predetermined route on which a conducting wire is laid.

さらに、例えば、工場内の搬送ニーズに応じた様々な経路に幅広く対応できるよう、異なる導線間の乗り換えを可能とした自動搬送車も提案されている(例えば、特許文献1参照。)。ここでは、平行に敷設された2本の導線の間隙に、自動搬送車を横行させるための横行導線を敷設することで、前記2本の導線間の乗り換えを可能としている。さらに、前進から横行への移行に際して自動搬送車を脱線させないための工夫として、横行導線の手前に斜行導線を敷設したり、横行導線に乗り移るときに一旦、停止させる技術が開示されている。   Furthermore, for example, an automatic transport vehicle that enables transfer between different conductors has been proposed so that various routes according to transport needs in the factory can be widely handled (see, for example, Patent Document 1). Here, the crossing between the two conductors is enabled by laying a transverse conductor for traversing the automated guided vehicle in the gap between the two conductors laid in parallel. Further, as a device for preventing the automatic guided vehicle from being derailed when moving from advancing to traversing, a technique is disclosed in which an oblique conducting wire is laid before the traversing conducting wire or is temporarily stopped when moving to the traversing conducting wire.

しかしながら、前記従来の自動搬送車では、次のような問題がある。すなわち、横行導線の手前に斜行導線を敷設する等、設置側の構成が複雑化したり、横行導線への乗り換え時に一旦、停止させると自動搬送車の滑らかな走行が阻害され、ワークを迅速に搬送できなくなるおそれがある。   However, the conventional automated guided vehicle has the following problems. In other words, if the installation side is complicated, such as laying a slanting conductor in front of the transverse conductor, or if it is stopped once when changing to the transverse conductor, the smooth running of the automated guided vehicle will be hindered, and the workpiece will be quickly There is a risk that it cannot be transported.

特開2009−223561号公報JP 2009-223561 A

本発明は、前記従来の問題点に鑑みてなされたものであり、前記自動搬送車を横行又は斜行させた後、新たな導線に対する追従状態に移行させるための制御方法であって、新たな導線に円滑に乗り移ることで、追従状態への移行に要する時間を短縮可能な自動搬送車の制御方法を提供しようとするものである。   The present invention has been made in view of the above-described conventional problems, and is a control method for shifting the automatic transport vehicle to a follow-up state with respect to a new conducting wire after traversing or skewing. An object of the present invention is to provide a method for controlling an automatic guided vehicle capable of shortening the time required for shifting to a follow-up state by smoothly transferring to a conducting wire.

本発明は、個別に駆動される2本1組の駆動輪が同軸に配置されていると共に当該2本1組の駆動輪の回転差に応じて旋回して操舵される前後2基の駆動ユニットと、経路に沿って敷設された所定幅の導線を検出するために駆動ユニットの前進側の正面に取り付けられた検出センサと、を備えた自動搬送車が横行又は斜行して新たな導線へ接近し、追従状態へ移行するための制御方法であって、
前記新たな導線に対して前記駆動ユニットを進入角aで前進させることにより、前記自動搬送車が横行又は斜行して前記新たな導線に接近する第1の走行ステップと、
少なくとも何れかの駆動ユニットの検出センサが前記新たな導線を検出した後、該検出センサが再度、該新たな導線を検出しなくなるまで該駆動ユニットを前記進入角aのまま前進させる第2の走行ステップと、
該第2の走行ステップの後、前記検出センサにより前記新たな導線を再検出できるように前記駆動ユニットを操舵する第3の走行ステップと、
前記新たな導線に対して前記駆動ユニットを斜め方向に進入させ、前記検出センサにより前記新たな導線が再検出された後、該新たな導線に追従して走行するように前記駆動ユニットを操舵する追従走行制御への切換を実行する移行ステップと、を含み、
前記検出センサは、前記駆動ユニットの進行方向に直交する方向に延設された検出エリアを含み、前記導線を検出しているか否かのみならず、前記検出エリアのどの部分が前記導線を検出しており、どの部分が検出していないかを検知可能であると共に、前記検出エリア内における検出部分と非検出部分との組合せに応じて前記導線の幅方向両側の縁部をなす導線エッジを検出可能であり、
前記移行ステップでは、前記検出センサが前記新たな導線を検出するのみでは前記追従走行制御への切換が実行されず、前記検出センサが新たな導線を検出した後、前記導線の幅方向両側の導線エッジのうち前記駆動ユニットの前進方向側の導線エッジが検出されたときに前記追従走行制御への切換が実行される自動搬送車の制御方法にある(請求項1)。
The present invention has two front and rear drive units in which two sets of drive wheels that are driven individually are arranged coaxially and are turned and steered according to the rotational difference between the two sets of drive wheels. And a detection sensor attached to the front side of the drive unit in order to detect a conductor having a predetermined width laid along the path, and an automatic guided vehicle traversing or skewing to a new conductor A control method for approaching and shifting to a follow-up state,
A first traveling step in which the automatic conveyance vehicle approaches the new conductor by traversing or skewing by moving the drive unit forward at an approach angle a with respect to the new conductor;
After the detection sensor of at least one of the drive units detects the new conducting wire, the second traveling advances the drive unit at the entry angle a until the detection sensor again detects the new conducting wire. Steps,
After the second traveling step, a third traveling step for steering the drive unit so that the new conducting wire can be redetected by the detection sensor;
The drive unit is made to enter the oblique direction with respect to the new conductor, and after the new conductor is re-detected by the detection sensor, the drive unit is steered so as to follow the new conductor. A transition step for performing switching to follow-up running control,
The detection sensor includes a detection area extending in a direction orthogonal to the traveling direction of the drive unit, and not only whether or not the conductor is detected, which part of the detection area detects the conductor. It is possible to detect which part is not detected, and to detect the conductor edge forming the edges on both sides in the width direction of the conductor according to the combination of the detection part and the non-detection part in the detection area Is possible,
In the transition step, switching to the following traveling control is not performed only by the detection sensor detecting the new conductor, and after the detection sensor detects a new conductor, the conductors on both sides of the conductor in the width direction are detected. In the control method of the automatic guided vehicle , the switching to the following traveling control is executed when the lead edge on the forward direction side of the drive unit is detected among the edges .

本発明の自動搬送車の制御方法では、前記自動搬送車を前記新たな導線に対する追従状態へ移行させるに当たって、前記第2の走行ステップのごとく、前記検出センサが前記新たな導線を検出しても直ちに追従走行制御に切り換えることはない。まずは、該検出センサが再度、前記新たな導線を検出しない状態になるまで前記駆動ユニットをそのまま前進させて通過させる。その後、前記新たな導線を再検出できるように前記駆動ユニットを操舵する。   In the control method for the automatic guided vehicle according to the present invention, when the automatic guided vehicle is shifted to the following state with respect to the new conducting wire, the detection sensor detects the new conducting wire as in the second traveling step. There is no immediate switch to follow-up running control. First, the drive unit is moved forward and passed until the detection sensor again detects the new conductor. Thereafter, the drive unit is steered so that the new conductor can be detected again.

前記移行ステップでは、前記新たな導線に対して前記駆動ユニットが斜め方向から進入する。例えば、導線の左側から進入する場合、前記検出エリアの右側から前記導線が検出され始める。本来、左操舵が必要とされるこの時点で前記追従走行制御に切り換えると、前記検出エリアの右側で検出した導線を中央で検出できるよう、逆向きの右操舵が発生するおそれがある。一方、上記のように駆動ユニットの前進方向側の前記導線エッジが検出されたときに前記追従走行制御への切換を実行する場合であれば、導線から逸脱しないように左方向の操舵を適切に発生させることができる。前記駆動ユニットの前進方向側の導線エッジが検出されたときに前記追従走行制御への切換を実行すれば、上記のような逆操舵を回避でき、前記追従走行制御への切換時の前記自動搬送車の挙動を安定させることができる。
本発明においては、前記移行ステップにおける前記新たな導線に対する前記駆動ユニットの進入角が、前記進入角aよりも小さい進入角bであることが好ましい(請求項2)。
この制御方法では、上記のような駆動ユニットの操舵を経由して、前記進入角aより小さい前記進入角bで前記新たな導線に対して前記駆動ユニットを再接近させる。そして、前記検出センサによる前記新たな導線の再検出に応じて、前記追従走行制御への切換が実行される。前記進入角bで前記新たな導線に接近して前記追従走行制御に切り換える場合であれば、前記進入角aで前記新たな導線に接近して前記追従走行制御に切り換える場合と比較して、導線から逸脱してしまう脱線のおそれを抑制できる。
In the transition step, the driving unit enters the new conducting wire from an oblique direction. For example, when entering from the left side of the conducting wire, the conducting wire starts to be detected from the right side of the detection area. If switching to the follow-up running control at this time when left steering is originally required, reverse right steering may occur so that the conductor detected on the right side of the detection area can be detected at the center. On the other hand, if switching to the follow-up running control is performed when the conductor edge on the forward direction side of the drive unit is detected as described above, steering in the left direction is appropriately performed so as not to deviate from the conductor. Can be generated. If switching to the following traveling control is executed when a lead wire edge on the forward direction side of the drive unit is detected, the reverse steering as described above can be avoided, and the automatic conveyance at the time of switching to the following traveling control is performed. Car behavior can be stabilized.
In this invention, it is preferable that the approach angle of the said drive unit with respect to the said new conducting wire in the said transition step is the approach angle b smaller than the said approach angle a (Claim 2).
In this control method, the drive unit is re-approached to the new conducting wire at the approach angle b smaller than the approach angle a via the steering of the drive unit as described above. Then, switching to the following traveling control is executed in response to the re-detection of the new conductor by the detection sensor. If the approach angle b approaches the new conductor and switches to the follow-up running control, the lead wire is compared with the approach angle a approach to the new conductor and the follow-up running control. The risk of derailment that deviates from can be suppressed.

本発明の制御方法では、横行あるいは斜行の後、少なくとも何れかの駆動ユニットが前記新たな導線を通り過ぎるように制御することで、本来、脱線してしまうような進入角あるいは速度での前記新たな導線への接近が可能となっている。その後、前記進入角を抑えて前記新たな導線に再接近させれば、前記自動搬送車が脱線するおそれを抑制しつつ前記追従走行制御に切り換えることができる。   According to the control method of the present invention, after traversing or skewing, at least one of the drive units is controlled so as to pass the new conducting wire, so that the new angle at an approaching angle or speed at which derailment is inherently caused. It is possible to access to a simple lead wire. Thereafter, if the approach angle is suppressed and the new conductor is re-approached, it is possible to switch to the following traveling control while suppressing the possibility that the automatic guided vehicle will derail.

このように本発明の自動搬送車の制御方法によれば、前記新たな導線への追従状態に円滑に移行でき、移行に要する時間を短縮可能である。   As described above, according to the control method of the automatic guided vehicle of the present invention, it is possible to smoothly shift to the following state of the new conductor, and it is possible to shorten the time required for the transition.

本発明において、前記第1の走行ステップ〜前記第3の走行ステップの実行回数は、1回であっても良いし、2回以上であっても良い。例えば、実行回数が2回であれば、前記新たな導線を中心として、その両側を前記駆動ユニットが蛇行するように制御される。例えば、進入角が大きかったり、前記駆動ユニットの速度が速い場合等であれば、実行回数を複数回にして上記のような蛇行を発生させることが良い。このような蛇行を次第に収束させるように制御すれば、前記新たな導線に対する追従状態への移行を確実性高く実行できる。   In the present invention, the number of executions of the first traveling step to the third traveling step may be one or may be two or more. For example, if the number of executions is two, the drive unit is controlled to meander on both sides of the new conductor. For example, if the approach angle is large or the speed of the drive unit is high, it is preferable to generate the meandering as described above by making the number of executions a plurality of times. If such meandering is controlled to gradually converge, the transition to the follow-up state for the new conductor can be performed with high reliability.

また、前記進入角は、前記自動搬送車が横行又は斜行により進行する第1の方向と、前記新たな導線に追従して前記自動搬送車を進行させる第2の方向と、のなす角を意味している。前記自動搬送車が横行する場合には、この進入角が約90度となる。この進入角が90度よりも小さくなるほど、前記新たな導線への乗り移りが容易となる。一方、この進入角が90度を超える場合には、前記第2の方向とは逆向きの方向成分が、前記第1の方向に包含されることになる。それ故、前記進入角が90度を超えるほど、前記新たな導線への乗り移りの難易度が高くなる。   Further, the approach angle is an angle formed by a first direction in which the automatic transport vehicle travels by traversing or skewing and a second direction in which the automatic transport vehicle travels following the new conductor. I mean. When the automatic transport vehicle traverses, this approach angle is about 90 degrees. As this approach angle becomes smaller than 90 degrees, the transfer to the new conductor becomes easier. On the other hand, when the approach angle exceeds 90 degrees, a direction component opposite to the second direction is included in the first direction. Therefore, as the approach angle exceeds 90 degrees, the difficulty of transferring to the new conductor increases.

また、前記検出センサは、前記駆動ユニットの進行方向に直交する方向に延設された検出エリアを含み、前記導線を検出しているか否かのみならず、前記検出エリアのどの部分が前記導線を検出しており、どの部分が検出していないかを検知可能であると共に、前記検出エリア内における検出部分と非検出部分との組合せに応じて前記導線の縁部をなす導線エッジを検出可能であり、
前記移行ステップでは、前記検出センサが前記新たな導線を検出するのみでは前記追従走行制御への切換が実行されず、その後、前進方向側の導線エッジが検出されたときに前記追従走行制御への切換が実行される
The detection sensor includes a detection area extending in a direction orthogonal to the traveling direction of the drive unit, and not only whether or not the conductor is detected, but also a portion of the detection area detects the conductor. It is possible to detect which part is detected and which part is not detected, and it is possible to detect the conductor edge that forms the edge of the conductor according to the combination of the detection part and the non-detection part in the detection area. Yes,
In the transition step, switching to the follow-up running control is not performed only by detecting the new conducting wire by the detection sensor, and then the follow-up running control is performed when a conducting wire edge on the forward direction side is detected. Switching is performed .

前記移行ステップでは、前記新たな導線に対して前記駆動ユニットが斜め方向から進入する。例えば、導線の左側から進入する場合、前記検出エリアの右側から前記導線が検出され始める。この時点で前記追従走行制御に切り換えられると、本来、左操舵が必要とされる状況であるにも関わらず、前記検出エリアの中央で導線を検出できるように逆向きの右操舵が発生するおそれがある。一方、上記のように駆動ユニットの前進方向側の前記導線エッジが検出されたときに前記追従走行制御への切換を実行する場合であれば、導線から逸脱しないように左方向の操舵を適切に発生させることができる。上記のような逆操舵を回避できれば、前記追従走行制御への切換時の前記自動搬送車の挙動を安定させることができる。   In the transition step, the driving unit enters the new conducting wire from an oblique direction. For example, when entering from the left side of the conducting wire, the conducting wire starts to be detected from the right side of the detection area. If the control is switched to the follow-up running control at this time, the right steering in the reverse direction may occur so that the conductor can be detected at the center of the detection area, even though the left steering is originally required. There is. On the other hand, if switching to the follow-up running control is performed when the conductor edge on the forward direction side of the drive unit is detected as described above, steering in the left direction is appropriately performed so as not to deviate from the conductor. Can be generated. If reverse steering as described above can be avoided, the behavior of the automatic guided vehicle at the time of switching to the follow-up traveling control can be stabilized.

また、前記自動搬送車は、自律航法による自律走行を可能とする自律航法手段を備えており、
前記第3の走行ステップは、前記自動搬送車が自律走行を行うステップであることが好ましい(請求項3)。
この場合には、進入角bで前記駆動ユニットを前進させるための導線を敷設する必要がなくなる。
In addition, the automatic transport vehicle includes autonomous navigation means that enables autonomous traveling by autonomous navigation,
The third traveling step is preferably a step in which the automatic guided vehicle performs autonomous traveling (claim 3).
In this case, it is not necessary to lay a conductor for advancing the drive unit at the approach angle b.

また、前記自動搬送車は、自律航法による自律走行を可能とする自律航法手段を備えており、
前記第1及び第2の走行ステップは、前記自動搬送車が自律走行を行うステップであることが好ましい(請求項4)。
この場合には、前記自動搬送車が追従してきた導線と前記新たな導線との間に、横行あるいは斜行のための導線を敷設する必要がなくなる。そのため、自動搬送車を走行させる経路のレイアウト変更が容易な汎用性の高い自動搬送システムを実現できる。
In addition, the automatic transport vehicle includes autonomous navigation means that enables autonomous traveling by autonomous navigation,
The first and second traveling steps are preferably steps in which the automatic guided vehicle performs autonomous traveling.
In this case, it is not necessary to lay a conducting wire for traversing or skewing between the conducting wire followed by the automated guided vehicle and the new conducting wire. Therefore, it is possible to realize a highly versatile automatic transfer system that can easily change the layout of the route on which the automatic guided vehicle travels.

また、 前記第1の走行ステップにおける前記進入角aの制御目標値が90度であることが好ましい。(請求項5)。
前記進入角aの制御目標値を90度に設定すれば、前記新たな導線に対して前記自動搬送車を横行で接近させることができる。前記自動搬送車を横行させれば、前記第1の走行ステップにおける前記自動搬送車の前後方向の走行距離をゼロに近づけることができる。この場合には、前記第1の走行ステップの実行に応じて前記自動搬送車を走行させる経路を、前記前後方向において非常にコンパクトに設計できるというメリットが生じる。
Moreover, it is preferable that the control target value of the approach angle a in the first traveling step is 90 degrees. (Claim 5).
If the control target value of the approach angle a is set to 90 degrees, the automatic guided vehicle can be brought close to the new conductor. If the automatic transport vehicle is traversed, the travel distance in the front-rear direction of the automatic transport vehicle in the first travel step can be reduced to zero. In this case, there is a merit that the route on which the automated guided vehicle travels can be designed very compactly in the front-rear direction in accordance with the execution of the first travel step.

しかし、前記新たな導線に対して約90度の前記進入角aで進入した前記駆動ユニットを停止させることなく直ちに前記追従走行制御に切り換えようとすると、その制御難易度が高くなり過ぎてしまい実現可能性が極めて低くなるというデメリットが生じる。それ故、本発明のごとく、前記進入角a前記新たな導線を横切るように前記駆動ユニットを通過させた後、より小さい前記進入角bで前記新たな導線に接近させるという本発明の作用効果が特に有効になる。   However, if the drive unit that has entered the new lead wire at the approach angle a of about 90 degrees is immediately switched to the follow-up running control without being stopped, the control difficulty becomes too high. The demerit that the possibility becomes extremely low occurs. Therefore, as in the present invention, after passing the drive unit so as to cross the approach angle a and the new conductor, the effect of the present invention is to approach the new conductor at a smaller approach angle b. Especially effective.

また、前後2基の駆動ユニットについて、それぞれ、前記第1〜第3の走行ステップ及び前記移行ステップを実行することが好ましい(請求項6)。
この場合には、前後2基の駆動ユニットについて同様の制御を行うことにより、前記自動搬送車を非常に滑らかな動作で前記新たな導線に乗り移らせることができる。
Further, it is preferable that the first to third travel steps and the transition step are executed for the two front and rear drive units, respectively.
In this case, by performing the same control for the two front and rear drive units, the automatic guided vehicle can be transferred to the new conductor with a very smooth operation.

実施例1における、自動搬送システムの概要を示す説明図。BRIEF DESCRIPTION OF THE DRAWINGS FIG. 実施例1における、自動搬送車を模式的に示す上面図。FIG. 3 is a top view schematically showing the automatic guided vehicle in the first embodiment. 実施例1における、ラインセンサの検出エリアを説明する説明図。Explanatory drawing explaining the detection area of a line sensor in Example 1. FIG. 実施例1における、自動搬送車のシステム構成を示すブロック図。1 is a block diagram showing a system configuration of an automated guided vehicle in Embodiment 1. FIG. 実施例1における、新たなガイドラインへの追従状態に移行する際の自動搬送車の走行ルートを示す説明図。Explanatory drawing which shows the driving | running route of the automatic conveyance vehicle at the time of shifting to the follow-up state to the new guideline in Example 1. FIG. 実施例1における、新たなガイドラインへの追従状態に移行する際の検出エリアの軌跡を示す説明図。Explanatory drawing which shows the locus | trajectory of the detection area at the time of shifting to the follow-up state to a new guideline in Example 1. FIG. 実施例1における、その他の自動搬送システムの概要を示す説明図。Explanatory drawing which shows the outline | summary of the other automatic conveyance system in Example 1. FIG. 実施例1における、その他の自動搬送システムの概要を示す説明図。Explanatory drawing which shows the outline | summary of the other automatic conveyance system in Example 1. FIG. 実施例2における、自動搬送システムの概要を示す説明図。Explanatory drawing which shows the outline | summary of the automatic conveyance system in Example 2. FIG. 実施例2における、新たなガイドラインへの追従状態に移行する際の自動搬送車の走行ルートを示す説明図。Explanatory drawing which shows the driving | running route of the automatic conveyance vehicle at the time of shifting to the follow-up state to the new guideline in Example 2. FIG. 実施例2における、新たなガイドラインへの追従状態に移行する際の検出エリアの軌跡を示す説明図。Explanatory drawing which shows the locus | trajectory of the detection area at the time of shifting to the follow-up state to a new guideline in Example 2. FIG.

本発明の実施の形態につき、以下の実施例を用いて具体的に説明する。
(実施例1)
本例は、予め定められた経路に沿って自動搬送車2を自動で走行させるための制御方法に関する。本例の内容について、図1〜図8を用いて説明する。
The embodiment of the present invention will be specifically described with reference to the following examples.
Example 1
This example relates to a control method for automatically running the automatic guided vehicle 2 along a predetermined route. The contents of this example will be described with reference to FIGS.

本例は、図1及び図2に示すごとく、個別に駆動される2本1組の駆動輪331が同軸に配置された前後2基の駆動ユニット3と、経路に沿って敷設された所定幅のガイドライン(導線)11、12を検出するためのラインセンサ351(検出センサ)と、を備えた自動搬送車2が横行して新たなガイドライン12に対する追従状態に移行する(乗り移る)ための制御方法に関する例である。   In this example, as shown in FIGS. 1 and 2, two sets of front and rear drive units 3 in which a set of two drive wheels 331 to be individually driven are coaxially arranged, and a predetermined width laid along the path. Control method for the automatic guided vehicle 2 having a line sensor 351 (detection sensor) for detecting the guideline (conducting wire) 11 and 12 to shift to a follow-up state for the new guideline 12 (transfer) It is an example regarding.

この自動搬送車2の制御方法は、自動搬送車2が横行でガイドライン12に接近する第1の走行ステップと、
駆動ユニット3のラインセンサ351がガイドライン12を検出した後、再びガイドライン12を検出しなくなるまで駆動ユニット3をそのまま前進させる第2の走行ステップと、
この第2の走行ステップの後、ラインセンサ351によりガイドライン12を再検出できるように駆動ユニット3を操舵する第3の走行ステップと、
ラインセンサ351によるガイドライン12の再検出に応じて、ガイドライン12に追従して走行するように駆動ユニット3を操舵する追従走行制御への切換を実行する移行ステップと、を含んでいる。
以下、この内容について詳しく説明する。
The control method of the automatic transport vehicle 2 includes a first traveling step in which the automatic transport vehicle 2 is traversing and approaches the guideline 12;
After the line sensor 351 of the drive unit 3 detects the guideline 12, a second traveling step of moving the drive unit 3 forward until it does not detect the guideline 12 again;
After this second traveling step, a third traveling step for steering the drive unit 3 so that the guideline 12 can be detected again by the line sensor 351;
A transition step of switching to follow-up running control in which the drive unit 3 is steered to run following the guideline 12 in response to the re-detection of the guideline 12 by the line sensor 351.
Hereinafter, this content will be described in detail.

本例の自動搬送システム1は、図1に示すごとく、例えば、自動車等の組立て工場等に導入される無人の搬送システムである。自動車部品等のワークの積み込み、あるいは積み下ろしの拠点となるワークステーション間で自動搬送車2を自動走行させる自動搬送システム1を導入すれば、高効率の搬送システムを実現できる。特に、本例の自動搬送システム1は、ガイドラインによらずに自動搬送車2が自律走行する自律走行区間を含めて構成されている。   As shown in FIG. 1, the automatic conveyance system 1 of this example is an unmanned conveyance system introduced into an assembly factory such as an automobile. A highly efficient transfer system can be realized by introducing an automatic transfer system 1 that automatically moves the automatic transfer vehicle 2 between work stations that serve as bases for loading or unloading workpieces such as automobile parts. In particular, the automatic conveyance system 1 of this example is configured to include an autonomous traveling section in which the automatic guided vehicle 2 autonomously travels regardless of the guidelines.

まず、本例の自動搬送システム1に適用される自動搬送車2について説明する。自動搬送車2は、図2のごとく、自動車部品等のワークを積載する荷台(図示略)を含む前後方向に長い車体20を備えている。車体20の大きさは、前後方向に約1.4mで、幅約0.5mとなっている。車体20には、前後方向の2箇所に駆動ユニット3が配置されているほか、制御ユニット50(図4)及び図示しないバッテリが搭載されている。2基の駆動ユニット3の前後方向の中間に当たる底面には、自在車輪よりなる補助輪(図示略)が左右両側に取り付けられている。   First, the automatic conveyance vehicle 2 applied to the automatic conveyance system 1 of this example is demonstrated. As shown in FIG. 2, the automatic transport vehicle 2 includes a vehicle body 20 that is long in the front-rear direction including a loading platform (not shown) on which a workpiece such as an automobile part is loaded. The size of the vehicle body 20 is about 1.4 m in the front-rear direction and the width is about 0.5 m. The vehicle body 20 is provided with a drive unit 3 at two locations in the front-rear direction, and a control unit 50 (FIG. 4) and a battery (not shown). Auxiliary wheels (not shown) made up of free wheels are attached to the left and right sides of the bottom surface corresponding to the middle of the two drive units 3 in the front-rear direction.

駆動ユニット3は、図1〜図4に示すごとく、同軸上に並列配置された2本1組の駆動輪331と、これらの駆動輪331に個別に対応し、それぞれ独立に回転制御可能な2基の駆動モータ310と、を備えている。駆動ユニット3は、個別に駆動される両側の駆動輪331の回転差に応じて操舵される。本例の駆動ユニット3では、360度全周をカバーできるように操舵範囲が設定されている。   As shown in FIGS. 1 to 4, the drive unit 3 corresponds to a set of two drive wheels 331 arranged in parallel on the same axis, and each of these drive wheels 331, and can be independently controlled for rotation. And a basic drive motor 310. The drive unit 3 is steered according to the rotational difference between the drive wheels 331 on both sides that are individually driven. In the drive unit 3 of this example, the steering range is set so that the entire circumference of 360 degrees can be covered.

駆動ユニット3の前面部分では、ラインセンサ351が中央に配設されていると共に、ラインセンサ351からオフセットする位置にマーカセンサ352が配設されている。これらのセンサは、常時、駆動ユニット3の前進側の正面に位置するよう、駆動ユニット3の操舵と共に回動するように取り付けられている。   In the front portion of the drive unit 3, the line sensor 351 is disposed at the center, and the marker sensor 352 is disposed at a position offset from the line sensor 351. These sensors are always attached so as to rotate together with the steering of the drive unit 3 so as to be positioned in front of the drive unit 3 on the forward side.

ラインセンサ351は、磁気テープであるガイドライン11、12等の磁気を検出する検出センサである。本例のラインセンサ351は、小さな磁気検出素子360を横方向に複数配列したセンサであり(図3参照。)、駆動ユニット3の進行方向に直交する方向に幅広の横幅約8cmの検出エリア36を備えている。ラインセンサ351は、検出エリア36内の各磁気検出素子360について、磁気を検出しているか否か個別に検知可能である。本例のラインセンサ351によれば、何れの磁気検出素子360がガイドラインを検出しており、何れが検出していないかの組み合わせに応じて、ガイドラインのエッジ(導線エッジ)を検出可能である。
マーカセンサ352は、床面に適宜、配置されたガイドマーカから番地情報等を読み取るセンサである。
The line sensor 351 is a detection sensor that detects magnetism of the guide lines 11 and 12 that are magnetic tapes. The line sensor 351 of this example is a sensor in which a plurality of small magnetic detection elements 360 are arranged in the horizontal direction (see FIG. 3), and the detection area 36 having a wide width of about 8 cm in a direction perpendicular to the traveling direction of the drive unit 3. It has. The line sensor 351 can individually detect whether or not magnetism is detected for each magnetic detection element 360 in the detection area 36. According to the line sensor 351 of this example, it is possible to detect the edge of the guide line (conductive wire edge) according to the combination of which magnetic detection element 360 detects the guide line and which is not detected.
The marker sensor 352 is a sensor that reads address information and the like from guide markers that are appropriately arranged on the floor surface.

自動搬送車2の内部システムは、図4に示すごとく構成されている。自動搬送車2の制御ユニット50に対しては、2基の駆動ユニット3のほか、バンパースイッチ220、障害物センサ26、非常停止スイッチ231、操作スイッチ232、表示ランプ233、LED表示器234、スピーカ235、通信ユニット25、角速度センサ281等が電気的に接続されている。   The internal system of the automatic guided vehicle 2 is configured as shown in FIG. For the control unit 50 of the automatic guided vehicle 2, in addition to the two drive units 3, a bumper switch 220, an obstacle sensor 26, an emergency stop switch 231, an operation switch 232, a display lamp 233, an LED display 234, a speaker 235, the communication unit 25, the angular velocity sensor 281 and the like are electrically connected.

駆動ユニット3の内部的な構成は、制御ユニット50から受信した制御信号に基づいて駆動輪331(図2)を駆動する駆動部31と、各種センサの検出信号を取り込んで制御ユニットに送信する検出部35と、に区分けされる。駆動部31は、駆動モータ310と、駆動モータ310を制御するモータドライバ315と、を含んで構成されている。モータドライバ315は、制御ユニット50から受信した制御信号に基づいて駆動モータ310の回転を制御する。このモータドライバ315は、駆動モータ310の制御値に基づいて、対応する駆動輪331の走行速度を把握可能である。   The internal configuration of the drive unit 3 includes a drive unit 31 that drives the drive wheel 331 (FIG. 2) based on a control signal received from the control unit 50, and a detection that receives detection signals from various sensors and transmits them to the control unit. And section 35. The drive unit 31 includes a drive motor 310 and a motor driver 315 that controls the drive motor 310. The motor driver 315 controls the rotation of the drive motor 310 based on the control signal received from the control unit 50. The motor driver 315 can grasp the traveling speed of the corresponding drive wheel 331 based on the control value of the drive motor 310.

検出部35は、ラインセンサ351、マーカセンサ352、操舵角を検出する操舵角検知部350等の検出手段のほか、制御ユニット50に対して検出信号等を送信する際のインターフェースとなるI/F回路38を備えている。   In addition to detection means such as a line sensor 351, a marker sensor 352, a steering angle detection unit 350 that detects a steering angle, the detection unit 35 is an I / F that serves as an interface when transmitting a detection signal to the control unit 50. A circuit 38 is provided.

制御ユニット50は、各種のスイッチ等と信号のやり取りをするためのインターフェースであるI/F回路55と、駆動ユニット3に向けて各種の制御信号を出力する主制御回路51と、を含むユニットである。主制御回路51は、自動搬送車2の走行を制御する走行制御手段510、走行制御のモードを切り換える制御切換手段512、自動搬送車2の位置等の測位情報を演算する測位手段513としての機能を備えている。   The control unit 50 is a unit including an I / F circuit 55 that is an interface for exchanging signals with various switches and the like, and a main control circuit 51 that outputs various control signals to the drive unit 3. is there. The main control circuit 51 functions as a travel control means 510 for controlling the travel of the automatic transport vehicle 2, a control switching means 512 for switching the travel control mode, and a positioning means 513 for calculating positioning information such as the position of the automatic transport vehicle 2. It has.

走行制御手段510は、ガイドライン11、12に対する追従走行制御、及び自律走行制御を実行可能な制御手段である。本例の追従走行制御では、前後の各駆動ユニット3が個別に制御される。一方、自律走行制御は、自律走行区間について予めティーチングされた経路に沿って走行するための制御である。この自律走行制御では、測位手段513による測位情報に基づく自律航法により各駆動ユニット3が制御される。   The travel control means 510 is a control means capable of executing follow-up travel control for the guidelines 11 and 12 and autonomous travel control. In the following traveling control of this example, the front and rear drive units 3 are individually controlled. On the other hand, the autonomous traveling control is a control for traveling along a route taught in advance for the autonomous traveling section. In this autonomous traveling control, each drive unit 3 is controlled by autonomous navigation based on positioning information by the positioning means 513.

本例の自律走行制御は、自動搬送車2の斜行時と横行時とで制御内容が相違している。斜行の自律走行制御では、前後の駆動ユニット2の操舵方向が同相で制御される。一方、横行の自律走行制御では、前後の駆動ユニット2の操舵方向が約90度に保持される一方、各駆動ユニット3の駆動輪331の速度調節により自動搬送車2の姿勢が制御される。 In the autonomous traveling control of this example, the control content is different between when the automatic guided vehicle 2 is skewed and when it is traversing. In the skewed autonomous traveling control, the steering directions of the front and rear drive units 2 are controlled in phase . On the other hand, in the transverse autonomous traveling control, the steering direction of the front and rear drive units 2 is maintained at about 90 degrees, while the posture of the automatic guided vehicle 2 is controlled by adjusting the speed of the drive wheels 331 of each drive unit 3.

測位手段513は、自律航法に必要となる自動搬送車2の位置、姿勢等の測位情報を演算する手段である。測位手段513は、角速度を検出する角速度センサ281、及び駆動輪331の走行速度を検出するモータドライバ315と共に自律航法手段28を構成している。測位手段513は、角速度センサ281の検出角速度やモータドライバ315による走行速度等に基づいて測位情報を演算する。演算された測位情報は、前記走行制御手段510による自律走行制御の入力値となる。   The positioning means 513 is a means for calculating positioning information such as the position and posture of the automated guided vehicle 2 necessary for autonomous navigation. The positioning means 513 constitutes the autonomous navigation means 28 together with the angular velocity sensor 281 that detects the angular velocity and the motor driver 315 that detects the traveling speed of the drive wheel 331. The positioning means 513 calculates positioning information based on the angular velocity detected by the angular velocity sensor 281, the traveling speed by the motor driver 315, and the like. The calculated positioning information becomes an input value for autonomous traveling control by the traveling control means 510.

次に、自動搬送システム1における経路の仕様について説明する。経路は、追従区間、自律走行区間を含んで構成されている。
追従区間は、図1に示すごとく、幅約2.5cmの磁気テープよりなるガイドライン11、12が経路に沿って敷設された区間である。本例の自動搬送システム1では、自律走行区間を介して、第1の追従区間のガイドライン11と第2の追従区間のガイドライン12とが平行に敷設されている。なお、自律走行区間に連なる第1の追従区間の終点には、その番地情報を表すガイドマーカ115が配置されている。
Next, the specification of the route in the automatic conveyance system 1 will be described. The route includes a follow-up section and an autonomous travel section.
As shown in FIG. 1, the following section is a section in which guide lines 11 and 12 made of magnetic tape having a width of about 2.5 cm are laid along the path. In the automatic conveyance system 1 of this example, the guide line 11 of the first follow-up section and the guide line 12 of the second follow-up section are laid in parallel through the autonomous traveling section. A guide marker 115 indicating the address information is arranged at the end point of the first follow-up section that is continuous with the autonomous travel section.

自律走行区間は、ガイドラインが敷設されていない導線レス区間であり、自動搬送車2が自律航法により自律走行する区間である。本例の自律走行区間については、自動搬送車2に走行させる経路として予め、ガイドライン11、12間を真横に横断して走行する横行経路がティーチングされている。   The autonomous traveling section is a section where no guide line is laid, and the section where the automatic guided vehicle 2 autonomously travels by autonomous navigation. In the autonomous traveling section of this example, a traversing route that travels across the guide lines 11 and 12 is taught in advance as a route for the automatic guided vehicle 2 to travel.

以上のように構成された自動搬送システム1の各区間における自動搬送車2の走行動作について説明する。
<第1の追従区間>
第1の追従区間では、ガイドライン11に追従して走行するように自動搬送車2が制御される。第1の追従区間では、2基の駆動ユニット3がそれぞれ個別に制御される前記追従走行制御が適用される。各駆動ユニット3は、各ラインセンサ351の検出エリア36の中央でガイドライン11を検出できるように操舵される。例えば、ラインセンサ351の検出エリア36の左側にずれてガイドライン11が検出されているときには左方向に操舵され、右側にずれているときには右方向に操舵される。また、第1の追従区間のガイドマーカ115が検知されたとき、自動搬送車2が前進停止して横行を開始し、ガイドライン11から離脱する。
The traveling operation of the automatic transport vehicle 2 in each section of the automatic transport system 1 configured as described above will be described.
<First follow-up section>
In the first follow-up section, the automatic guided vehicle 2 is controlled so as to follow the guideline 11 and travel. In the first following section, the following traveling control in which the two drive units 3 are individually controlled is applied. Each drive unit 3 is steered so that the guide line 11 can be detected at the center of the detection area 36 of each line sensor 351. For example, when the guideline 11 is detected by shifting to the left side of the detection area 36 of the line sensor 351, the steering is performed in the left direction. When the guideline 11 is shifted to the right side, the steering is performed in the right direction. Further, when the guide marker 115 in the first follow-up section is detected, the automatic guided vehicle 2 stops moving forward, starts traversing, and leaves the guideline 11.

<自律走行区間>
自律走行区間では、自動搬送車がガイドライン11を離脱したときの姿勢を維持しながら自律航法により自動搬送車2が自律走行する。
<第2の追従区間>
第2の追従区間では、ガイドライン12に追従して走行するように自動搬送車2が制御される。この第2の追従区間では、前記第1の追従区間と同様に駆動ユニット3が制御される。
<Autonomous driving section>
In the autonomous traveling section, the automated guided vehicle 2 autonomously travels by autonomous navigation while maintaining the posture when the automated guided vehicle leaves the guideline 11.
<Second follow-up section>
In the second follow-up section, the automatic guided vehicle 2 is controlled so as to follow the guideline 12 and travel. In the second follow-up section, the drive unit 3 is controlled similarly to the first follow-up section.

本例の自動搬送車2の制御方法の特徴は、図5に示すごとく、自律走行区間から第2のの追従区間への追従制御に移行する際の移行制御にある。この移行制御では、第1〜第3の走行ステップ、及び移行ステップが各駆動ユニット3に適用される。
(1)第1の走行ステップ
このステップでは、各駆動ユニット3が進入角a=約90度でガイドライン12に接近するように制御され、自動搬送車2が横行するステップである。このステップでは、前記横行の自律走行制御が適用され、各駆動ユニット3の操舵角が約90度となっている。この第1の走行ステップは、検出状態の磁気検出素子360を黒丸で示す図6中、検出エリア36Aまでの走行期間に対応している。
As shown in FIG. 5, the characteristic of the control method of the automatic guided vehicle 2 in this example is transition control when shifting from the autonomous traveling section to the second tracking section. In this transition control, the first to third travel steps and the transition step are applied to each drive unit 3.
(1) First traveling step In this step, each drive unit 3 is controlled so as to approach the guideline 12 at an approach angle a = about 90 degrees, and the automatic guided vehicle 2 traverses. In this step, the transverse autonomous traveling control is applied, and the steering angle of each drive unit 3 is about 90 degrees. This first traveling step corresponds to the traveling period to the detection area 36A in FIG. 6 in which the magnetic detection element 360 in the detection state is indicated by a black circle.

(2)第2の走行ステップ
このステップは、ラインセンサ351がガイドライン12を検出した後、各ラインセンサ351が再度、ガイドライン12を検出しない状態になるまで該駆動ユニット3の操舵角をそのまま維持して前進させるステップであり、前記第1の走行ステップと同様、横行の自律走行制御が適用されるステップである。なお、上記のごとく自律走行区間では、ガイドライン11を離脱したときの姿勢のままガイドライン12に到達できるように、姿勢制御を受けつつ自律航法によって自動搬送車2が自律走行する。そのため、ガイドライン12への各駆動ユニット3の到達タイミングは、ほぼ同時となる。この第2の走行ステップは、図6中、検出エリア36Aを経て検出エリア36Bまでの走行期間に対応している。
(2) Second traveling step This step maintains the steering angle of the drive unit 3 until each line sensor 351 again detects the guideline 12 after the line sensor 351 detects the guideline 12. As in the first traveling step, traversing autonomous traveling control is applied. In the autonomous traveling section as described above, the automatic guided vehicle 2 autonomously travels by autonomous navigation while receiving posture control so that the guideline 12 can be reached with the posture when the guideline 11 is left. Therefore, the arrival timing of each drive unit 3 to the guideline 12 is almost the same. This second traveling step corresponds to the traveling period from the detection area 36A to the detection area 36B in FIG.

(3)第3の走行ステップ
このステップは、第2の走行ステップの後、ラインセンサ351によりガイドライン12を再検出できるように駆動ユニット3が操舵されるステップである。このステップでは、自律航法により図5の走行ルートを辿るように操舵される。第3の走行ステップは、図6中、検出エリア36Bを経て検出エリア36Cまでの走行期間に対応している。この第3の走行ステップでは、前記斜行の自律走行制御が適用され、前後の駆動ユニット3が同相で制御される。
(3) Third Traveling Step This step is a step in which the drive unit 3 is steered so that the guideline 12 can be detected again by the line sensor 351 after the second traveling step. In this step, the vehicle is steered so as to follow the travel route of FIG. 5 by autonomous navigation. The third traveling step corresponds to a traveling period from the detection area 36B to the detection area 36C in FIG. In this third traveling step, the oblique autonomous traveling control is applied, and the front and rear drive units 3 are controlled in phase .

(4)移行ステップ
このステップは、各駆動ユニット3が進入角b=約45度でガイドライン12に接近するように自動搬送車2を斜行させた後、ガイドライン12への追従走行制御に切り換えるステップである。上記のように自動搬送車2を斜行させると、図6中、検出エリア36Dのごとく、その左側からガイドライン12が検出され始める。本例の移行制御では、ガイドライン12がこのように検出されても直ちに追従走行制御に切り換えることなく、そのまま斜行が維持される。検出エリア36のうち左側からガイドライン12が検出され始めたときに追従走行制御に切り換えてしまうと、本来、ガイドライン12に追従するために右方向に操舵すべきところ、検出エリア36の中央でガイドライン12を検出しようとして左方向の逆操舵(逆ステア)が発生してしまうからである。
(4) Transition step This step is a step in which the automatic transport vehicle 2 is skewed so that each drive unit 3 approaches the guideline 12 at the approach angle b = about 45 degrees, and then the control is switched to follow-up running control to the guideline 12. It is. When the automatic guided vehicle 2 is skewed as described above, the guideline 12 starts to be detected from the left side as in the detection area 36D in FIG. In the transition control of this example, even if the guideline 12 is detected in this way, the skew is maintained without being immediately switched to the follow-up running control. When the guideline 12 starts to be detected from the left side of the detection area 36 and is switched to the follow-up running control, the guideline 12 should be steered rightward in order to follow the guideline 12. This is because reverse steering (reverse steer) in the left direction is generated in order to detect this.

上記のように斜行を維持すれば、図6中、検出エリア36Eのごとく、その左側からガイドライン12を検出しない状態となり、これにより前進方向側のエッジ121を検出できる。本例の移行ステップでは、このようにガイドライン12のエッジ121が検出されたときに前記追従走行制御への切換が実行される。このようなタイミングで追従走行制御への切換を実行すれば、ガイドライン12の左側に逸脱しないように右方向に適切に操舵され、図5に示すごとく、滑らかな走行ルートでガイドライン12への追従状態に移行できる。この移行ステップは、図6中の検出エリア36Cを経て検出エリア36Eまでの走行期間に対応している。   If the skew is maintained as described above, the guideline 12 is not detected from the left side as in the detection area 36E in FIG. 6, and thus the edge 121 on the forward direction side can be detected. In the transition step of this example, when the edge 121 of the guideline 12 is detected in this way, switching to the following traveling control is executed. If the switching to the follow-up running control is executed at such timing, the steering is appropriately performed in the right direction so as not to deviate to the left of the guideline 12, and as shown in FIG. Can be migrated to. This transition step corresponds to the traveling period from the detection area 36C in FIG. 6 to the detection area 36E.

以上のように構成された本例の自動搬送システム1では、横行による自律走行からガイドライン12へ乗り移る際、自動搬送車2が一旦、ガイドライン12を横行して通過し、その後、斜行してガイドライン12に再接近して追従状態へ移行する。このような追従状態への移行制御では、横行してガイドライン12に到達した際、自動搬送車2を一時、停止させなくても良い。本例の自動搬送システム1では、敢えて、ガイドライン12から自動搬送車2を逸脱させ、その後、ガイドライン12に再接近するように自律走行させることで、滑らかで迅速なガイドライン12への乗り移りを実現している。   In the automatic conveyance system 1 of the present example configured as described above, when the vehicle moves from the autonomous traveling by traversing to the guideline 12, the automatic transport vehicle 2 temporarily traverses the guideline 12 and then skews and guides the guideline. 12 again approaches to the follow-up state. In the transition control to such a follow-up state, the automatic guided vehicle 2 may not be temporarily stopped when traversing and reaching the guideline 12. In the automatic conveyance system 1 of this example, the automatic conveyance vehicle 2 is deliberately deviated from the guideline 12, and then autonomously travels so as to reapproach the guideline 12, thereby realizing a smooth and quick transfer to the guideline 12. ing.

このように、自動搬送車2を横行させた後、新たなガイドライン12に対する追従状態に移行させるための本例の自動搬送車2の制御方法によれば、新たなガイドライン12への円滑な乗り移りを実現でき、乗り移りに要する時間を短縮可能である。   As described above, according to the control method of the automatic guided vehicle 2 of the present example for causing the automatic guided vehicle 2 to traverse and then shifting to a follow-up state with respect to the new guideline 12, smooth transfer to the new guideline 12 is achieved. This can be realized and the time required for transfer can be shortened.

なお、本例の自動搬送システム1では、元のガイドライン11と乗り移るガイドライン12とが平行をなしている。これに代えて、図7に示すごとく、元のガイドライン11に対して、乗り移るガイドライン12を斜めに敷設することもできる。同図の場合では、横行する自動搬送車2の後ろ側の駆動ユニット3が先にガイドライン12に到達することになる。後ろ側の駆動ユニット3がガイドライン12に到達したときに姿勢制御を解除すると共に後ろ側の駆動ユニット3を停止し、その後、前側の駆動ユニット3についてのみ前記第1〜3の走行ステップ及び前記移行ステップよりなる移行制御を適用しても良い。あるいは、後ろ側の駆動ユニット3についても前側の駆動ユニット3と同様の移行制御を適用しても良い。   In the automatic conveyance system 1 of this example, the original guideline 11 and the guideline 12 to be transferred are parallel. Instead, as shown in FIG. 7, the guideline 12 to be transferred to the original guideline 11 can be laid diagonally. In the case of the figure, the drive unit 3 on the rear side of the traveling automatic transport vehicle 2 reaches the guideline 12 first. When the rear drive unit 3 reaches the guideline 12, the posture control is canceled and the rear drive unit 3 is stopped. Thereafter, the first to third travel steps and the transition are performed only for the front drive unit 3. Transition control consisting of steps may be applied. Alternatively, the same transition control as that of the front drive unit 3 may be applied to the rear drive unit 3.

なお、本例では、第1の追従区間と第2の追従区間との間の横行区間が自律走行区間として設定されている。これに代えて、図8に示すごとく、第1の追従区間のガイドライン11と第2の追従区間のガイドライン12との間に、自動搬送車2を横行させるためのガイドライン13を設けることも良い。この場合には、前記移行制御のうちの第1の走行ステップ及び第2の走行ステップに対して追従走行制御が適用され、第3の走行ステップに対して自律走行制御が適用されることになる。ガイドライン12を通り過ぎるように各駆動ユニット3を制御すれば、ガイドライン13に追従して横行してきた自動搬送車2をガイドライン12上で一時停止させる必要がなくなり、滑らかで迅速なガイドライン12への乗り移りを実現できる。   In this example, a transverse section between the first following section and the second following section is set as the autonomous traveling section. Instead, as shown in FIG. 8, a guideline 13 for traversing the automatic guided vehicle 2 may be provided between the guideline 11 in the first follow-up section and the guideline 12 in the second follow-up section. In this case, the following traveling control is applied to the first traveling step and the second traveling step in the transition control, and the autonomous traveling control is applied to the third traveling step. . If each drive unit 3 is controlled so as to pass through the guideline 12, it is not necessary to temporarily stop the automatic guided vehicle 2 that has traversed following the guideline 13 on the guideline 12, and the transfer to the guideline 12 is smooth and quick. realizable.

なお、本例では、進入角a及びbを、それぞれ、約90度、約45度に設定している。これらの数値は一例に過ぎず、進入角の設定は適宜、変更可能である。進入角は、自動搬送車2の走行特性や、制御仕様や、進入速度等に応じて適宜、選択されるべきであり、進入角a>進入角bの関係が保持されていれば良い。   In this example, the approach angles a and b are set to about 90 degrees and about 45 degrees, respectively. These numerical values are merely examples, and the setting of the approach angle can be changed as appropriate. The approach angle should be appropriately selected according to the travel characteristics, control specifications, approach speed, and the like of the automatic guided vehicle 2 as long as the relationship of the approach angle a> the approach angle b is maintained.

(実施例2)
本例は、実施例1に基づいて、自律走行区間における走行パターンを斜行に変更した例である。この内容について、図9〜図11を参照して説明する。
本例の自動搬送システム1では、平行をなすように敷設されたガイドライン11とガイドライン12との間で、自動搬送車2が斜行で自律走行する。その斜行方向とガイドライン12とのなす角、すなわちガイドライン12に対する自動搬送車2の進入角aが約45度となっている。また、ガイドライン12へ乗り移る際の進入角bは約22.5度となっている。なお、本例では、ガイドライン12に対する進入速度が実施例1よりも速く設定されており、それ故、進入角aでのガイドライン12への乗り移りの難易度が実施例1よりも高くなっている。
(Example 2)
This example is an example in which the traveling pattern in the autonomous traveling section is changed to skew based on the first embodiment. The contents will be described with reference to FIGS.
In the automatic conveyance system 1 of this example, the automatic conveyance vehicle 2 autonomously travels obliquely between the guideline 11 and the guideline 12 laid so as to be parallel to each other. The angle formed by the skew direction and the guideline 12, that is, the approach angle a of the automatic guided vehicle 2 with respect to the guideline 12 is about 45 degrees. Moreover, the approach angle b when changing to the guideline 12 is about 22.5 degrees. In this example, the approach speed with respect to the guideline 12 is set faster than that in the first embodiment, and therefore, the difficulty of transferring to the guideline 12 at the approach angle a is higher than that in the first embodiment.

本例では、図10及び図11に示すごとく、検出エリア36Aまでの走行期間が第1の走行ステップに対応している。検出エリア36Aを経て検出エリア36Bまでの走行期間が第2の走行ステップに対応している。検出エリア36Bを経て検出エリア36Cまでの走行期間が第3の走行ステップに対応している。さらに、検出エリア36Cを経て検出エリア36Eまでの走行期間が移行ステップに対応している。
なお、その他の構成及び作用効果については、実施例1と同様である。
In this example, as shown in FIGS. 10 and 11, the traveling period up to the detection area 36A corresponds to the first traveling step. The travel period from the detection area 36A to the detection area 36B corresponds to the second travel step. The travel period from the detection area 36B to the detection area 36C corresponds to the third travel step. Furthermore, the traveling period from the detection area 36C to the detection area 36E corresponds to the transition step.
Other configurations and operational effects are the same as those in the first embodiment.

以上、実施例1及び実施例2のごとく本発明の具体例を詳細に説明したが、これらの具体例は、特許請求の範囲に包含される技術の一例を開示しているにすぎない。言うまでもなく、具体例の構成や数値等によって、特許請求の範囲が限定的に解釈されるべきではない。特許請求の範囲は、公知技術や当業者の知識等を利用して前記具体例を多様に変形あるいは変更した技術を包含している。   As mentioned above, although the specific example of this invention was demonstrated in detail like Example 1 and Example 2, these specific examples are only disclosing the example of the technique included by a claim. Needless to say, the scope of the claims should not be construed as limited by the configuration, numerical values, or the like of the specific examples. The scope of the claims includes techniques obtained by variously modifying or changing the specific examples using known techniques, knowledge of those skilled in the art, and the like.

1 自動搬送システム
11、12 ガイドライン(導線)
121 エッジ(導線エッジ)
2 自動搬送車
20 車体
28 自律航法手段
281 角速度センサ
3 駆動ユニット
331 駆動輪
351 ラインセンサ(検出センサ)
352 マーカセンサ
36 検出エリア
360 磁気検出素子
50 制御ユニット
510 走行制御手段
512 制御切換手段
513 測位手段
1 Automatic transport system 11, 12 Guidelines (conductor)
121 Edge (conductor edge)
2 Automatic transport vehicle 20 Car body 28 Autonomous navigation means 281 Angular velocity sensor 3 Drive unit 331 Drive wheel 351 Line sensor (detection sensor)
352 Marker sensor 36 Detection area 360 Magnetic detection element 50 Control unit 510 Travel control means 512 Control switching means 513 Positioning means

Claims (6)

個別に駆動される2本1組の駆動輪が同軸に配置されていると共に当該2本1組の駆動輪の回転差に応じて旋回して操舵される前後2基の駆動ユニットと、経路に沿って敷設された所定幅の導線を検出するために駆動ユニットの前進側の正面に取り付けられた検出センサと、を備えた自動搬送車が横行又は斜行して新たな導線へ接近し、追従状態へ移行するための制御方法であって、
前記新たな導線に対して前記駆動ユニットを進入角aで前進させることにより、前記自動搬送車が横行又は斜行して前記新たな導線に接近する第1の走行ステップと、
少なくとも何れかの駆動ユニットの検出センサが前記新たな導線を検出した後、該検出センサが再度、該新たな導線を検出しなくなるまで該駆動ユニットを前記進入角aのまま前進させる第2の走行ステップと、
該第2の走行ステップの後、前記検出センサにより前記新たな導線を再検出できるように前記駆動ユニットを操舵する第3の走行ステップと、
前記新たな導線に対して前記駆動ユニットを斜め方向に進入させ、前記検出センサにより前記新たな導線が再検出された後、該新たな導線に追従して走行するように前記駆動ユニットを操舵する追従走行制御への切換を実行する移行ステップと、を含み、
前記検出センサは、前記駆動ユニットの進行方向に直交する方向に延設された検出エリアを含み、前記導線を検出しているか否かのみならず、前記検出エリアのどの部分が前記導線を検出しており、どの部分が検出していないかを検知可能であると共に、前記検出エリア内における検出部分と非検出部分との組合せに応じて前記導線の幅方向両側の縁部をなす導線エッジを検出可能であり、
前記移行ステップでは、前記検出センサが前記新たな導線を検出するのみでは前記追従走行制御への切換が実行されず、前記検出センサが新たな導線を検出した後、前記導線の幅方向両側の導線エッジのうち前記駆動ユニットの前進方向側の導線エッジが検出されたときに前記追従走行制御への切換が実行される自動搬送車の制御方法。
Two sets of drive wheels that are driven individually are arranged coaxially, and two drive units, front and rear, that are turned and steered according to the rotational difference between the two sets of drive wheels, and in the path A self-conveying vehicle equipped with a detection sensor attached to the front side of the drive unit for detecting a conducting wire of a predetermined width laid along the line approaches the new conducting wire by traversing or skewing. A control method for transitioning to a state,
A first traveling step in which the automatic conveyance vehicle approaches the new conductor by traversing or skewing by moving the drive unit forward at an approach angle a with respect to the new conductor;
After the detection sensor of at least one of the drive units detects the new conducting wire, the second traveling advances the drive unit at the entry angle a until the detection sensor again detects the new conducting wire. Steps,
After the second traveling step, a third traveling step for steering the drive unit so that the new conducting wire can be redetected by the detection sensor;
The drive unit is made to enter the oblique direction with respect to the new conductor, and after the new conductor is re-detected by the detection sensor, the drive unit is steered so as to follow the new conductor. A transition step for performing switching to follow-up running control,
The detection sensor includes a detection area extending in a direction orthogonal to the traveling direction of the drive unit, and not only whether or not the conductor is detected, which part of the detection area detects the conductor. It is possible to detect which part is not detected, and to detect the conductor edge forming the edges on both sides in the width direction of the conductor according to the combination of the detection part and the non-detection part in the detection area Is possible,
In the transition step, switching to the following traveling control is not performed only by the detection sensor detecting the new conductor, and after the detection sensor detects a new conductor, the conductors on both sides of the conductor in the width direction are detected. A control method for an automatic guided vehicle in which switching to the following traveling control is executed when a lead edge on the forward direction side of the drive unit is detected among the edges .
前記移行ステップにおける前記新たな導線に対する前記駆動ユニットの進入角が、前記進入角aよりも小さい進入角bである請求項1に記載の自動搬送車の制御方法。 The method for controlling an automatic guided vehicle according to claim 1 , wherein an approach angle of the drive unit with respect to the new conducting wire in the transition step is an approach angle b smaller than the approach angle a . 前記自動搬送車は、自律航法による自律走行を可能とする自律航法手段を備えており、
前記第3の走行ステップは、前記自動搬送車が自律走行を行うステップである請求項1又は2に記載の自動搬送車の制御方法。
The automated guided vehicle includes autonomous navigation means that enables autonomous traveling by autonomous navigation,
The method for controlling an automatic guided vehicle according to claim 1, wherein the third traveling step is a step in which the automatic guided vehicle performs autonomous traveling.
前記自動搬送車は、自律航法による自律走行を可能とする自律航法手段を備えており、
前記第1及び第2の走行ステップは、前記自動搬送車が自律走行を行うステップである請求項1〜3の何れか1項に記載の自動搬送車の制御方法。
The automated guided vehicle includes autonomous navigation means that enables autonomous traveling by autonomous navigation,
The method for controlling an automatic guided vehicle according to any one of claims 1 to 3, wherein the first and second traveling steps are steps in which the automatic guided vehicle performs autonomous traveling.
前記第1の走行ステップにおける前記進入角aの制御目標値が90度である請求項1〜4の何れか1項に記載の自動搬送車の制御方法。   The control method of the automatic guided vehicle according to any one of claims 1 to 4, wherein a control target value of the approach angle a in the first traveling step is 90 degrees. 前後2基の駆動ユニットについて、それぞれ、前記第1〜第3の走行ステップ及び前記移行ステップを実行する請求項1〜5の何れか1項に記載の自動搬送車の制御方法。   The method for controlling an automatic guided vehicle according to any one of claims 1 to 5, wherein the first to third travel steps and the transition step are executed for two front and rear drive units, respectively.
JP2010237594A 2010-10-22 2010-10-22 Control method of automatic guided vehicle Active JP5689278B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2010237594A JP5689278B2 (en) 2010-10-22 2010-10-22 Control method of automatic guided vehicle
CN201110078816.2A CN102452400B (en) 2010-10-22 2011-03-29 Method for controlling automatic carrier

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2010237594A JP5689278B2 (en) 2010-10-22 2010-10-22 Control method of automatic guided vehicle

Publications (2)

Publication Number Publication Date
JP2012089078A JP2012089078A (en) 2012-05-10
JP5689278B2 true JP5689278B2 (en) 2015-03-25

Family

ID=46036182

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2010237594A Active JP5689278B2 (en) 2010-10-22 2010-10-22 Control method of automatic guided vehicle

Country Status (2)

Country Link
JP (1) JP5689278B2 (en)
CN (1) CN102452400B (en)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103383570A (en) * 2013-06-25 2013-11-06 天奇自动化工程股份有限公司 Automatic guided vehicle capable of moving in all directions
US10534367B2 (en) * 2014-12-16 2020-01-14 Aktiebolaget Electrolux Experience-based roadmap for a robotic cleaning device
TWI703833B (en) * 2016-04-27 2020-09-01 日本電產新寶股份有限公司 System, method, and computer program for management of vehicles
JP6771999B2 (en) * 2016-08-26 2020-10-21 シャープ株式会社 Autonomous driving device and automatic driving system
DE102016119793A1 (en) * 2016-10-18 2018-04-19 Terex Mhps Gmbh Portal lifting device for handling containers with a sensor device
JP6704876B2 (en) * 2017-06-02 2020-06-03 本田技研工業株式会社 Automatic driving control system
CN109426251B (en) * 2017-08-29 2020-11-06 杭州海康机器人技术有限公司 Running control method and device for robot
JP7380350B2 (en) * 2020-03-10 2023-11-15 株式会社リコー Autonomous running device, autonomous running control method, and autonomous running control program
WO2022149284A1 (en) * 2021-01-08 2022-07-14 株式会社LexxPluss Transport system and transport control method

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS60189513A (en) * 1984-03-09 1985-09-27 Mitsubishi Electric Corp Unmanned carrier control system
JPS60209821A (en) * 1984-04-03 1985-10-22 Nec Corp Magnetic sensor array for unattended car
JPS6151511U (en) * 1984-08-31 1986-04-07
JPH09305225A (en) * 1996-05-17 1997-11-28 Bridgestone Corp Traveling method for unmanned carrier
JP3317159B2 (en) * 1996-09-25 2002-08-26 株式会社デンソー Automatic guided vehicle
JPH11249736A (en) * 1998-02-27 1999-09-17 Ishikawajima Harima Heavy Ind Co Ltd Automated guided vehicle and automated guided vehicle facility
CN2898771Y (en) * 2005-12-30 2007-05-09 吉林大学 Inspecting sensor for automatically guiding automobile path information
JP4280940B2 (en) * 2007-09-06 2009-06-17 トヨタ自動車株式会社 Automatic transfer device
JP5134402B2 (en) * 2008-03-14 2013-01-30 日産自動車株式会社 Route change method and route change device for automated guided vehicle

Also Published As

Publication number Publication date
CN102452400A (en) 2012-05-16
JP2012089078A (en) 2012-05-10
CN102452400B (en) 2015-03-18

Similar Documents

Publication Publication Date Title
JP5689278B2 (en) Control method of automatic guided vehicle
JP5580713B2 (en) Automatic transfer system
JP2006259877A (en) Article conveyance equipment
WO2010150580A1 (en) Travel control device for unmanned conveyance vehicle
JP4984831B2 (en) Automated guided vehicle and control method thereof
JP5882130B2 (en) Transport device
JP2000330635A (en) Automatic guided vehicle
JP2009223561A (en) Route changing method and device for unmanned carrier system
JP2639921B2 (en) Unmanned traveling system capable of detouring
CN111123931A (en) AGV dual-drive magnetic navigation turning method and storage device
JP5848989B2 (en) Automatic conveyance vehicle and control method of automatic conveyance vehicle
JP6085063B1 (en) Sensor arrangement structure for self-propelled transport vehicles
JP6405760B2 (en) Control method of automatic guided vehicle
JPH0543125B2 (en)
JPS63311511A (en) Travel controller for unmanned vehicle
JP5212228B2 (en) Automated transport system
JP4164351B2 (en) Branch control device for automated guided vehicles
JPH10111718A (en) Method and device for controlling travel of automated guided carrier
JPS5952310A (en) Control method of unmanned guide truck
JPH0820901B2 (en) How to drive an automated guided vehicle
JP2021082122A (en) Unmanned carrier vehicle
JP2000330629A (en) Traveling and stopping position changing mechanism for unmanned carrier
JPS61244660A (en) Travelling control facility for transfer car
CN116811843A (en) Parking control method, device, equipment and computer storage medium
JP2022042165A (en) Unmanned running cart and carrying system using unmanned running cart

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20130912

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20140625

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20140701

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20140807

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20150128

R150 Certificate of patent or registration of utility model

Ref document number: 5689278

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250