JP5806823B2 - Steering control device - Google Patents

Steering control device Download PDF

Info

Publication number
JP5806823B2
JP5806823B2 JP2011040826A JP2011040826A JP5806823B2 JP 5806823 B2 JP5806823 B2 JP 5806823B2 JP 2011040826 A JP2011040826 A JP 2011040826A JP 2011040826 A JP2011040826 A JP 2011040826A JP 5806823 B2 JP5806823 B2 JP 5806823B2
Authority
JP
Japan
Prior art keywords
steering angle
axle
traveling
guided vehicle
automatic guided
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
JP2011040826A
Other languages
Japanese (ja)
Other versions
JP2012178055A (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.)
Nippon Sharyo Ltd
Original Assignee
Nippon Sharyo 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 filed Critical Nippon Sharyo Ltd
Priority to JP2011040826A priority Critical patent/JP5806823B2/en
Publication of JP2012178055A publication Critical patent/JP2012178055A/en
Application granted granted Critical
Publication of JP5806823B2 publication Critical patent/JP5806823B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Description

本発明は、操舵制御装置に関し、特に、搬送車両に多数の車軸が設けられている場合でも、その搬送車両を走行経路に沿って円滑に走行させることができる操舵制御装置に関するものである。   The present invention relates to a steering control device, and more particularly, to a steering control device that can smoothly travel a transport vehicle along a travel path even when the transport vehicle is provided with a large number of axles.

従来より、工場内などでは、荷物の搬送の効率化や省力化を図るために、無人化搬送車両によって荷物の搬送が行われている。このような搬送車両を工場内などで走行させる場合には、搬送車両の走行経路として、予め床などに誘導テープが貼着される。搬送車両には、複数の車軸(例えば、4つ)が設けられており、搬送車両の走行中は、搬送車両が誘導テープ上を走行するように、これらの車軸の操舵角が定期的に(例えば、5ms間隔)操舵制御装置により制御されて、搬送車両の進行方向が修正される。   2. Description of the Related Art Conventionally, in factories and the like, packages are transported by unmanned transport vehicles in order to improve the efficiency and labor saving of the transport of packages. When such a transport vehicle travels in a factory or the like, a guide tape is previously attached to the floor or the like as a travel route of the transport vehicle. The transport vehicle is provided with a plurality of axles (for example, four). During the travel of the transport vehicle, the steering angles of these axles are periodically set so that the transport vehicle travels on the guide tape ( For example, the traveling direction of the transport vehicle is corrected under the control of the steering control device.

この種の操舵制御装置に関し、次の特許文献1には、操舵制御可能な1つの前輪と、操舵不可能な2つの後輪とを有する搬送車両が、カーブした走行経路を円滑に走行できるように、操舵制御装置により前輪および後輪の走行速度を制御して、カーブ走行時に搬送車両の車輪が滑ることを抑制する技術が開示されている。具体的には、前輪の駆動輪の走行速度に対して相応しい後輪の駆動輪の走行速度を算出するための補正係数を、前輪の駆動輪の操舵角ごとに予めテーブルに記憶している。そして、搬送車両が走行経路に沿って走行する場合には、前輪に設定される操舵角に対応する補正係数をテーブルから取得すると共に、前輪の走行速度を検出し、次いで、取得した補正係数と、検出した前輪の走行速度とに基づく演算を行って後輪の走行速度を算出し、その算出した値を後輪に設定している。   With regard to this type of steering control device, the following Patent Document 1 describes that a transport vehicle having one front wheel that can be steered and two rear wheels that cannot be steered can smoothly travel along a curved traveling route. In addition, a technique is disclosed in which the traveling speed of the front wheels and the rear wheels is controlled by a steering control device to prevent the wheels of the transport vehicle from slipping during curve traveling. Specifically, a correction coefficient for calculating the traveling speed of the driving wheel of the rear wheel appropriate for the traveling speed of the driving wheel of the front wheel is stored in advance in the table for each steering angle of the driving wheel of the front wheel. When the transport vehicle travels along the travel route, the correction coefficient corresponding to the steering angle set for the front wheels is acquired from the table, the traveling speed of the front wheels is detected, and then the acquired correction coefficient and Then, a calculation based on the detected traveling speed of the front wheels is performed to calculate the traveling speed of the rear wheels, and the calculated value is set for the rear wheels.

特開2005−71128号公報(第0044段落など)JP-A-2005-71128 (paragraph 0044, etc.)

しかしながら、特許文献1に記載の操舵制御装置のように、制御すべき車軸が1つであるなど、数が少なければ、車軸単位で補正係数に基づく演算を行っても全体の演算時間が短くて済むため、その演算結果を用いて各車軸の操舵制御を行っても制御遅れは生じないが、大型の搬送車両のように、制御すべき車軸の数が多くなると、全体の演算時間が長くなるため、操舵制御を行う周期内に演算が終わらず、各車軸の操舵制御に遅延が生じるおそれがあった。そのため、搬送車両を円滑に走行させられないおそれがあった。   However, as in the steering control device described in Patent Document 1, if the number of axles to be controlled is small, such as the number of axles to be controlled, the overall computation time is short even if computation based on the correction coefficient is performed in units of axles. Therefore, even if steering control of each axle is performed using the calculation result, control delay does not occur. However, as the number of axles to be controlled increases as in a large transport vehicle, the entire calculation time becomes longer. For this reason, the calculation is not completed within the period of performing the steering control, and there is a possibility that the steering control of each axle is delayed. Therefore, there is a possibility that the transport vehicle cannot be smoothly run.

本発明は、上述した問題点を解決するためになされたものであり、搬送車両に多数の車軸が設けられている場合でも、その搬送車両を走行経路に沿って円滑に走行させることができる操舵制御装置を提供することを目的としている。   The present invention has been made to solve the above-described problems, and even when the transport vehicle is provided with a large number of axles, the transport vehicle can smoothly travel along the travel route. The object is to provide a control device.

課題を解決するための手段および発明の効果Means for Solving the Problems and Effects of the Invention

請求項1記載の操舵制御装置によれば、搬送車両のシャーシの長手方向には3以上の車軸が設けられ、その3以上の車軸のうち少なくとも第1車軸と第2車軸とには、それぞれ1ずつ走行経路に敷設された誘導体を検出する2以上の検出手段が設けられている。そして、かかる検出手段の検出信号に基づいて搬送車両が走行経路に沿って進行するように、車軸の各操舵角が次のように車軸ごとに制御される。第1車軸に設けられる検出手段の検出信号に基づいて、その検出手段と走行経路との位置ずれを示す第1偏差が第1偏差算出手段によって算出され、その算出される第1偏差に応じて、その第1偏差を減少させる第1車軸の第1操舵角が第1操舵角算出手段によって算出される。第2車軸に設けられる検出手段の検出結果に基づいて、その検出手段と走行経路との位置ずれを示す第2偏差が第2偏差算出手段によって算出され、その算出される第2偏差に応じて、その第2偏差を減少させる第2車軸の第2操舵角が第2操舵角算出手段によって算出される。一方で、操舵角記憶手段には、車軸の各操舵角が、第1操舵角算出手段によって算出される第1操舵角と第2操舵角算出手段によって算出される第2操舵角とに対応付けて、予め算出された定数で記憶されている。そして、第1操舵角算出手段によって第1操舵角が、第2操舵角算出手段によって第2操舵角が算出された場合、その第1操舵角と第2操舵角とに対応付けて操舵角記憶手段に記憶された車軸の各操舵角が操舵角取得手段によって取得され、その取得された車軸の各操舵角で、車軸の各々が操舵角制御手段によって制御される。よって、3以上の車軸の操舵角を車軸ごとに制御する場合に、その操舵角の全部を計算式などにより算出しなくて良く、第1車軸の第1操舵角と第2車軸の第2操舵角とを算出すれば、車軸の各操舵角は、かかる第1操舵角と第2操舵角とに対応付けて予め算出された定数で操舵角記憶手段に記憶されているので、それを取得すれば良い。よって、各操舵角を短時間で得られる。従って、搬送車両に多数の車軸が設けられている場合でも、その多数の車軸に設定する各操舵角を短時間で得られるので、多数の車軸の各操舵角を短い時間間隔で制御できる。故に、搬送車両を走行経路に沿って円滑に走行させることができるという効果がある。 According to the steering control device of the first aspect, three or more axles are provided in the longitudinal direction of the chassis of the transport vehicle, and at least the first axle and the second axle among the three or more axles are each 1 Two or more detection means are provided for detecting the derivatives laid on the travel route one by one. As the transport vehicle is traveling along the travel path based on the detection signal of such detection means, each steering angle of the axle is controlled for each axle, as follows. Based on the detection signal of the detecting means provided on the first axle, a first deviation indicating a positional deviation between the detecting means and the travel route is calculated by the first deviation calculating means, and according to the calculated first deviation. The first steering angle of the first axle for reducing the first deviation is calculated by the first steering angle calculation means. Based on the detection result of the detection means provided on the second axle, the second deviation indicating the positional deviation between the detection means and the travel route is calculated by the second deviation calculation means, and according to the calculated second deviation. The second steering angle of the second axle that reduces the second deviation is calculated by the second steering angle calculation means. On the other hand, the steering angle storage means associates each steering angle of the axle with the first steering angle calculated by the first steering angle calculation means and the second steering angle calculated by the second steering angle calculation means. Te is remembers with pre-calculated constants. When the first steering angle is calculated by the first steering angle calculating means and the second steering angle is calculated by the second steering angle calculating means, the steering angle is stored in association with the first steering angle and the second steering angle. each steering angle of the stored vehicle shaft is acquired by the steering angle obtaining means to the means, at each steering angle of the acquired vehicle axis, each of the axles is controlled by the steering angle control means. Therefore, when the steering angles of three or more axles are controlled for each axle, it is not necessary to calculate all of the steering angles by a calculation formula or the like, and the first steering angle of the first axle and the second steering of the second axle. If the angle is calculated , each steering angle of the axle is stored in the steering angle storage means with a constant calculated in advance in association with the first steering angle and the second steering angle. It ’s fine. Therefore, each steering angle can be obtained in a short time. Accordingly, even when a large number of axles are provided on the transport vehicle, the steering angles set on the many axles can be obtained in a short time, and thus the steering angles of the many axles can be controlled at short time intervals. Therefore, there is an effect that the transport vehicle can smoothly travel along the travel route.

請求項2記載の操舵制御装置によれば、請求項1記載の操舵制御装置の奏する効果に加え、次の効果を奏する。即ち、搬送車両の目標走行速度に対する走行速度比であって、車軸の各操舵角に応じて定まる車軸の各走行速度比が、操舵角記憶手段に記憶される車軸の各操舵角に対応つけて、予め算出された定数で走行速度比記憶手段に記憶されている。そして、操舵角取得手段によって車軸の各操舵角が取得される場合には、かかる車軸の各操舵角と対応つけて走行速度比記憶手段に記憶された各走行速度比が走行速度比取得手段によって取得される。そして、その走行速度比取得手段により取得された各走行速度比と、目標速度取得手段により取得された目標走行速度とに基づいて、車軸の各走行速度が走行速度算出手段によって算出され、その算出された各走行速度で車軸の各々が走行速度制御手段によって制御される。よって、軸の各操舵角が取得される場合に、かかる車軸と、それと対応する各走行速度比を取得することができ、その取得する各走行速度比に対して目標走行速度を乗算するという簡単な演算で、車軸の各走行速度を算出できる。従って、搬送車両に多数の車軸が設けられている場合でも、その多数の車軸に設定する各走行速度を短時間に得られるので、多数の車軸の各走行速度を短い時間間隔で制御できる。故に、多数の車軸間で走行速度の釣り合いが取れなくなることを抑制できるので、搬送車両をより円滑に走行させることができるという効果がある。 According to the steering control device of the second aspect, in addition to the effect exhibited by the steering control device according to the first aspect, the following effect can be obtained. That is, a traveling speed ratio with respect to the target traveling speed of the transfer vehicle, the traveling speed ratio of the drive shaft that Sadama according to the steering angle of the axle, each steering angle of the axle to be stored in the steering angle storage means Correspondingly, it is stored in the traveling speed ratio storage means as a constant calculated in advance. Then, when each steering angle of the vehicle axis by the steering angle acquisition unit is acquired, the travel speed ratio stored in the steering angle and corresponds put in travel speed ratio storage means of the car axis that written Is acquired by the traveling speed ratio acquisition means. Then, based on each travel speed ratio acquired by the travel speed ratio acquisition means and the target travel speed acquired by the target speed acquisition means , each travel speed of the axle is calculated by the travel speed calculation means, and the calculation Each axle is controlled by the traveling speed control means at each traveling speed. Therefore, when each steering angle of the vehicle axis is acquired, and cars shaft that written therewith can obtain the traveling speed ratio the corresponding target travel speed for each travel speed ratio for obtaining Each traveling speed of the axle can be calculated by a simple calculation of multiplying by. Accordingly, even when a large number of axles are provided on the transport vehicle, the traveling speeds set on the numerous axles can be obtained in a short time, and thus the traveling speeds of the many axles can be controlled at short time intervals. Therefore, since it is possible to prevent the traveling speed from being balanced between a large number of axles, there is an effect that the transport vehicle can be driven more smoothly.

請求項3記載の操舵制御装置によれば、請求項1または2記載の操舵制御装置の奏する効果に加え、次の効果を奏する。即ち、第1車軸はシャーシの長手方向の一端側に、第2車軸はシャーシの長手方向の他端側に設けられる。よって、第1車軸に設けられる検出手段と、第2車軸に設けられる検出手段とが共に、走行経路に対して位置ずれしなくなるように、即ち、走行経路上に存在し続けるように搬送車両の進行方向を設定できる。従って、走行経路がカーブ、又は、屈折している場合においても、搬送車両の前方側や後方側が、走行経路上から外れることを抑制できるので、走行経路の周辺を通行する歩行者などに対する安全性を高められるという効果がある。   According to the steering control device of the third aspect, in addition to the effect exhibited by the steering control device according to the first or second aspect, the following effect can be obtained. That is, the first axle is provided on one end side in the longitudinal direction of the chassis, and the second axle is provided on the other end side in the longitudinal direction of the chassis. Therefore, both the detection means provided on the first axle and the detection means provided on the second axle are prevented from being displaced with respect to the travel route, that is, so as to continue to exist on the travel route. You can set the direction of travel. Therefore, even when the travel route is curved or refracted, it is possible to prevent the front side and the rear side of the transport vehicle from being deviated from the travel route. There is an effect that can be improved.

(a)は、無人搬送車両の側面図であり、(b)は、無人搬送車両の底面図であり、(c)は、無人搬送車両の走行装置の拡大斜視図である。(A) is a side view of an automatic guided vehicle, (b) is a bottom view of the automatic guided vehicle, and (c) is an enlarged perspective view of a traveling device of the automatic guided vehicle. (a)は、無人搬送車両の走行経路全体を模式的に示す平面図であり、(b)は、走行経路における分岐点周辺の拡大図である。(A) is a top view which shows typically the whole driving | running route of an automatic guided vehicle, (b) is an enlarged view of a branch point periphery in a driving route. 無人搬送車両の電気的構成を模式的に示すブロック図である。It is a block diagram which shows typically the electric constitution of an automatic guided vehicle. (a)は、動作情報リンクテーブルの内容の一例を示す模式図であり、(b)は、動作コマンドテーブルの内容の一例を示す模式図であり、(c)は、動作コマンドの種別の一例を示す模式図である。(A) is a schematic diagram which shows an example of the content of an operation information link table, (b) is a schematic diagram which shows an example of the content of an operation command table, (c) is an example of the classification of an operation command. It is a schematic diagram which shows. (a)は、操舵角設定テーブルの内容の一例を示す模式図であり、(b)は、操舵角設定テーブルの各マス目ごとに設定される複数の定数の一例を示す模式図である。(A) is a schematic diagram which shows an example of the content of a steering angle setting table, (b) is a schematic diagram which shows an example of the some constant set for every square of a steering angle setting table. 操舵角設定テーブルの各マス目ごとに設定される各定数の算出方法の一例を説明するための説明図である。It is explanatory drawing for demonstrating an example of the calculation method of each constant set for every square of a steering angle setting table. 操舵角設定テーブルの各マス目ごとに設定される各定数の算出方法の一例を説明するための説明図である。It is explanatory drawing for demonstrating an example of the calculation method of each constant set for every square of a steering angle setting table. 制御装置で実行される自動運転処理を示すフローチャートである。It is a flowchart which shows the automatic driving | running | working process performed with a control apparatus. 制御装置で実行される動作コマンド設定処理を示すフローチャートである。It is a flowchart which shows the operation command setting process performed with a control apparatus. 制御装置で実行される動作コマンド生成処理を示すフローチャートである。It is a flowchart which shows the operation command production | generation process performed with a control apparatus. 動作コマンド設定処理の流れを説明するための説明図である。It is explanatory drawing for demonstrating the flow of an operation command setting process. 動作コマンド設定処理の流れを説明するための説明図である。It is explanatory drawing for demonstrating the flow of an operation command setting process. 制御装置で実行される操舵角自動設定処理を示すフローチャートである。It is a flowchart which shows the steering angle automatic setting process performed with a control apparatus.

以下、本発明の好ましい実施形態について、添付図面を参照して説明する。図1(a)は、無人搬送車両1の側面図であり、図1(b)は、無人搬送車両1の底面図であり、図1(c)は、無人搬送車両1の走行装置5の拡大斜視図である。尚、本実施形態では、図1(a),(b)において、図面に向かった左方向を無人搬送車両1の前方とし、図面に向かった右方向を無人搬送車両1の後方とする。また、図1(a),(b)では、無人搬送車両1の前後方向を矢印Yにより図示し、左右方向を矢印Xにより図示している。   Hereinafter, preferred embodiments of the present invention will be described with reference to the accompanying drawings. FIG. 1A is a side view of the automatic guided vehicle 1, FIG. 1B is a bottom view of the automatic guided vehicle 1, and FIG. 1C is a diagram of the traveling device 5 of the automatic guided vehicle 1. It is an expansion perspective view. In this embodiment, in FIGS. 1A and 1B, the left direction toward the drawing is the front of the automatic guided vehicle 1, and the right direction toward the drawing is the rear of the automatic guided vehicle 1. 1A and 1B, the front-rear direction of the automatic guided vehicle 1 is indicated by an arrow Y, and the left-right direction is indicated by an arrow X.

無人搬送車両1は、無人搬送車両1の運行制御を行う上位プロコン(非図示)から通知されてくる行先指令に基づいて、走行経路R(図2(a)参照)上を自動運転により無人で走行し、更に、その走行経路R上に設置されている複数のステーションCのうち、指令されたステーションCにおいて積載される積載物を、指令されたステーションCまで搬送するものである。   The automatic guided vehicle 1 is unmanned by automatic driving on a travel route R (see FIG. 2A) based on a destination command notified from a host computer (not shown) that performs operation control of the automatic guided vehicle 1. The vehicle travels, and further, among the plurality of stations C installed on the travel route R, the load loaded at the commanded station C is transported to the commanded station C.

図1(a),(b)に示すように、無人搬送車両1は、積載物が積載される荷台2と、荷台2を支持するシャーシ3と、シャーシ3の下部に設置された走行装置5a〜5lと、磁気ガイド検出センサ79a〜79dと、磁気マーク検出センサ80a〜80dと、IDタグ検出センサ81と、制御装置70とを主に有して構成されている。   As shown in FIGS. 1A and 1B, the automatic guided vehicle 1 includes a loading platform 2 on which a load is loaded, a chassis 3 that supports the loading platform 2, and a traveling device 5 a that is installed at a lower portion of the chassis 3. ˜5 l, magnetic guide detection sensors 79 a to 79 d, magnetic mark detection sensors 80 a to 80 d, an ID tag detection sensor 81, and a control device 70.

走行装置5a〜5lは、図1(b)に示すように、シャーシ3の下部において、無人搬送車両1の前後方向に6列、各列の左右方向に2個の計12個設けられている。尚、前後方向に6列設けられた走行装置5a〜5lを列番号で示す場合、無人搬送車両1の前面に最も近い列(5aおよび5b)を1列目(最前列)と記載し、それ以降は、無人搬送車両1の後方に向かって順番に、2列目、・・・、6列目(最終列)と記載する。   As shown in FIG. 1B, the traveling devices 5 a to 5 l are provided in a total of 12 in the lower part of the chassis 3, 6 rows in the front-rear direction of the automated guided vehicle 1 and 2 in the left-right direction of each row. . When the traveling devices 5a to 5l provided in six rows in the front-rear direction are indicated by column numbers, the row (5a and 5b) closest to the front surface of the automated guided vehicle 1 is described as the first row (front row), Hereinafter, the second row,..., The sixth row (final row) are described in order toward the rear of the automatic guided vehicle 1.

各走行装置5a〜5lは、1本の車軸6aと、車軸6aの両端に連結された2つの車輪6bとをそれぞれ有し、各車軸6aは、車輪6bと共に前転または後転、また、シャーシ3に対して旋回するように構成されている。   Each of the traveling devices 5a to 5l has one axle 6a and two wheels 6b connected to both ends of the axle 6a. Each axle 6a rotates forward or backward together with the wheels 6b. 3 is configured to pivot with respect to 3.

これらの各走行装置5a〜5lには、車軸6aに回転駆動力を付与して車輪6bを回転させる回転駆動装置76a〜76l(図3参照)と、車軸6aを旋回させて車軸6aに操舵角を付与する操舵駆動装置77a〜77l(図3参照)とが、それぞれ個別に接続されている。   Each of the traveling devices 5a to 5l is provided with rotational driving devices 76a to 76l (see FIG. 3) for applying a rotational driving force to the axle 6a to rotate the wheel 6b, and turning the axle 6a to turn the axle 6a to a steering angle. Are respectively connected to the steering drive devices 77a to 77l (see FIG. 3).

本実施形態では、無人搬送車両1の前後方向(矢印Y方向)と、車軸6aに対する垂線とがなす角度を、その車軸6aの操舵角としている。具体的には、無人搬送車両1の前後方向(矢印Y方向)に対して車軸6aが垂直な場合に、その車軸6aの操舵角が0度となり、その状態から、車軸6aが時計回りに旋回すると、操舵角がプラス方向に増え、車軸6aが反時計回りに旋回すると、操舵角がマイナスに方向に増える(図6,図7参照)。   In the present embodiment, the angle formed by the front-rear direction (in the direction of arrow Y) of the automatic guided vehicle 1 and the perpendicular to the axle 6a is used as the steering angle of the axle 6a. Specifically, when the axle 6a is perpendicular to the front-rear direction (arrow Y direction) of the automatic guided vehicle 1, the steering angle of the axle 6a becomes 0 degrees, and the axle 6a turns clockwise from this state. Then, the steering angle increases in the positive direction, and when the axle 6a turns counterclockwise, the steering angle increases in the negative direction (see FIGS. 6 and 7).

回転駆動装置76a〜76lは、車軸6aに回転駆動力を付与する回転モータ76a1〜76l1(図3参照)を有し、操舵駆動装置77a〜77lは、車軸6aを旋回させる回転モータ77a1〜77l1(図3参照)を有している。本実施形態では、制御装置70からの指令によって、走行装置5a〜5lごとに、車軸6aの前転後転や旋回が制御される。   The rotation driving devices 76a to 76l have rotation motors 76a1 to 7611 (see FIG. 3) for applying a rotation driving force to the axle 6a, and the steering driving devices 77a to 77l rotate motors 77a1 to 7711 (which rotate the axle 6a). 3). In the present embodiment, forward / reverse rotation and turning of the axle 6a are controlled for each of the traveling devices 5a to 5l in accordance with a command from the control device 70.

また、各走行装置5a〜5lには、車輪6bの走行速度を検出する走行速度センサ78a〜78l(図3参照)がそれぞれ設けられており、車輪6b走行速度は、各走行装置5a〜5lごとに、それぞれ個別に制御装置70へ出力される(図3参照)。   Each traveling device 5a to 5l is provided with traveling speed sensors 78a to 78l (see FIG. 3) for detecting the traveling speed of the wheel 6b, and the traveling speed of the wheel 6b is determined for each traveling device 5a to 5l. In addition, they are individually output to the control device 70 (see FIG. 3).

また、図1(b),(c)に示すように、各走行装置5a〜5lのうち、走行装置5a,5b,5k,5lには、車軸6aの中央部分から無人搬送車両1の前面側に向かって、車軸6aに対して垂直に、磁気ガイド検出センサ79a,79b,79c,79dが設置されている。この磁気ガイド検出センサ79a〜79dは、設置されている走行装置5a,5b,5k,5lの車軸6aが旋回すると、その車軸6aと同様に旋回する。尚、磁気ガイド検出センサ79a〜79dの機能などについては、図2を参照しつつ後述する。   Further, as shown in FIGS. 1B and 1C, among the traveling devices 5 a to 5 l, the traveling devices 5 a, 5 b, 5 k, and 5 l include a front side of the automatic guided vehicle 1 from the central portion of the axle 6 a. The magnetic guide detection sensors 79a, 79b, 79c, 79d are installed perpendicular to the axle 6a. The magnetic guide detection sensors 79a to 79d turn in the same manner as the axle 6a when the axle 6a of the installed traveling devices 5a, 5b, 5k, 5l turns. The functions of the magnetic guide detection sensors 79a to 79d will be described later with reference to FIG.

また、図1(b)に示すように、磁気マーク検出センサ80a〜80dは、無人搬送車両1の前方および後方の底面であって、その左右方向の両端にそれぞれ1つずつ、計4個設けられている。また、IDタグ検出センサ81は、無人搬送車両1の前方の底面であって、左右方向の中央に1つ設けられている。尚、磁気マーク検出センサ80a〜80dおよびIDタグ検出センサ81の機能などについても、図2を参照しつつ後述する。   Further, as shown in FIG. 1B, the magnetic mark detection sensors 80a to 80d are provided on the front and rear bottom surfaces of the automatic guided vehicle 1 and are provided in total, four at each of the left and right ends. It has been. One ID tag detection sensor 81 is provided at the front bottom surface of the automated guided vehicle 1 and at the center in the left-right direction. The functions of the magnetic mark detection sensors 80a to 80d and the ID tag detection sensor 81 will be described later with reference to FIG.

