JP5753704B2 - Travel data generator - Google Patents

Travel data generator Download PDF

Info

Publication number
JP5753704B2
JP5753704B2 JP2011040825A JP2011040825A JP5753704B2 JP 5753704 B2 JP5753704 B2 JP 5753704B2 JP 2011040825 A JP2011040825 A JP 2011040825A JP 2011040825 A JP2011040825 A JP 2011040825A JP 5753704 B2 JP5753704 B2 JP 5753704B2
Authority
JP
Japan
Prior art keywords
station
data
guided vehicle
automatic guided
stations
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
JP2011040825A
Other languages
Japanese (ja)
Other versions
JP2012178054A (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 JP2011040825A priority Critical patent/JP5753704B2/en
Publication of JP2012178054A publication Critical patent/JP2012178054A/en
Application granted granted Critical
Publication of JP5753704B2 publication Critical patent/JP5753704B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

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

Description

本発明は、走行データ生成装置に関し、特に、ステーションの総数が多い場合でも、走行データを生成するために予め記憶手段に記憶しておくデータ量を抑制できる走行データ生成装置に関するものである。   The present invention relates to a travel data generation device, and more particularly to a travel data generation device that can suppress the amount of data stored in a storage unit in advance in order to generate travel data even when the total number of stations is large.

従来より、工場内などでは、荷物の搬送の効率化や省力化を図るために、無人搬送車両によって荷物の搬送が行われている。例えば、工場内などには、無人搬送車両に対して荷物の積み降ろしが行われる位置や、無人搬送車両が別の無人搬送車両の通過を待つ位置や、無人搬送車両が走行経路上にある自動シャッタや自動扉の開放を待つ位置など(以下、「ステーション」と称す)が予め複数箇所設置され、それらのステーションを無人搬送車両が循環できるように走行経路が設けられる。無人搬送車両は、走行経路上を走行して、荷物の積載を指示されたステーションへ向かい、そこで荷物を積載した後、引き続き走行経路上を走行して、荷物の搬送先となるステーションまで走行する。一般的に、荷物の積み降ろしを行うタイミングや、荷物の積み降ろしが行われるステーションは、工場の稼働状況に応じて変化する。そのため、無人搬送車両は、無人搬送車両の配車等を管理する基地局(例えば、上位プロコン)からの指令に基づいて走行するように構成されている。基地局からの指令が無人搬送車両において受信されると、その指令に応じた走行経路を走行するための走行データが、無人搬送車両に搭載された走行データ生成装置によって生成される。   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. For example, in a factory, a position where an unmanned transport vehicle is loaded and unloaded, a position where an unmanned transport vehicle waits for another unmanned transport vehicle, or an automatic transport vehicle that is on a travel route A plurality of positions (hereinafter referred to as “stations”) for waiting for the shutters and automatic doors to be opened are installed in advance, and a travel route is provided so that the automatic guided vehicle can circulate through these stations. The automated guided vehicle travels on the travel route and heads to the station where the loading of the package is instructed. After loading the load there, the unmanned transport vehicle continues to travel on the travel route and travels to the station where the package is transported. . In general, the timing of loading / unloading of luggage and the station for loading / unloading of luggage vary depending on the operation status of the factory. Therefore, the automatic guided vehicle is configured to travel based on a command from a base station (for example, a host computer) that manages the allocation of the automatic guided vehicle. When a command from the base station is received by the unmanned transport vehicle, travel data for traveling on a travel route corresponding to the command is generated by a travel data generation device mounted on the unmanned transport vehicle.

この種の走行データ生成装置に関し、次の特許文献1には、出発元のステーションから到着先のステーションまでの一連の走行経路を無人搬送車両に走行させるために必要な走行データを、出発元および到着先の2つのステーション毎に、予め記憶手段に記憶しておき、出発元および到着先の2つのステーションが基地局から指示された場合に、その指示された2つのステーションに対応する走行データを記憶手段から取得する技術が開示されている。   With respect to this type of travel data generation device, the following Patent Document 1 describes travel data necessary for causing an unmanned transport vehicle to travel a series of travel routes from a departure station to an arrival station. For each two destination stations, store in advance in the storage means, and when the departure and arrival destination stations are instructed by the base station, the travel data corresponding to the instructed two stations is stored. A technique for acquiring from storage means is disclosed.

特開平01−017108号公報(64頁左下、65頁左上など)JP-A-01-017108 (lower left of page 64, upper left of page 65, etc.)

しかしながら、出発元および到着先の2つのステーション毎に、その2つのステーション間を走行するための走行データを予め記憶手段に記憶しておく構成だと、新たなステーションを1つ増やすだけで、新たなステーションを出発元とし、既存の各ステーションを到着先とする2つのステーション群と、既存の各ステーションを出発元とし、新たなステーションを到着先とする2つのステーション群とが、出発元および到着先の2つのステーションとして増える。そのため、ステーションの総数が多くなると、出発元および到着先の2つのステーションの数が膨大となり、それに伴って、多数の走行データを予め記憶手段に記憶しなければならず、予め記憶手段に記憶しておく走行データの量が増大してしまうという問題点があった。   However, if the travel data for traveling between the two stations is stored in the storage means in advance for every two stations of the departure and arrival destinations, a new station can be added by adding one new station. The two stations that originate from the existing station and arrive at each existing station, and the two stations that originate from each existing station and arrive at the new station. It will increase as the previous two stations. For this reason, when the total number of stations increases, the number of departure and arrival stations becomes enormous, and accordingly, a large amount of travel data must be stored in the storage means in advance and stored in the storage means in advance. There was a problem that the amount of traveling data to be kept increased.

本発明は、上述した問題点を解決するためになされたものであり、ステーションの総数が多い場合でも、走行データを生成するために予め記憶手段に記憶しておくデータ量を抑制できる走行データ生成装置を提供することを目的としている。   The present invention has been made to solve the above-described problems, and even when the total number of stations is large, travel data generation that can suppress the amount of data stored in the storage means in advance in order to generate travel data. The object is to provide a device.

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

請求項1記載の走行データ生成装置によれば、次の効果を奏する。即ち、無人搬送車両が走行する走行経路に敷設された誘導体上に所定間隔毎に設けられる複数のステーションのうち、無人搬送車両に経由させるステーションが順番に指示される行先指令が取得手段によって取得されると、その行先指令に基づいて無人搬送車両の走行データが生成される。出発データ記憶手段には、複数のステーションの一つである現在ステーションと対応付けられ、その現在ステーションから、その現在ステーションに対して無人搬送車両の進行方向下流側に隣設されるステーションである次回ステーションに向けて無人搬送車両を出発させる出発データが、複数のステーションの各々を現在ステーションとした場合についてそれぞれ記憶される。また、到着データ記憶手段には、現在ステーションと対応付けられ、その現在ステーションに対して無人搬送車両の進行方向上流側に隣設されるステーションである前回ステーションから現在ステーションに向けて走行してくる無人搬送車両を現在ステーションで停止させる到着データが、複数のステーションの各々を現在ステーションとした場合についてそれぞれ記憶される。更に、通過データ記憶手段には、現在ステーションと対応付けられ、前回ステーションから現在ステーションに向けて走行してくる無人搬送車両を、現在ステーションで停止させずに通過させ次回ステーションに向けて走行させる通過データが、複数のステーションの各々を現在ステーションとした場合についてそれぞれ記憶される。そして、取得手段によって行先指令が取得されると、その行先指令に基づいて、出発データ記憶手段に記憶される一の出発データと、到着データ記憶手段に記憶される一の到着データと、通過データ記憶手段に記憶される少なくとも一以上の通過データとを組み合わせた走行データが走行データ生成手段によって生成される。
よって、各ステーションを無人搬送車両を出発させる出発ステーション、無人搬送車両を到着させる到着ステーション、無人搬送車両を停止させずに通過させる通過ステーションの何れのステーションにも設定でき、全走行パターンの各々に対応した走行データを個別に記憶させる場合より消費される記憶容量を抑制できる。従って、無人搬送車両を走行させる走行パターンの自由度を確保しつつ、消費される記憶容量を抑制できるという効果がある。
また、その生成された一の走行データに従って無人搬送車両が走行している間に、取得手段によって新たな行先指令が取得されると、その新たに取得した行先指令に基づいて、一の走行データに組み合わせられた一の到着データが、通過データ記憶手段に記憶される一の通過データに走行データ変更手段によって変更される。よって、無人搬送車両が走行中(停止する前)であれば、到着ステーションを変更できるので、無人搬送車両の走行経路や行先を自由に変更できる。従って、無人搬送車両の走行経路の状況などの外的要因に合わせて、無人搬送車両を効率良く運行させることができるという効果がある。
According to the travel data generating device of the first aspect , the following effects can be obtained. That is, a destination command that sequentially instructs a station to be routed through the automatic guided vehicle among a plurality of stations provided at predetermined intervals on a derivative laid on a travel route on which the automatic guided vehicle travels is acquired by the acquisition unit. Then, traveling data of the automated guided vehicle is generated based on the destination command. The departure data storage means is associated with the current station, which is one of a plurality of stations, and is the next station that is adjacent to the current station on the downstream side in the traveling direction of the automatic guided vehicle from the current station. Departure data for starting the automated guided vehicle toward the station is stored for each of the cases where each of the plurality of stations is the current station. The arrival data storage means is associated with the current station and travels from the previous station, which is a station adjacent to the current station on the upstream side in the traveling direction, toward the current station. Arrival data for stopping the automatic guided vehicle at the current station is stored for each of the plurality of stations as the current station. Further, the passage data storage means is associated with the current station, and the unmanned transport vehicle traveling from the previous station toward the current station is passed without stopping at the current station and traveling toward the next station. Data is stored for each of the plurality of stations as the current station. Then, when the destination command is acquired by the acquisition means, based on the destination command, one departure data stored in the departure data storage means, one arrival data stored in the arrival data storage means, and passage data Travel data that combines at least one or more passage data stored in the storage means is generated by the travel data generation means.
Therefore, each station can be set to any one of a departure station for starting an automated guided vehicle, an arrival station for arrival of an automated guided vehicle, and a passing station for passing an automated guided vehicle without stopping. The storage capacity consumed can be suppressed as compared with the case where the corresponding traveling data is stored individually. Therefore, there is an effect that the consumed storage capacity can be suppressed while ensuring the degree of freedom of the running pattern for running the automatic guided vehicle.
Further, when a new destination command is acquired by the acquisition unit while the automatic guided vehicle is traveling according to the generated one traveling data, one traveling data is obtained based on the newly acquired destination command. The one piece of arrival data combined with is changed to one passage data stored in the passage data storage means by the travel data changing means. Therefore, if the automatic guided vehicle is traveling (before stopping), the arrival station can be changed, so the travel route and destination of the automatic guided vehicle can be freely changed. Therefore, there is an effect that the automatic guided vehicle can be efficiently operated in accordance with external factors such as the condition of the travel route of the automatic guided vehicle.

請求項2記載の走行データ生成装置によれば、請求項1記載の走行データ生成装置の奏する効果に加え、次の効果を奏する。即ち、取得手段によって行先指令が取得される度に、その取得した行先指令に基づいて、無人搬送車両を到着させる到着ステーションで無人搬送車両を停止させる一の到着データが到着データ記憶手段から到着データ特定手段により特定される。そして、到着データ特定手段によって特定される一の到着データに従って無人搬送車両が到着ステーションで停止する前に、新たに取得手段によって行先指令が取得されると、その取得された行先指令に基づいて到着ステーションを通過させる一の通過データが、通過データ記憶手段から通過データ特定手段により特定される。すると、到着データ特定手段によって特定される一の到着データが、通過データ特定手段によって特定された一の通過データに走行データ変更手段により変更される。よって、到着ステーションの変更を単純な処理で行え、制御的負担を軽減できるという効果がある。 According to the travel data generating device of the second aspect, in addition to the effect produced by the travel data generating device according to the first aspect, the following effect is achieved. That is, each time the destination command is acquired by the acquisition unit, one arrival data for stopping the automatic guided vehicle at the arrival station for arrival of the automatic guided vehicle is received from the arrival data storage unit based on the acquired destination command. It is specified by specifying means. Then, when the destination command is newly acquired by the acquisition unit before the automated guided vehicle stops at the arrival station according to the one arrival data specified by the arrival data specifying unit, the arrival command is received based on the acquired destination command. One passage data passing through the station is specified by the passage data specifying means from the passage data storage means. Then, one arrival data specified by the arrival data specifying means is changed by the run line data changing means to one of the pass data specified by the passage data identification means. Therefore, the arrival station can be changed by a simple process, and the control burden can be reduced.

請求項3記載の走行データ生成装置によれば、請求項1又は2記載の走行データ生成装置の奏する効果に加え、次の効果を奏する。出発データ記憶手段には、現在ステーションに対して次回ステーションが複数設けられる場合、その現在ステーションと、一の次回ステーションと、その一の次回ステーションに応じた出発データとが対応付けられたデータが、複数の次回ステーションの各々を一の次回ステーションとした場合についてそれぞれ記憶される。到着データ記憶手段には、現在ステーションに対して前回ステーションが複数設けられる場合、その現在ステーションと、一の前回ステーションと、その一の前回ステーションに応じた到着データとが対応付けられたデータが、複数の前回ステーションの各々を一の前回ステーションとした場合についてそれぞれ記憶される。通過データ記憶手段は、現在ステーションに対して次回ステーションと前回ステーションとの少なくとも一方が複数設けられる場合、その現在ステーションと、一の次回ステーションと、一の前回ステーションと、その一の前回ステーションおよび一の次回ステーションに応じた前記通過データとが対応付けられたデータが、次回ステーションと前回ステーションとの全組み合わせの各々についてそれぞれ記憶される。取得手段によって行先指令が取得されると、その行先指令において、最初に指示されるステーションが現在ステーション、次に指示されるステーションが次回ステーションとして第1特定手段によって特定され、その特定される現在ステーションと次回ステーションとに対応付けて出発データ記憶手段に記憶される一の出発データが第1抽出手段によって抽出される。また、行先指令において最初に指示されるステーションと、最後に指示されるステーションとの間に指示される1以上のステーションが指示順に現在ステーションとして特定されると共に、その現在ステーションとして特定されたステーションの1つ前に指示されるステーションが前回ステーション、その現在ステーションとして特定されたステーションの次に指示されるステーションが次回ステーションとして第2特定手段によって特定され、その第2特定手段によって特定される現在ステーションと、前回ステーションと、次回ステーションとに対応付けて通過データ記憶手段に記憶される通過データが少なくとも1以上、第2抽出手段によって抽出される。更に、行先指令において最後に指示されるステーションの一つ前に指示されるステーションが前回ステーション、最後に指示されるステーションが現在ステーションとして第3特定手段によって特定され、その特定された前回ステーションと、現在ステーションとに対応付けて到着データ記憶手段に記憶される一の到着データが第3抽出手段によって抽出される。そして、第1抽出手段によって抽出される一の出発データと、第2抽出手段によって抽出される少なくとも1以上の通過データと、第3抽出手段によって抽出される一の到着データとを組み合わせた走行データが走行データ生成手段によって生成される。よって、誘導体が分岐している場合、例えば、T字状に設けるられる3方向の誘導体の各々にステーションが設けられる場合でも、全ての走行パターンについて走行データを生成できる。また、行先指令により指示される無人搬送車両を通行させるステーションから、出発データ、通過データ、および到着データを単純な処理で抽出することができる。従って、制御的負担を軽減できるという効果がある。 According to the travel data generation device of the third aspect, in addition to the effect exhibited by the travel data generation device according to the first or second aspect, the following effect is achieved. In the departure data storage means, when a plurality of next stations are provided for the current station, data in which the current station, one next station, and departure data corresponding to the one next station are associated, Each of the plurality of next stations is stored as one next station. In the arrival data storage means, when a plurality of previous stations are provided for the current station, data in which the current station, one previous station, and arrival data corresponding to the one previous station are associated with each other, Each of the plurality of previous stations is stored as one previous station. When at least one of the next station and the previous station is provided for the current station, the passage data storage means includes the current station, the next station, the previous station, the previous station, and the previous station. The data associated with the passing data corresponding to the next station is stored for each of all combinations of the next station and the previous station. When the destination command is acquired by the acquisition means, in the destination command, the first specified means is specified as the current station and the next specified station is specified as the next station in the destination command, and the specified current station is specified. One departure data stored in the departure data storage means in association with the next station is extracted by the first extraction means. In addition, one or more stations specified between the first specified station and the last specified station in the destination command are specified as the current station in the specified order, and the stations specified as the current station are also specified. The station specified next is the previous station, the station specified next as the current station is specified by the second specifying means as the next station, and the current station specified by the second specifying means Then, at least one or more passage data stored in the passage data storage means in association with the previous station and the next station is extracted by the second extraction means. Further, the station designated immediately before the last designated station in the destination command is identified as the previous station, the last designated station is identified as the current station by the third identifying means, the identified previous station, One arrival data stored in the arrival data storage means in association with the current station is extracted by the third extraction means. The traveling data is a combination of one departure data extracted by the first extraction means, at least one passage data extracted by the second extraction means, and one arrival data extracted by the third extraction means. Is generated by the travel data generating means. Therefore, when the derivatives are branched, for example, even when a station is provided in each of the three-direction derivatives provided in a T shape, it is possible to generate travel data for all travel patterns. In addition, departure data, passage data, and arrival data can be extracted by simple processing from a station that passes an automatic guided vehicle that is instructed by a destination command. Therefore, there is an effect that the control burden can be reduced.

(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に設けられている車輪6bの走行速度V1を算出するための走行速度比率を示し、走行速度比率Va2は、無人搬送車両1の右側最前列の走行装置5bに設けられている車輪6bの走行速度V2を算出するための走行速度比率を示している。 The traveling speed ratio Va1 indicates the traveling speed ratio for calculating the traveling speed V1 of the wheel 6b 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→C209」という行先指令に対応する動作コマンド列が追加される。より具体的には、動作コマンドバッファメモリ73aには、ステーションC205で無人搬送車両1を停車させずにそのまま通過させ、その後、ステーションC209で無人搬送車両1を停車させる動作コマンド列が追加される。 As a result, an operation command sequence corresponding to the destination command “C205 → C206 → C207 → C208 → C209 ” 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 passing the automatic guided vehicle 1 as it is without stopping at the station C205, and then stopping the automatic guided vehicle 1 at the station C209 .

以上説明したように、上述した図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.

尚、上記実施形態に記載の「動作コマンドバッファメモリ73aに記憶される動作コマンド列」が、特許請求の範囲に記載の「走行データ」に対応する。また、上記実施形態に記載の「走行経路R上で隣設する3つのステーションCの組み合わせに対応する動作コマンド列」が、特許請求の範囲に記載の「通過データ」に対応する。また、上記実施形態に記載の「走行経路R上で隣設する2つのステーションCの組み合わせに対応する動作コマンド列」が、特許請求の範囲に記載の「出発データ」や「到着データ」に対応する。   The “operation command sequence stored in the operation command buffer memory 73a” described in the above embodiment corresponds to the “running data” described in the claims. Further, “an operation command sequence corresponding to a combination of three stations C provided adjacently on the travel route R” described in the above embodiment corresponds to “passing data” recited in the claims. In addition, the “operation command sequence corresponding to the combination of two adjacent stations C on the travel route R” described in the above embodiment corresponds to “departure data” and “arrival data” described in the claims. To do.

以上、実施形態に基づき本発明を説明したが、本発明は上記実施形態に何ら限定されるものではなく、本発明の趣旨を逸脱しない範囲内で種々の改良変更が可能であることは容易に推察できるものである。   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記載の走行データ生成装置は、無人搬送車両が通行可能な複数のステーションのうち前記無人搬送車両を通行させる3以上のステーションを指示する行先指令を取得する取得手段を備え、その取得手段によって取得された行先指令に従って前記無人搬送車両を走行させる走行データを生成するものであって、前記複数のステーションのうち隣設する2つのステーション毎に、一方のステーションから他方のステーションに向けて出発するように前記無人搬送車両を走行させる出発データを記憶する出発データ記憶手段と、前記複数のステーションのうち隣設する2つのステーション毎に、一方のステーションから走行してきて他方のステーションで停止するように前記無人搬送車両を走行させる到着データを記憶する到着データ記憶手段と、前記複数のステーションのうち隣設する3つのステーション毎に、一のステーションを挟む2つのステーションの一方から他方に向けて、その一のステーションを通過するように前記無人搬送車両を走行させる通過データを記憶する通過データ記憶手段と、前記出発データ記憶手段に記憶されている一の出発データと、前記到着データ記憶手段に記憶されている一の到着データと、前記通過データ記憶手段に記憶されている少なくとも一以上の通過データとを組み合わせ、前記走行データを生成する走行データ生成手段とを備えている。
技術的思想1記載の走行データ生成装置は、技術的思想1記載の走行データ生成装置において、前記走行データ生成手段は、前記取得手段によって行先指令を取得する度に、その取得した行先指令に基づいて、前記無人搬送車両を到着させる到着ステーションで前記無人搬送車両を停止させる一の到着データを前記到着データ記憶手段から特定する到着データ特定手段と、その到着データ特定手段によって特定される一の到着データに従って前記無人搬送車両が前記到着ステーションで停止する前に、新たに前記取得手段によって行先指令を取得した場合、その取得した行先指令に基づいて前記到着ステーションを通過させる通過データを前記通過データ記憶手段から特定する通過データ特定手段とを備え、
その通過データ特定手段によって通過データが特定された場合に、前記到着データ特定手段によって特定される一の到着データに替えて、前記通過データ特定手段によって特定された前記通過データを組み合わせて前記走行データを生成する。
技術的思想3記載の走行データ生成装置は、技術的思想1又は2記載の走行データ生成装置において、前記走行データ生成手段は、前記行先指令に基づいて、前記無人搬送車両を出発させる出発ステーションと、その出発ステーションの次に前記無人搬送車両が通行するステーションとの2つのステーションを特定する第1特定手段と、その第1特定手段によって特定された2つのステーションに対応する一の出発データを、前記出発データ記憶手段から抽出する第1抽出手段と、前記行先指令に基づいて、前記無人搬送車両が通行する一連のステーションの中から隣設する3つのステーションを、一つずつステーションをずらしながら通過順に特定する第2特定手段と、その第2特定手段によって特定された3つのステーション毎に、その3つのステーションに対応する通過データを前記通過データ記憶手段から抽出する第2抽出手段と、前記行先指令に基づいて、前記無人搬送車両を到着させる到着ステーションと、その到着ステーションの一つ前に前記無人搬送車両が通過するステーションとの2つのステーションを特定する第3特定手段と、その第3特定手段によって特定された2つのステーションに対応する一の到着データを、前記到着データ記憶手段から抽出する第3抽出手段とを備え、前記第1抽出手段によって抽出された一の出発データと、前記第2抽出手段によって抽出された各通過データと、前記第3抽出手段によって抽出された一の到着データとを組み合わせ、前記走行データを生成する。
<効果>
技術的思想1記載の走行データ生成装置によれば、複数のステーションのうち隣設する2つのステーション毎に、一方のステーションから他方のステーションに向けて出発するように無人搬送車両を走行させる出発データが出発データ記憶手段に記憶され、複数のステーションのうち隣設する2つのステーション毎に、一方のステーションから走行してきて他方のステーションで停止するように無人搬送車両を走行させる到着データが到着データ記憶手段に記憶されている。また、複数のステーションのうち隣設する3つのステーション毎に、一のステーションを挟む2つのステーションの一方から他方に向けて、その一のステーションを通過するように無人搬送車両を走行させる通過データが通過データ記憶手段に記憶されている。そして、出発データ記憶手段に記憶されている一の出発データと、到着データ記憶手段に記憶されている一の到着データと、通過データ記憶手段に記憶されている少なくとも一以上の通過データとが走行データ生成手段により組み合わされて、走行データが生成される。よって、新たなステーションを増やす場合には、新たなステーションを含む隣設する2つのステーション毎に、出発データおよび到着データを作成して、出発データ記憶手段および到着データ記憶手段に追加すれば良い。また、新たなステーションを含む隣設する3つのステーション毎に、通過データを作成して、通過データ記憶手段に追加すれば良い。即ち、新たなステーションを増やす場合には、新たなステーションを含む隣設する2つのステーションと、新たなステーションを含む隣設する3つのステーションとに関するデータを作成して、記憶手段に追加すれば良いので、追加するデータ量を抑制できる。従って、ステーションの総数が多い場合でも、走行データを生成するために予め記憶手段に記憶しておくデータ量を抑制できるという効果がある。
技術的思想2記載の走行データ生成装置によれば、技術的思想1記載の走行データ生成装置の奏する効果に加え、次の効果を奏する。即ち、取得手段によって行先指令が取得される度に、その取得した行先指令に基づいて、無人搬送車両を到着させる到着ステーションで無人搬送車両を停止させる一の到着データが到着データ記憶手段から到着データ特定手段により特定される。そして、到着データ特定手段によって特定される一の到着データに従って無人搬送車両が到着ステーションで停止する前に、新たに取得手段によって行先指令が取得されると、その取得された行先指令に基づいて到着ステーションを通過させる通過データが、通過データ記憶手段から通過データ特定手段により特定される。すると、到着データ特定手段によって特定される一の到着データに替えて、通過データ特定手段によって特定された通過データを組み合わせた走行データが、走行データ生成手段により生成される。よって、無人搬送車両が到着ステーションで停止する前であれば、到着ステーションを変更できるので、無人搬送車両の走行経路や行先を自由に変更できる。従って、無人搬送車両の走行経路の状況などの外的要因に合わせて、無人搬送車両を効率良く運行させることができるという効果がある。
技術的思想3記載の走行データ生成装置によれば、技術的思想1又は2記載の走行データ生成装置の奏する効果に加え、次の効果を奏する。即ち、無人搬送車両を出発させる出発ステーションと、その出発ステーションの次に無人搬送車両が通行するステーションとの2つのステーションが、第1特定手段により行先指令に基づいて特定されると、その2つのステーションに対応する一の出発データが、出発データ記憶手段から第1抽出手段により抽出される。また、無人搬送車両が通行する一連のステーションの中から隣設する3つのステーションが、一つずつステーションをずらしながら通過順に第2特定手段により、行先指令に基づいて特定されると、その3つのステーション毎に、その3つのステーションに対応する通過データが、通過データ記憶手段から第2抽出手段により抽出される。また、無人搬送車両を到着させる到着ステーションと、その到着ステーションの一つ前に無人搬送車両が通過するステーションとの2つのステーションが第3特定手段により、行先指令に基づいて特定されると、その2つのステーションに対応する一の到着データが、到着データ記憶手段から第3抽出手段により抽出される。そして、第1抽出手段によって抽出された一の出発データと、第2抽出手段によって抽出された各通過データと、第3抽出手段によって抽出された一の到着データとが、走行データ生成手段により組み合わされて走行データが生成される。よって、行先指令により指示される無人搬送車両を通行させるステーションから、出発データ、通過データ、および到着データを単純な処理で抽出することができる。従って、制御的負担を軽減できるという効果がある。
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 travel data generation device described in the technical idea 1 includes an acquisition unit that acquires a destination command that instructs three or more stations that allow the automatic guided vehicle to pass among a plurality of stations that the automatic guided vehicle can pass. Generating travel data for traveling the automatic guided vehicle according to a destination command acquired by the means, and for every two adjacent stations among the plurality of stations, from one station to the other station The departure data storage means for storing the departure data for running the automatic guided vehicle so as to leave, and every two adjacent stations among the plurality of stations, the vehicle travels from one station and stops at the other station. Arrival data for storing arrival data for running the automatic guided vehicle The unmanned conveyance vehicle travels through the one station from one of the two stations sandwiching one station to the other for every three adjacent stations among the plurality of stations. Passage data storage means for storing passage data to be stored; one departure data stored in the departure data storage means; one arrival data stored in the arrival data storage means; and the passage data storage means A travel data generating unit configured to combine the stored at least one passage data and generate the travel data;
The travel data generation device described in the technical idea 1 is the travel data generation device described in the technical idea 1, in which the travel data generation unit is based on the acquired destination command every time the destination command is acquired by the acquisition unit. The arrival data specifying means for specifying one arrival data for stopping the automatic guided vehicle at the arrival station for arriving the automatic guided vehicle from the arrival data storage means, and one arrival specified by the arrival data specifying means When the destination command is newly acquired by the acquisition means before the automatic guided vehicle stops at the arrival station according to the data, the passage data storing the passage data for passing the arrival station based on the acquired destination command is stored in the passage data storage. A passage data specifying means for specifying from the means,
When the passing data is specified by the passing data specifying means, the travel data is combined with the passing data specified by the passing data specifying means instead of the one arrival data specified by the arrival data specifying means. Is generated.
The travel data generation device described in the technical idea 3 is the travel data generation device described in the technical idea 1 or 2, wherein the travel data generation means includes a departure station that starts the automatic guided vehicle based on the destination command. A first specifying means for specifying two stations, that is, a station through which the automatic guided vehicle passes after the departure station, and one departure data corresponding to the two stations specified by the first specifying means, Based on the destination command and the first extraction means that extracts from the departure data storage means, the adjacent three stations among the series of stations that the automated guided vehicle passes through are shifted one by one. Second specifying means for specifying in order, and for each of the three stations specified by the second specifying means, Second extraction means for extracting passage data corresponding to one station from the passage data storage means, an arrival station for arriving the automatic guided vehicle based on the destination command, and the unmanned one before the arrival station The third specifying means for specifying two stations, the station through which the transport vehicle passes, and the first arrival data corresponding to the two stations specified by the third specifying means are extracted from the arrival data storage means. 3 extraction means, one departure data extracted by the first extraction means, each passage data extracted by the second extraction means, one arrival data extracted by the third extraction means, To generate the travel data.
<Effect>
According to the travel data generation device described in the technical idea 1, departure data for running an unmanned transport vehicle so as to leave from one station to the other station for every two adjacent stations among a plurality of stations. Is stored in the departure data storage means, and for every two adjacent stations among the plurality of stations, arrival data for running the automatic guided vehicle so as to travel from one station and stop at the other station is stored as arrival data. Stored in the means. In addition, for every three adjacent stations among a plurality of stations, there is passing data for running the automatic guided vehicle so as to pass through the one station from one of the two stations sandwiching the one station to the other. It is stored in the passage data storage means. One departure data stored in the departure data storage means, one arrival data stored in the arrival data storage means, and at least one or more passage data stored in the passage data storage means The combined data is generated by the data generation means to generate travel data. Therefore, when adding new stations, departure data and arrival data may be created and added to the departure data storage means and arrival data storage means for every two adjacent stations including the new station. Further, it is only necessary to create passing data for each of the three adjacent stations including the new station and add it to the passing data storage means. That is, when adding a new station, data relating to two adjacent stations including the new station and three adjacent stations including the new station may be created and added to the storage means. Therefore, the amount of data to be added can be suppressed. Therefore, even when the total number of stations is large, there is an effect that it is possible to reduce the amount of data stored in the storage unit in advance in order to generate travel data.
According to the travel data generation device described in the technical idea 2, in addition to the effects exhibited by the travel data generation device described in the technical idea 1, the following effects are achieved. That is, each time the destination command is acquired by the acquisition unit, one arrival data for stopping the automatic guided vehicle at the arrival station for arrival of the automatic guided vehicle is received from the arrival data storage unit based on the acquired destination command. It is specified by specifying means. Then, when the destination command is newly acquired by the acquisition unit before the automated guided vehicle stops at the arrival station according to the one arrival data specified by the arrival data specifying unit, the arrival command is received based on the acquired destination command. The passage data passing through the station is specified by the passage data specifying means from the passage data storage means. Then, instead of the one arrival data specified by the arrival data specifying means, the driving data generating means generates driving data combining the passing data specified by the passing data specifying means. Therefore, since the arrival station can be changed before the automatic guided vehicle stops at the arrival station, the travel route and the destination of the automatic guided vehicle can be freely changed. Therefore, there is an effect that the automatic guided vehicle can be efficiently operated in accordance with external factors such as the condition of the travel route of the automatic guided vehicle.
According to the travel data generation device described in the technical idea 3, in addition to the effects exhibited by the travel data generation device described in the technical idea 1 or 2, the following effects are achieved. That is, when two stations, a departure station for starting an automated guided vehicle and a station to which the automated guided vehicle passes after the departure station, are specified based on a destination command by the first specifying means, the two stations One departure data corresponding to the station is extracted from the departure data storage means by the first extraction means. In addition, when three adjacent stations among a series of stations through which the automated guided vehicle passes are specified based on the destination command by the second specifying means in the passing order while shifting the stations one by one, the three stations For each station, passage data corresponding to the three stations is extracted from the passage data storage means by the second extraction means. In addition, when two stations, an arrival station for arrival of the automated guided vehicle and a station where the automated guided vehicle passes immediately before the arrival station, are identified based on the destination command by the third identification means, One arrival data corresponding to the two stations is extracted from the arrival data storage means by the third extraction means. Then, the traveling data generating means combines the one departure data extracted by the first extracting means, each passing data extracted by the second extracting means, and one arrival data extracted by the third extracting means. Thus, travel data is generated. Therefore, departure data, passage data, and arrival data can be extracted by a simple process from a station that passes an automatic guided vehicle that is instructed by a destination command. Therefore, there is an effect that the control burden can be reduced.

1 無人搬送車両
70 制御装置(走行データ生成装置)
72a 動作情報リンクテーブル(出発データ記憶手段、到着データ記憶手段、通過データ記憶手段)
72b 動作コマンドテーブル(出発データ記憶手段、到着データ記憶手段、通過データ記憶手段)
S11 取得手段
S21 走行データ変更手段
S18,S22 走行データ生成手段
S31,S32 第1特定手段
S31〜S35,S40,S41 通過データ取得手段
S31,S40 第3特定手段
S31,S40,S39 第2特定手段
S33〜S35 第1抽出手段
S41,S34,S35 第2抽出手段
S42,S34,S35 到着データ取得手段、第3抽出手段
1 automatic guided vehicle 70 control device (running data generation device)
72a Operation information link table (departure data storage means, arrival data storage means, passage data storage means)
72b Operation command table (departure data storage means, arrival data storage means, passage data storage means)
S11 acquisition means
S21 travel data changing means S18, S22 travel data generating means S31, S32 first specifying means S31 to S35, S40, S41 passing data acquiring means S31, S40 third specifying means S31, S40, S39 second specifying means S33 to S35 second 1 extraction means S41, S34, S35 second extraction means S42, S34, S35 arrival data acquisition means, third extraction means

Claims (3)

走行経路に敷設された誘導体に沿って走行する無人搬送車両の走行データを生成する走行データ生成装置において、
前記誘導体上に所定間隔毎に設けられる複数のステーションのうち前記無人搬送車両に経由させるステーションが順番に指示される行先指令を取得する取得手段と、
前記複数のステーションの一つである現在ステーションと対応付けられ、その現在ステーションから、その現在ステーションに対して前記無人搬送車両の進行方向下流側に隣設されるステーションである次回ステーションに向けて前記無人搬送車両を出発させる出発データを、前記複数のステーションの各々を前記現在ステーションとした場合についてそれぞれ記憶する出発データ記憶手段と、
前記現在ステーションと対応付けられ、その現在ステーションに対して前記無人搬送車両の進行方向上流側に隣設されるステーションである前回ステーションから前記現在ステーションに向けて走行してくる前記無人搬送車両を前記現在ステーションで停止させる到着データを、前記複数のステーションの各々を前記現在ステーションとした場合についてそれぞれ記憶する到着データ記憶手段と、
前記現在ステーションと対応付けられ、前記前回ステーションから前記現在ステーションに向けて走行してくる前記無人搬送車両を、前記現在ステーションで停止させずに通過させ前記次回ステーションに向けて走行させる通過データを、前記複数のステーションの各々を前記現在ステーションとした場合についてそれぞれ記憶する通過データ記憶手段と、
前記取得手段によって取得される行先指令に基づいて、前記出発データ記憶手段に記憶される一の出発データと、前記到着データ記憶手段に記憶される一の到着データと、前記通過データ記憶手段に記憶される少なくとも一以上の通過データとを組み合わせた走行データを生成する走行データ生成手段とを備え
前記走行データ生成手段は、
生成された一の走行データに従って前記無人搬送車両が走行している間に、前記取得手段によって新たに行先指令を取得した場合、その新たに取得した行先指令に基づいて、前記一の走行データに組み合わせられた前記一の到着データを、前記通過データ記憶手段に記憶される一の通過データに変更する走行データ変更手段とを備えることを特徴とする走行データ生成装置。
In a travel data generation device that generates travel data of an automated guided vehicle that travels along a derivative laid on a travel route ,
An acquisition means for acquiring a destination command in which stations to be routed through the automatic guided vehicle among a plurality of stations provided at predetermined intervals on the derivative are instructed;
The current station is associated with the current station that is one of the plurality of stations, and is directed from the current station toward the next station that is adjacent to the current station on the downstream side in the traveling direction of the automatic guided vehicle. Departure data storage means for storing departure data for starting an automated guided vehicle when each of the plurality of stations is the current station ;
The automatic guided vehicle traveling to the current station from the previous station, which is associated with the current station and adjacent to the current station on the upstream side in the traveling direction of the automatic guided vehicle, Arrival data storage means for storing arrival data to be stopped at the current station for each of the plurality of stations as the current station ;
Passing data that is associated with the current station and passes through the unmanned transport vehicle traveling from the previous station toward the current station without stopping at the current station and traveling toward the next station, Passing data storage means for storing each of the plurality of stations as the current station ;
Based on the destination command acquired by the acquisition means, one departure data stored in the departure data storage means, one arrival data stored in the arrival data storage means, and storage in the passage data storage means Traveling data generating means for generating traveling data in combination with at least one or more passing data that is ,
The travel data generating means includes
When a new destination command is acquired by the acquisition unit while the automatic guided vehicle is traveling according to the generated one travel data, the one travel data is converted into the one travel data based on the newly acquired destination command. the combined the one incoming data, travel data generating apparatus according to claim Rukoto a running data changing means for changing one of the passage data to be stored in the pass data storage means.
前記走行データ生成手段は、
前記取得手段によって行先指令を取得する度に、その取得した行先指令に基づいて、前記無人搬送車両を到着させる到着ステーションで前記無人搬送車両を停止させる一の到着データを前記到着データ記憶手段から特定する到着データ特定手段と、
その到着データ特定手段によって特定される一の到着データに従って前記無人搬送車両が前記到着ステーションで停止する前に、新たに前記取得手段によって行先指令を取得した場合、その取得した行先指令に基づいて前記到着ステーションを通過させる一の通過データを前記通過データ記憶手段から特定する通過データ特定手段とを備え、
前記走行データ変更手段は、
前記通過データ特定手段によって一の通過データが特定された場合に、前記到着データ特定手段によって特定される一の到着データを、前記通過データ特定手段によって特定される一の前記通過データに変更することを特徴とする請求項1に記載の走行データ生成装置。
The travel data generating means includes
Each time the destination command is acquired by the acquiring means, based on the acquired destination command, one arrival data for stopping the automatic guided vehicle at the arrival station where the automatic guided vehicle arrives is identified from the arrival data storage means. An arrival data identification means to
If the destination command is newly acquired by the acquisition unit before the automatic guided vehicle stops at the arrival station in accordance with the one arrival data specified by the arrival data specifying unit, based on the acquired destination command Passing data specifying means for specifying one passing data passing through the arrival station from the passing data storage means,
The travel data changing means is
If it is identified one pass data by the passing data identifying means, an arrival data identified by said incoming data specifying means, changing one of the pass data specified by the passed data specifying means The travel data generation device according to claim 1, wherein:
前記出発データ記憶手段は、前記現在ステーションに対して前記次回ステーションが複数設けられる場合、その現在ステーションと、一の次回ステーションと、その一の次回ステーションに応じた前記出発データとが対応付けられたデータを、前記複数の次回ステーションの各々を前記一の次回ステーションとした場合についてそれぞれ記憶し、
前記到着データ記憶手段は、前記現在ステーションに対して前記前回ステーションが複数設けられる場合、その現在ステーションと、一の前回ステーションと、その一の前回ステーションに応じた前記到着データとが対応付けられたデータを、前記複数の前回ステーションの各々を前記一の前回ステーションとした場合についてそれぞれ記憶し、
前記通過データ記憶手段は、前記現在ステーションに対して前記次回ステーションと前記前回ステーションとの少なくとも一方が複数設けられる場合、その現在ステーションと、一の次回ステーションと、一の前回ステーションと、その一の前回ステーションおよび一の次回ステーションに応じた前記通過データとが対応付けられたデータを、前記次回ステーションと前記前回ステーションとの全組み合わせの各々についてそれぞれ記憶し、
前記走行データ生成手段は、
前記行先指令において最初に指示されるステーションを前記現在ステーション、次に指示されるステーションを前記次回ステーションとして特定する第1特定手段と、
その第1特定手段によって特定される前記現在ステーションと前記次回ステーションとに対応付けて前記出発データ記憶手段に記憶される一の出発データを抽出する第1抽出手段と、
前記行先指令において最初に指示されるステーションと、最後に指示されるステーションとの間に指示される1以上のステーションを指示順に前記現在ステーションとして特定すると共に、その現在ステーションとして特定されたステーションの1つ前に指示されるステーションを前記前回ステーション、その現在ステーションとして特定されたステーションの次に指示されるステーションを前記次回ステーションとして特定する第2特定手段と、
その第2特定手段によって特定される前記現在ステーションと、前記前回ステーションと、前記次回ステーションとに対応付けて前記通過データ記憶手段に記憶される通過データを少なくとも1以上抽出する第2抽出手段と、
前記行先指令において最後に指示されるステーションの一つ前に指示されるステーションを前記前回ステーション、最後に指示されるステーションを前記現在ステーションとして特定する第3特定手段と、
その第3特定手段によって特定される前記前回ステーションと、前記現在ステーションとに対応付けて前記到着データ記憶手段に記憶される一の到着データを抽出する第3抽出手段とを備え、
前記第1抽出手段によって抽出され一の出発データと、前記第2抽出手段によって抽出される少なくとも1以上の通過データと、前記第3抽出手段によって抽出され一の到着データとを組み合わせた走行データを生成することを特徴とする請求項1又は2記載の走行データ生成装置。
When a plurality of next stations are provided for the current station, the departure data storage means associates the current station, one next station, and the departure data corresponding to the one next station. Storing data for each of the plurality of next stations as the one next station;
In the case where a plurality of the previous stations are provided for the current station, the arrival data storage means associates the current station, one previous station, and the arrival data corresponding to the one previous station. Data is stored for each of the plurality of previous stations as the one previous station;
In the case where a plurality of at least one of the next station and the previous station are provided with respect to the current station, the passing data storage means includes the current station, one next station, one previous station, and one Data associated with the previous station and the passage data corresponding to one next station is stored for each of all combinations of the next station and the previous station,
The travel data generating means includes
First specifying means for specifying the first designated station in the destination command as the current station and the next designated station as the next station ;
A first extraction means for extracting one of the starting data stored in said starting data storage means in association with said next station and the current station that will be specified by the first specifying means,
One or more stations designated between the first designated station and the last designated station in the destination command are identified as the current station in the designated order, and one of the stations identified as the current station is specified. A second specifying means for specifying the station specified next as the previous station and the station specified next as the current station as the next station ;
It said current station that will be specified by the second specifying means, and the last station, a second extraction means for extracting passage data at least one or more stored in the pass data storage means in association with said next station,
Third specifying means for specifying the station specified immediately before the station last specified in the destination command as the previous station and the station specified last as the current station ;
With its third said previous station that will be specified by the specifying means, and a third extraction means for extracting an arrival data stored in the incoming data storage means in association said current station and,
Traveling in combination with one of the starting data that is extracted, and at least one or more passes data that are extracted by said second extracting means, and one of arrival data that is extracted by the third extraction means by said first extracting means The travel data generating device according to claim 1 or 2, wherein the data is generated.
JP2011040825A 2011-02-25 2011-02-25 Travel data generator Active JP5753704B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2011040825A JP5753704B2 (en) 2011-02-25 2011-02-25 Travel data generator

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011040825A JP5753704B2 (en) 2011-02-25 2011-02-25 Travel data generator

Publications (2)

Publication Number Publication Date
JP2012178054A JP2012178054A (en) 2012-09-13
JP5753704B2 true JP5753704B2 (en) 2015-07-22

Family

ID=46979852

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011040825A Active JP5753704B2 (en) 2011-02-25 2011-02-25 Travel data generator

Country Status (1)

Country Link
JP (1) JP5753704B2 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105988876B (en) * 2015-03-27 2019-09-17 杭州迪普科技股份有限公司 Memory allocation method and device
JP6689142B2 (en) * 2016-06-23 2020-04-28 日本車輌製造株式会社 Travel management program for transport vehicles
JP7494746B2 (en) 2021-01-28 2024-06-04 トヨタ自動車株式会社 AUTONOMOUS MOBILITY SYSTEM, AUTONOMOUS MOBILITY METHOD, AND AUTONOMOUS MOBILITY PROGRAM

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6417108A (en) * 1987-07-10 1989-01-20 Komatsu Mfg Co Ltd Operating command producing method for unmanned carrier
JP2000003219A (en) * 1998-06-16 2000-01-07 Toyota Autom Loom Works Ltd Method for instructing work of automated guided vehicle and device therefor

Also Published As

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

Similar Documents

Publication Publication Date Title
US20230050192A1 (en) Global Multi-Vehicle Decision Making System for Connected and Automated Vehicles in Dynamic Environment
JP5753704B2 (en) Travel data generator
CN109552333A (en) Vehicle movement prediction technique and equipment
CN102189992B (en) Method for setting basis following position and system for lane-keeping control
CN101561680A (en) Embedded guidance device of autonomous vehicle and intelligent composite guidance method thereof
US20030233177A1 (en) Graphical system configuration program for material handling
CN103308051B (en) Movable body position detection system, device and method
US10684135B2 (en) Method for updating an electronic card of a vehicle
TW200725500A (en) Path guiding system and method thereof
JP5806823B2 (en) Steering control device
CN112923945B (en) AGV multi-spectrum color-differentiation tracking navigation and shape-color positioning method based on visual recognition technology
US20210365043A1 (en) System and method for guiding vehicles and computer program product
JP4283804B2 (en) Transport system
US20230316920A1 (en) System and Method for Jointly Controlling Connected Autonomous Vehicles (CAVs) and Manual Connected Vehicles (MCVs)
JP2007328486A (en) Moving robot
JP4791481B2 (en) Transport route determination device, transport route determination method, and transport route determination program
KR101371966B1 (en) Robot driving system using rfidm
US20200026300A1 (en) Vehicle control system, self-driving vehicle, vehicle control method, and program
KR101704193B1 (en) The operating system of mobile robot having cross-shaped magnetic position sensor unit
JP6771999B2 (en) Autonomous driving device and automatic driving system
US11016502B1 (en) Autonomous travel system
JP5454662B2 (en) Navigation device and program for navigation device
JPH04318911A (en) Method of controlling processing process in multikind manufacture line
JP2008117204A (en) Intersection branch control method for automated guided vehicle and device therefor
CN107430511A (en) Parallel execution based on the command sequence monitored in advance

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20131224

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20140930

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20141014

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20141212

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20150525

R150 Certificate of patent or registration of utility model

Ref document number: 5753704

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250