制御装置70は、各種センサ78a〜78l,79a〜79d,80a〜80d,81の状態を検出すると共に、上位プロコン(非図示)から通知されてくる行先指令に基づいて、回転駆動装置76a〜76l(図3参照)や、操舵駆動装置77a〜77lなどを制御して、無人搬送車両1を自動運転させる装置である。   The control device 70 detects the states of the various sensors 78a to 78l, 79a to 79d, 80a to 80d, 81, and based on a destination command notified from a host computer (not shown), the rotational drive devices 76a to 76l. (Refer to FIG. 3), steering drive devices 77a to 77l, etc. are controlled to automatically drive the automatic guided vehicle 1.

本実施形態では、無人搬送車両1の運転モードとして、自動モードと、手動モードとの2つのモードが設けられており、制御装置70の電源が投入されると、通常は自動モードに設定される。制御装置70は、無人搬送車両1の運転モードが自動モードの場合、上位プロコンから通知されてくる行先指令に基づいて、無人搬送車両1を自動運転させる。一方、手動モードの場合、手動ペンダント(所謂、手動操作リモコン)による指令に基づいて、無人搬送車両1を走行させる。   In the present embodiment, two modes of an automatic mode and a manual mode are provided as the operation mode of the automatic guided vehicle 1, and when the control device 70 is turned on, the automatic mode is normally set. . When the operation mode of the automatic guided vehicle 1 is the automatic mode, the control device 70 causes the automatic guided vehicle 1 to automatically operate based on the destination command notified from the host computer. On the other hand, in the manual mode, the automatic guided vehicle 1 is caused to travel based on a command from a manual pendant (so-called manual operation remote controller).

次に、図2(a),(b)を参照して、無人搬送車両1の走行経路Rについて説明する。図2(a)は、無人搬送車両1の走行経路R全体を模式的に示す平面図であり、図2(b)は、走行経路Rにおける分岐点周辺(図1(a)の領域IIb)の拡大図である。   Next, the travel route R of the automatic guided vehicle 1 will be described with reference to FIGS. FIG. 2A is a plan view schematically showing the entire travel route R of the automated guided vehicle 1, and FIG. 2B is a vicinity of a branch point in the travel route R (region IIb in FIG. 1A). FIG.

図2(a)に示すように、無人搬送車両1の走行経路R全体は、8の字状に形成されており、無人搬送車両1を走行させる路面などに走行経路Rとして敷設された帯状の磁気ガイドGと、その磁気ガイドG上に所定間隔で設けられたステーションCとにより構成されている。   As shown in FIG. 2 (a), the entire travel route R of the automatic guided vehicle 1 is formed in an 8-shape, and is a belt-like shape laid as the travel route R on the road surface on which the automatic guided vehicle 1 travels. The magnetic guide G includes a station C provided on the magnetic guide G at a predetermined interval.

上述した磁気ガイド検出センサ79a〜79dは、磁気ガイドGを検出するセンサ素子を28個備えた検出部を有しており、検出部のどの領域で磁気ガイドGが検出されているのかなどの検出結果を制御装置70(図3参照)に出力する。   The magnetic guide detection sensors 79a to 79d described above have a detection unit including 28 sensor elements that detect the magnetic guide G, and detect in which region of the detection unit the magnetic guide G is detected. The result is output to the control device 70 (see FIG. 3).

この28個のセンサ素子は、車軸6aに対して平行となるように一列に配置されており、その一列の長さは、磁気ガイドGの横幅よりも十分広く設けられている。例えば、28個のセンサ素子と、磁気ガイドG全体とが垂直に交差していれば、一列に並ぶ28個のセンサ素子の中の数個のセンサにより磁気ガイドGが検出される。   The 28 sensor elements are arranged in a row so as to be parallel to the axle 6a, and the length of the row is sufficiently wider than the lateral width of the magnetic guide G. For example, if 28 sensor elements and the entire magnetic guide G intersect perpendicularly, the magnetic guide G is detected by several of the 28 sensor elements arranged in a row.

制御装置70は、運転モードとして右倣いモードが設定されている場合、各磁気ガイド検出センサ79b,79dから出力されている検出結果を取得する一方、運転モードとして左倣いモードが設定されている場合、各磁気ガイド検出センサ79a,79cから出力されている検出結果を取得する。   When the right scanning mode is set as the operation mode, the control device 70 acquires the detection results output from the magnetic guide detection sensors 79b and 79d, while the left scanning mode is set as the operation mode. The detection results output from the magnetic guide detection sensors 79a and 79c are acquired.

そして、取得した検出結果に基づいて、無人搬送車両1と磁気ガイドGとの位置ずれを算出し、その位置ずれを補正する(減少させる)ように、即ち、無人搬送車両1が磁気ガイドG上を走行するように進行方向などを制御する。より具体的には、制御装置70は、検出結果を取得した磁気ガイド検出センサ79a〜79dの検出部の中央に、磁気ガイドGが収まるように、無人搬送車両1の進行方向を制御する。   Then, based on the acquired detection result, the positional deviation between the automatic guided vehicle 1 and the magnetic guide G is calculated, and the positional deviation is corrected (decreased), that is, the automatic guided vehicle 1 is placed on the magnetic guide G. Control the direction of travel and so on. More specifically, the control device 70 controls the traveling direction of the automatic guided vehicle 1 so that the magnetic guide G fits in the center of the detection units of the magnetic guide detection sensors 79a to 79d that have acquired the detection results.

ステーションCは、無人搬送車両1に対して積載物の積み降ろしが行われる位置や、無人搬送車両1が別の無人搬送車両1の通過を待つ位置や、無人搬送車両1が走行経路R上にある自動シャッタや自動扉の開放を待つ位置などである。   Station C is a position where unloading vehicle 1 is loaded or unloaded, a position where unmanned transport vehicle 1 waits for another unmanned transport vehicle 1 to pass, or unmanned transport vehicle 1 is on travel route R. For example, the position of waiting for the opening of a certain automatic shutter or automatic door.

図2(a)に示すように、各ステーションCには、それぞれ個別に名称「C***」(尚、「***」は、3桁の数字)が付されている。以後、ステーションCを個別に特定する場合には、ステーションC名をそのまま記載する。例えば、「C201」という名称のステーションCを示す場合には、「C201」と記載する。   As shown in FIG. 2A, each station C is individually assigned a name “C ***” (where “***” is a three-digit number). Thereafter, when the station C is individually specified, the station C name is described as it is. For example, when the station C named “C201” is indicated, it is described as “C201”.

また、図2(a)では、「C201」や「C220」や「C251」に、それぞれ無人搬送車両1が配備されている状態を示している。本実施形態では、各無人搬送車両1の配車など、各無人搬送車両1の運行制御については上位プロコン(非図示)により管理される。   Further, FIG. 2A shows a state in which the automatic guided vehicle 1 is provided in each of “C201”, “C220”, and “C251”. In the present embodiment, operation control of each automated guided vehicle 1 such as allocation of each automated guided vehicle 1 is managed by a host computer (not shown).

それぞれの無人搬送車両1は、定期的(例えば、数秒毎に)に上位プロコンに対して、走行中であるか待機中であるかや、走行中であれば走行位置や、待機中であれば待機位置などを通知する。上位プロコンは、無人搬送車両1同士が走行経路R上で出会って立ち往生したり、無人搬送車両1が別の無人搬送車両1に追突しないように、各無人搬送車両1に対して行先指令を通知する。   Each automatic guided vehicle 1 is traveling or waiting for a host computer on a regular basis (for example, every few seconds). Notify the standby position. The host computer notifies each unmanned transport vehicle 1 of a destination command so that the unmanned transport vehicles 1 meet on the travel route R and get stuck, or the unmanned transport vehicle 1 does not collide with another unmanned transport vehicle 1. To do.

また、図2(b)に示すように、走行経路R上の各ステーションCには、磁気ガイドGと同様に、矩形板状の磁気マークMと、コイン状のIDタグITとが配設されている。また、走行経路Rにおける分岐点にも、同様に磁気マークMが配設されている。   Further, as shown in FIG. 2B, each station C on the travel route R is provided with a rectangular plate-like magnetic mark M and a coin-like ID tag IT, as with the magnetic guide G. ing. Similarly, magnetic marks M are arranged at branch points in the travel route R.

磁気マークMは、走行経路R上における各ステーションCや、分岐点などに配置されるものであり、無人搬送車両1の停止位置や、右折位置や、左折位置などの基準位置を、制御装置70が確認するためのものである。上述した磁気マーク検出センサ80a〜80dは、磁気マークMを検出しているか否かを制御装置70(図3参照)に出力するセンサであり、制御装置70は、磁気マークMが検出された場合に、無人搬送車両1が何れかのステーションCに到着した、または、走行経路Rにおける分岐点に差し掛かったと判別する。   The magnetic mark M is arranged at each station C on the travel route R, a branch point, or the like, and the control device 70 determines the reference position such as the stop position, right turn position, left turn position, etc. of the automatic guided vehicle 1. Is to confirm. The magnetic mark detection sensors 80a to 80d described above are sensors that output whether or not the magnetic mark M is detected to the control device 70 (see FIG. 3), and the control device 70 detects when the magnetic mark M is detected. Then, it is determined that the automated guided vehicle 1 has arrived at any station C or has reached a branch point in the travel route R.

IDタグITは、走行経路R上の各ステーションCをそれぞれ個別に識別するための識別情報(例えば、ステーションCの名称)が記憶されたものである。IDタグ検出センサ81は、IDタグITとの距離が接近している間(例えば、数10cm以内)、そのIDタグITに記憶されている識別情報を非接触(例えば、電磁誘導方式など)で読み取って、制御装置70へ出力するセンサである。   The ID tag IT stores identification information (for example, the name of the station C) for individually identifying each station C on the travel route R. While the distance from the ID tag IT is close (for example, within several tens of centimeters), the ID tag detection sensor 81 can contact the identification information stored in the ID tag IT in a non-contact manner (for example, an electromagnetic induction method). It is a sensor that reads and outputs to the control device 70.

制御装置70は、磁気マーク検出センサ80a〜80dにより磁気マークが検出されていると共に、IDタグ検出センサ81によりIDタグITの識別情報が検出されていれば、その検出された識別情報に対応するステーションCに、無人搬送車両1が到着したと判別する。   If the magnetic mark is detected by the magnetic mark detection sensors 80a to 80d and the identification information of the ID tag IT is detected by the ID tag detection sensor 81, the control device 70 corresponds to the detected identification information. It is determined that the automatic guided vehicle 1 has arrived at the station C.

次に、図3を参照して、無人搬送車両1の電気的構成について説明する。制御装置70は、無人搬送車両1に搭載されている装置であり、無人搬送車両1が有する各種装置や、無人搬送車両1の走行状態などを制御するものである。制御装置70は、CPU71、フラッシュメモリ72、及び、RAM73を備え、これらがバスライン74を介して入出力ポート75にそれぞれ接続されている。   Next, the electrical configuration of the automatic guided vehicle 1 will be described with reference to FIG. The control device 70 is a device mounted on the automatic guided vehicle 1, and controls various devices included in the automatic guided vehicle 1, the traveling state of the automatic guided vehicle 1, and the like. The control device 70 includes a CPU 71, a flash memory 72, and a RAM 73, which are connected to the input / output port 75 via the bus line 74.

入出力ポート75には、上述した回転駆動装置76a〜76lと、操舵駆動装置77a〜77lと、走行速度検出センサ78a〜78lと、磁気ガイド検出センサ79a〜79dと、磁気マーク検出センサ80a〜80dと、IDタグ検出センサ81とに加えて、無線通信装置82とが主に接続されている。   The input / output port 75 includes the rotation driving devices 76a to 76l, the steering driving devices 77a to 77l, the traveling speed detection sensors 78a to 78l, the magnetic guide detection sensors 79a to 79d, and the magnetic mark detection sensors 80a to 80d. In addition to the ID tag detection sensor 81, a wireless communication device 82 is mainly connected.

CPU71は、バスライン74により接続された各部を制御する演算装置である。フラッシュメモリ72は、CPU71により実行されるプログラムや固定値データ等を格納した書き換え可能な不揮発性のメモリである。尚、後述する図8のフローチャートに示す自動運転処理、図9のフローチャートに示す動作コマンド設定処理、図10のフローチャートに示す動作コマンド生成処理、及び、図13のフローチャートに示す操舵角自動設定処理を実行する各プログラムは、このフラッシュメモリ72に格納されている。   The CPU 71 is an arithmetic unit that controls each unit connected by the bus line 74. The flash memory 72 is a rewritable nonvolatile memory that stores programs executed by the CPU 71, fixed value data, and the like. In addition, the automatic driving process shown in the flowchart of FIG. 8 described later, the operation command setting process shown in the flowchart of FIG. 9, the operation command generation process shown in the flowchart of FIG. 10, and the steering angle automatic setting process shown in the flowchart of FIG. Each program to be executed is stored in the flash memory 72.

また、フラッシュメモリ72には、動作情報リンクテーブル72aと、動作コマンドテーブル72bと、操舵角設定テーブル72cとが設けられている。ここで、図4を参照して、動作情報リンクテーブル72aおよび動作コマンドテーブル72bについて説明する。   The flash memory 72 is provided with an operation information link table 72a, an operation command table 72b, and a steering angle setting table 72c. Here, the operation information link table 72a and the operation command table 72b will be described with reference to FIG.

図4(a)は、動作情報リンクテーブル72aの内容の一例を示す模式図であり、図4(b)は、動作コマンドテーブル72bの内容の一例を示す模式図であり、図4(c)は、動作コマンドの種別の一例を示す模式図である。   FIG. 4A is a schematic diagram showing an example of the contents of the operation information link table 72a, and FIG. 4B is a schematic diagram showing an example of the contents of the operation command table 72b. These are schematic diagrams showing an example of types of operation commands.

動作情報リンクテーブル72aは、上位プロコンから通知された行先指令に対応する動作コマンド列を制御装置70が生成する場合に、後述する動作コマンドテーブル72bと共に制御装置70により参照されるテーブルである。   The operation information link table 72a is a table that is referred to by the control device 70 together with the operation command table 72b described later when the control device 70 generates an operation command sequence corresponding to the destination command notified from the host computer.

行先指令は、出発地点となるステーションCから到着地点となるステーションCまでの各ステーションCを走行順に並べたデータ(以後、「ステーションC列」と称す)で構成されており、出発地点となるステーションCが「C201」であり、到着地点となるステーションCが「C203」の場合には、「C201→C202→C203」という行先指令が、上位プロコンから無人搬送車両1へ通知される。   The destination command is composed of data in which the stations C from the station C serving as the departure point to the station C serving as the arrival point are arranged in the order of travel (hereinafter referred to as “station C column”). When C is “C201” and the station C as the arrival point is “C203”, a destination command “C201 → C202 → C203” is notified from the host computer to the automatic guided vehicle 1.

また、動作コマンドは、無人搬送車両1の走行制御を行うために制御装置70が実行する命令であり、無人搬送車両1の制御内容に応じて複数種類設けられている(図4(c)参照)。制御装置70は、これらの動作コマンドを組み合わせて、上位プロコンより通知された行先指令に対応する動作コマンド列を生成し、その後、その生成した動作コマンド列の各動作コマンドを1つずつ順番に実行して、出発地点となるステーションCから到着地点となるステーションCまで無人搬送車両1を走行させる。尚、行先指令から動作コマンド列を生成する方法については後述する。   The operation command is a command executed by the control device 70 to perform traveling control of the automatic guided vehicle 1, and a plurality of types of operation commands are provided according to the control content of the automatic guided vehicle 1 (see FIG. 4C). ). The control device 70 combines these operation commands to generate an operation command sequence corresponding to the destination command notified from the host computer, and then sequentially executes each operation command of the generated operation command sequence one by one. Then, the automatic guided vehicle 1 is caused to travel from the station C serving as the departure point to the station C serving as the arrival point. A method for generating an operation command sequence from a destination command will be described later.

動作情報リンクテーブル72aは、図4(a)に示すように、走行経路R上で隣設する3つのステーションCの組み合わせと、その組み合わせに対応する動作情報データ番号列とに加え、走行経路R上で隣設する2つのステーションCの組み合わせと、その組み合わせに対応する動作情報データ番号列とにより構成されている。   As shown in FIG. 4A, the motion information link table 72a includes a combination of three stations C adjacent on the travel route R and a motion information data number sequence corresponding to the combination, as well as a travel route R. It is composed of a combination of two stations C adjacent to each other and an operation information data number string corresponding to the combination.

ここで、隣設する3つのステーションCの組み合わせは、無人搬送車両1が直近に通過する予定のステーションC(以後、「前回位置」と称す)と、無人搬送車両1が存在する予定のステーションC(以後、「現在位置」と称す)と、無人搬送車両1が次に通過する予定のステーションC(以後、「次回位置」と称す)とにより構成されている。   Here, the combination of three adjacent stations C includes a station C where the unmanned transport vehicle 1 is scheduled to pass most recently (hereinafter referred to as “previous position”) and a station C where the unmanned transport vehicle 1 is scheduled to exist. (Hereinafter referred to as “current position”) and a station C to which the automatic guided vehicle 1 is scheduled to pass next (hereinafter referred to as “next position”).

以後、説明を簡単にするために、隣設する3つのステーションCの組み合わせを記載する場合には、「前回位置,現在位置,次回位置」という順序で各ステーションCを記載する。例えば、前回位置が「C201」、現在位置が「C202」、次回位置が「C203」であれば、「C201,C202,C203」と記載する。尚、この組み合わせは、無人搬送車両1がC201からC202までの走行を終え、引き続き、C202からC203へ向かって走行することを意味する。   Hereinafter, in order to simplify the description, when describing a combination of three adjacent stations C, each station C is described in the order of “previous position, current position, and next position”. For example, if the previous position is “C201”, the current position is “C202”, and the next position is “C203”, “C201, C202, C203” is described. This combination means that the automatic guided vehicle 1 finishes traveling from C201 to C202 and continues to travel from C202 to C203.

ところで、本実施形態では、隣設する3つのステーションCの組み合わせを構成する場合に、前回位置や次回位置が存在しないため、その組み合わせを構成できないことがある。即ち、無人搬送車両1が現在位置で指令待ちの状態(以後、「待機中」と称す)から、新たに走行開始する場合には、前回位置が存在しない。また、無人搬送車両1が自動運転を行っている状態(以後、「自動運転中」と称す)であるものの、現在位置で停車し、それ以後は待機中となる場合には、次回位置が存在しない。   By the way, in this embodiment, when configuring a combination of three adjacent stations C, there is a case where the previous position and the next position do not exist, and therefore the combination cannot be configured. That is, when the unmanned transport vehicle 1 newly starts running from a state of waiting for a command at the current position (hereinafter referred to as “standby”), there is no previous position. In addition, if the automatic guided vehicle 1 is in an automatic driving state (hereinafter referred to as “automatic driving”) but stops at the current position and then waits thereafter, the next position exists. do not do.

よって、このような場合には、走行経路R上で隣接する2つのステーションCの組み合わせしか構成できない。そこで、本実施形態では、「前回位置」や「次回位置」が存在せず、2つのステーションCの組み合わせしか構成できない場合には、「前回位置」や「次回位置」に、「該当なし」という意味で「0」を記載する。   Therefore, in such a case, only a combination of two stations C adjacent on the travel route R can be configured. Therefore, in the present embodiment, when there is no “previous position” or “next position” and only a combination of the two stations C can be configured, the “previous position” or “next position” is referred to as “not applicable”. “0” is written in the meaning.

例えば、「0,C201,C202」というステーションCの組み合わせは、C201で待機中であった無人搬送車両1が、C201から走行開始してC202へ向かうことを意味する。また、例えば、「C201,C202,0」というステーションCの組み合わせは、無人搬送車両1がC201からC202までの走行を終えて、C202で停車し、それ以後は待機中になることを意味する。   For example, the combination of the stations C “0, C201, C202” means that the automatic guided vehicle 1 that has been waiting in C201 starts traveling from C201 and heads for C202. Further, for example, the combination of the stations C of “C201, C202, 0” means that the automatic guided vehicle 1 finishes traveling from C201 to C202, stops at C202, and thereafter waits.

動作情報データ番号列は、動作情報データ番号が1以上連なって構成されている。尚、詳細については後述するが、各動作情報データ番号には、後述する動作コマンドテーブル72b(図4(b)参照)において、複数の動作コマンドで構成される動作コマンド列がそれぞれ設定されている。   The motion information data number sequence is composed of one or more motion information data numbers. Although details will be described later, each operation information data number is set with an operation command string composed of a plurality of operation commands in an operation command table 72b (see FIG. 4B) described later. .

上述したように、動作情報データ番号列は、隣設する3つのステーションCの組み合わせに応じて設定されており、例えば、図4(a)に示すように、「0,C201,C202」というステーションCの組み合わせには、「11,22,208,99,112,31」という動作情報データ番号列が対応づけられている。尚、この番号列に対応する動作コマンド列が制御装置70により実行されると、C201で待機中であった無人搬送車両1が、C201からC202まで走行する。   As described above, the operation information data number string is set according to the combination of three adjacent stations C. For example, as shown in FIG. 4A, the stations “0, C201, C202” are set. The combination of C is associated with an operation information data number string of “11, 22, 208, 99, 112, 31”. When an operation command sequence corresponding to this number sequence is executed by the control device 70, the automatic guided vehicle 1 that has been waiting in C201 travels from C201 to C202.

また、例えば、「C203,C204,C205」というステーションCの組み合わせには、「67,212,99,114,31」という動作情報データ番号列が対応づけられている。尚、この番号列に対応する動作コマンド列が制御装置70により実行されると、C203からC204まで走行してきた無人搬送車両1が、引き続き、C204からC205まで走行する。以下、その他のステーションCの組み合わせについても同様な説明となるので、その説明は省略する。   For example, the combination of the station C “C203, C204, C205” is associated with the operation information data number string “67, 212, 99, 114, 31”. When the operation command sequence corresponding to this number sequence is executed by the control device 70, the automatic guided vehicle 1 traveling from C203 to C204 continues to travel from C204 to C205. Hereinafter, the same description will be given for other combinations of the stations C, and the description thereof will be omitted.

本実施形態では、走行経路R全体と、その走行経路R上に配置するステーションCとが決定された段階で、その走行経路Rに応じた動作情報リンクテーブル72aが、無人搬送車両1の開発元(提供元)などより事前に作成される。より具体的には、動作情報リンクテーブル72aを作成するために、走行経路R上に配置されるステーションCの中から、隣設する3つのステーションCの組み合わせが全て求められて、各組み合わせごとに、その組み合わせに対応する動作情報データ番号列を設定するという作業が行われる。同様に、走行経路R上に配置されるステーションCの中から、隣設する2つのステーションCの組み合わせが全て求められて、各組み合わせごとに、その組み合わせに対応する動作情報データ番号列を設定するという作業が行われる。   In the present embodiment, when the entire travel route R and the stations C arranged on the travel route R are determined, the operation information link table 72a corresponding to the travel route R is the developer of the automatic guided vehicle 1. (Provider) and so on. More specifically, in order to create the operation information link table 72a, all the combinations of the three adjacent stations C are obtained from the stations C arranged on the travel route R. For each combination, Then, an operation of setting an operation information data number sequence corresponding to the combination is performed. Similarly, all the combinations of two adjacent stations C are obtained from the stations C arranged on the travel route R, and an operation information data number sequence corresponding to the combination is set for each combination. The work is done.

これに対して、従来の無人搬送車両の場合にも同様に、動作情報リンクテーブルが作成されていたが、後述するように、ステーションCの組み合わせを総当たりで求めていたため、そのサイズは本実施形態よりも大きいものとなっていた。即ち、従来の無人搬送車両用の動作情報リンクテーブルを作成する場合には、まず、走行経路R上に配置されるステーションCのうち、1つのステーションCを現在位置とし、その現在位置を除く残りのステーションCの1つを次回位置とする2つのステーションCの組み合わせが求められる。加えて、現在位置はそのまま変えずに、その現在位置と、先に組み合わせた1つのステーションを除く残りの各ステーションCをそれぞれ次回位置とする2つのステーションCの組み合わせについても、全て求められる。   On the other hand, in the case of the conventional automatic guided vehicle, the operation information link table was created in the same manner. However, as described later, since the combination of the stations C was obtained as a brute force, the size of the operation information link table was determined according to this embodiment. It was larger than the form. That is, when creating a conventional operation information link table for an automated guided vehicle, first, among the stations C arranged on the travel route R, one station C is set as the current position, and the remaining positions excluding the current position are excluded. A combination of two stations C is determined, with one of the stations C as the next position. In addition, the present position is not changed as it is, and all the combinations of the present position and the two stations C having the remaining stations C other than the previously combined station C as the next positions are obtained.

そして、以下同様に、走行経路R上に配置される各ステーションCをそれぞれ現在位置とする場合についても、現在位置と、次回位置との2つのステーションCの組み合わせが全て求められる。その後、各組み合わせごとに、その組み合わせに対応する動作情報データ番号列を設定するという作業が行われる。   Similarly, in the case where each station C arranged on the travel route R is set as the current position, all combinations of the two stations C of the current position and the next position are obtained. Thereafter, for each combination, an operation of setting an operation information data number sequence corresponding to the combination is performed.

このように、従来の無人搬送車両用の動作情報リンクテーブルでは、ステーションCの組み合わせを、総当たりで求めていたため、動作情報リンクテーブルのサイズが大きくなっていた。また、ステーションCの組み合わせが多いため、その組み合わせに対応する動作情報データ番号列の設定が煩雑であり、入力ミスを招き易かった。また、走行経路R上のステーションC数を増減する場合には、動作情報リンクテーブルを全体的に修正しなければならないので、修正作業が煩雑であった。   As described above, in the operation information link table for the conventional automatic guided vehicle, since the combination of the stations C is obtained as a brute force, the size of the operation information link table is large. Further, since there are many combinations of stations C, setting of the operation information data number sequence corresponding to the combinations is complicated, and input errors are easily caused. Further, when the number of stations C on the travel route R is increased or decreased, the operation information link table must be corrected as a whole, so that the correction work is complicated.

これに対して、本実施形態では、動作情報リンクテーブル72aを事前に作成する場合に、走行経路R上に配置されるステーションCの中から、隣設する3つのステーションCの組み合わせと、隣設する2つのステーションCの組み合わせとについて、その組み合わせを全て求めて、その各組み合わせに対応する動作情報データ番号列を設定している。よって、求める組み合わせの数が少ないため、従来の無人搬送車両用の動作情報リンクテーブルよりも、そのサイズを小さくできる。また、走行経路R上のステーションC数を増減する場合には、動作情報リンクテーブル72aのうち、増減させるステーションCを含む3つのステーションCの組み合わせと、増減させるステーションCを含む2つのステーションCの組み合わせとについてのみ修正を行い、その各組み合わせに対応する動作情報データ番号列を設定し直せば良いので、修正作業が容易である。   On the other hand, in the present embodiment, when the operation information link table 72a is created in advance, the combination of three adjacent stations C among the stations C arranged on the travel route R and the adjacent installation The combinations of the two stations C to be obtained are all obtained, and the operation information data number sequence corresponding to each combination is set. Therefore, since the number of combinations to be obtained is small, the size can be made smaller than that of the conventional operation information link table for automatic guided vehicles. When the number of stations C on the travel route R is increased or decreased, the combination of the three stations C including the station C to be increased or decreased and the two stations C including the station C to be increased or decreased in the operation information link table 72a. Since only the combinations are corrected and the operation information data number sequence corresponding to each combination is reset, the correction work is easy.

また、上述したように、本実施形態では、「前回位置,現在位置,次回位置」というステーションCの組み合わせから、無人搬送車両1を「現在位置」から「次回位置」まで走行させるための動作コマンド列を取得するように構成している。   Further, as described above, in the present embodiment, the operation command for causing the automatic guided vehicle 1 to travel from the “current position” to the “next position” from the combination of the stations C “previous position, current position, and next position”. Configured to retrieve columns.

よって、「前回位置」から「次回位置」までの走行経路Rが直線であるか、カーブしているか、又は、屈折しているかなどの走行条件に応じて、「現在位置」から「次回位置」までの無人搬送車両1の走行状態を適切に設定できる。   Therefore, depending on the driving conditions such as whether the travel route R from the “previous position” to the “next position” is a straight line, curved, or refracted, the “current position” to the “next position” The traveling state of the automatic guided vehicle 1 can be appropriately set.

即ち、「前回位置」から「次回位置」までの走行経路Rが直線の場合、無人搬送車両1は走行速度を落とさずに「前回位置」から「次回位置」まで走行できる。このような場合、本実施形態では、「前回位置」から「現在位置」まで走行してきた無人搬送車両1の走行速度を維持して、引き続き、無人搬送車両1を「現在位置」から「次回位置」まで走行させるように動作コマンド列を設定している。これにより、「前回位置」から「次回位置」までの走行速度の変化を抑制できるので、無人搬送車両1をスムーズに走行させられる。   That is, when the travel route R from the “previous position” to the “next position” is a straight line, the automated guided vehicle 1 can travel from the “previous position” to the “next position” without reducing the travel speed. In such a case, in the present embodiment, the traveling speed of the automatic guided vehicle 1 that has traveled from the “previous position” to the “current position” is maintained, and the automatic guided vehicle 1 is subsequently moved from the “current position” to the “next position”. The operation command sequence is set so that the vehicle travels to “. As a result, the change in the traveling speed from the “previous position” to the “next position” can be suppressed, so that the automatic guided vehicle 1 can be smoothly traveled.

また、「前回位置」から「現在位置」までの走行経路Rがカーブ、又は、屈折していれば、無人搬送車両1は走行速度を落としつつ、「前回位置」から「現在位置」まで走行してくる。その後、「現在位置」から「次回位置」までの走行経路Rが直線になるのであれば、本実施形態では、無人搬送車両1の走行速度を上昇させつつ、無人搬送車両1を「現在位置」から「次回位置」まで走行させるように動作コマンド列を設定している。   If the travel route R from the “previous position” to the “current position” is curved or refracted, the automatic guided vehicle 1 travels from the “previous position” to the “current position” while reducing the travel speed. Come. Thereafter, if the travel route R from the “current position” to the “next position” is a straight line, in this embodiment, the unmanned transport vehicle 1 is moved to the “current position” while the travel speed of the unmanned transport vehicle 1 is increased. The operation command string is set so that the vehicle travels from “to next position”.

一方、「現在位置」から「次回位置」までの走行経路Rがカーブ、又は、屈折しているのであれば、そのカーブや屈折に応じて、無人搬送車両1の走行速度を維持したり、更に、走行速度を落として、無人搬送車両1を「現在位置」から「次回位置」まで走行させるように動作コマンド列を設定している。これにより、「前回位置」から「次回位置」までの走行経路Rの形状に応じて、無人搬送車両1を適切な走行速度で走行させられる。   On the other hand, if the travel route R from the “current position” to the “next position” is curved or refracted, the traveling speed of the automatic guided vehicle 1 is maintained according to the curve or refraction, The operation command sequence is set such that the traveling speed is decreased and the automatic guided vehicle 1 is traveled from the “current position” to the “next position”. As a result, the automatic guided vehicle 1 can be driven at an appropriate travel speed according to the shape of the travel route R from the “previous position” to the “next position”.

次に、図4(b)を参照して、動作コマンドテーブル72bについて説明する。動作コマンドテーブル72bは、上位プロコンから通知された行先指令に対応する動作コマンド列を制御装置70が生成する場合に、上述した動作情報リンクテーブル72aと共に制御装置70により参照されるテーブルである。   Next, the operation command table 72b will be described with reference to FIG. The operation command table 72b is a table that is referred to by the control device 70 together with the above-described operation information link table 72a when the control device 70 generates an operation command sequence corresponding to the destination command notified from the host computer.

この動作コマンドテーブル72bは、図4(b)に示すように、動作情報データ番号と、その動作情報データ番号に対応する動作コマンド列とにより構成されている。例えば、動作情報データ番号「1」には、1番目の動作コマンドとして「9101H−0000H」が対応づけられており、2番目の動作コマンドとして「0101H−1001H」が対応づけられている。尚、その他の動作情報データ番号についても同様な説明となるので、その説明は省略する。   As shown in FIG. 4B, the operation command table 72b includes an operation information data number and an operation command string corresponding to the operation information data number. For example, “9101H-0000H” is associated with the operation information data number “1” as the first operation command, and “0101H-1001H” is associated with the second operation command. Since the other operation information data numbers are also described in the same manner, the description thereof is omitted.

各動作コマンドは、2ワード(本実施形態の1ワードは2バイト)単位で構成されており、1ワード目の上位バイトには、コマンドの種別を示すコマンドコードが設定される。また、1ワード目の下位バイトと、2ワード目全体とには、コマンドのパラメータを示すデータが設定される。例えば、動作コマンド「9101H−0000H」であれば、「91H」がコマンドコードとなり、「01H−0000H」がパラメータを示すデータとなる。   Each operation command is configured in units of 2 words (1 word in this embodiment is 2 bytes), and a command code indicating a command type is set in the upper byte of the first word. Data indicating command parameters is set in the lower byte of the first word and the entire second word. For example, if the operation command is “9101H-0000H”, “91H” is a command code, and “01H-0000H” is data indicating a parameter.

次に、図4(c)を参照して、動作コマンドの種別の一例について説明する。図4(c)に示すように、本実施形態では、無人搬送車両1の制御内容に応じて、動作コマンドが個別に設けられており、各動作コマンドごとに、コマンドコードが個別に設定されている。   Next, an example of the type of operation command will be described with reference to FIG. As shown in FIG.4 (c), in this embodiment, according to the control content of the automatic guided vehicle 1, the operation command is provided separately, and a command code is individually set for each operation command. Yes.

例えば、進行方向設定を実行する動作コマンドには、コマンドコードとして「01H」が設定されており、走行速度設定を実行する動作コマンドには、コマンドコードとして「12H」が設定されている。尚、その他の動作コマンドについても同様な説明となるので、その説明は省略する。   For example, “01H” is set as the command code for the operation command for executing the traveling direction setting, and “12H” is set as the command code for the operation command for executing the traveling speed setting. The other operation commands are also described in the same manner, and the description thereof is omitted.

ここで、図3の説明に戻る。操舵角設定テーブル72cは、12個の各走行装置5a〜5lに対して設定すべき操舵角を決定するためのテーブルであり、無人搬送車両1の自動運転中に、定期的(例えば、5ms毎)に制御装置70により参照される。尚、この操舵角設定テーブル72cは、無人搬送車両1の開発元(提供元)などより事前に作成されるものである。   Returning to the description of FIG. The steering angle setting table 72c is a table for determining the steering angle to be set for each of the twelve travel devices 5a to 5l. During the automatic operation of the automatic guided vehicle 1, the steering angle setting table 72c is periodically (for example, every 5 ms). ) Is referred to by the control device 70. The steering angle setting table 72c is created in advance by a developer (provider) of the automatic guided vehicle 1 or the like.

ここで、図5を参照して、操舵角設定テーブル72cについて説明する。図5(a)は、操舵角設定テーブル72cの内容の一例を示す模式図であり、図5(b)は、操舵角設定テーブル72cの各マス目ごとに設定される複数の定数の一例を示す模式図である。   Here, the steering angle setting table 72c will be described with reference to FIG. FIG. 5A is a schematic diagram showing an example of the contents of the steering angle setting table 72c, and FIG. 5B is an example of a plurality of constants set for each square of the steering angle setting table 72c. It is a schematic diagram shown.

図5(a)に示すように、操舵角設定テーブル72cは、前側操舵角θfおよび後側操舵角θbの組み合わせと、その組み合わせに基づいて予め算出された複数の定数とにより構成されている。   As shown in FIG. 5A, the steering angle setting table 72c includes a combination of the front steering angle θf and the rear steering angle θb, and a plurality of constants calculated in advance based on the combination.

前側操舵角θfおよび後側操舵角θbは、制御装置70において用いられる基準値(基準操舵角)であり、検出結果を取得した磁気ガイド検出センサ79a〜79dの検出部の中央に磁気ガイドGが収まるように、各走行装置5a〜5lにおける各車軸6aの操舵角を制御するために、制御装置70が用いる値である。   The front steering angle θf and the rear steering angle θb are reference values (reference steering angles) used in the control device 70, and the magnetic guide G is located at the center of the detection units of the magnetic guide detection sensors 79a to 79d that have acquired the detection results. This value is used by the control device 70 to control the steering angle of each axle 6a in each of the traveling devices 5a to 5l so as to be within the range.

上述したように、制御装置70では、運転モードとして右倣いモードが設定されている場合、各磁気ガイド検出センサ79b,79dから出力されている検出結果が取得される。すると、制御装置70では、磁気ガイド検出センサ79bの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させる場合の走行装置5bの操舵角が、前側操舵角θfとして算出される。また、磁気ガイド検出センサ79dの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させる場合の走行装置5lの操舵角が、後側操舵角θbとして算出される。   As described above, in the control device 70, when the right scanning mode is set as the operation mode, the detection results output from the magnetic guide detection sensors 79b and 79d are acquired. Then, in the control device 70, the steering angle of the traveling device 5b when the automatic guided vehicle 1 is traveling is calculated as the front steering angle θf so that the magnetic guide G fits in the center of the detection unit of the magnetic guide detection sensor 79b. The In addition, the steering angle of the traveling device 5l when the automatic guided vehicle 1 is traveling is calculated as the rear steering angle θb so that the magnetic guide G fits in the center of the detection unit of the magnetic guide detection sensor 79d.

尚、ここで算出される前側操舵角θfおよび後側操舵角θbは、あくまでも、制御装置70が操舵角設定テーブル72cを参照するための基準操舵角なので、走行装置5bおよび走行装置5lに対して設定される操舵角と一致するとは限らない。   It should be noted that the front steering angle θf and the rear steering angle θb calculated here are reference steering angles for the control device 70 to refer to the steering angle setting table 72c, so that the traveling device 5b and the traveling device 5l are referred to. It does not always coincide with the set steering angle.

一方、制御装置70では、運転モードとして左倣いモードが設定されている場合、各磁気ガイド検出センサ79a,79cから出力されている検出結果が取得される。すると、制御装置70では、磁気ガイド検出センサ79aの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させる場合の走行装置5aの操舵角が、前側操舵角θfとして算出される。また、磁気ガイド検出センサ79cの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させる場合の走行装置5kの操舵角が、後側操舵角θbとして算出される。   On the other hand, in the control device 70, when the left scanning mode is set as the operation mode, the detection results output from the magnetic guide detection sensors 79a and 79c are acquired. Then, in the control device 70, the steering angle of the traveling device 5a when the automatic guided vehicle 1 is traveling is calculated as the front steering angle θf so that the magnetic guide G is accommodated in the center of the detection unit of the magnetic guide detection sensor 79a. The In addition, the steering angle of the traveling device 5k when the automatic guided vehicle 1 is traveling is calculated as the rear steering angle θb so that the magnetic guide G fits in the center of the detection unit of the magnetic guide detection sensor 79c.

尚、ここで算出される前側操舵角θfおよび後側操舵角θbについても、走行装置5aおよび走行装置5kに対して設定される操舵角と一致するとは限らない。また、前側操舵角θfおよび後側操舵角θbの算出方法は、磁気ガイド検出センサ79a〜79d毎に変わるものではなく、共通であり、前側操舵角θfおよび後側操舵角θbの値は、単に、検出結果に応じて決まる。   In addition, the front side steering angle θf and the rear side steering angle θb calculated here do not always coincide with the steering angles set for the traveling device 5a and the traveling device 5k. The calculation method of the front steering angle θf and the rear steering angle θb does not change for each of the magnetic guide detection sensors 79a to 79d, but is common, and the values of the front steering angle θf and the rear steering angle θb are simply It depends on the detection result.

操舵角設定テーブル72cは、前側操舵角θfの範囲を0〜89度とし、後側操舵角θbの範囲を−89〜89度とし、更に、前側操舵角θfおよび後側操舵角θbを1度単位で漏れなく組み合わせたものである。尚、図5(a)に示すテーブル72cでは、各マス目に対応する複数の定数について、その記載を省略している。   The steering angle setting table 72c sets the range of the front steering angle θf to 0 to 89 degrees, the range of the rear steering angle θb to −89 to 89 degrees, and further sets the front steering angle θf and the rear steering angle θb to 1 degree. The unit is combined without omission. In the table 72c shown in FIG. 5A, the description of a plurality of constants corresponding to each square is omitted.

上述したように、車軸6aの操舵角は、プラスの角度だけではなく、マイナスの角度も有るため、前側操舵角θfの範囲も、後側操舵角θbと同様に、0度を中心として、プラスおよびマイナスの範囲(−89度〜89度の範囲)に角度を設定しておく必要がある。しかしながら、本実施形態では、前側操舵角θfの範囲を0度〜89度としている。これは、操舵角設定テーブル72cの大きさを小さくするためであり、その詳細については後述する。   As described above, since the steering angle of the axle 6a has not only a positive angle but also a negative angle, the range of the front steering angle θf is also positive around 0 degrees, like the rear steering angle θb. In addition, it is necessary to set the angle in a negative range (a range of −89 degrees to 89 degrees). However, in the present embodiment, the range of the front steering angle θf is 0 to 89 degrees. This is to reduce the size of the steering angle setting table 72c, and details thereof will be described later.

操舵角設定テーブル72cを構成する一のマス目(即ち、前側操舵角θfおよび後側操舵角θbの一の組み合わせ)に対応する複数の定数は、図5(b)に示すように、12個の走行装置5a〜5lに対して設定すべき操舵角θ1〜θ12と、12個の走行装置5a〜5lに対して設定すべき各走行速度V1〜V12を算出するための走行速度比率Va1〜Va12とにより構成されている。   As shown in FIG. 5B, there are twelve constants corresponding to one square constituting the steering angle setting table 72c (that is, one combination of the front steering angle θf and the rear steering angle θb). Traveling speed ratios Va1 to Va12 for calculating the steering angles θ1 to θ12 to be set for the traveling apparatuses 5a to 5l and the traveling speeds V1 to V12 to be set for the 12 traveling apparatuses 5a to 5l. It is comprised by.

ここで、操舵角θ1は、無人搬送車両1の左側最前列の走行装置5aに設けられている車軸6aの操舵角を示し、操舵角θ2は、無人搬送車両1の右側最前列の走行装置5bに設けられている車軸6aの操舵角を示す。以下同様に、操舵角θ3〜θ12のそれぞれは、走行装置5c〜5lに設けられている各車軸6aの操舵角をそれぞれ示す。   Here, the steering angle θ1 indicates the steering angle of the axle 6a provided in the left frontmost traveling device 5a of the automatic guided vehicle 1, and the steering angle θ2 is the right frontmost traveling device 5b of the automatic guided vehicle 1. The steering angle of the axle 6a provided in is shown. Hereinafter, similarly, each of the steering angles θ3 to θ12 indicates the steering angle of each axle 6a provided in the traveling devices 5c to 5l.

また、走行速度比率Va1は、無人搬送車両1の左側最前列の走行装置5aに設けられている車軸6aの走行速度V1を算出するための走行速度比率を示し、走行速度比率Va2は、無人搬送車両1の右側最前列の走行装置5bに設けられている車輪6bの走行速度V2を算出するための走行速度比率を示している。   The traveling speed ratio Va1 indicates a traveling speed ratio for calculating the traveling speed V1 of the axle 6a provided in the traveling device 5a in the left frontmost row of the unmanned transport vehicle 1, and the traveling speed ratio Va2 is the unmanned transport. The traveling speed ratio for calculating the traveling speed V2 of the wheel 6b provided in the traveling device 5b in the right frontmost row of the vehicle 1 is shown.

以下同様に、走行速度比率Va3〜Va12のそれぞれは、走行装置5c〜5lの各車輪6bの走行速度V3〜V12を算出するための走行速度比率をそれぞれ示す。尚、これらの走行速度比率Va1〜Va12は、無人搬送車両1が目標とすべき走行速度である基準走行速度Vを基準(即ち、「1」)とした場合の比率である。   Similarly, each of the traveling speed ratios Va3 to Va12 indicates a traveling speed ratio for calculating the traveling speeds V3 to V12 of the wheels 6b of the traveling devices 5c to 5l. These travel speed ratios Va1 to Va12 are ratios when the reference travel speed V, which is the travel speed that the automatic guided vehicle 1 should target, is used as a reference (ie, “1”).

この基準走行速度Vは、走行経路R上の隣接する2つのステーションC単位で予め定められている。言い換えれば、走行経路Rを各ステーションC毎に区切った場合の各区間毎に予め定められている。   The reference travel speed V is determined in advance for each two adjacent stations C on the travel route R. In other words, it is predetermined for each section when the travel route R is divided for each station C.

上述したように、本実施形態では、隣接する2つのステーションCの組み合わせ、および、隣設する3つのステーションCの組み合わせに応じて、動作情報データ番号列が設定されており、基準走行速度Vは、この動作情報データ番号列を構成する一部の番号により指定される。基準走行速度Vを指定するための動作コマンドが制御装置70により実行されると、指定された基準走行速度Vで無人搬送車両1が走行するように、走行装置5a〜5lに設けられている各車輪6bの走行速度が制御される。   As described above, in the present embodiment, the operation information data number sequence is set according to the combination of two adjacent stations C and the combination of three adjacent stations C, and the reference traveling speed V is The operation information data number string is designated by a part of the numbers. When an operation command for designating the reference travel speed V is executed by the control device 70, each of the travel devices 5a to 5l is provided so that the automatic guided vehicle 1 travels at the designated reference travel speed V. The traveling speed of the wheel 6b is controlled.

尚、走行装置5a〜5lに対して設定すべき各車輪6bの走行速度V1〜V12は、基準走行速度Vに対して、走行速度比率Va1〜Va12を乗算することで算出できる。例えば、走行装置5aに対して設定すべき、走行装置5aの車輪6bの走行速度V1は、基準走行速度Vに、走行速度比率Va1を乗算して算出する。   The traveling speeds V1 to V12 of the wheels 6b to be set for the traveling devices 5a to 5l can be calculated by multiplying the reference traveling speed V by the traveling speed ratios Va1 to Va12. For example, the traveling speed V1 of the wheel 6b of the traveling apparatus 5a to be set for the traveling apparatus 5a is calculated by multiplying the reference traveling speed V by the traveling speed ratio Va1.

ここで、図6および図7を参照して、各操舵角θ1〜θ12、および、各走行速度比率Va1〜Va12の算出方法について説明する。図6および図7は、操舵角設定テーブルの各マス目ごとに設定される各定数の算出方法の一例を説明するための説明図である。   Here, with reference to FIG. 6 and FIG. 7, a calculation method of each steering angle θ1 to θ12 and each traveling speed ratio Va1 to Va12 will be described. 6 and 7 are explanatory diagrams for explaining an example of a method for calculating each constant set for each square of the steering angle setting table.

図6では、無人搬送車両1の前後方向を矢印Yにより図示し、左右方向を矢印Xで図示し、無人搬送車両1の旋回中心を点Oとして図示している。また、図7では、図6における各走行装置5a〜5lをそれぞれ個別に図示している。また、図6に示すように、無人搬送車両1の最前列に設けられている走行装置5a,5bの車軸6aと、無人搬送車両1の最終列に設けられている走行装置5k,5lの車軸6aとの距離を第1ホイールベースB1とする。   In FIG. 6, the front-rear direction of the automatic guided vehicle 1 is indicated by an arrow Y, the horizontal direction is indicated by an arrow X, and the turning center of the automatic guided vehicle 1 is indicated by a point O. Moreover, in FIG. 7, each traveling apparatus 5a-5l in FIG. 6 is each illustrated individually. Further, as shown in FIG. 6, the axles 6 a of the traveling devices 5 a and 5 b provided in the front row of the automatic guided vehicle 1 and the axles of the traveling devices 5 k and 5 l provided in the final row of the automatic guided vehicle 1. The distance from 6a is defined as a first wheel base B1.

また、無人搬送車両1の2列目に設けられている走行装置5c,5dの車軸6aと、無人搬送車両1の5列目に設けられている走行装置5i,5jの車軸6aとの距離を第2ホイールベースB2とし、無人搬送車両1の3列目に設けられている走行装置5e,5fの車軸6aと、無人搬送車両1の4列目に設けられている走行装置5g,5hの車軸6aとの距離を第3ホイールベースB3とする。   Further, the distance between the axle 6a of the traveling devices 5c and 5d provided in the second row of the automated guided vehicle 1 and the axle 6a of the traveling devices 5i and 5j provided in the fifth row of the automated guided vehicle 1 is determined. The axle 6a of the traveling devices 5e and 5f provided in the third row of the automatic guided vehicle 1 as the second wheel base B2, and the axles of the traveling devices 5g and 5h provided in the fourth row of the automatic guided vehicle 1 The distance from 6a is defined as a third wheel base B3.

また、無人搬送車両1の右側に設けられている走行装置5b,5d,5f,5h,5j,5lの車軸6aと、無人搬送車両1の左側に設けられている走行装置5a,5c,5e,5g,5i,5kの車軸6aとの距離を、トレッドTとする。尚、ホイールベースB1〜B3、及び、トレッドTは、無人搬送車両1の設計時に定められる固有値である。   Further, the axles 6a of the traveling devices 5b, 5d, 5f, 5h, 5j, 5l provided on the right side of the automatic guided vehicle 1 and the traveling devices 5a, 5c, 5e provided on the left side of the automatic guided vehicle 1 are provided. The distance from the axle 6a of 5g, 5i, and 5k is defined as a tread T. The wheel bases B <b> 1 to B <b> 3 and the tread T are eigenvalues that are determined when the automatic guided vehicle 1 is designed.

ここで、無人搬送車両1の左右方向(図中の矢印X方向)の距離であって、無人搬送車両1の右側に設けられている走行装置5b,5d,5f,5h,5j,5lの車軸6aと、旋回中心Oとの距離を距離Aとした場合に、前側操舵角θfおよび後側操舵角θbが一意に決まれば、その距離Aは、
A=B1÷(Tan(θf)+Tan(θb))
により算出できる。
Here, it is the distance of the automated guided vehicle 1 in the left-right direction (the direction of the arrow X in the figure), and the axles of the traveling devices 5b, 5d, 5f, 5h, 5j, 5l provided on the right side of the automated guided vehicle 1 When the distance between 6a and the turning center O is a distance A, if the front steering angle θf and the rear steering angle θb are uniquely determined, the distance A is
A = B1 ÷ (Tan (θf) + Tan (θb))
Can be calculated.

そして、この距離Aが決まれば、以下の計算式により各操舵角θ1〜θ12を算出できる。   When the distance A is determined, the steering angles θ1 to θ12 can be calculated by the following calculation formula.

θ1=Tan−1((Tan(θf)×A)÷(A+T))
θ2=θf
θ3=Tan−1(((Tan(θf)×A)−((B1−B2)÷2))÷(A+T))
θ4=Tan−1(((Tan(θf)×A)−((B1−B2)÷2))÷A)
θ5=Tan−1(((Tan(θf)×A)−((B1−B3)÷2))÷(A+T))
θ6=Tan−1(((Tan(θf)×A)−((B1−B3)÷2))÷A)
θ7=Tan−1(((Tan(θb)×A)−((B1−B3)÷2))÷(A+T))
θ8=Tan−1(((Tan(θb)×A)−((B1−B3)÷2))÷A)
θ9=Tan−1(((Tan(θb)×A)−((B1−B2)÷2))÷(A+T))
θ10=Tan−1(((Tan(θb)×A)−((B1−B2)÷2))÷A)
θ11=Tan−1((Tan(θb)×A)÷(A+T))
θ12=θb
また、図6に示すように、旋回中心Oから、無人搬送車両1の左側最前列に設けられている走行装置5aの車軸6aまでの直線距離を旋回半径R1とし、旋回中心Oから、無人搬送車両1の右側最前列に設けられている走行装置5bの車軸6aまでの直線距離をR2とする。以下同様に、旋回中心Oから、各走行装置5c〜5lの車軸6aまでの直線距離を、それぞれ旋回半径R3〜R12とする。
θ1 = Tan−1 ((Tan (θf) × A) ÷ (A + T))
θ2 = θf
θ3 = Tan−1 (((Tan (θf) × A) − ((B1−B2) ÷ 2)) ÷ (A + T))
θ4 = Tan−1 (((Tan (θf) × A) − ((B1−B2) ÷ 2)) ÷ A)
θ5 = Tan−1 (((Tan (θf) × A) − ((B1−B3) ÷ 2)) ÷ (A + T))
θ6 = Tan−1 (((Tan (θf) × A) − ((B1−B3) ÷ 2)) ÷ A)
θ7 = Tan−1 (((Tan (θb) × A) − ((B1−B3) ÷ 2)) ÷ (A + T))
θ8 = Tan−1 (((Tan (θb) × A) − ((B1−B3) ÷ 2)) ÷ A)
θ9 = Tan−1 (((Tan (θb) × A) − ((B1−B2) ÷ 2)) ÷ (A + T))
θ10 = Tan−1 (((Tan (θb) × A) − ((B1−B2) ÷ 2)) ÷ A)
θ11 = Tan−1 ((Tan (θb) × A) ÷ (A + T))
θ12 = θb
Further, as shown in FIG. 6, the straight line distance from the turning center O to the axle 6a of the traveling device 5a provided in the left frontmost row of the unmanned conveyance vehicle 1 is defined as a turning radius R1, and the unmanned conveyance from the turning center O is performed. Let R2 be the linear distance to the axle 6a of the traveling device 5b provided in the right frontmost row of the vehicle 1. Similarly, the linear distances from the turning center O to the axles 6a of the traveling devices 5c to 5l are assumed to be turning radii R3 to R12, respectively.

これらの各旋回半径R1〜R12は、各操舵角θ1〜θ12が決まれば、以下の計算式により算出できる。   These turning radii R1 to R12 can be calculated by the following calculation formulas if the respective steering angles θ1 to θ12 are determined.

R1=(A+T)÷Cos(θ1)
R2=A÷Cos(θ2)
R3=(A+T)÷Cos(θ3)
R4=A÷Cos(θ4)
R5=(A+T)÷Cos(θ5)
R6=A÷Cos(θ6)
R7=(A+T)÷Cos(θ7)
R8=A÷Cos(θ8)
R9=(A+T)÷Cos(θ9)
R10=A÷Cos(θ10)
R11=(A+T)÷Cos(θ11)
R12=A÷Cos(θ12)
そして、各旋回半径R1〜R12が決まれば、その各旋回半径R1〜R12の中から、最も値の大きい最大旋回半径Rmaxを求めることができ、その結果、以下の計算式により各走行速度比率Va1〜Va12を算出できる。
R1 = (A + T) ÷ Cos (θ1)
R2 = A ÷ Cos (θ2)
R3 = (A + T) ÷ Cos (θ3)
R4 = A ÷ Cos (θ4)
R5 = (A + T) ÷ Cos (θ5)
R6 = A ÷ Cos (θ6)
R7 = (A + T) ÷ Cos (θ7)
R8 = A ÷ Cos (θ8)
R9 = (A + T) ÷ Cos (θ9)
R10 = A ÷ Cos (θ10)
R11 = (A + T) ÷ Cos (θ11)
R12 = A ÷ Cos (θ12)
And if each turning radius R1-R12 is decided, the largest turning radius Rmax with the largest value can be calculated | required from each turning radius R1-R12, As a result, each traveling speed ratio Va1 by the following formulas. ~ Va12 can be calculated.

Va1=R1÷Rmax
Va2=R2÷Rmax
Va3=R3÷Rmax
Va4=R4÷Rmax
Va5=R5÷Rmax
Va6=R6÷Rmax
Va7=R7÷Rmax
Va8=R8÷Rmax
Va9=R9÷Rmax
Va10=R10÷Rmax
Va11=R11÷Rmax
Va12=R12÷Rmax
上述したように、本実施形態では、前側操舵角θfの範囲を0〜89度とし、後側操舵角θbの範囲を−89〜89度とし、更に、前側操舵角θfおよび後側操舵角θbを1度単位で漏れなく組み合わせたテーブル72cを、事前に作成している。このテーブル72cを作成する場合には、上述した計算式を用いることで、テーブル72cの各マス目ごとに、各操舵角θ1〜θ12、及び、各走行速度比率Va1〜Va12を予め算出できる。
Va1 = R1 ÷ Rmax
Va2 = R2 ÷ Rmax
Va3 = R3 ÷ Rmax
Va4 = R4 ÷ Rmax
Va5 = R5 ÷ Rmax
Va6 = R6 ÷ Rmax
Va7 = R7 ÷ Rmax
Va8 = R8 ÷ Rmax
Va9 = R9 ÷ Rmax
Va10 = R10 ÷ Rmax
Va11 = R11 ÷ Rmax
Va12 = R12 ÷ Rmax
As described above, in the present embodiment, the range of the front steering angle θf is 0 to 89 degrees, the range of the rear steering angle θb is −89 to 89 degrees, and further, the front steering angle θf and the rear steering angle θb are set. A table 72c is created in advance in which the above are combined without omission in units of 1 degree. When creating the table 72c, the steering angles θ1 to θ12 and the traveling speed ratios Va1 to Va12 can be calculated in advance for each square of the table 72c by using the above-described calculation formula.

制御装置70は、磁気ガイド検出センサ79a〜79dの検出結果に基づいて、前側操舵角θfおよび後側操舵角θbを算出した場合に、前側操舵角θfがプラスの角度であれば、そのまま、その算出した前側操舵角θfおよび後側操舵角θbに対応する各操舵角θ1〜θ12、及び、各走行速度比率Va1〜Va12を、操舵角設定テーブル72cの中から取得する。   When the front steering angle θf and the rear steering angle θb are calculated on the basis of the detection results of the magnetic guide detection sensors 79a to 79d, the control device 70, if the front steering angle θf is a positive angle, The steering angles θ1 to θ12 and the traveling speed ratios Va1 to Va12 corresponding to the calculated front steering angle θf and rear steering angle θb and the travel speed ratios Va1 to Va12 are acquired from the steering angle setting table 72c.

一方、前側操舵角θfがマイナスの角度であれば、一旦、前側操舵角θfおよび後側操舵角θbにそれぞれ−1を乗じて、前側操舵角θfの符号をプラスにする。そして、−1乗じた前側操舵角θfおよび後側操舵角θbに対応する各操舵角θ1〜θ12、及び、各走行速度比率Va1〜Va12を、操舵角設定テーブル72cの中から取得する。そして、その取得した各操舵角θ1〜θ12については、それぞれ−1を乗じ、その結果得られた各操舵角θ1〜θ12を、無人搬送車両1における走行装置5a〜5lの各列単位で、左右入れ替える。   On the other hand, if the front steering angle θf is a negative angle, the front steering angle θf and the rear steering angle θb are each multiplied by −1 to make the sign of the front steering angle θf positive. Then, the steering angles θ1 to θ12 and the traveling speed ratios Va1 to Va12 corresponding to the front steering angle θf and the rear steering angle θb multiplied by −1 are acquired from the steering angle setting table 72c. The obtained steering angles θ1 to θ12 are respectively multiplied by −1, and the obtained steering angles θ1 to θ12 are converted to left and right in units of each row of the traveling devices 5a to 5l in the automatic guided vehicle 1. Replace.

即ち、−1を乗じて得られた操舵角θ2(操舵角の入れ替え前のθ2)は、各列における操舵角の入れ替えによって、走行装置5aの操舵角θ1となる。同様に、左右入れ替え前の操舵角θ1は、各列における操舵角の入れ替えによって、走行装置5bの操舵角θ2となる。その他の操舵角θ3〜θ12についても同様に、走行装置5c〜5lの各列単位で、左右入れ替える。   That is, the steering angle θ2 (θ2 before changing the steering angle) obtained by multiplying by −1 becomes the steering angle θ1 of the traveling device 5a by changing the steering angle in each row. Similarly, the steering angle θ1 before the left-right change becomes the steering angle θ2 of the traveling device 5b by changing the steering angle in each row. Similarly, the other steering angles θ3 to θ12 are interchanged left and right for each row of the traveling devices 5c to 5l.

また、各走行速度比率Va1〜Va12については、単に、走行装置5a〜5lの各列単位で、左右入れ替える。即ち、左右入れ替え前の走行速度比率Va2は、各列における走行速度比率の入れ替えによって、走行装置5aの走行速度比率Va1となる。同様に、左右入れ替え前の走行速度比率Va1は、走行速度比率の入れ替えによって、走行装置5bの走行速度比率Va2となる。その他の走行速度比率Va3〜Va12についても同様に、走行装置5c〜5lの各列単位で、左右入れ替える。   In addition, the travel speed ratios Va1 to Va12 are simply switched left and right in units of each row of the travel devices 5a to 5l. That is, the traveling speed ratio Va2 before the left-right replacement becomes the traveling speed ratio Va1 of the traveling device 5a by the replacement of the traveling speed ratio in each row. Similarly, the traveling speed ratio Va1 before the left / right replacement becomes the traveling speed ratio Va2 of the traveling device 5b by the replacement of the traveling speed ratio. Similarly, the other travel speed ratios Va3 to Va12 are interchanged left and right for each row of the travel devices 5c to 5l.

本実施形態では、無人搬送車両1の前後方向(矢印Y方向)に対し、車軸6aが垂直な状態を0度としているので、絶対値が同一で、符号だけ異なる操舵角については、無人搬送車両1の前後方向(矢印Y方向)を基準として、車軸6aが左右対称に回転しているだけである。即ち、単に、符号が反転しているだけの違いしかない。   In the present embodiment, the state in which the axle 6a is perpendicular to the front-rear direction (arrow Y direction) of the automatic guided vehicle 1 is set to 0 degree. The axle 6a merely rotates symmetrically with respect to the front-rear direction (arrow Y direction) of 1. That is, the only difference is that the sign is inverted.

よって、仮に、前側操舵角θfの範囲を−89〜0度とし、後側操舵角θbの範囲を−89〜89度とする操舵角設定テーブルを設けたとしても、そのテーブルは、単に、前側操舵角θfの範囲を0〜89度とし、後側操舵角θbの範囲を−89〜89度としている操舵角設定テーブル72cにおいて、前側操舵角θfおよび各操舵角θ1〜θ12の符号を反転させただけのものとなる。従って、冗長なテーブルを設けることになってしまう。   Therefore, even if a steering angle setting table is provided in which the range of the front steering angle θf is −89 to 0 degrees and the range of the rear steering angle θb is −89 to 89 degrees, the table is simply the front side. In the steering angle setting table 72c in which the range of the steering angle θf is 0 to 89 degrees and the range of the rear steering angle θb is −89 to 89 degrees, the signs of the front steering angle θf and the steering angles θ1 to θ12 are reversed. It will be just a thing. Therefore, a redundant table is provided.

そこで、本実施形態では、前側操舵角θfの範囲を0〜89度とし、後側操舵角θbの範囲を−89〜89度とした操舵角設定テーブル72cだけを設けておき、磁気ガイド検出センサ79a〜79dの検出結果に基づいて算出された前側操舵角θfがマイナスの角度の場合は、一旦、前側操舵角θfおよび後側操舵角θbにそれぞれ−1を乗じて、前側操舵角θfの符号をプラスにして操舵角設定テーブル72cを用い、最後に、取得した操舵角θ1〜θ12に対してそれぞれ−1を乗じている。このように、本実施形態では、操舵角設定テーブル72cの大きさを小さくしているので、記憶領域の消費を抑制できる。   Therefore, in the present embodiment, only the steering angle setting table 72c in which the range of the front steering angle θf is 0 to 89 degrees and the range of the rear steering angle θb is −89 to 89 degrees is provided, and the magnetic guide detection sensor is provided. When the front side steering angle θf calculated based on the detection results of 79a to 79d is a negative angle, the front side steering angle θf and the rear side steering angle θb are each multiplied by −1 to sign the front side steering angle θf. Is used, and the steering angle setting table 72c is used. Finally, the obtained steering angles θ1 to θ12 are respectively multiplied by −1. Thus, in this embodiment, since the size of the steering angle setting table 72c is reduced, consumption of the storage area can be suppressed.

ここで、図3の説明に戻る。RAM73は、CPU71が制御プログラムの実行時に各種のワークデータやフラグ等を書き換え可能に記憶するためのメモリである。RAM73には、動作コマンドバッファメモリ73aと、コマンド実行ポインタ73bと、指令バッファメモリ73cと、新規コマンドポインタ73dと、上書開始ポインタ73eと、基準操舵角メモリ73fと、基準走行速度メモリ73gとが設けられている。   Returning to the description of FIG. The RAM 73 is a memory for the CPU 71 to store various work data, flags, and the like in a rewritable manner when executing the control program. The RAM 73 includes an operation command buffer memory 73a, a command execution pointer 73b, a command buffer memory 73c, a new command pointer 73d, an overwrite start pointer 73e, a reference steering angle memory 73f, and a reference travel speed memory 73g. Is provided.

動作コマンドバッファメモリ73aは、上位プロコンから通知された行先指令に対応する動作コマンド列を記憶するためのメモリである。無人搬送車両1の待機中に上位プロコンから行先指令が通知され、その行先指令が制御装置70により受信された場合、動作コマンドバッファメモリ73aはクリアされる。その後、制御装置70では、受信した行先指令に基づいて、出発地点となるステーションCから到着地点となるステーションCまでの走行経路R上を無人搬送車両1に走行させるための動作コマンド列が生成されて、それらが動作コマンドバッファメモリ73aの先頭から実行順に記憶される。   The operation command buffer memory 73a is a memory for storing an operation command sequence corresponding to the destination command notified from the host computer. When the destination command is notified from the host computer while the automatic guided vehicle 1 is on standby, and the destination command is received by the control device 70, the operation command buffer memory 73a is cleared. Thereafter, the control device 70 generates an operation command sequence for causing the automatic guided vehicle 1 to travel on the travel route R from the station C as the departure point to the station C as the arrival point based on the received destination command. These are stored in order of execution from the top of the operation command buffer memory 73a.

本実施形態では、無人搬送車両1が既に自動運転中であっても、その無人搬送車両1に対して上位プロコンから、再度、行先指令が通知される場合がある。例えば、出発地点となるステーションCから、目的地点となるステーションCまで無人搬送車両1を走行させたいが、その走行経路R上に別の無人搬送車両1が存在していて通行できない場合である。   In this embodiment, even if the automatic guided vehicle 1 is already in automatic operation, the destination command may be notified to the automatic guided vehicle 1 again from the host computer. For example, there is a case where it is desired that the automatic guided vehicle 1 travels from the station C serving as the departure point to the station C serving as the destination point, but another automatic guided vehicle 1 exists on the travel route R and cannot pass through.

ここで、その一例を具体的に説明する。例えば、ステーション「C201」(図2(a)参照)で待機している無人搬送車両1を、ステーション「C203」まで走行させる予定であるが、ステーション「C203」には、現在、別の無人搬送車両1が存在しているとする。この場合、上位プロコンは、1回目の行先指令として、ステーション「C201」からステーション「C202」まで無人搬送車両1を走行させるための行先指令を、待機中の無人搬送車両1に対して通知する。   Here, an example thereof will be specifically described. For example, the automatic guided vehicle 1 waiting at the station “C201” (see FIG. 2A) is scheduled to travel to the station “C203”. It is assumed that the vehicle 1 exists. In this case, the host computer notifies the waiting unmanned transport vehicle 1 of a destination command for causing the unmanned transport vehicle 1 to travel from the station “C201” to the station “C202” as the first destination command.

そして、ステーション「C203」に存在していた別の無人搬送車両1が移動し、ステーション「C203」へ進入可能になったら、上位プロコンは、2回目の行先指令として、ステーション「C202」からステーション「C203」まで無人搬送車両1を走行させるための行先指令を、無人搬送車両1に対して通知する。このように、上位プロコンは、目的地点となるステーションCまで無人搬送車両1を走行させたいが、その走行経路R上に別の無人搬送車両1が存在しており、途中で無人搬送車両1を進行させることができなくなる場合、進行可能なステーションCまで無人搬送車両1を走行させるための行先指令を、無人搬送車両1に対して通知する。そして、先に進行できるようになる度に、進行可能になったステーションCまで無人搬送車両1を走行させるための行先指令を、無人搬送車両1に対して通知する。   Then, when another automatic guided vehicle 1 that has existed in the station “C203” moves and can enter the station “C203”, the host computer controls the station “C202” to the station “C203” as a second destination command. A destination command for causing the automatic guided vehicle 1 to travel to “C203” is notified to the automatic guided vehicle 1. As described above, the host computer wants to drive the automatic guided vehicle 1 to the destination station C, but another automatic guided vehicle 1 exists on the travel route R, and the automatic guided vehicle 1 is moved along the way. When it becomes impossible to advance, the destination instruction | command for making the automatic guided vehicle 1 drive | work to the station C which can advance is notified with respect to the automatic guided vehicle 1. FIG. And every time it can advance, the destination instruction | command for making the automatic guided vehicle 1 drive | work to the station C which became possible to advance is notified with respect to the automatic guided vehicle 1. FIG.

また、本実施形態では、到着地点となるステーションCが途中で変更される場合にも、上位プロコンから、再度、行先指令が通知される。例えば、待機中の無人搬送車両1に対して、上位プロコンから1回目の行先指令が通知され、その行先指令に従って無人搬送車両1が走行開始した後に、到着地点となるステーションCが上位プロコンにおいて変更されたとする。このような場合、上位プロコンは、その変更された到着地点となるステーションCまで無人搬送車両1を走行させるための行先指令を、無人搬送車両1に対して通知する。   Further, in the present embodiment, even when the station C as the arrival point is changed on the way, the destination command is notified again from the host computer. For example, the first destination command is notified from the host computer to the waiting unmanned transport vehicle 1, and after the unmanned transport vehicle 1 starts traveling in accordance with the destination command, the station C serving as the arrival point is changed in the host computer. Suppose that In such a case, the host computer notifies the automatic guided vehicle 1 of a destination command for causing the automatic guided vehicle 1 to travel to the station C that is the changed arrival point.

尚、本実施形態では、上位プロコンから無人搬送車両1に対して行先指令が通知される度に、出発地点となるステーションCから到着地点となるステーションCまでの走行経路R上に並ぶステーションCが、3つ単位で通知される場合の一例を以下で説明する。即ち、出発地点となるステーションCから到着地点となるステーションCまでの走行経路R上に並ぶステーションCが、4以上であれば、上位プロコンから複数回に渡って行先指令が通知される場合の一例を以下で説明する。   In this embodiment, every time a destination command is notified from the host computer to the automatic guided vehicle 1, the station C arranged on the travel route R from the station C serving as the departure point to the station C serving as the arrival point is displayed. An example of notification in units of three will be described below. That is, an example of a case where a destination command is notified multiple times from the host computer if there are four or more stations C on the travel route R from the station C serving as the departure point to the station C serving as the arrival point. Is described below.

具体的には、まず、出発地点から到着地点までの走行経路R上に並ぶ各ステーションCのうち、出発地点から到着地点に向かって連続して並ぶ3つのステーションCが、1回目の行先指令として、上位プロコンから無人搬送車両1に対して通知される。   Specifically, first, among the stations C arranged on the travel route R from the departure point to the arrival point, three stations C successively arranged from the departure point to the arrival point are used as the first destination command. The upper-level control computer notifies the automatic guided vehicle 1.

次に、直近に通知された3つのステーションCのうち、最後のステーションCを先頭とし、そこから到着地点に向かって連続して並ぶ3つのステーションCが、次の行先指令として無人搬送車両1に通知される。尚、次の行先指令の通知タイミングは、遅くとも、直近の行先指令の示す到着地点に、無人搬送車両1が停車する前に通知される。   Next, among the three stations C notified most recently, the three stations C starting from the last station C and continuously arranged from there to the arrival point are sent to the automatic guided vehicle 1 as the next destination command. Be notified. The notification timing of the next destination command is notified at the latest before the automatic guided vehicle 1 stops at the arrival point indicated by the latest destination command.

以後同様に、到着地点のステーションCが行先指令の最後に現れるまで、行先指令が繰り返し無人搬送車両1に通知される。   Thereafter, similarly, the destination command is repeatedly notified to the automatic guided vehicle 1 until the station C at the arrival point appears at the end of the destination command.

例えば、出発地点となるステーションCが「C201」であり、到着地点となるステーションCが「C204」であって、出発地点から到着地点までの走行経路R上に4つのステーションCが並んでいる場合には、まず始めに「C201→C202→C203」という行先指令が、上位プロコンから無人搬送車両1へ通知される。次に、「C203→C204」という行先指令が、上位プロコンから無人搬送車両1へ通知される。   For example, the station C as the departure point is “C201”, the station C as the arrival point is “C204”, and four stations C are arranged on the travel route R from the departure point to the arrival point. First, a destination command “C201 → C202 → C203” is notified from the host computer to the automatic guided vehicle 1. Next, a destination command “C203 → C204” is notified to the automatic guided vehicle 1 from the host computer.

無人搬送車両1の自動運転中に上位プロコンから次の行先指令が通知され、その行先指令が制御装置70により受信された場合、制御装置70では、その次の行先指令に対応する動作コマンド列が生成されて、それらが動作コマンドバッファメモリ73aに追加される。これにより、制御装置70では、メモリ73aに既に記憶されている動作コマンド列に加えて、新たに追加された動作コマンド列も実行される。その結果、制御装置70は、次の行先指令により示される到着地点まで無人搬送車両1を走行させることができる。   When the next destination command is notified from the host computer during automatic operation of the automatic guided vehicle 1 and the destination command is received by the control device 70, the control device 70 displays an operation command sequence corresponding to the next destination command. They are generated and added to the operation command buffer memory 73a. As a result, in the control device 70, in addition to the operation command sequence already stored in the memory 73a, the newly added operation command sequence is also executed. As a result, the control device 70 can cause the automatic guided vehicle 1 to travel to the arrival point indicated by the next destination command.

つまり、無人搬送車両1が到着地点となるステーションCに到着し、停車する前であれば、到着地点を変更できるので、無人搬送車両1の走行経路Rや行先を自由に変更できる。従って、無人搬送車両1が走行する走行経路Rの混雑状況などの外的要因に合わせて、無人搬送車両1を効率よく運行させることができる。   That is, since the arrival point can be changed before the automatic guided vehicle 1 arrives at the station C as the arrival point and stops, the traveling route R and the destination of the automatic guided vehicle 1 can be freely changed. Therefore, the automatic guided vehicle 1 can be operated efficiently in accordance with external factors such as the congestion state of the travel route R on which the automatic guided vehicle 1 travels.

コマンド実行ポインタ73bは、動作コマンドバッファメモリ73aに記憶されている動作コマンド列の中で、制御装置70が次に実行すべき一の動作コマンドの記憶位置を示すものである。無人搬送車両1の待機中に、上位プロコンから通知される行先指令が制御装置70により受信された場合、コマンド実行ポインタ73bは、動作コマンドバッファメモリ73aに記憶されている先頭の動作コマンドの記憶位置を示すように初期化される(図9のS14参照)。   The command execution pointer 73b indicates a storage position of one operation command to be executed next by the control device 70 in the operation command sequence stored in the operation command buffer memory 73a. When the destination command notified from the host computer is received by the control device 70 while the automatic guided vehicle 1 is on standby, the command execution pointer 73b is stored at the storage position of the head operation command stored in the operation command buffer memory 73a. Is initialized (see S14 in FIG. 9).

制御装置70は、無人搬送車両1を走行させる場合、動作コマンドバッファメモリ73aの中から、コマンド実行ポインタ73bにより示される一の動作コマンドを取得して、その動作コマンドを実行する。そして、実行された動作コマンドが終了した場合、次に実行すべき一の動作コマンドの記憶位置がコマンド実行ポインタ73bにより示されるように、コマンド実行ポインタ73bを更新する。制御装置70は、動作コマンドバッファメモリ73aの中に実行すべき動作コマンドが他にも残っている間(即ち、動作コマンドを全て実行するまで)、コマンド実行ポインタ73bにより示される動作コマンドの取得と、コマンド実行ポインタ73bの更新とを繰り返す。   When the unmanned transport vehicle 1 travels, the control device 70 acquires one operation command indicated by the command execution pointer 73b from the operation command buffer memory 73a and executes the operation command. Then, when the executed operation command is completed, the command execution pointer 73b is updated so that the storage position of one operation command to be executed next is indicated by the command execution pointer 73b. The control device 70 obtains the operation command indicated by the command execution pointer 73b while other operation commands to be executed remain in the operation command buffer memory 73a (that is, until all operation commands are executed). The command execution pointer 73b is repeatedly updated.

指令バッファメモリ73cは、上位プロコンから通知された行先指令が記憶されるメモリである。無人搬送車両1の待機中に、上位プロコンから通知される行先指令が制御装置70により受信された場合、指令バッファメモリ73cはクリアされ、更に、その受信された行先指令が、指令バッファメモリ73cの先頭から順番に記憶される。   The command buffer memory 73c is a memory in which the destination command notified from the host computer is stored. When the destination command notified from the host computer is received by the control device 70 while the automatic guided vehicle 1 is on standby, the command buffer memory 73c is cleared, and the received destination command is stored in the command buffer memory 73c. Stored in order from the top.

例えば、無人搬送車両1の待機中に、「C201→C202→C203」という行先指令が制御装置70により受信された場合には、指令バッファメモリ73cの先頭から「C201→C202→C203」というステーションC列が順番に記憶される(図11(a)参照)。   For example, when the destination command “C201 → C202 → C203” is received by the control device 70 while the automatic guided vehicle 1 is on standby, the station C “C201 → C202 → C203” from the top of the command buffer memory 73c. The columns are stored in order (see FIG. 11 (a)).

一方、詳細については後述するが、無人搬送車両1の自動運転中に上位プロコンから次の行先指令が通知されて、その行先指令が制御装置70により受信された場合、制御装置70では、今回受信された行先指令が、指令バッファメモリ73cに追加される。   On the other hand, as will be described in detail later, when the next destination command is notified from the host computer during automatic operation of the automatic guided vehicle 1 and the destination command is received by the control device 70, the control device 70 receives the current destination command. The destination command is added to the command buffer memory 73c.

尚、この場合は、既に記憶されている行先指令の中の最後のステーションCと、今回受信した行先指令の先頭のステーションCとが同一となるため、今回受信した行先指令を、指令バッファメモリ73cに記憶されている行先指令の中の最後のステーションCの位置から順番に上書きしている(図12(a)参照)。   In this case, since the last station C in the destination command already stored is the same as the first station C of the destination command received this time, the destination command received this time is stored in the command buffer memory 73c. Are overwritten in order from the position of the last station C in the destination command stored in (see FIG. 12A).

例えば、指令バッファメモリ73cに「C201→C202→C203」という行先指令が既に記憶されており、その内容に従って無人搬送車両1が自動運転を行っている場合に、「C203→C204」という行先指令が制御装置70により受信されると、その行先指令が、指令バッファメモリ73cにおいて「C203」が記憶されている位置から上書きされる。その結果、最終的には、指令バッファメモリ73cに「C201→C202→C203→C204」というステーションC列が記憶される。   For example, when the destination command “C201 → C202 → C203” is already stored in the command buffer memory 73c, and the automatic guided vehicle 1 performs automatic driving according to the contents, the destination command “C203 → C204” When received by the control device 70, the destination command is overwritten from the position where “C203” is stored in the command buffer memory 73c. As a result, the station C column “C201 → C202 → C203 → C204” is finally stored in the command buffer memory 73c.

新規コマンドポインタ73dは、行先指令に対応する動作コマンド列が制御装置70において新たに生成された後、その新たな動作コマンド列を動作コマンドバッファメモリ73aに記憶する場合に、その記憶位置を示すものである。   The new command pointer 73d indicates a storage position when the operation command sequence corresponding to the destination command is newly generated in the control device 70 and then stored in the operation command buffer memory 73a. It is.

無人搬送車両1の待機中に、上位プロコンから通知される行先指令が制御装置70により受信された場合、新規コマンドポインタ73dは、動作コマンドバッファメモリ73aの先頭を示すように初期化される(図9のS14参照)。   When the destination command notified from the host computer is received by the control device 70 while the automatic guided vehicle 1 is on standby, the new command pointer 73d is initialized to indicate the head of the operation command buffer memory 73a (see FIG. 9 S14).

そして、動作コマンドバッファメモリ73aのうち、新規コマンドポインタ73dにより示される位置に動作コマンド列が記憶されると、新規コマンドポインタ73dは、次の動作コマンド列を書き込む位置を示すように設定される(図10のS37参照)。   When the operation command string is stored at the position indicated by the new command pointer 73d in the operation command buffer memory 73a, the new command pointer 73d is set to indicate the position to write the next operation command string ( (See S37 in FIG. 10).

上書開始ポインタ73eは、無人搬送車両1の自動運転中に上位プロコンから次の行先指令が通知されて、その行先指令が制御装置70により受信され、その次の行先指令に対応する動作コマンド列を動作コマンドバッファメモリ73aに追加して記憶する場合に、その追加位置を示すものである。   The overwriting start pointer 73e is an operation command sequence corresponding to the next destination command when the next destination command is notified from the host computer during the automatic operation of the automatic guided vehicle 1 and the destination command is received by the control device 70. Is added to the operation command buffer memory 73a and stored in the operation command buffer memory 73a.

基準操舵角メモリ73fは、基準操舵角である前側操舵角θfおよび後側操舵角θbを記憶するためのメモリであり、前側操舵角θfを記憶するための前側操舵角メモリ73f1と、後側操舵角θbを記憶するための後側操舵角メモリ73f2とを有している。   The reference steering angle memory 73f is a memory for storing the front steering angle θf and the rear steering angle θb, which are reference steering angles, and the front steering angle memory 73f1 for storing the front steering angle θf and the rear steering. A rear steering angle memory 73f2 for storing the angle θb.

制御装置70において、磁気ガイド検出センサ79a,79bの検出結果に基づいて、前側操舵角θfが算出されると、その算出された前側操舵角θfが、前側操舵角メモリ73f1に記憶される。また、磁気ガイド検出センサ79c,79dの検出結果に基づいて、後側操舵角θbが算出されると、その算出された後側操舵角θbが、後側操舵角メモリ73f2に記憶される。   In the control device 70, when the front steering angle θf is calculated based on the detection results of the magnetic guide detection sensors 79a and 79b, the calculated front steering angle θf is stored in the front steering angle memory 73f1. Further, when the rear side steering angle θb is calculated based on the detection results of the magnetic guide detection sensors 79c and 79d, the calculated rear side steering angle θb is stored in the rear side steering angle memory 73f2.

前側操舵角メモリ73f1の値と、後側操舵角メモリ73f2の値とは、定期的(例えば、5ms毎)にCPU71により更新される。そして、12個の走行装置5a〜5lに対して設定すべき操舵角θ1〜θ12や走行速度V1〜V12を算出する場合などに、CPU71により用いられる。   The value of the front steering angle memory 73f1 and the value of the rear steering angle memory 73f2 are updated by the CPU 71 periodically (for example, every 5 ms). And it is used by CPU71, when calculating steering angle (theta) 1-theta12 and driving speed V1-V12 which should be set with respect to 12 traveling apparatuses 5a-5l.

基準走行速度メモリ73gは、無人搬送車両1が目標とすべき走行速度である基準走行速度Vを記憶するためのメモリである。上述したように、基準走行速度Vは、走行経路Rを各ステーションC毎に区切った場合の各区間毎に予め定められている。基準走行速度メモリ73gの値は、無人搬送車両1がステーションCを通過する度に、CPU71により更新される。そして、12個の走行装置5a〜5lに対して設定すべき走行速度V1〜V12を算出する場合などに、CPU71により用いられる。   The reference traveling speed memory 73g is a memory for storing a reference traveling speed V that is a traveling speed that the automatic guided vehicle 1 should target. As described above, the reference travel speed V is determined in advance for each section when the travel route R is divided for each station C. The value of the reference traveling speed memory 73g is updated by the CPU 71 every time the automatic guided vehicle 1 passes through the station C. And it is used by CPU71, when calculating the running speeds V1-V12 which should be set with respect to the 12 traveling apparatuses 5a-5l.

無線通信装置82は、上位プロコンとの間で、無線通信によるデータ通信を行うための既知の回路であり、行先指令や、走行中であるか待機中であるかや、走行中であれば走行位置や、待機中であれば待機位置などのデータ通信が行われる。   The wireless communication device 82 is a known circuit for performing data communication by wireless communication with a host computer, and it is a destination command, whether the vehicle is traveling or waiting, and traveling if traveling Data communication such as the position and the standby position is performed if the apparatus is on standby.

次に、図8を参照して、制御装置70で実行される自動運転処理について説明する。図8は、自動運転処理を示すフローチャートである。この処理は、無人搬送車両1を自動運転させるための処理であり、無人搬送車両1の運転モードが自動モードに設定されている間、繰り返し実行される。尚、この処理が実行開始される場合、無人搬送車両1は初期状態として待機中になるものとする。   Next, with reference to FIG. 8, the automatic driving process executed by the control device 70 will be described. FIG. 8 is a flowchart showing the automatic driving process. This process is a process for automatically driving the automatic guided vehicle 1 and is repeatedly executed while the operation mode of the automatic guided vehicle 1 is set to the automatic mode. When this process is started, it is assumed that the automatic guided vehicle 1 is on standby as an initial state.

まず、CPU71は、RAM73のコマンド実行ポインタ73bと、新規コマンドポインタ73dとを比較し、それぞれの示す記憶位置が異なっているかを判別する(S1)。S1の判別が否定される場合は(S1:No)、実行すべき動作コマンドがない場合なので待機する。一方、S1の判別が肯定される場合は(S1:Yes)、実行すべき動作コマンドがある場合なので、コマンド実行ポインタ73bにより示される一の動作コマンドを、動作コマンドバッファメモリ73aから取得する(S2)。   First, the CPU 71 compares the command execution pointer 73b of the RAM 73 with the new command pointer 73d, and determines whether or not the storage positions indicated are different (S1). If the determination at S1 is negative (S1: No), the operation waits because there is no operation command to be executed. On the other hand, if the determination in S1 is affirmative (S1: Yes), there is an operation command to be executed, so one operation command indicated by the command execution pointer 73b is acquired from the operation command buffer memory 73a (S2). ).

次に、CPU71は、S2の処理で取得した一の動作コマンドを実行する(S3)。本実施形態では、動作コマンドが実行された場合、その動作コマンドに対応する制御(図4(c)参照)が制御装置70により実行されて、無人搬送車両1の走行状態が制御される。   Next, the CPU 71 executes one operation command acquired in the process of S2 (S3). In the present embodiment, when an operation command is executed, control corresponding to the operation command (see FIG. 4C) is executed by the control device 70, and the traveling state of the automatic guided vehicle 1 is controlled.

次に、CPU71は、S3の処理で実行した動作コマンドに対応する処理が、制御装置70において終了したかを判定する(S4)。S4の判別が否定される場合(S4:No)、実行中の処理が終了するまで待機する。一方、S4の判別が肯定される場合(S4:Yes)、CPU71は、次に取得すべき一の動作コマンドをコマンド実行ポインタ73bが示すように、コマンド実行ポインタ73bを設定(更新)する(S5)。   Next, the CPU 71 determines whether or not the process corresponding to the operation command executed in the process of S3 has been completed in the control device 70 (S4). If the determination in S4 is negative (S4: No), the process waits until the process being executed is completed. On the other hand, if the determination in S4 is affirmative (S4: Yes), the CPU 71 sets (updates) the command execution pointer 73b so that the command execution pointer 73b indicates one operation command to be acquired next (S5). ).

次に、CPU71は、動作コマンドバッファメモリ73aに記憶されている動作コマンドを全て取得したかを判別し(S6)、S6の判別が肯定される場合は(S6:Yes)、動作コマンドバッファメモリ73aに記憶されている動作コマンドを全て実行した場合であり、その結果、無人搬送車両1が出発地点から到着地点までの走行経路R上を走行し終えて、待機中となった場合である。よって、この場合は、S1の処理へ戻る。   Next, the CPU 71 determines whether or not all the operation commands stored in the operation command buffer memory 73a have been acquired (S6). If the determination in S6 is affirmative (S6: Yes), the operation command buffer memory 73a. This is a case where all of the operation commands stored in are executed, and as a result, the automatic guided vehicle 1 has finished traveling on the travel route R from the departure point to the arrival point and is on standby. Therefore, in this case, the process returns to S1.

一方、S6の判別が否定される場合は(S6:No)、動作コマンドバッファメモリ73aの中に、まだ取得していない動作コマンドが残っている場合なので、S2の処理に戻る。S2の処理に戻った後は、動作コマンドバッファメモリ73aに記憶されている動作コマンドが全て実行されるまで、S2〜S6の処理が繰り返し実行される。その結果、出発地点から到着地点までの走行経路R上を走行するための動作コマンドが1つずつ順番に制御装置70により実行されて、最終的に無人搬送車両1が到着地点まで走行し、停車して待機中となる。   On the other hand, if the determination in S6 is negative (S6: No), the operation command buffer memory 73a contains an operation command that has not yet been acquired, and the process returns to S2. After returning to the process of S2, the processes of S2 to S6 are repeatedly executed until all the operation commands stored in the operation command buffer memory 73a are executed. As a result, operation commands for traveling on the travel route R from the departure point to the arrival point are sequentially executed by the control device 70 one by one, and finally the automatic guided vehicle 1 travels to the arrival point and stops. And will be waiting.

次に、図9を参照して、制御装置70で実行される動作コマンド設定処理について説明する。図9は、動作コマンド設定処理を示すフローチャートである。この処理は、上位プロコンから行先指令が通知された場合に、その行先指令に従って無人搬送車両1が走行するように各種設定を行うための処理であり、無人搬送車両1の運転モードが自動モードに設定されている間、繰り返し実行される。   Next, an operation command setting process executed by the control device 70 will be described with reference to FIG. FIG. 9 is a flowchart showing the operation command setting process. This process is a process for making various settings so that the automatic guided vehicle 1 travels in accordance with the destination command when the destination command is notified from the host computer, and the operation mode of the automatic guided vehicle 1 is set to the automatic mode. It is executed repeatedly while it is set.

まず、CPU71は、上位プロコンから通知される行先指令を受信したかを判別する(S11)。S11の判別が否定される場合は(S11:No)、行先指令を受信するまで待機する。一方、S11の判別が肯定される場合(S11:Yes)、CPU71は、無人搬送車両1が自動運転中であるかを判別する(S12)。   First, the CPU 71 determines whether or not a destination command notified from the host computer is received (S11). If the determination in S11 is negative (S11: No), the process waits until a destination command is received. On the other hand, when the determination in S11 is affirmative (S11: Yes), the CPU 71 determines whether the automatic guided vehicle 1 is in automatic operation (S12).

S12の判別が否定される場合(S12:No)、CPU71は、RAM73の動作コマンドバッファメモリ73aをクリアし(S13)、コマンド実行ポインタ73bおよび新規コマンドポインタ73dが共に、動作コマンドバッファメモリ73aの先頭を示すように設定する(S14)。   If the determination in S12 is negative (S12: No), the CPU 71 clears the operation command buffer memory 73a in the RAM 73 (S13), and both the command execution pointer 73b and the new command pointer 73d are at the head of the operation command buffer memory 73a. (S14).

次に、CPU71は、RAM73の指令バッファメモリ73cをクリアして(S15)、今回受信した行先指令(即ち、ステーションC列)を指令バッファメモリ73cに記憶する(S16)。そして、CPU71は、変数iを0に設定し(S17)、動作コマンド生成処理を実行する(S18)。   Next, the CPU 71 clears the command buffer memory 73c of the RAM 73 (S15), and stores the destination command (that is, the station C column) received this time in the command buffer memory 73c (S16). Then, the CPU 71 sets the variable i to 0 (S17) and executes an operation command generation process (S18).

ここで、図10〜図12を参照して、制御装置70で実行される動作コマンド生成処理について説明する。図10は、動作コマンド生成処理を示すフローチャートであり、図11および図12は、動作コマンド設定処理の流れを説明するための説明図である。   Here, with reference to FIGS. 10 to 12, an operation command generation process executed by the control device 70 will be described. FIG. 10 is a flowchart showing operation command generation processing, and FIGS. 11 and 12 are explanatory diagrams for explaining the flow of operation command setting processing.

この動作コマンド生成処理は、指令バッファメモリ73cに記憶されている行先指令に対応する動作コマンド列を生成し、その生成した動作コマンド列を動作コマンドバッファメモリ73aに書き込むための処理である。尚、上述したように、行先指令は、出発地点となるステーションCから到着地点となるステーションCまでの各ステーションCを走行順に並べたステーションC列で構成されている。   This operation command generation process is a process for generating an operation command sequence corresponding to the destination command stored in the command buffer memory 73c and writing the generated operation command sequence in the operation command buffer memory 73a. As described above, the destination command is composed of the station C row in which the stations C from the station C serving as the departure point to the station C serving as the arrival point are arranged in the traveling order.

まず、CPU71は、指令バッファメモリ73cに記憶されているステーションC列のうち、(i−1)番目、i番目、及び(i+1)番目の各ステーションCを取得する(S31)。尚、指令バッファメモリ73cでは、先頭に記憶されているステーションCを0番目とし、それ以降は、1番目、2番目、・・・、という順序で、各ステーションCが順番に記憶されているものとする。   First, the CPU 71 acquires the (i−1) th, ith, and (i + 1) th stations C among the station C columns stored in the command buffer memory 73c (S31). In the command buffer memory 73c, the station C stored at the head is set to 0th, and thereafter, the stations C are stored in the order of 1st, 2nd,... And

次に、CPU71は、変数iが0であるかを判別し(S32)、S32の判別が肯定される場合には(S32:Yes)、前回位置が「該当なし(即ち、「0」)」、現在位置が「i番目のステーションC」、次回位置が「(i+1)番目のステーションC」というステーションCの組み合わせを生成する(S33)。   Next, the CPU 71 determines whether the variable i is 0 (S32). If the determination in S32 is affirmative (S32: Yes), the previous position is “not applicable (ie,“ 0 ”). Then, a combination of the stations C whose current position is “i-th station C” and whose next position is “(i + 1) -th station C” is generated (S33).

そして、CPU71は、S33の処理で生成した組み合わせに対応する動作情報データ番号列を、動作情報リンクテーブル72aから取得し(S34)、その取得した動作情報データ番号列の先頭の番号から各番号の並び順に、その番号に対応する動作コマンド列を、動作コマンドテーブル72bから取得する(S35)。   Then, the CPU 71 acquires the operation information data number sequence corresponding to the combination generated in the process of S33 from the operation information link table 72a (S34), and the number of each number from the top number of the acquired operation information data number sequence. In order of arrangement, an operation command string corresponding to the number is acquired from the operation command table 72b (S35).

次に、CPU71は、S35の処理で取得した各動作コマンド列を、新規コマンドポインタ73dの示す位置を開始位置として、動作コマンドバッファメモリ73aに書き込み(S36)、新規コマンドポインタ73dが次の動作コマンド列を書き込む位置を示すように、新規コマンドポインタ73dを設定(更新)する(S37)。   Next, the CPU 71 writes each operation command sequence acquired in the process of S35 into the operation command buffer memory 73a with the position indicated by the new command pointer 73d as the start position (S36), and the new command pointer 73d is the next operation command. A new command pointer 73d is set (updated) to indicate the position to write the column (S37).

尚、上述したように、無人搬送車両1の待機中に行先指令を受信した場合には、動作コマンド設定処理(図9参照)において、S17の処理が実行されて変数iが0に設定され、その後、この動作コマンド生成処理が実行される。   As described above, when the destination command is received while the automatic guided vehicle 1 is on standby, in the operation command setting process (see FIG. 9), the process of S17 is executed and the variable i is set to 0. Thereafter, the operation command generation process is executed.

この場合に、例えば、図11(a)に示すように、指令バッファメモリ73cに「C201→C202→C203」というステーションC列が記憶されているとする。ここで、S31の処理が実行されると、0番目のステーションCとして「C201」が取得され、1番目のステーションCとして「C202」が取得される。尚、−1番目のステーションC、即ち、(i−1)番目のステーションCは存在しないので取得されない。   In this case, for example, as shown in FIG. 11A, it is assumed that the station C column “C201 → C202 → C203” is stored in the command buffer memory 73c. Here, when the process of S31 is executed, “C201” is acquired as the 0th station C, and “C202” is acquired as the first station C. The -1st station C, that is, the (i-1) th station C does not exist and is not acquired.

次に、S32の処理が実行されると、S32:Yesへ分岐し、S33の処理が実行される。すると、「0,C201,C202」というステーションCの組み合わせが生成される。   Next, when the process of S32 is executed, the process branches to S32: Yes, and the process of S33 is executed. Then, a combination of the stations C “0, C201, C202” is generated.

そして、上述したように、動作情報リンクテーブル72a(図4(a)参照)では、「0,C201,C202」というステーションCの組み合わせに対して、「11,22,…,31」という動作情報データ番号列が対応づけられている。よって、次に、S34の処理が実行されると、その「11,22,…,31」という動作情報データ番号列が取得される。   As described above, in the operation information link table 72a (see FIG. 4A), the operation information “11, 22,..., 31” is associated with the combination of the stations C “0, C201, C202”. A data number column is associated. Therefore, when the process of S34 is executed next, the operation information data number string “11, 22,..., 31” is acquired.

次に、S35の処理が実行されて、その動作情報データ番号列に対応する各動作コマンド列が、上述した動作コマンドテーブル72b(図4(b)参照)から取得される。例えば、動作情報データ番号列が「11,22,…、31」であれば、まず始めに、「11」に対応する3つの動作コマンドが取得され、次に、「22」に対応する4つの動作コマンドが取得され、以下同様に、各動作情報データ番号に対応する動作コマンドが取得され、最後に「31」に対応する2つの動作コマンドが取得される。   Next, the process of S35 is executed, and each operation command sequence corresponding to the operation information data number sequence is acquired from the operation command table 72b (see FIG. 4B). For example, if the operation information data number string is “11, 22,..., 31”, first, three operation commands corresponding to “11” are acquired, and then, four operation commands corresponding to “22” are acquired. An operation command is acquired, and thereafter, similarly, an operation command corresponding to each operation information data number is acquired, and finally two operation commands corresponding to “31” are acquired.

その後、S36の処理が実行されると、S35の処理で取得された各コマンド列が、図11(b)に示すように、動作コマンドバッファメモリ73aに記憶される。更に、S37の処理が実行されると、新規コマンドポインタ73dが次の書き込み位置を示すように更新される。   Thereafter, when the process of S36 is executed, each command string acquired in the process of S35 is stored in the operation command buffer memory 73a as shown in FIG. 11B. Further, when the process of S37 is executed, the new command pointer 73d is updated to indicate the next writing position.

S37の処理が終了したら、次に、CPU71は、i番目のステーションCが、指令バッファメモリ73cに記憶されているステーションC列のうち、最後のステーションCであるかを判別する(S38)。例えば、図11(a)に示すように、指令バッファメモリ73cに3つのステーションCが記憶されている場合には、変数iが2の場合に、最後のステーションCであると判別される。   When the process of S37 is completed, the CPU 71 next determines whether or not the i-th station C is the last station C in the station C row stored in the command buffer memory 73c (S38). For example, as shown in FIG. 11A, when three stations C are stored in the command buffer memory 73c, when the variable i is 2, it is determined that the station is the last station C.

S38の判別が肯定される場合は(S38:Yes)、指令バッファメモリ73cに記憶されているステーションC列(行先指令)に対応する全ての動作コマンド列を動作コマンドバッファメモリ73aに記憶した場合である。よって、この場合、CPU71は、本処理を終了して、動作コマンド設定処理(図9参照)へ戻る。   If the determination in S38 is affirmative (S38: Yes), all the operation command sequences corresponding to the station C sequence (destination command) stored in the command buffer memory 73c are stored in the operation command buffer memory 73a. is there. Therefore, in this case, the CPU 71 ends this process and returns to the operation command setting process (see FIG. 9).

一方、S38の判別が否定される場合は(S38:No)、変数iに1を加算して(S39)、S31の処理に戻り、S31〜S38の各処理を繰り返して、残りの動作コマンド列を動作コマンドバッファメモリ73aに記憶していく。   On the other hand, if the determination in S38 is negative (S38: No), 1 is added to the variable i (S39), the process returns to S31, the processes in S31 to S38 are repeated, and the remaining operation command sequence is determined. Are stored in the operation command buffer memory 73a.

S32の判別が否定される場合(S32:No)、CPU71は、i番目のステーションCが、指令バッファメモリ73cに記憶されているステーションC列のうち、最後のステーションCであるかを判別する(S40)。   When the determination in S32 is negative (S32: No), the CPU 71 determines whether or not the i-th station C is the last station C in the station C row stored in the command buffer memory 73c ( S40).

S40の判別が否定される場合は(S40:No)、CPU71は、前回位置が「(i−1)番目のステーションC」、現在位置が「i番目のステーションC」、次回位置が「(i+1)番目のステーションC」というステーションCの組み合わせを生成し(S41)、S34の処理へ移行する。   If the determination in S40 is negative (S40: No), the CPU 71 determines that the previous position is “(i−1) th station C”, the current position is “ith station C”, and the next position is “(i + 1). ) Station C ”is generated (S41), and the process proceeds to S34.

例えば、図11(a)に示すように、指令バッファメモリ73cに「C201→C202→C203」というステーションC列が記憶されていて、変数iの値が1である場合に、S31の処理が実行されると、その後、S32:YesおよびS40:Noへ分岐して、S41の処理が実行される。   For example, as shown in FIG. 11A, when the station C column “C201 → C202 → C203” is stored in the command buffer memory 73c and the value of the variable i is 1, the process of S31 is executed. Then, the process branches to S32: Yes and S40: No, and the process of S41 is executed.

その結果、「C201,C202,C203」というステーションCの組み合わせが生成され、次に、S34〜S37の処理が実行される。S34〜S37の処理では、上述したように、まず、「C201,C202,C203」というステーションCの組み合わせに対応する動作コマンド列が生成される。そして、その生成された動作コマンド列が、図11(c)に示すように、動作コマンドバッファメモリ73aのうち、新規コマンドポインタ73dの示す位置に書き込まれる。   As a result, a combination of the stations C “C201, C202, C203” is generated, and then the processes of S34 to S37 are executed. In the processes of S34 to S37, as described above, first, an operation command sequence corresponding to the combination of the stations C “C201, C202, C203” is generated. Then, the generated operation command string is written in the position indicated by the new command pointer 73d in the operation command buffer memory 73a, as shown in FIG. 11C.

これにより、動作コマンドバッファメモリ73aには、既に書き込まれている動作コマンド列に続けて、新たに生成された動作コマンド列が追加される。その後、新規コマンドポインタ73dは次の書き込み位置を示すように更新される。   As a result, a newly generated operation command sequence is added to the operation command buffer memory 73a after the already written operation command sequence. Thereafter, the new command pointer 73d is updated to indicate the next writing position.

一方、S40の判別が肯定される場合は(S40:Yes)、CPU71は、前回位置が「(i−1)番目のステーションC」、現在位置が「i番目のステーションC」、次回位置が「該当なし(即ち、「0」)」というステーションCの組み合わせを生成する(S42)。   On the other hand, when the determination in S40 is affirmative (S40: Yes), the CPU 71 determines that the previous position is “(i−1) th station C”, the current position is “i-th station C”, and the next position is “ A combination of the stations C “not applicable (ie,“ 0 ”)” is generated (S42).

そして、動作コマンドバッファメモリ73a内の新規コマンドポインタ73dが現在示している位置を、上書開始ポインタ73eが示すように、上書開始ポインタ73eを設定して(S43)、S34の処理へ移行する。   Then, the overwrite start pointer 73e is set so that the overwrite start pointer 73e indicates the position currently indicated by the new command pointer 73d in the operation command buffer memory 73a (S43), and the process proceeds to S34. .

例えば、図11(a)に示すように、指令バッファメモリ73cに「C201→C202→C203」というステーションC列が記憶されている場合には、i=2のステーションCが、最後のステーションCとなる。   For example, as shown in FIG. 11A, when the station C column “C201 → C202 → C203” is stored in the command buffer memory 73c, the station C with i = 2 is the last station C. Become.

よって、この場合に変数iの値が2になって、S31の処理が実行されると、1番目のステーションCとして「C202」が取得され、2番目のステーションCとして「C203」が取得される。尚、3番目のステーションC、即ち、(i+1)番目のステーションCは存在しないので取得されない。   Therefore, in this case, when the value of the variable i becomes 2 and the process of S31 is executed, “C202” is acquired as the first station C, and “C203” is acquired as the second station C. . The third station C, that is, the (i + 1) th station C does not exist and is not acquired.

その後、S32:YesおよびS40:Yesへ分岐して、S42の処理およびS43の処理が実行される。その結果、「C202,C203,0」というステーションCの組み合わせが生成され、更に、新規コマンドポインタ73dが現在示している位置を、上書開始ポインタ73eが示すように設定される。   Thereafter, the process branches to S32: Yes and S40: Yes, and the process of S42 and the process of S43 are executed. As a result, a combination of the stations C “C202, C203, 0” is generated, and the position where the new command pointer 73d currently indicates is set as indicated by the overwrite start pointer 73e.

その後、S34〜S37の処理が実行されると、まず、「C202,C203,0」というステーションCの組み合わせに対応する動作コマンド列が生成される。そして、その生成された動作コマンド列が、図11(d)に示すように、動作コマンドバッファメモリ73aのうち、新規コマンドポインタ73dの示す位置に書き込まれる。   Thereafter, when the processes of S34 to S37 are executed, first, an operation command string corresponding to the combination of the stations C “C202, C203, 0” is generated. Then, the generated operation command string is written in the position indicated by the new command pointer 73d in the operation command buffer memory 73a as shown in FIG. 11 (d).

その結果、動作コマンドバッファメモリ73aには、既に書き込まれている動作コマンド列に続けて、新たに生成された動作コマンド列が追加される。尚、その後、新規コマンドポインタ73dは次の書き込み位置を示すように更新される。   As a result, a newly generated operation command sequence is added to the operation command buffer memory 73a after the already written operation command sequence. Thereafter, the new command pointer 73d is updated to indicate the next writing position.

上述したように、本実施形態では、i番目のステーションCが、指令バッファメモリ73c内の最後のステーションCと判別された場合(S40:Yesの場合)、次回位置が「該当なし」というステーションCの組み合わせが生成される。すると、制御装置70では、無人搬送車両1を最後のステーションCで停車させて待機させるための動作コマンド列が生成されて、動作コマンドバッファメモリ73aに記憶される。   As described above, in the present embodiment, when the i-th station C is determined to be the last station C in the command buffer memory 73c (S40: Yes), the station C whose next position is “not applicable”. Is generated. Then, in the control device 70, an operation command sequence for stopping the automatic guided vehicle 1 at the last station C and waiting is generated and stored in the operation command buffer memory 73a.

しかしながら、無人搬送車両1の自動運転中に、次の行先指令を受信した場合には、到着地点となるステーションCが変更されるため、動作コマンドバッファメモリ73aに記憶されている動作コマンド列のうち、無人搬送車両1を停車させるための動作コマンド列は不要となる。   However, when the next destination command is received during the automatic operation of the automatic guided vehicle 1, the station C as the arrival point is changed, and therefore, among the operation command sequences stored in the operation command buffer memory 73a. The operation command sequence for stopping the automatic guided vehicle 1 becomes unnecessary.

そこで、本実施形態では、動作コマンドバッファメモリ73aに記憶されている動作コマンド列のうち、次の行先指令を受信した場合に不要となる動作コマンド列、即ち、無人搬送車両1を停車させるための動作コマンド列が記憶されている先頭の位置を、上書開始ポインタ73eに記憶させている。そして、次に行先指令を受信した場合には、その次の行先指令に対応する動作コマンド列を、動作コマンドバッファメモリ73aのうち、上書開始ポインタ73eにより示される位置と同一の位置から、上書き開始するように構成している。   Therefore, in the present embodiment, among the operation command sequences stored in the operation command buffer memory 73a, an operation command sequence that becomes unnecessary when the next destination command is received, that is, for stopping the automatic guided vehicle 1 is stopped. The top position where the operation command string is stored is stored in the overwrite start pointer 73e. Then, when the destination command is received next, the operation command sequence corresponding to the next destination command is overwritten from the same position as the overwrite start pointer 73e in the operation command buffer memory 73a. Configured to start.

これにより、上位プロコンから複数回に分けて行先指令が通知される場合でも、最後に通知された行先指令についてのみ、無人搬送車両1を停車させるための動作コマンド列が動作コマンドバッファメモリ73aに残る。よって、無人搬送車両1が最終的な到着地点となるステーションCへ到着するまでに、無人搬送車両1が停車および発進を繰り返すことを抑制できるので、無人搬送車両1にスムーズに走行させられる。   As a result, even when the destination command is notified in multiple times from the host computer, the operation command sequence for stopping the automatic guided vehicle 1 remains in the operation command buffer memory 73a only for the last notified destination command. . Therefore, it is possible to prevent the automatic guided vehicle 1 from repeatedly stopping and starting until the automatic guided vehicle 1 arrives at the station C, which is the final arrival point, so that the automatic guided vehicle 1 can smoothly run.

以上の図10に示す動作コマンド生成処理によれば、出発地点となるステーションCから到着地点となるステーションCまでの走行経路Rを無人搬送車両1に走行させる動作コマンド列を、隣設する3つのステーションCの組み合わせと、隣設する2つのステーションCの組み合わせとから取得できる。よって、無人搬送車両1を走行させるための動作コマンド列を、単純な処理で取得できるので、制御装置70に掛かる負担を軽減できる。   According to the operation command generation process shown in FIG. 10 described above, the operation command sequence for causing the automatic guided vehicle 1 to travel on the travel route R from the station C serving as the departure point to the station C serving as the arrival point is adjacent to the three. It can be obtained from the combination of the stations C and the combination of the two adjacent stations C. Therefore, since the operation command sequence for running the automatic guided vehicle 1 can be acquired by a simple process, the burden on the control device 70 can be reduced.

ここで、図9の説明に戻る。動作コマンド生成処理(S18)が終了した後は、S11の処理へ戻る。S12の判別が肯定される場合は(S12:Yes)、無人搬送車両1が自動運転中に、新たに行先指令を受信した場合である。この場合、CPU71は、新たに受信した行先指令における先頭のステーションCが、指令バッファメモリ73cに記憶されているステーションC列において何番目であるかを算出する(S19)。   Returning to the description of FIG. After the operation command generation process (S18) ends, the process returns to S11. When the determination in S12 is affirmative (S12: Yes), this is a case where a new destination command is received while the automatic guided vehicle 1 is in automatic operation. In this case, the CPU 71 calculates the position of the first station C in the station C column stored in the command buffer memory 73c in the newly received destination command (S19).

次に、CPU71は、S19の処理で算出した番号を変数iに設定し(S20)、i番目のステーションCが記憶されている位置を開始位置として、新たに受信した行先指令(即ち、ステーションC列)を指令バッファメモリ73cに書き込む(S21)。これにより、新たに受信された行先指令が、指令バッファメモリ73cのうち、その行先指令の先頭と同一のステーションCが記憶されている位置から上書きされる。   Next, the CPU 71 sets the number calculated in the process of S19 to the variable i (S20), and uses the position where the i-th station C is stored as the start position, so that the newly received destination command (ie, station C Column) is written into the command buffer memory 73c (S21). As a result, the newly received destination command is overwritten from the position where the same station C as the head of the destination command is stored in the command buffer memory 73c.

そして、CPU71は、上書開始ポインタ73eが現在示している位置を新規コマンドポインタ73dが示すように設定し(S22)、上述した動作コマンド生成処理(S18)を実行する。   Then, the CPU 71 sets the position indicated by the overwriting start pointer 73e as indicated by the new command pointer 73d (S22), and executes the operation command generation process (S18) described above.

ここで、動作コマンド生成処理が実行されると、今回受信した行先指令に対応する動作コマンド列が生成され、それらが動作コマンドバッファメモリ73aに追加される。そして、動作コマンド生成処理(S18)が終了した後は、S11の処理に戻る。   Here, when the operation command generation process is executed, an operation command sequence corresponding to the destination command received this time is generated and added to the operation command buffer memory 73a. Then, after the operation command generation process (S18) ends, the process returns to S11.

例えば、無人搬送車両1が自動運転中であって、指令バッファメモリ73cに「C201→C202→C203」というステーションC列が記憶されている場合(図11(a)参照)に、「C203→C204」という新たな行先指令を受信したとする。この場合、新たな行先指令の先頭である「C203」は、指令バッファメモリ73c内において2番目に位置するため、S12:Yesへ分岐して、S19の処理では2番目と算出され、その結果、S20の処理では変数iに2が設定される。   For example, when the automatic guided vehicle 1 is in automatic operation and the station C column “C201 → C202 → C203” is stored in the command buffer memory 73c (see FIG. 11A), “C203 → C204” is stored. ”Is received. In this case, since “C203”, which is the head of the new destination command, is second in the command buffer memory 73c, the process branches to S12: Yes, and is calculated as the second in the process of S19. In the process of S20, 2 is set to the variable i.

そして、S21の処理が実行されると、指令バッファメモリ73c内のうち、新たに受信した行先指令の先頭と同一である「C203」が記憶されている位置から、新たに受信した行先指令「C203→C204」が上書きされる。その結果、図12(a)に示すように、指令バッファメモリ73cには、「C201→C202→C203→C204」というステーションC列が記憶される。   Then, when the process of S21 is executed, the newly received destination command “C203” from the position in the command buffer memory 73c where “C203” that is the same as the head of the newly received destination command is stored. → C204 "is overwritten. As a result, as shown in FIG. 12A, the instruction buffer memory 73c stores a station C column of “C201 → C202 → C203 → C204”.

次に、S22の処理が実行されると、図12(a)に示すように、上書開始ポインタ73eに記憶させている位置を新規コマンドポインタ73dが示すように設定される。その結果、動作コマンド生成処理(S18)が実行されて、新たに受信した行先指令に対応する動作コマンド列が生成された場合に、その生成されたコマンド列が、動作コマンドバッファメモリ73aのうち、無人搬送車両1を停車させるための動作コマンド列が記憶されている位置から上書きされ追加される。   Next, when the process of S22 is executed, as shown in FIG. 12A, the position stored in the overwrite start pointer 73e is set so that the new command pointer 73d indicates. As a result, when the operation command generation process (S18) is executed and an operation command sequence corresponding to the newly received destination command is generated, the generated command sequence is stored in the operation command buffer memory 73a. An operation command sequence for stopping the automatic guided vehicle 1 is overwritten and added from the stored position.

より具体的には、動作コマンド生成処理(S18)が実行されると、最初、変数iは2に設定された状態で、S31,S32,S40の各処理が順番に実行される。そして、S32:NoおよびS40:Noへ分岐して、S41の処理が実行される。その結果、「C202,C203,C204」というステーションCの組み合わせが生成される。   More specifically, when the operation command generation process (S18) is executed, first, each process of S31, S32, and S40 is executed in order with the variable i set to 2. And it branches to S32: No and S40: No, and the process of S41 is performed. As a result, a combination of the stations C “C202, C203, C204” is generated.

その後、S34〜S37の処理が実行されると、まず、「C202,C203,C204」というステーションCの組み合わせに対応する動作コマンド列が生成される。そして、その生成された動作コマンド列が、図12(b)に示すように、動作コマンドバッファメモリ73aのうち、新規コマンドポインタ73dの示す位置(即ち、図12(a)における上書開始ポインタ73eの示す位置)から上書きされる。   After that, when the processes of S34 to S37 are executed, first, an operation command sequence corresponding to the combination of the stations C “C202, C203, C204” is generated. Then, as shown in FIG. 12B, the generated operation command string is the position indicated by the new command pointer 73d in the operation command buffer memory 73a (ie, the overwriting start pointer 73e in FIG. 12A). Is overwritten from the position indicated by

次に、S38の処理が実行されるが、図12(a)に示す例では、i=3番目のステーションCが、最後のステーションCとなるので、S38:Noへ分岐する。そして、S39の処理が実行されて、変数iに1が加算され、S31の処理に戻る。   Next, the process of S38 is executed. In the example shown in FIG. 12A, since i = 3rd station C becomes the last station C, the process branches to S38: No. Then, the process of S39 is executed, 1 is added to the variable i, and the process returns to S31.

そして、次は、変数iが3に設定された状態で、S31,S32,S40の各処理が順番に実行され、S32:NoおよびS40:Yesへ分岐して、S42およびS43の各処理が実行される。その後、S34〜S37の処理が実行されると、まず、「C203,C204,0」というステーションCの組み合わせに対応する動作コマンド列が生成される。そして、その生成された動作コマンド列が、図12(c)に示すように、動作コマンドバッファメモリ73aのうち、新規コマンドポインタ73dの示す位置に書き込まれる。   Next, with the variable i set to 3, the processes of S31, S32, and S40 are executed in order, branching to S32: No and S40: Yes, and the processes of S42 and S43 are executed. Is done. After that, when the processes of S34 to S37 are executed, first, an operation command string corresponding to the combination of the stations C “C203, C204, 0” is generated. Then, the generated operation command string is written in the position indicated by the new command pointer 73d in the operation command buffer memory 73a as shown in FIG.

その結果、動作コマンドバッファメモリ73aには、既に書き込まれている動作コマンド列に続けて、新たに生成された動作コマンド列が追加される。尚、その後、新規コマンドポインタ73dは次の書き込み位置を示すように更新される。加えて、S43の処理も実行されるため、動作コマンドバッファメモリ73aのうち、次の行先指令を受信した場合に不要となる動作コマンド列の先頭の位置が、上書開始ポインタ73eにより記憶される。   As a result, a newly generated operation command sequence is added to the operation command buffer memory 73a after the already written operation command sequence. Thereafter, the new command pointer 73d is updated to indicate the next writing position. In addition, since the process of S43 is also executed, the top position of the operation command string that becomes unnecessary when the next destination command is received in the operation command buffer memory 73a is stored by the overwrite start pointer 73e. .

以上の図9に示す動作コマンド設定処理によれば、上位プロコンから行先指令が通知された場合に、その行先指令に従って無人搬送車両1が走行するように各種設定を行うことができる。   According to the operation command setting process shown in FIG. 9 described above, when the destination command is notified from the host computer, various settings can be performed so that the automatic guided vehicle 1 travels according to the destination command.

尚、上述したように、本実施形態では、上位プロコンから無人搬送車両1に対して行先指令が通知される度に、出発地点となるステーションCから到着地点となるステーションCまでの走行経路R上に並ぶステーションCが、3つ単位で通知される場合の一例を説明している。しかしながら、1回の行先指令の通知において、出発地点となるステーションCから到着地点となるステーションCまでの走行経路R上に並ぶステーションCが全て(又は、4以上)通知される場合でも、当然、本発明を適用できる。   As described above, in this embodiment, every time a destination command is notified from the host computer to the automatic guided vehicle 1, the route C from the station C serving as the departure point to the station C serving as the arrival point is displayed. An example in which the stations C arranged in a row are notified in units of three is described. However, even when all the stations C arranged on the travel route R from the station C serving as the departure point to the station C serving as the arrival point are notified (or four or more) in one destination instruction notification, The present invention can be applied.

上述した図9に示す動作コマンド処理、及び、図10に示す動作コマンド生成処理によれば、1回の行先指令により、3以上のステーションCが通知される場合でも、その通知された行先指令に対応する動作コマンド列を生成できる。ここで、1回の行先指令により、3以上のステーションCが通知された場合に、動作コマンド生成処理により実行される処理について説明する。まず、無人搬送車両1の待機中に、1回の行先指令により、3以上のステーションCが通知された場合について説明する。   According to the operation command process shown in FIG. 9 and the operation command generation process shown in FIG. 10 described above, even when three or more stations C are notified by one destination instruction, the notified destination instruction is A corresponding operation command sequence can be generated. Here, a process executed by the operation command generation process when three or more stations C are notified by one destination command will be described. First, a case will be described in which three or more stations C are notified by one destination command while the automatic guided vehicle 1 is on standby.

例えば、無人搬送車両1の待機中に、「C201→C202→C203→C204→C205」という行先指令が制御装置70により受信され、その結果、指令バッファメモリ73cの先頭から「C201→C202→C203→C204→C205」というステーションC列が順番に記憶されたとする(図9のS11〜S16参照)。すると、変数iが0に設定され(図9のS17参照)、その後、動作コマンド生成処理(図9のS18)が実行される。   For example, while the automatic guided vehicle 1 is on standby, a destination command “C201 → C202 → C203 → C204 → C205” is received by the control device 70. As a result, “C201 → C202 → C203 →” from the top of the command buffer memory 73c. Assume that the station C column “C204 → C205” is stored in order (see S11 to S16 in FIG. 9). Then, the variable i is set to 0 (see S17 in FIG. 9), and then an operation command generation process (S18 in FIG. 9) is executed.

ここで、動作コマンド生成処理が実行されると、i=0なので、「0→C201→C202」というステーションCの組み合わせが生成され、その生成された組み合わせに対応する動作コマンド列が生成される。そして、その生成された動作コマンド列が、動作コマンドバッファメモリ73aのうち、新規コマンドポインタ73dの示す位置に書き込まれ、その後、新規コマンドポインタ73dが、次の書き込み位置を示すように更新される。   Here, when the operation command generation process is executed, since i = 0, a combination of station C “0 → C201 → C202” is generated, and an operation command sequence corresponding to the generated combination is generated. Then, the generated operation command sequence is written in the position indicated by the new command pointer 73d in the operation command buffer memory 73a, and then the new command pointer 73d is updated to indicate the next writing position.

以下同様に、i=1の場合には、「C201→C202→C203」というステーションCの組み合わせが、i=2の場合には、「C202→C203→C204」というステーションCの組み合わせが、i=3の場合には、「C203→C204→C205」というステーションCの組み合わせが、i=4の場合には、「C204→C205→0」というステーションCの組み合わせが、それぞれ生成される。   Similarly, in the case of i = 1, the combination of the station C “C201 → C202 → C203”, and in the case of i = 2, the combination of the station C “C202 → C203 → C204” is i = In the case of 3, the station C combination “C203 → C204 → C205” is generated, and in the case of i = 4, the station C combination “C204 → C205 → 0” is generated.

そして、生成されたステーションCの組み合わせ毎に、そのステーションCに対応する動作コマンド列が生成され、その生成された動作コマンド列が、動作コマンドバッファメモリ73aのうち、新規コマンドポインタ73dの示す位置に書き込まれる。更に、生成された動作コマンド列が動作コマンドバッファメモリ73aに書き込まれると、その度に、新規コマンドポインタ73dが、次の書き込み位置を示すように更新される。その結果、動作コマンドバッファメモリ73aには、「C201→C202→C203→C204→C205」という行先指令に対応する動作コマンド列が記憶される。   Then, for each combination of the generated stations C, an operation command sequence corresponding to the station C is generated, and the generated operation command sequence is in the position indicated by the new command pointer 73d in the operation command buffer memory 73a. Written. Further, each time the generated operation command string is written into the operation command buffer memory 73a, the new command pointer 73d is updated to indicate the next writing position. As a result, the operation command buffer memory 73a stores an operation command sequence corresponding to the destination command “C201 → C202 → C203 → C204 → C205”.

次に、無人搬送車両1が自動運転中に、上位プロコンから新たな行先指令が通知され、その新たな行先指令において、3以上のステーションCが通知された場合について説明する。   Next, a case where a new destination command is notified from the host computer while the automatic guided vehicle 1 is in automatic operation, and three or more stations C are notified in the new destination command will be described.

例えば、無人搬送車両1が自動運転中であって、指令バッファメモリ73cに「C201→C202→C203→C204→C205」というステーションC列が記憶されている場合に、「C205→C206→C207→C208→C209」という新たな行先指令を受信したとする。この場合、新たな行先指令の先頭である「C205」は、指令バッファメモリ73c内において4番目に位置するため、変数iに4が設定される(図9のS19,S20参照)。   For example, when the automatic guided vehicle 1 is in an automatic operation and the station C column “C201 → C202 → C203 → C204 → C205” is stored in the command buffer memory 73c, “C205 → C206 → C207 → C208” is stored. Suppose that a new destination command “→ C209” is received. In this case, since “C205”, which is the head of the new destination command, is positioned fourth in the command buffer memory 73c, 4 is set to the variable i (see S19 and S20 in FIG. 9).

そして、指令バッファメモリ73cの内のうち、新たに受信した行先指令の先頭と同一である「C205」が記憶されている位置から、新たに受信した行先指令「C205→C206→C207→C208→C209」が上書きされる(図9のS21参照)。その結果、指令バッファメモリ73cには、「C201→C202→C203→C204→C205→C206→C207→C208→C209」というステーションC列が記憶される。   The destination command “C205 → C206 → C207 → C208 → C209” is newly received from the position where “C205”, which is the same as the head of the newly received destination command, is stored in the command buffer memory 73c. "Is overwritten (see S21 in FIG. 9). As a result, the station C column of “C201 → C202 → C203 → C204 → C205 → C206 → C207 → C208 → C209” is stored in the command buffer memory 73c.

その後、上書開始ポインタ73eに記憶させている位置を新規コマンドポインタ73dが示すように設定されると(図9のS22参照)、動作コマンド生成処理(図9のS18)が実行される。   Thereafter, when the position stored in the overwrite start pointer 73e is set as indicated by the new command pointer 73d (see S22 in FIG. 9), an operation command generation process (S18 in FIG. 9) is executed.

ここで、動作コマンド生成処理が実行されると、i=4なので、「C204→C205→C206」というステーションCの組み合わせが生成され、その生成された組み合わせに対応する動作コマンド列が生成される。そして、その生成された動作コマンド列が、動作コマンドバッファメモリ73aのうち、新規コマンドポインタ73dの示す位置に書き込まれる。その結果、生成された動作コマンド列が、動作コマンドバッファメモリ73aのうち、ステーションC205で無人搬送車両1を停車させるための動作コマンド列が記憶されている位置から上書きされ追加される。その後、新規コマンドポインタ73dが、次の書き込み位置を示すように更新される。   Here, when the operation command generation processing is executed, since i = 4, a combination of the stations C “C204 → C205 → C206” is generated, and an operation command sequence corresponding to the generated combination is generated. The generated operation command string is written in the position indicated by the new command pointer 73d in the operation command buffer memory 73a. As a result, the generated operation command sequence is overwritten and added from the position where the operation command sequence for stopping the automatic guided vehicle 1 at the station C205 is stored in the operation command buffer memory 73a. Thereafter, the new command pointer 73d is updated to indicate the next writing position.

そして、i=5の場合には、「C205→C206→C207」というステーションCの組み合わせが、i=6の場合には、「C206→C207→C208」というステーションCの組み合わせが、i=7の場合には、「C207→C208→C209」というステーションCの組み合わせが、i=8の場合には、「C208→C209→0」というステーションCの組み合わせが、それぞれ生成される。   When i = 5, the combination of station C “C205 → C206 → C207” is set. When i = 6, the combination of station C “C206 → C207 → C208” is set to i = 7. In this case, a combination of stations C “C207 → C208 → C209” is generated, and when i = 8, a combination of stations C “C208 → C209 → 0” is generated.

そして、生成されたステーションCの組み合わせ毎に、そのステーションCに対応する動作コマンド列が生成され、その生成された動作コマンド列が、動作コマンドバッファメモリ73aのうち、新規コマンドポインタ73dの示す位置に書き込まれる。更に、生成された動作コマンド列が動作コマンドバッファメモリ73aに書き込まれると、その度に、新規コマンドポインタ73dが、次の書き込み位置を示すように更新される。   Then, for each combination of the generated stations C, an operation command sequence corresponding to the station C is generated, and the generated operation command sequence is in the position indicated by the new command pointer 73d in the operation command buffer memory 73a. Written. Further, each time the generated operation command string is written into the operation command buffer memory 73a, the new command pointer 73d is updated to indicate the next writing position.

その結果、動作コマンドバッファメモリ73aには、「C205→C206→C207→C208→C208」という行先指令に対応する動作コマンド列が追加される。より具体的には、動作コマンドバッファメモリ73aには、ステーションC205で無人搬送車両1を停車させずにそのまま通過させ、その後、ステーションC208で無人搬送車両1を停車させる動作コマンド列が追加される。   As a result, an operation command sequence corresponding to the destination command “C205 → C206 → C207 → C208 → C208” is added to the operation command buffer memory 73a. More specifically, the operation command buffer memory 73a is added with an operation command sequence for allowing the automatic guided vehicle 1 to pass through the station C205 without stopping, and then stopping the automatic guided vehicle 1 at the station C208.

以上説明したように、上述した図9に示す動作コマンド処理、及び、図10に示す動作コマンド生成処理によれば、1回の行先指令により、3以上のステーションCが通知される場合でも、無人搬送車両1を走行させるための動作コマンド列を生成できる。   As described above, according to the operation command process shown in FIG. 9 and the operation command generation process shown in FIG. 10 described above, even when three or more stations C are notified by a single destination command, unmanned An operation command sequence for causing the transport vehicle 1 to travel can be generated.

次に、図13を参照して、制御装置70で実行される操舵角自動設定処理について説明する。図13は、操舵角自動設定処理を示すフローチャートである。この処理は、無人搬送車両1が磁気ガイドG上を走行するように、各走行装置5a〜5lに設けられている車軸6aの操舵角θ1〜θ12、および、車輪6bの走行速度V1〜V12を設定するための処理であり、無人搬送車両1の運転モードが自動モードに設定されている間、繰り返し実行される。   Next, a steering angle automatic setting process executed by the control device 70 will be described with reference to FIG. FIG. 13 is a flowchart showing the steering angle automatic setting process. In this process, the steering angles θ1 to θ12 of the axles 6a and the traveling speeds V1 to V12 of the wheels 6b provided in the traveling devices 5a to 5l are set so that the automatic guided vehicle 1 travels on the magnetic guide G. This is a process for setting, and is repeatedly executed while the operation mode of the automatic guided vehicle 1 is set to the automatic mode.

まず、CPU71は、無人搬送車両1が走行中であるかを判別する(S51)。S51の判別が否定される場合は(S51:No)、無人搬送車両1が走行中になるまで待機する。一方、S51の判別が肯定される場合(S51:Yes)、CPU71は、RAM73の基準走行速度メモリ73gから基準走行速度Vを取得して(S52)、現在設定されている運転モードの種別が、何であるかを判別する(S53)。   First, the CPU 71 determines whether the automatic guided vehicle 1 is traveling (S51). When the determination in S51 is negative (S51: No), the process waits until the automatic guided vehicle 1 is traveling. On the other hand, if the determination in S51 is affirmative (S51: Yes), the CPU 71 acquires the reference travel speed V from the reference travel speed memory 73g of the RAM 73 (S52), and the currently set operation mode type is What this is is determined (S53).

S53の判別の結果、右倣いモードと判別された場合(S53:右倣いモード)、CPU71は、無人搬送車両1の右側最前列および右側最終列の各走行装置5b,5lに設けられた各磁気ガイド検出センサ79b,79dから、磁気ガイドGの検出結果を取得する(S54)。   As a result of the determination in S53, when the right scanning mode is determined (S53: right scanning mode), the CPU 71 sets each magnetic device provided in each of the traveling devices 5b and 5l in the rightmost front row and the rightmost last row of the automatic guided vehicle 1. The detection result of the magnetic guide G is acquired from the guide detection sensors 79b and 79d (S54).

次に、CPU71は、右側最前列および右側最終列の各走行装置5b,5lごとに、磁気ガイド検出センサ79b,79dと、磁気ガイドGとの偏差(横ずれ)を、S54の処理で取得した検出結果に基づいて算出する(S55)。そして、S58の処理へ移行する。   Next, the CPU 71 detects the deviation (lateral deviation) between the magnetic guide detection sensors 79b and 79d and the magnetic guide G for each of the traveling devices 5b and 5l in the rightmost front row and the rightmost last row obtained in the process of S54. Calculation is made based on the result (S55). Then, the process proceeds to S58.

一方、S53の判別の結果、左倣いモードと判別された場合(S53:左倣いモード)、CPU71は、無人搬送車両1の左側最前列および左側最終列の各走行装置5a,5kに設けられた各磁気ガイド検出センサ79a,79cから、磁気ガイドGの検出結果を取得する(S56)。   On the other hand, if the left scanning mode is determined as a result of the determination in S53 (S53: left scanning mode), the CPU 71 is provided in each of the traveling devices 5a and 5k in the leftmost front row and the leftmost last row of the automatic guided vehicle 1. The detection result of the magnetic guide G is acquired from each magnetic guide detection sensor 79a, 79c (S56).

次に、CPU71は、左側最前列および左側最終列の各走行装置5a,5kごとに、磁気ガイド検出センサ79a,79cと、磁気ガイドGとの偏差(横ずれ)を、S56の処理で取得した検出結果に基づいて算出する(S57)。そして、S58の処理へ移行する。   Next, the CPU 71 detects the deviation (lateral deviation) between the magnetic guide detection sensors 79a and 79c and the magnetic guide G for each of the traveling devices 5a and 5k in the left front row and the left final row obtained in the process of S56. Based on the result (S57). Then, the process proceeds to S58.

S58の処理では、CPU71は、S55またはS57の処理で算出された偏差を減少させる2つの基準操舵角(前側操舵角θf、及び、後側操舵角θb)を算出する(S58)。尚、S55の処理が実行された場合であれば、磁気ガイド検出センサ79bの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させる場合の走行装置5bの操舵角を、前側操舵角θfとして算出する。また、磁気ガイド検出センサ79dの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させる場合の走行装置5lの操舵角を、後側操舵角θbとして算出する。   In the process of S58, the CPU 71 calculates two reference steering angles (a front steering angle θf and a rear steering angle θb) that reduce the deviation calculated in the process of S55 or S57 (S58). If the process of S55 is executed, the steering angle of the traveling device 5b when the automatic guided vehicle 1 is traveled so that the magnetic guide G fits in the center of the detection part of the magnetic guide detection sensor 79b is Calculated as the front steering angle θf. In addition, the steering angle of the traveling device 5l when the automatic guided vehicle 1 is traveling is calculated as the rear steering angle θb so that the magnetic guide G fits in the center of the detection unit of the magnetic guide detection sensor 79d.

一方、S57の処理が実行された場合であれば、磁気ガイド検出センサ79aの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させる場合の走行装置5aの操舵角を、前側操舵角θfとして算出する。また、磁気ガイド検出センサ79cの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させる場合の走行装置5kの操舵角を、後側操舵角θbとして算出する。   On the other hand, if the process of S57 is executed, the steering angle of the traveling device 5a when the automatic guided vehicle 1 is traveled so that the magnetic guide G fits in the center of the detection unit of the magnetic guide detection sensor 79a, Calculated as the front steering angle θf. In addition, the steering angle of the traveling device 5k when the automatic guided vehicle 1 is traveling is calculated as the rear steering angle θb so that the magnetic guide G fits in the center of the detection unit of the magnetic guide detection sensor 79c.

S58の処理において前側操舵角θfおよび後側操舵角θbが算出されると、前側操舵角θfが前側操舵角メモリ73f1に記憶され、後側操舵角θbが後側操舵角メモリ73f2に記憶される。   When the front side steering angle θf and the rear side steering angle θb are calculated in the process of S58, the front side steering angle θf is stored in the front side steering angle memory 73f1, and the rear side steering angle θb is stored in the rear side steering angle memory 73f2. .

尚、上述したように、ここで算出される前側操舵角θfおよび後側操舵角θbは、あくまでも、制御装置70が操舵角設定テーブル72cを参照するための基準操舵角なので、走行装置5a,5b,5k,5lに対して設定される操舵角と一致するとは限らない。   Note that, as described above, the front steering angle θf and the rear steering angle θb calculated here are reference steering angles for the control device 70 to refer to the steering angle setting table 72c, and thus the traveling devices 5a and 5b. , 5k, 5l does not necessarily coincide with the steering angle set.

次に、CPU71は、S58の処理で算出した2つの基準操舵角(前側操舵角θf、及び、後側操舵角θb)を用いて、各走行装置5a〜5lに対応する操舵角θ1〜θ12、および、走行速度比率Va1〜Va12を、操舵角設定テーブル72cから取得する(S59)。   Next, the CPU 71 uses the two reference steering angles (front steering angle θf and rear steering angle θb) calculated in the process of S58 to control the steering angles θ1 to θ12 corresponding to the traveling devices 5a to 5l. And traveling speed ratio Va1-Va12 is acquired from the steering angle setting table 72c (S59).

尚、S58の処理で算出した前側操舵角θfがプラスの角度であれば、そのまま、その算出した前側操舵角θfおよび後側操舵角θbに対応する各操舵角θ1〜θ12、及び、各走行速度比率Va1〜Va12を、操舵角設定テーブル72cの中から取得する。   If the front steering angle θf calculated in the process of S58 is a positive angle, the steering angles θ1 to θ12 corresponding to the calculated front steering angle θf and the rear steering angle θb, and the traveling speeds as they are. The ratios Va1 to Va12 are acquired from the steering angle setting table 72c.

一方、前側操舵角θfがマイナスの角度であれば、一旦、前側操舵角θfおよび後側操舵角θbにそれぞれ−1を乗じて、前側操舵角θfの符号をプラスにする。そして、−1乗じた前側操舵角θfおよび後側操舵角θbに対応する各操舵角θ1〜θ12、及び、各走行速度比率Va1〜Va12を、操舵角設定テーブル72cの中から取得する。そして、その取得した各操舵角θ1〜θ12については、それぞれ−1を乗じ、その結果得られた値を、無人搬送車両1における走行装置5a〜5lの各列単位で、左右入れ替える。そして、その結果得られた値を、最終的な各操舵角θ1〜θ12とする。また、各走行速度比率Va1〜Va12については、単に、走行装置5a〜5lの各列単位で、左右入れ替える。そして、その結果得られた値を、最終的な走行速度比率Va1〜Va12とする。   On the other hand, if the front steering angle θf is a negative angle, the front steering angle θf and the rear steering angle θb are each multiplied by −1 to make the sign of the front steering angle θf positive. Then, the steering angles θ1 to θ12 and the traveling speed ratios Va1 to Va12 corresponding to the front steering angle θf and the rear steering angle θb multiplied by −1 are acquired from the steering angle setting table 72c. And about each acquired steering angle (theta) 1-theta12, respectively, -1 is multiplied, and the value obtained as a result is exchanged right and left for each row unit of traveling devices 5a-5l in automatic guided vehicle 1. The values obtained as a result are regarded as final steering angles θ1 to θ12. In addition, the travel speed ratios Va1 to Va12 are simply switched left and right in units of each row of the travel devices 5a to 5l. And let the value obtained as a result be final travel speed ratio Va1-Va12.

そして、CPU71は、S52の処理で取得した基準走行速度Vと、S59の処理で取得した走行速度比率Va1〜Va12とから、各走行装置5a〜5lの走行速度V1〜V12を算出する(S60)。   Then, the CPU 71 calculates the traveling speeds V1 to V12 of the traveling devices 5a to 5l from the reference traveling speed V acquired in the process of S52 and the traveling speed ratios Va1 to Va12 acquired in the process of S59 (S60). .

次に、CPU71は、各走行装置5a〜5lについて、S59の処理で取得した操舵角θ1〜θ12を設定すると共に、S60の処理で算出した走行速度V1〜V12を設定する(S61)。より具体的には、各走行装置5a〜5lの各車軸6aの操舵角θ1〜θ12を、S59の処理で取得した操舵角θ1〜θ12に設定すると共に、各走行装置5a〜5lの各車輪6bの走行速度が、S60の処理で算出した走行速度V1〜V12となるように、各車軸6aの回転速度を設定する。   Next, the CPU 71 sets the steering angles θ1 to θ12 acquired in the process of S59 and sets the travel speeds V1 to V12 calculated in the process of S60 for each of the travel devices 5a to 5l (S61). More specifically, the steering angles θ1 to θ12 of the axles 6a of the traveling devices 5a to 5l are set to the steering angles θ1 to θ12 acquired in the process of S59, and the wheels 6b of the traveling devices 5a to 5l. The rotational speed of each axle 6a is set so that the travel speed becomes the travel speeds V1 to V12 calculated in the process of S60.

以上の図13に示す操舵角自動設定処理によれば、各走行装置5a〜5lの車軸6aに対して操舵角θ1〜θ12を設定する場合に、各車軸6aごとに計算式を用いて各操舵角θ1〜θ12を算出する必要がないため、CPU71に掛かる負担を少なくできる。よって、各操舵角θ1〜θ12の設定を短い周期で実行することができるので、走行経路R上を無人搬送車両1に円滑に走行させられる。   According to the steering angle automatic setting process shown in FIG. 13 described above, when the steering angles θ1 to θ12 are set for the axles 6a of the traveling devices 5a to 5l, each steering is performed using the calculation formula for each axle 6a. Since it is not necessary to calculate the angles θ1 to θ12, the burden on the CPU 71 can be reduced. Therefore, since the setting of each steering angle θ1 to θ12 can be executed in a short cycle, the unmanned transport vehicle 1 can smoothly travel on the travel route R.

例えば、本実施形態に対して、各操舵角θ1〜θ12を算出するための計算式を、各車軸6aごとに予め用意しておき、各走行装置5a〜5lの車軸6aの操舵角θ1〜θ12を設定(補正)する場合に、それらの計算式を用いて各操舵角θ1〜θ12を個別に算出するように構成しておくことも考えられる。   For example, with respect to the present embodiment, a calculation formula for calculating each steering angle θ1 to θ12 is prepared in advance for each axle 6a, and the steering angles θ1 to θ12 of the axle 6a of each traveling device 5a to 5l. It is also conceivable that each of the steering angles θ1 to θ12 is calculated individually using these calculation formulas when setting (correcting).

しかしながら、走行経路R上を無人搬送車両1に円滑に走行させるためには、各車軸6aの操舵角θ1〜θ12を、より短い周期で設定(補正)する必要があるので、計算式を用いて各操舵角θ1〜θ12を個別に算出するように構成すると、その設定(補正)を短い周期で実行できないおそれがある。   However, in order for the automatic guided vehicle 1 to smoothly travel on the travel route R, the steering angles θ1 to θ12 of the respective axles 6a need to be set (corrected) in a shorter cycle. If each steering angle θ1 to θ12 is calculated separately, the setting (correction) may not be executed in a short cycle.

即ち、小型車両のように、無人搬送車両1に設けられている走行装置5の数が少ない場合は、計算式を用いて各操舵角θを算出するように構成していても、算出する操舵角θの数が少ないため、演算量も少なく、演算時間も短い。よって、CPU71に掛かる負担が少ない。しかしながら、本実施形態のように、走行装置5a〜5lの数が多い場合は、計算式により算出する操舵角θ1〜θ12の数が多いため、演算量が多くなり、演算時間も長くなる。よって、CPU71に大きな負担が掛かる。   That is, when the number of traveling devices 5 provided in the automatic guided vehicle 1 is small, such as a small vehicle, even if the steering angle θ is calculated using a calculation formula, the calculated steering is calculated. Since the number of angles θ is small, the amount of calculation is small and the calculation time is short. Therefore, the burden on the CPU 71 is small. However, when the number of the traveling devices 5a to 5l is large as in the present embodiment, the number of steering angles θ1 to θ12 calculated by the calculation formula is large, so that the amount of calculation increases and the calculation time also increases. Therefore, a large burden is imposed on the CPU 71.

従って、走行装置5a〜5lの数が多い場合に、仮に、各車軸6aの操舵角θ1〜θ12を設定(補正)する周期を短くすると、その周期内に演算を終了できず、制御遅れが発生するおそれがある。一方で、その周期を長くすると、制御遅れは発生しないものの、走行経路R上を無人搬送車両1に円滑に走行させられなくなる。尚、演算能力の高いCPUを搭載して、演算時間を短くすることも考えられるが、コストが高くなるため、現実的ではない。また、演算能力の高いCPUは、演算時以外には過剰性能となるため、その性能を無駄にしてしまう。   Accordingly, when the number of the traveling devices 5a to 5l is large, if the cycle for setting (correcting) the steering angles θ1 to θ12 of the axles 6a is shortened, the calculation cannot be completed within the cycle and a control delay occurs. There is a risk. On the other hand, if the period is lengthened, control delay does not occur, but the unmanned transport vehicle 1 cannot be smoothly traveled on the travel route R. Although it may be possible to shorten the calculation time by installing a CPU with high calculation capability, this is not practical because the cost increases. In addition, a CPU having a high computing capacity has an excessive performance other than at the time of computation, so that the performance is wasted.

これに対して、本実施形態では、各走行装置5a〜5lに対して操舵角θ1〜θ12を設定する場合に、操舵角設定テーブル72cから、各操舵角θ1〜θ12を取得している。よって、計算式により各操舵角θ1〜θ12を算出する場合よりも、演算量を少なくできるので、CPU71に掛かる負担を少なくでき、CPU71の演算時間も短くできる。従って、本実施形態のように、走行装置5a〜5lの数が多い場合でも、CPU71に掛かる負担が大きくならず、演算時間も長くならない。故に、各操舵角θ1〜θ12の設定を短い周期で実行することができ、走行経路R上を無人搬送車両1に円滑に走行させられる。   On the other hand, in this embodiment, when the steering angles θ1 to θ12 are set for the traveling devices 5a to 5l, the steering angles θ1 to θ12 are acquired from the steering angle setting table 72c. Therefore, since the amount of calculation can be reduced as compared with the case where the steering angles θ1 to θ12 are calculated by the calculation formula, the burden on the CPU 71 can be reduced and the calculation time of the CPU 71 can be shortened. Therefore, even when the number of the traveling devices 5a to 5l is large as in the present embodiment, the burden on the CPU 71 is not increased and the calculation time is not increased. Therefore, the setting of each steering angle θ1 to θ12 can be executed in a short cycle, and the unmanned transport vehicle 1 can smoothly travel on the travel route R.

また、走行装置5a〜5lの数が多い場合でも、CPU71に掛かる負担が大きくならないため、CPU71の演算能力が高くなくても、制御遅れを発生させずに、各操舵角θ1〜θ12の設定を短い周期で実行することができる。よって、CPU71に汎用のCPUを用いることができ、コストを抑制できる。このように、走行装置5a〜5lの数が多い場合、本発明は特に好適である。   Even when the number of the traveling devices 5a to 5l is large, the burden on the CPU 71 does not increase. Therefore, even if the CPU 71 does not have a high calculation capability, the steering angles θ1 to θ12 can be set without causing a control delay. It can be executed in a short cycle. Therefore, a general-purpose CPU can be used as the CPU 71, and costs can be suppressed. As described above, the present invention is particularly suitable when the number of the traveling devices 5a to 5l is large.

また、本実施形態では、操舵角θ1〜θ12に加えて、走行速度比率Va1〜V12も、操舵角設定テーブル72において、それぞれ予め設定している。これにより、走行速度V1〜V12を算出する場合に、無人搬送車両1が目標とすべき走行速度である基準走行速度Vに対して、各走行速度比率Va1〜Va12を乗算するという簡単な演算だけで、各走行速度V1〜V12を算出できる。そのため、CPU71に掛かる負担が大きくならず、演算時間も長くならない。   In the present embodiment, in addition to the steering angles θ1 to θ12, the travel speed ratios Va1 to V12 are also set in advance in the steering angle setting table 72, respectively. Thus, when calculating the traveling speeds V1 to V12, only a simple calculation of multiplying the respective traveling speed ratios Va1 to Va12 by the reference traveling speed V, which is the traveling speed that the automatic guided vehicle 1 should target. Thus, the traveling speeds V1 to V12 can be calculated. For this reason, the burden on the CPU 71 does not increase and the calculation time does not increase.

よって、各走行速度V1〜V12を算出するための計算式を、各車軸6aごとに予め用意しておき、各走行速度V1〜V12を設定する場合に、それらの計算式を用いて各走行速度V1〜V12を1つずつ算出するように構成したときと比較して、CPU71に掛かる負担を少なくできる。従って、各操舵角θ1〜θ12を設定する場合と同様に、走行装置5a〜5lの数が多い場合でも、各走行速度V1〜V12の設定を短い周期で実行することができ、走行経路R上を無人搬送車両1に円滑に走行させられる。また、CPU71に汎用のCPUを用いることができ、コストを抑制できる。故に、走行装置5a〜5lの数が多い場合、本発明は特に好適である。   Therefore, calculation formulas for calculating the respective traveling speeds V1 to V12 are prepared in advance for the respective axles 6a, and when the respective traveling speeds V1 to V12 are set, the respective traveling speeds are calculated by using those calculating formulas. Compared to the case where V1 to V12 are calculated one by one, the burden on the CPU 71 can be reduced. Therefore, similarly to the case where the steering angles θ1 to θ12 are set, even when the number of the travel devices 5a to 5l is large, the travel speeds V1 to V12 can be set in a short cycle, and the travel route R Can be smoothly driven by the automated guided vehicle 1. Further, a general-purpose CPU can be used as the CPU 71, and costs can be suppressed. Therefore, the present invention is particularly suitable when the number of the traveling devices 5a to 5l is large.

尚、各走行装置5の数が、本実施形態より更に多い場合についても、本実施形態と同様に構成すれば、各走行装置5に対して操舵角θや走行速度Vを設定する場合に、本実施形態と同様に、CPU71に掛かる負担を少なくでき、CPU71の演算時間も短くできる。よって、各車軸6aの操舵角θや、各車輪6bの走行速度Vの設定を短い周期で実行することができ、走行経路R上を無人搬送車両1に円滑に走行させられる。また、CPU71に汎用のCPUを用いることができ、コストを抑制できる。   Even when the number of each traveling device 5 is larger than that in the present embodiment, when the steering angle θ and the traveling speed V are set for each traveling device 5, if configured similarly to the present embodiment, As in the present embodiment, the load on the CPU 71 can be reduced, and the calculation time of the CPU 71 can be shortened. Therefore, the setting of the steering angle θ of each axle 6a and the traveling speed V of each wheel 6b can be executed in a short cycle, and the unmanned transport vehicle 1 can smoothly travel on the traveling route R. Further, a general-purpose CPU can be used as the CPU 71, and costs can be suppressed.

また、上述した操舵角自動設定処理によれば、無人搬送車両1の運転モードが右倣いモードの場合、磁気ガイド検出センサ79b,79dの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1の進行方向が制御される。その結果、右側最前列および右側最終列の走行装置5b,5lに設けられている各車軸6aは、常に、走行経路R上に存在するように制御される。尚、無人搬送車両1の運転モードが左倣いモードの場合についても同様に、左側最前列および左側最終列の走行装置5a,5kに設けられている各車軸6aが、常に、走行経路R上に存在するように制御される。   Further, according to the steering angle automatic setting process described above, when the operation mode of the automatic guided vehicle 1 is the right scanning mode, the automatic guide is set so that the magnetic guide G is placed in the center of the detection units of the magnetic guide detection sensors 79b and 79d. The traveling direction of the vehicle 1 is controlled. As a result, the axles 6a provided in the right frontmost row and right last row travel devices 5b and 5l are controlled so as to always exist on the travel route R. Similarly, when the operation mode of the automated guided vehicle 1 is the left scanning mode, the axles 6a provided in the traveling devices 5a and 5k in the leftmost front row and the leftmost last row are always on the traveling route R. Controlled to exist.

よって、走行経路Rがカーブ、又は、屈折している場合に、無人搬送車両1がそこを通過したとしても、無人搬送車両1の前面周辺および後面周辺は共に走行経路R上に存在することとなり、無人搬送車両1の前面および後面のうち、進行方向と反対側の面が走行経路R上から外れて、その進行方向と反対側の面が、左右に振れることを防止できる。従って、走行経路Rの周辺を通行する歩行者などに対する安全性を高められる。   Therefore, when the travel route R is curved or refracted, even if the unmanned transport vehicle 1 passes there, both the front and rear periphery of the unmanned transport vehicle 1 exist on the travel route R. Of the front and rear surfaces of the automated guided vehicle 1, it is possible to prevent the surface on the opposite side to the traveling direction from moving out of the travel route R, and the surface on the opposite side to the traveling direction from swinging left and right. Therefore, the safety for a pedestrian or the like traveling around the travel route R can be improved.

また、本実施形態では、前側操舵角θf、及び、後側操舵角θbの2つの基準操舵角を基準にして、操舵角設定テーブル72cを構成している。尚、基準操舵角を3つ以上設けて、無人搬送車両1の各車軸6aの操舵角θ1〜θ12を設定し、操舵角設定テーブル72cを構成しても良い。   In the present embodiment, the steering angle setting table 72c is configured based on two reference steering angles, that is, the front steering angle θf and the rear steering angle θb. The steering angle setting table 72c may be configured by providing three or more reference steering angles and setting the steering angles θ1 to θ12 of each axle 6a of the automatic guided vehicle 1.

以上、実施形態に基づき本発明を説明したが、本発明は上記実施形態に何ら限定されるものではなく、本発明の趣旨を逸脱しない範囲内で種々の改良変更が可能であることは容易に推察できるものである。   As described above, the present invention has been described based on the embodiment, but the present invention is not limited to the above embodiment, and various modifications and changes can be easily made without departing from the gist of the present invention. It can be guessed.

例えば、上記実施形態で挙げた具体的数値は一例であり、他の数値を採用することは当然可能である。   For example, the specific numerical values given in the above embodiment are merely examples, and other numerical values can naturally be adopted.

また、上記実施形態では、磁気ガイド検出センサ79a〜79dの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させる場合の走行装置5a,5bの操舵角を前側操舵角θfとし、走行装置5k,5lの操舵角を後側操舵角θbしている。しかしながら、磁気ガイド検出センサ79a〜79dの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させることが可能であれば、どの走行装置5a〜5lの操舵角を、前側操舵角θfや、後側操舵角θbとしても良い。   Further, in the above embodiment, the steering angle of the traveling devices 5a and 5b when the automatic guided vehicle 1 is driven so that the magnetic guide G is accommodated in the center of the detection units of the magnetic guide detection sensors 79a to 79d is the front steering angle θf. The steering angle of the traveling devices 5k and 5l is the rear steering angle θb. However, as long as it is possible to run the automatic guided vehicle 1 so that the magnetic guide G fits in the center of the detection units of the magnetic guide detection sensors 79a to 79d, the steering angle of which traveling device 5a to 5l is set to the front side steering. The angle θf or the rear steering angle θb may be used.

また、上記実施形態では、磁気ガイド検出センサ79a〜79dを、走行装置5a,5b,5k、5lに設置しているが、磁気ガイドGを検出可能な場所であれば、無人搬送車両1のどこに設置しても良い。尚、この場合も、磁気ガイド検出センサ79a〜79dの検出部の中央に磁気ガイドGが収まるように、無人搬送車両1を走行させることが可能であれば、どの走行装置5a〜5lの操舵角を、前側操舵角θfや、後側操舵角θbとしても良い。   Moreover, in the said embodiment, although the magnetic guide detection sensors 79a-79d are installed in the travel apparatuses 5a, 5b, 5k, 5l, if it is a place where the magnetic guide G can be detected, anywhere in the automatic guided vehicle 1 May be installed. Also in this case, as long as the automatic guided vehicle 1 can be traveled so that the magnetic guide G fits in the center of the detection part of the magnetic guide detection sensors 79a to 79d, the steering angle of any travel device 5a to 5l. May be the front steering angle θf or the rear steering angle θb.

また、上記実施形態の操舵角設定テーブル72cは、磁気ガイド検出センサ79a〜79dの検出結果に基づいて算出される前側操舵角θfおよび後側操舵角θbに対して、操舵角θ1〜θ12と、走行速度比率Va1〜Va12とを対応付けたテーブルであるが、磁気ガイド検出センサ79a〜79dの検出結果に対して、操舵角θ1〜θ12と、走行速度比率Va1〜Va12とを対応付けたテーブルとしても良い。これにより、制御装置70において操舵角設定テーブル72cを用いる場合に、磁気ガイド検出センサ79a〜79dの検出結果そのものを用いて、操舵角θ1〜θ12と、走行速度比率Va1〜Va12を取得できるので、前側操舵角θfおよび後側操舵角θbを算出する手間を省ける。よって、制御装置70に掛かる負担を軽減できる。   In addition, the steering angle setting table 72c of the above embodiment includes steering angles θ1 to θ12 with respect to the front steering angle θf and the rear steering angle θb calculated based on the detection results of the magnetic guide detection sensors 79a to 79d. Although it is a table in which the travel speed ratios Va1 to Va12 are associated with each other, as a table in which the steering angles θ1 to θ12 and the travel speed ratios Va1 to Va12 are associated with the detection results of the magnetic guide detection sensors 79a to 79d. Also good. Thus, when the steering angle setting table 72c is used in the control device 70, the steering angles θ1 to θ12 and the traveling speed ratios Va1 to Va12 can be acquired using the detection results themselves of the magnetic guide detection sensors 79a to 79d. This saves the trouble of calculating the front steering angle θf and the rear steering angle θb. Therefore, the burden placed on the control device 70 can be reduced.

また、上記実施形態では、前側操舵角θfおよび後側操舵角θbの2つの操舵角θf,θbを基準として、操舵角設定テーブル72cを作成しているが、前側操舵角θfおよび後側操舵角θbの一方と、無人搬送車両1の旋回半径Rとを基準として、操舵角設定テーブル72cを作成しても良い。尚、この場合には、旋回半径Rの範囲(例えば、5〜20m)を予め定めておき、所定ピッチ(例えば、0.2m単位)ごとに、旋回半径Rを設定して、操舵角θf,θbの一方と、旋回半径Rとを漏れなく組み合わせたテーブル72cを作成する。   In the above embodiment, the steering angle setting table 72c is created based on the two steering angles θf and θb of the front steering angle θf and the rear steering angle θb. However, the front steering angle θf and the rear steering angle are generated. The steering angle setting table 72c may be created on the basis of one of θb and the turning radius R of the automatic guided vehicle 1. In this case, a range (for example, 5 to 20 m) of the turning radius R is determined in advance, the turning radius R is set for each predetermined pitch (for example, 0.2 m unit), and the steering angle θf, A table 72c is created in which one of θb and the turning radius R are combined without omission.

また、上記実施形態の操舵角設定テーブル72cでは、前側操舵角θfおよび後側操舵角θbごとに、基準走行速度Vに対する走行速度比率Va1〜Va12を記憶しているが、走行速度比率Va1〜Va12に替えて、基準走行速度Vに対応する走行速度V1〜V12を記憶しておくように構成しても良い。   In the steering angle setting table 72c of the above embodiment, the traveling speed ratios Va1 to Va12 with respect to the reference traveling speed V are stored for each of the front side steering angle θf and the rear side steering angle θb, but the traveling speed ratios Va1 to Va12 are stored. Instead of this, the traveling speeds V1 to V12 corresponding to the reference traveling speed V may be stored.

また、上記実施形態では、上位プロコンから無人搬送車両1に対して、1回の行先指令により、ステーションCが3つ単位で通知されるように構成されているが、1回の行先指令により、任意の数のステーションCが通知される場合でも、行先指令毎に、通知されるステーションCの数が変わる場合でも、当然、本発明を適用できる。   Moreover, in the said embodiment, although it is comprised so that the station C may be notified by 3 units | sets by one destination command with respect to the automatic guided vehicle 1 from a high-order process computer, by one destination command, Even when an arbitrary number of stations C are notified or even when the number of notified stations C changes for each destination command, the present invention can naturally be applied.

また、上記実施形態では、自動運転処理(図8参照)、動作コマンド設定処理(図9参照)、及び、操舵角自動設定処理(図13参照)を繰り返し実行するように構成しているが、各処理を定期的(例えば、5ms毎)に実行するように構成しても良い。   In the above embodiment, the automatic driving process (see FIG. 8), the operation command setting process (see FIG. 9), and the steering angle automatic setting process (see FIG. 13) are repeatedly executed. You may comprise so that each process may be performed regularly (for example, every 5 ms).

また、上記実施形態では、本発明を無人搬送車両1に適用した形態について説明したが、有人無人に関わらず、行先指令に基づいて操舵を制御するように構成された搬送車両であれば本発明を適用できる。
<その他>
<手段>
技術的思想1記載の操舵制御装置は、複数の車軸を有する搬送車両が走行経路に沿って進行するように、前記複数の車軸の各操舵角を前記車軸ごとに制御するものであって、前記搬送車両の進行方向を制御するための制御角を算出する制御角算出手段と、その制御角算出段により算出される制御角に応じた方向へ前記搬送車両を進行させる前記複数の車軸の各操舵角を、その制御角ごとに予め記憶しておく操舵角記憶手段と、その操舵角記憶手段から前記制御角算出手段により算出された制御角に対応する前記複数の車軸の各操舵角を取得する操舵角取得手段と、その操舵角取得手段により取得された前記複数の車軸の各操舵角を、前記複数の車軸に対して設定する操舵角設定手段とを備えている。
技術的思想2記載の操舵制御装置は、技術的思想1記載の操舵制御装置において、前記搬送車両の目標走行速度を取得する目標速度取得手段と、前記目標走行速度に対する走行速度比であって、前記複数の車軸の各操舵角に応じて定まる前記複数の車軸の各走行速度比を、前記制御角ごとに予め記憶しておく走行速度比記憶手段と、その走行速度比記憶手段から前記制御角算出手段により算出された制御角に対応する前記複数の車軸の各走行速度比を取得する走行速度比取得手段と、その走行速度比取得手段により取得された各走行速度比と、前記目標速度取得手段により取得された目標走行速度とに基づいて、前記複数の車軸の各走行速度を算出する走行速度算出手段と、その走行速度算出手段により算出された前記複数の車軸の各走行速度を、前記複数の車軸に対して設定する走行速度設定手段とを備えている。
技術的思想3記載の操舵制御装置は、技術的思想1または2記載の操舵制御装置において、前記複数の車軸のうち前記搬送車両の前方側および後方側に配設された2つの車軸の位置と前記走行経路との位置ずれを検出する位置検出手段を備え、前記制御角算出手段は、前記位置検出手段により検出される位置ずれを前記搬送車両の進行に伴って減少させる制御角を算出するものである。

<効果>
技術的思想1記載の操舵制御装置によれば、搬送車両の進行方向を制御するための制御角ごとに、その制御角に応じた方向へ搬送車両を進行させる複数の車軸の各操舵角が予め操舵角記憶手段に記憶される。そして、制御角算出手段により制御角が算出されると、その制御角に対応する複数の車軸の各操舵角が、操舵角記憶手段から操舵角取得手段により取得され、その取得された複数の車軸の各操舵角が、複数の車軸に対して操舵角設定手段により設定される。よって、複数の車軸に対して操舵角を設定する場合に、複数の車軸の各車軸ごとに、その操舵角を計算式などにより算出しなくて良く、単に、制御角に対応するものを操舵角記憶手段から取得すれば良いので、各操舵角を短時間で得られる。従って、搬送車両に多数の車軸が設けられている場合でも、その多数の車軸に設定する各操舵角を短時間で得られるので、多数の車軸に対して操舵角を短い時間間隔で設定できる。故に、搬送車両を走行経路に沿って円滑に走行させることができるという効果がある。
技術的思想2記載の操舵制御装置によれば、技術的思想1記載の操舵制御装置の奏する効果に加え、次の効果を奏する。即ち、搬送車両の目標走行速度に対する走行速度比であって、複数の車軸の各操舵角に応じて定まる複数の車軸の各走行速度比が、制御角ごとに予め走行速度比記憶手段に記憶される。そして、搬送車両の目標走行速度が目標速度取得手段により取得され、制御角算出手段により算出された制御角に対応する複数の車軸の各走行速度比が、走行速度比記憶手段から走行速度比取得手段により取得されると、その各走行速度比と、その目標走行速度とに基づいて、複数の車軸の各走行速度が走行速度算出手段により算出される。すると、その算出された複数の車軸の各走行速度が、複数の車軸に対して走行速度設定手段により設定される。よって、制御角が決まれば、その制御角に対応する複数の車軸の各走行速度比を取得することができ、その取得する各走行速度比に対して目標走行速度を乗算するという簡単な演算で、複数の車軸に設定する各走行速度を算出できる。従って、搬送車両に多数の車軸が設けられている場合でも、その多数の車軸に設定する各走行速度を短時間に得られるので、多数の車軸に対して走行速度を短い時間間隔で設定できる。故に、多数の車軸間で走行速度の釣り合いが取れなくなることを抑制できるので、搬送車両をより円滑に走行させることができるという効果がある。
技術的思想3記載の操舵制御装置によれば、技術的思想1または2記載の操舵制御装置の奏する効果に加え、次の効果を奏する。即ち、前方側および後方側に配設された2つの車軸の位置と走行経路との位置ずれが位置検出手段により検出され、制御角算出手段では、位置検出手段により検出される位置ずれを搬送車両の進行に伴って減少させる制御角が算出される。その結果、その算出された制御角に対応する複数の車軸の各操舵角が操舵角取得手段により取得され、その取得された各操舵角が操舵角設定手段により複数の車軸に対して設定される。よって、搬送車両の前方側および後方側に配設された2つの車軸の位置が共に、走行経路に対して位置ずれしなくなるように、即ち、走行経路上に存在し続けるように搬送車両の進行方向を設定できる。従って、走行経路がカーブ、又は、屈折している場合においても、搬送車両の前方側や後方側が、走行経路上から外れることを抑制できるので、走行経路の周辺を通行する歩行者などに対する安全性を高められるという効果がある。
Moreover, although the said embodiment demonstrated the form which applied this invention to the unmanned conveyance vehicle 1, if it is a conveyance vehicle comprised so that steering might be controlled based on a destination command irrespective of manned unmanned, this invention. Can be applied.
<Others>
<Means>
The steering control device according to the technical idea 1 controls each steering angle of the plurality of axles for each axle so that a transport vehicle having a plurality of axles travels along a travel route. Control angle calculating means for calculating a control angle for controlling the traveling direction of the transport vehicle, and each steering of the plurality of axles for propelling the transport vehicle in a direction according to the control angle calculated by the control angle calculation stage Steering angle storage means for storing the angle for each control angle in advance, and each steering angle of the plurality of axles corresponding to the control angle calculated by the control angle calculation means is acquired from the steering angle storage means. Steering angle acquisition means, and steering angle setting means for setting each steering angle of the plurality of axles acquired by the steering angle acquisition means for the plurality of axles.
The steering control device described in the technical idea 2 is the steering control device described in the technical idea 1, in which a target speed acquisition unit that acquires a target travel speed of the transport vehicle and a travel speed ratio with respect to the target travel speed, Travel speed ratio storage means for storing each travel speed ratio of the plurality of axles determined according to each steering angle of the plurality of axles in advance for each control angle, and the control angle from the travel speed ratio storage means Travel speed ratio acquisition means for acquiring each travel speed ratio of the plurality of axles corresponding to the control angle calculated by the calculation means, each travel speed ratio acquired by the travel speed ratio acquisition means, and the target speed acquisition Travel speed calculation means for calculating the travel speeds of the plurality of axles based on the target travel speed obtained by the means, and the travel speeds of the plurality of axles calculated by the travel speed calculation means. The, and a traveling speed setting means for setting to the plurality of axles.
The steering control device described in the technical idea 3 is the steering control device described in the technical idea 1 or 2, in which the positions of two axles disposed on the front side and the rear side of the transport vehicle among the plurality of axles. Position detecting means for detecting a position deviation with respect to the travel route, and the control angle calculating means calculates a control angle for reducing the position deviation detected by the position detecting means as the conveyance vehicle advances. It is.

<Effect>
According to the steering control device described in the technical idea 1, for each control angle for controlling the traveling direction of the transport vehicle, each steering angle of the plurality of axles that advance the transport vehicle in a direction according to the control angle is determined in advance. Stored in the steering angle storage means. Then, when the control angle is calculated by the control angle calculation means, the respective steering angles of the plurality of axles corresponding to the control angle are acquired from the steering angle storage means by the steering angle acquisition means, and the acquired plurality of axles These steering angles are set by the steering angle setting means for a plurality of axles. Therefore, when setting the steering angle for a plurality of axles, it is not necessary to calculate the steering angle for each axle of the plurality of axles by a calculation formula or the like. Since it suffices to obtain it from the storage means, each steering angle can be obtained in a short time. Therefore, even when a large number of axles are provided on the transport vehicle, the steering angles set for the many axles can be obtained in a short time, so that the steering angles can be set for many axles at short time intervals. Therefore, there is an effect that the transport vehicle can smoothly travel along the travel route.
According to the steering control device described in the technical idea 2, in addition to the effects exhibited by the steering control device described in the technical idea 1, the following effects can be obtained. That is, the traveling speed ratio of the plurality of axles, which is the traveling speed ratio with respect to the target traveling speed of the transport vehicle and determined according to the respective steering angles of the plurality of axles, is stored in advance in the traveling speed ratio storage unit for each control angle. The Then, the target travel speed of the transport vehicle is acquired by the target speed acquisition means, and the respective travel speed ratios of the plurality of axles corresponding to the control angles calculated by the control angle calculation means are acquired from the travel speed ratio storage means. When acquired by the means, the respective traveling speeds of the plurality of axles are calculated by the traveling speed calculating means based on the respective traveling speed ratios and the target traveling speed. Then, the calculated traveling speeds of the plurality of axles are set by the traveling speed setting means for the plurality of axles. Therefore, once the control angle is determined, it is possible to acquire the respective travel speed ratios of the plurality of axles corresponding to the control angle, and simply calculate by multiplying each acquired travel speed ratio by the target travel speed. Each traveling speed set for a plurality of axles can be calculated. Accordingly, even when a large number of axles are provided on the transport vehicle, the traveling speeds set for the large number of axles can be obtained in a short time, so that the traveling speeds can be set for a large number of axles at short time intervals. Therefore, since it is possible to prevent the traveling speed from being balanced between a large number of axles, there is an effect that the transport vehicle can be driven more smoothly.
According to the steering control device described in the technical idea 3, in addition to the effects exhibited by the steering control device described in the technical idea 1 or 2, the following effects can be obtained. That is, the position deviation between the position of the two axles arranged on the front side and the rear side and the travel route is detected by the position detection means, and the control angle calculation means detects the position deviation detected by the position detection means. A control angle to be reduced as the process proceeds is calculated. As a result, the steering angles of the plurality of axles corresponding to the calculated control angles are acquired by the steering angle acquisition means, and the acquired steering angles are set for the plurality of axles by the steering angle setting means. . Therefore, the traveling vehicle travels so that the positions of the two axles arranged on the front side and the rear side of the transportation vehicle are not shifted from each other with respect to the traveling route, that is, continue to exist on the traveling route. You can set the direction. Therefore, even when the travel route is curved or refracted, it is possible to prevent the front side and the rear side of the transport vehicle from being deviated from the travel route. There is an effect that can be improved.

1 無人搬送車両(搬送車両)
3 シャーシ
6a 車軸
70 制御装置(操舵制御装置)
72c 操舵角設定テーブル(操舵角記憶手段、走行速度比記憶手段)
79a〜79d 磁気ガイド検出センサ(検出手段)
S52 目標速度取得手段
S56,S57 第1偏差算出手段、第2偏差算出手段
S58 第1操舵角算出手段、第2操舵角算出手段
S59 制御角取得手段、走行速度比取得手段
S60 走行速度算出手段
S61 操舵角制御手段、走行速度制御手段
G 磁気ガイド(誘導体)
R 走行経路
1 Automated guided vehicle (transported vehicle)
3 Chassis 6a Axle 70 Control device (steering control device)
72c Steering angle setting table (steering angle storage means, travel speed ratio storage means)
79a to 79d Magnetic guide detection sensor (detection means)
S52 target speed acquisition means S56, S57 first deviation calculation means, second deviation calculation means S58 first steering angle calculation means, second steering angle calculation means S59 control angle acquisition means, travel speed ratio acquisition means S60 travel speed calculation means S61 Steering angle control means, traveling speed control means G Magnetic guide (derivative)
R Travel route

Claims (3)

シャーシと、そのシャーシの長手方向に設けられる3以上の車軸と、その3以上の車軸のうち少なくとも第1車軸と第2車軸とにそれぞれ1ずつ設けられ走行経路に敷設された誘導体を検出する2以上の検出手段とを備える搬送車両に対し、前記検出手段の検出信号に基づいて搬送車両が走行経路に沿って進行するように、前記3以上の車軸の各操舵角を前記車軸ごとに制御する操舵制御装置であって、
前記第1車軸に設けられる前記検出手段の検出信号に基づいて、その検出手段と前記走行経路との位置ずれを示す第1偏差を算出する第1偏差算出手段と、
その第1偏差算出手段によって算出される第1偏差に応じて、その第1偏差を減少させる前記第1車軸の第1操舵角を算出する第1操舵角算出手段と、
前記第2車軸に設けられる前記検出手段の検出結果に基づいて、その検出手段と前記走行経路との位置ずれを示す第2偏差を算出する第2偏差算出手段と、
その第2偏差算出手段によって算出される第2偏差に応じて、その第2偏差を減少させる前記第2車軸の第2操舵角を算出する第2操舵角算出手段と、
前記第1操舵角算出手段によって算出される第1操舵角と前記第2操舵角算出手段によって算出される第2操舵角とに対応付けて、前記車軸の各操舵角を、予め算出された定数で記憶する操舵角記憶手段と、
前記第1操舵角算出手段によって第1操舵角が、前記第2操舵角算出手段によって第2操舵角が算出された場合に、その第1操舵角と第2操舵角とに対応付けて前記操舵角記憶手段に記憶された前記車軸の各操舵角を取得する操舵角取得手段と、
その操舵角取得手段により取得された前記車軸の各操舵角で、前記車軸の各々を制御する操舵角制御手段とを備えていることを特徴とする操舵制御装置。
A chassis, three or more axles provided in the longitudinal direction of the chassis, and one of the three or more axles, each of which is provided on at least a first axle and a second axle and detects a derivative laid on a travel route 2 The steering angle of each of the three or more axles is controlled for each of the axles so that the transporting vehicle travels along the travel path based on the detection signal of the detecting means for the transporting vehicle provided with the above detecting means. A steering control device,
First deviation calculating means for calculating a first deviation indicating a positional deviation between the detecting means and the travel route based on a detection signal of the detecting means provided on the first axle;
First steering angle calculating means for calculating a first steering angle of the first axle for reducing the first deviation according to the first deviation calculated by the first deviation calculating means;
A second deviation calculating means for calculating a second deviation indicating a positional deviation between the detecting means and the travel route based on a detection result of the detecting means provided on the second axle;
Second steering angle calculating means for calculating a second steering angle of the second axle for reducing the second deviation according to the second deviation calculated by the second deviation calculating means;
In association with the second steering angle calculated by the first steering angle and the second steering angle calculating means is calculated by the first steering angle calculating means, each steering angle of the axle, which is calculated in advance constants Steering angle storage means for storing
When the first steering angle is calculated by the first steering angle calculation means and the second steering angle is calculated by the second steering angle calculation means, the steering is associated with the first steering angle and the second steering angle. a steering angle acquisition unit that acquires the steering angle of the axle, which is stored in the angular storage means,
A steering control device comprising: steering angle control means for controlling each of the axles at each steering angle of the axle acquired by the steering angle acquisition means.
前記搬送車両の目標走行速度を取得する目標速度取得手段と、
前記目標走行速度に対する走行速度比であって、前記車軸の各操舵角に応じて定まる前記車軸の各走行速度比を、前記操舵角記憶手段に記憶される前記車軸の各操舵角に対応つけて、予め算出された定数で記憶する走行速度比記憶手段と、
前記操舵角取得手段によって前記車軸の各操舵角を取得する場合に、かかる車軸の各操舵角と対応つけて前記走行速度比記憶手段に記憶された各走行速度比を取得する走行速度比取得手段と、
その走行速度比取得手段により取得された各走行速度比と、前記目標速度取得手段により取得された目標走行速度とに基づいて、前記車軸の各走行速度を算出する走行速度算出手段と、
その走行速度算出手段により算出された各走行速度で前記車軸の各々を制御する走行速度制御手段とを備えていることを特徴とする請求項1記載の操舵制御装置。
Target speed acquisition means for acquiring the target travel speed of the transport vehicle;
A travel speed ratio to said target running speed, each speed ratio of the axles determined according to the steering angle of the wheel shaft, in association with each steering angle of the axle to be stored in the steering angle storage means A traveling speed ratio storing means for storing a constant calculated in advance;
Wherein when the steering angle acquisition unit acquires the steering angle of the axle, the traveling speed ratio acquisition for acquiring the traveling speed ratios stored in the traveling speed ratio storage means put the steering angle and the correspondence between such axle Means,
Travel speed calculation means for calculating each travel speed of the axle based on each travel speed ratio acquired by the travel speed ratio acquisition means and the target travel speed acquired by the target speed acquisition means;
The steering control device according to claim 1, further comprising a travel speed control means for controlling each of the axles at each travel speed calculated by the travel speed calculation means.
前記第1車軸は前記シャーシの長手方向の一端側に、前記第2車軸は前記シャーシの長手方向の他端側に設けられることを特徴とする請求項1又は2に記載の操舵制御装置。   The steering control device according to claim 1 or 2, wherein the first axle is provided on one end side in the longitudinal direction of the chassis, and the second axle is provided on the other end side in the longitudinal direction of the chassis.
JP2011040826A 2011-02-25 2011-02-25 Steering control device Active JP5806823B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2011040826A JP5806823B2 (en) 2011-02-25 2011-02-25 Steering control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011040826A JP5806823B2 (en) 2011-02-25 2011-02-25 Steering control device

Publications (2)

Publication Number Publication Date
JP2012178055A JP2012178055A (en) 2012-09-13
JP5806823B2 true JP5806823B2 (en) 2015-11-10

Family

ID=46979853

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011040826A Active JP5806823B2 (en) 2011-02-25 2011-02-25 Steering control device

Country Status (1)

Country Link
JP (1) JP5806823B2 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7247865B2 (en) * 2019-11-25 2023-03-29 トヨタ自動車株式会社 TRANSPORT CONTROL SYSTEM, TRANSPORT CONTROL PROGRAM AND TRANSPORT CONTROL METHOD
JPWO2021153031A1 (en) * 2020-01-31 2021-08-05

Also Published As

Publication number Publication date
JP2012178055A (en) 2012-09-13

Similar Documents

Publication Publication Date Title
CN102189992B (en) Method for setting basis following position and system for lane-keeping control
US20230050192A1 (en) Global Multi-Vehicle Decision Making System for Connected and Automated Vehicles in Dynamic Environment
JP6599543B2 (en) Automated guided vehicle
US8761989B1 (en) Method of material handling with automatic guided vehicles
US20210016780A1 (en) Controlling an autonomous vehicle based upon computed lane boundaries
CN112000113A (en) Multi-AGV storage management system and method based on traditional Chinese medicine pharmacy
JP5806823B2 (en) Steering control device
CN101346602A (en) Vehicle positioning information update device
KR19990029506A (en) Method and system for controlling the movement of automatic guided vehicle
CN113184423B (en) Control method of automatic guided vehicle, automatic guided vehicle and cargo handling system
US10684135B2 (en) Method for updating an electronic card of a vehicle
CN105774801A (en) Method and equipment for guiding a vehicle on a lane
JP5753704B2 (en) Travel data generator
EP3239657B1 (en) Information processing device
CN110154787A (en) A kind of Twin Rudders wheel automatic guided vehicle and its control method
WO2020137520A1 (en) Crane control system and control method
JP2007328486A (en) Moving robot
WO2004108347A1 (en) Assembling system, assembling unit, layout arranging system and layout arranging method
JPH06187032A (en) Marker for mobile robot and information detector and traveling controller
CN112859826A (en) Method and apparatus for controlling an automated guided vehicle
TW202034104A (en) Guided vehicle control system and method
CN115214775A (en) Method, device, equipment and medium for adjusting steering wheel neutral position
JP4694599B2 (en) Unmanned vehicle
KR20130122272A (en) Method for setting driving path of robot and system driving path of robot using rfid
JPWO2007043120A1 (en) Transport route determination device, transport route determination method, and transport route determination program

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20131224

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20140924

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20140926

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20141121

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20150428

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20150611

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20150907

R150 Certificate of patent or registration of utility model

Ref document number: 5806823

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250