JP5278749B2 - Article conveying device - Google Patents

Article conveying device Download PDF

Info

Publication number
JP5278749B2
JP5278749B2 JP2009056893A JP2009056893A JP5278749B2 JP 5278749 B2 JP5278749 B2 JP 5278749B2 JP 2009056893 A JP2009056893 A JP 2009056893A JP 2009056893 A JP2009056893 A JP 2009056893A JP 5278749 B2 JP5278749 B2 JP 5278749B2
Authority
JP
Japan
Prior art keywords
article
amount
mounting body
exit
arm
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
JP2009056893A
Other languages
Japanese (ja)
Other versions
JP2010208802A (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.)
Daifuku Co Ltd
Original Assignee
Daifuku Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Daifuku Co Ltd filed Critical Daifuku Co Ltd
Priority to JP2009056893A priority Critical patent/JP5278749B2/en
Publication of JP2010208802A publication Critical patent/JP2010208802A/en
Application granted granted Critical
Publication of JP5278749B2 publication Critical patent/JP5278749B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Warehouses Or Storage Devices (AREA)
  • Container, Conveyance, Adherence, Positioning, Of Wafer (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide an article carrying device capable of accurately adjusting a projection quantity so as to obtain a projection quantity corresponding to a dislocation quantity from the reference position of an article in the protruding-retreating direction of a placing body. <P>SOLUTION: This article carrying device is provided with the placing body connected to a rocking body rockably operated by a driving means, a driving quantity detecting means and an operation control means, and is constituted so that an article state detecting sensor for detecting a protruding-retreating dislocation quantity from the reference position of the article is arranged in the placing body, and the operation control means determines the protruding-retreating dislocating quantity based on the detecting information of the article state detecting sensor and the driving quantity detecting means, and when controlling protruding-retreating operation based on the detecting information of the driving quantity detecting means so that the placing body is positioned in a correcting position dislocated by the protruding-retreating dislocation quantity from the reference position, a driving quantity of a driving means is determined by converting a protruding-retreating quantity into a driving quantity by a converting unit protruding-retreating quantity R(ON) per unit driving quantity of the driving means on a position in the protruding-retreating direction of the placing body in the sensor detecting timing CNT(ON). <P>COPYRIGHT: (C)2010,JPO&amp;INPIT

Description

本発明は、移動経路に沿って移動される移動体と、前記移動体側に設けられた駆動手段により揺動軸心周りに揺動操作される揺動体の揺動端部側に連結されて、前記駆動手段による前記揺動体の揺動作動に連動して前記移動体上に位置する移動用の引退位置と前記移動体の外方側に位置する移載用の突出位置との間で出退作動し、かつ昇降操作自在に設けられた物品載置支持用の載置体と、前記駆動手段の駆動量を検出する駆動量検出手段と、前記移動経路に沿って位置する物品支持部に対する物品移載用停止位置に前記移動体を移動させるように前記移動体の移動作動を制御し、且つ、前記移動体が前記物品移載用停止位置に停止する状態において前記物品支持部に支持された物品を取り出す又は前記物品支持部に物品を卸すように前記載置体の出退作動及び昇降作動を制御する運転制御手段が設けられ、前記物品支持部に支持された物品についての前記載置体の出退方向における基準位置からのズレ量である出退ズレ量を検出するための物品状態検出センサーが、前記載置体を前記引退位置から予め設定された基準突出量だけ突出させるときに前記物品に備えられた被検出体を検出作用する状態で、前記載置体に設けられ、前記運転制御手段が、前記載置体を前記引退位置から前記基準突出量だけ突出させるときに、前記物品状態検出センサー及び前記駆動量検出手段の検出情報に基づいて前記出退ズレ量を求め、前記出退方向における前記基準位置から前記出退方向で前記出退ズレ量だけずれた補正用位置に対して前記載置体を位置させるように前記駆動量検出手段の検出情報に基づいて前記載置体の出退作動を制御するように構成された物品搬送装置に関する。   The present invention is connected to a moving body that is moved along a moving path and a swinging end side of a swinging body that is swung around a swinging axis by a driving means provided on the moving body side, In conjunction with the swinging operation of the swinging body by the driving means, it moves between the retracted position for movement located on the moving body and the protruding position for transfer located on the outer side of the moving body. An article mounting support body that is operated and can be moved up and down, a drive amount detection means that detects a drive amount of the drive means, and an article for an article support portion positioned along the movement path The movement of the moving body is controlled so as to move the moving body to the transfer stop position, and the moving body is supported by the article support portion in a state of stopping at the article transfer stop position. As described above, the article is taken out or the article support part is wholesaled. An operation control means for controlling a body exit / retreat operation and a lifting / lowering operation is provided, and a displacement amount that is a displacement amount from a reference position in a retracting direction of the placing body for the article supported by the article support portion. In the state where the article state detection sensor for detecting the object detects the object to be detected provided in the article when the placement body protrudes from the retraction position by a preset reference protrusion amount, When the operation control means is provided on the mounting body and causes the mounting body to protrude from the retracted position by the reference protruding amount, the output control unit is configured to output the output based on detection information of the article state detection sensor and the driving amount detecting means. Detection of the driving amount detection means so as to determine the amount of displacement, and to position the mounting body with respect to a correction position that is shifted from the reference position in the direction of withdrawal by the amount of displacement in the direction of withdrawal. Affection It relates configured article carrying apparatus to control projecting and retracting operation of the pre-described mounting body based on.

上記のような物品搬送装置は、例えば、自動倉庫設備や工場内搬送設備に適用され、運転制御手段が、移動体及び載置体の作動を制御することにより、自動倉庫における収納棚の収納部や入出庫用の物品支持台、或いは、工場内搬送設備における処理装置等に対する物品載置台といった物品支持部に支持された物品を取り出す又は物品支持部に物品を卸す作業を行うものである。   The article conveying apparatus as described above is applied to, for example, an automatic warehouse facility or a factory conveying facility, and the operation control unit controls the operation of the moving body and the mounting body, thereby storing the storage shelf in the automatic warehouse. Or an article support table for loading and unloading, or an article support unit such as an article placement table for a processing apparatus in a factory transport facility, or the like.

そして、物品支持部に支持された物品を取り出すときには、載置体を移動体上の引退位置に位置させた状態で物品移載用停止位置に移動体を移動させて、移動体が物品移載用停止位置に停止すると載置体を移動体より外方の移載用の突出位置に突出させる。このとき、物品を適正に取り出す為には、突出させた載置体に対して、物品支持部に支持された物品の姿勢及び位置が適正な姿勢及び位置にあることが必要となる。つまり、物品支持部に支持された物品について、平面視における基準姿勢(例えば、移動経路の長手方向に平行又は略平行な姿勢)であり、移動経路の長手方向における基準位置(例えば、移動経路の長手方向において突出された載置体の中心と物品支持部に支持された物品の中心とが上下に重複する位置)に位置し、且つ、載置体の出退方向における基準位置(例えば、載置体の出退方向において突出された載置体の中心と物品支持部に支持された物品の中心とが上下に重複する位置)に位置することが必要である。   Then, when taking out the article supported by the article support section, the movable body is moved to the article transfer stop position in a state where the mounting body is located at the retraction position on the movable body, and the movable body is transferred to the article. When stopped at the stop position, the mounting body is projected to a projecting position for transfer outside the moving body. At this time, in order to properly take out the article, it is necessary that the posture and position of the article supported by the article support portion are in an appropriate posture and position with respect to the protruding mounting body. That is, the article supported by the article support unit has a reference posture in plan view (for example, a posture parallel or substantially parallel to the longitudinal direction of the movement path) and a reference position in the longitudinal direction of the movement path (for example, the movement path The center of the placing body protruding in the longitudinal direction and the center of the article supported by the article support portion are positioned at the top and bottom, and the reference position (for example, the placing body) in the retracting direction of the placing body. It is necessary that the center of the mounting body projecting in the direction in which the mounting body is withdrawn and the center of the article supported by the article support portion overlap each other in the vertical direction.

そこで、移動体を物品移載用停止位置に停止させた状態で載置体を突出位置に突出させたときに、載置体に対して物品支持部に支持された物品が適正な姿勢及び位置になるように、基準停止位置、載置体の基準出退方向、及び、載置体の基準突出量が予め定められている。   Therefore, when the mounting body is protruded to the protruding position in a state where the moving body is stopped at the article transfer stop position, the article supported by the article support portion with respect to the mounting body is in an appropriate posture and position. The reference stop position, the reference exit / retreat direction of the mounting body, and the reference protrusion amount of the mounting body are determined in advance.

しかしながら、上記基準停止位置、基準出退方向、及び、基準突出量は、設計上物品が位置しているとされる基準位置に基準姿勢で存在している物品を対象に定められるので、物品支持部の設置精度や物品を物品支持部に支持させるときの移載精度等に起因して、実際に物品支持部に支持されている物品の姿勢及び位置は、設計上物品が位置しているとされる姿勢及び位置からずれている場合がある。そのため、上記基準停止位置に停止させた移動体から基準出退方向に基準突出量だけ突出させた載置体は、実際に物品支持部に支持されている物品に対して適正な姿勢及び位置となっているとは限らない。   However, the reference stop position, the reference exit / retreat direction, and the reference protrusion amount are determined for an article that exists in a reference posture at a reference position where the article is positioned by design. The position and position of the article that is actually supported by the article support section is determined by the design of the article due to the installation accuracy of the section and the transfer accuracy when the article is supported by the article support section. May be out of position and position. Therefore, the mounting body that is projected from the moving body stopped at the reference stop position by the reference protrusion amount in the reference exit / retraction direction has an appropriate posture and position with respect to the article that is actually supported by the article support unit. Not necessarily.

そこで、従来から、物品支持部に支持されている物品を取り出す場合には、当該物品の基準姿勢や基準位置からのズレに対応するべく、運転制御手段が、当該物品についての平面視における基準姿勢からの傾き、移動経路の長手方向における基準位置からのズレ量、及び、載置体の出退方向における基準位置からのズレ量を求めて、上記物品移載用停止位置、基準出退方向、及び、基準突出量をこれらの傾き及びズレ量だけ補正し、移動体を補正後の物品移載用停止位置に停止させた状態で、載置体を補正後の出退方向に、補正後の突出量だけ突出させることで、基準姿勢から傾いた姿勢で基準位置からずれた位置に位置している物品に対して適正な姿勢で適正な位置に載置体を位置させるようにしている(例えば、特許文献1参照。)。   Therefore, conventionally, when taking out an article supported by the article support unit, the operation control means has a reference attitude in plan view of the article in order to cope with a deviation from the reference attitude or reference position of the article. From the reference position in the longitudinal direction of the movement path, the deviation amount from the reference position in the moving direction of the mounting body, and the deviation amount from the reference position in the moving direction of the mounting body, the article transfer stop position, the reference moving direction, And the reference protrusion amount is corrected by these inclinations and deviation amounts, and the moving body is stopped at the corrected article transfer stop position in the corrected article transfer stop position in the corrected exit / retreat direction. By projecting by the projection amount, the mounting body is positioned at an appropriate position in an appropriate posture with respect to an article located at a position that is inclined from the reference posture and shifted from the reference position (for example, , See Patent Document 1).

ところで、上記物品搬送装置は、移動体を移動経路に沿って移動させる移動駆動手段、及び、載置体を出退作動させる出退駆動手段を備えており、載置体の平面視姿勢を変更することができるものにおいては、ターンテーブル等の旋回手段を駆動する旋回駆動手段を備えている。そして、上述のように、移動体を補正後の物品移載用停止位置に停止させた状態で、載置体を補正後の出退方向に、補正後の突出量だけ突出させるに当たっては、運転制御手段が、各駆動手段の駆動量を補正することになる。   By the way, the article transporting apparatus includes a movement drive unit that moves the moving body along the movement path and a withdrawal drive unit that moves the placement body back and forth, and changes the posture of the placement body in plan view. What can do is provided with a turning drive means for driving turning means such as a turntable. Then, as described above, in the state where the movable body is stopped at the corrected article transfer stop position, the placement body is projected in the corrected exit / retreat direction by the corrected protrusion amount. The control means corrects the driving amount of each driving means.

すなわち、移動駆動手段の駆動量を基準停止位置に位置させるために必要な基準移動駆動量からズレ量に応じた補正移動駆動量だけ加減算した適応移動駆動量に補正し、旋回駆動手段の駆動量を基準出退方向に向けるために必要な基準旋回駆動量から傾きに応じた補正旋回駆動量だけ加減算した適応旋回駆動量に補正し、出退駆動手段の駆動量を基準突出量だけ突出させるために必要な基準出退駆動量からズレ量に応じた補正出退駆動量だけ加減算した適応出退駆動量に補正する。   That is, the drive amount of the turning drive means is corrected to the adaptive movement drive amount obtained by adding or subtracting the correction movement drive amount corresponding to the deviation amount from the reference movement drive amount necessary for positioning the drive amount of the movement drive means at the reference stop position. Is corrected to an adaptive turning drive amount obtained by adding / subtracting a corrected turning drive amount corresponding to the inclination from a reference turning drive amount necessary to direct the vehicle in the reference exit / retreat direction, and the drive amount of the exit / retreat drive means is projected by the reference protrusion amount. Is corrected to an adaptive exit / retreat drive amount obtained by adding / subtracting a corrected exit / retreat drive amount corresponding to the amount of deviation from the reference exit / retreat drive amount required for the operation.

そして、従来では、運転制御手段は、上記各駆動手段の基準駆動量を補正する場合に必要となる補正移動駆動量、補正旋回駆動量、補正出退駆動量を、夫々の駆動手段について、単位駆動量当たりの移動量・旋回量・出退量が一定であるとして、傾きやズレ量に対応した各補正駆動量を算出して、適応駆動量を取得するように構成されていた。   Conventionally, the operation control means provides the corrected movement drive amount, the corrected turning drive amount, and the corrected exit / retreat drive amount required for correcting the reference drive amount of each of the drive means for each drive means. Assuming that the moving amount, turning amount, and withdrawal amount per driving amount are constant, each correction driving amount corresponding to the inclination and the deviation amount is calculated, and the adaptive driving amount is obtained.

特開2007−004603号公報JP 2007-004603 A

しなしながら、上述した従来の物品搬送装置によれば、運転制御手段は、単位駆動量当たりの変位量が一定であるとして、物品支持体に支持されている物品の実際の位置と基準位置との出退方向でのズレ量に対応した補正出退駆動量を取得するので、載置体が、出退駆動手段により揺動軸心周りに揺動操作される揺動体の揺動端部側に連結されて、出退駆動手段による揺動体の揺動作動に連動して出退作動するものであると、補正出退駆動量は、物品の出退方向における基準位置からのズレ量に正確に対応したものとはなっていないという問題がある。   However, according to the above-described conventional article transport apparatus, the operation control means assumes that the displacement amount per unit driving amount is constant, and the actual position and reference position of the article supported by the article support. Since the corrected drive / retreat drive amount corresponding to the shift amount in the retracting / retracting direction is acquired, the mounting body is swung around the rocking shaft center by the retracting / retracting driving means. If the swinging movement of the swinging body by the swinging / retracting driving means is linked, the corrected retracting / driving amount is accurate to the amount of deviation from the reference position in the retracting / retracting direction of the article. There is a problem that it does not correspond to.

説明を加えると、載置体が揺動体の揺動端部側に連結され、その揺動体の揺動作動に連動して出退作動するものであると、揺動体の揺動軸心周りの揺動作動から載置体の出退方向の変位を得るので、揺動体の揺動径方向と載置体の出退方向との為す角、つまりは、載置体の出退方向での位置によって、揺動体の揺動量が同じであっても出退駆動手段による揺動体の揺動作動により得られる載置体の出退作動量は異なることになる。例えば、載置体が突出位置側に位置しているときの方よりも引退位置側に位置しているときの方が揺動体の揺動量が同じであっても載置体が出退方向で大きく変位する。したがって、載置体の引退位置からの突出量が異なると、単位出退駆動量当たりの出退方向での変位量が異なるため、単位駆動量当たりの変位量が一定であるとして、物品支持体に支持されている物品の実際の位置と基準位置との出退方向でのズレ量に対応した補正出退駆動量を取得すると、その補正出退駆動量は、載置体の出退方向での位置によっては、物品の出退方向における基準位置からのズレ量と一致しない場合がある。   In other words, if the mounting body is connected to the swinging end side of the swinging body and is moved out and retracted in conjunction with the swinging operation of the swinging body, Since the displacement in the moving direction of the mounting body is obtained from the swinging operation, the angle formed by the rocking diameter direction of the rocking body and the moving direction of the mounting body, that is, the position in the moving direction of the mounting body Therefore, even if the swinging amount of the swinging body is the same, the amount of the retracting operation of the mounting body obtained by the swinging operation of the swinging body by the retracting and driving means is different. For example, even when the amount of swinging of the swinging body is the same when the mounting body is positioned at the retracted position side than when the mounting body is positioned at the protruding position side, the mounting body is in the retracting direction. Displaces greatly. Accordingly, if the amount of protrusion from the retracted position of the mounting body is different, the amount of displacement in the retracting / retracting direction per unit retreating drive amount is different, so that the amount of displacement per unit driving amount is assumed to be constant. When the corrected exit / exit drive amount corresponding to the deviation amount in the exit / retreat direction between the actual position of the article supported by the reference position and the reference position is acquired, the corrected exit / retreat drive amount is determined in the exit / retreat direction of the mounting body. Depending on the position, the amount of deviation from the reference position in the exit / retreat direction of the article may not match.

このように、従来の物品搬送装置では、運転制御手段が取得する補正出退駆動量は、物品の出退方向における基準位置からのズレ量に正確に一致しない場合があるので、基準出退駆動量をそのような補正出退駆動量だけ加減算した適応出退駆動量に補正した適応出退駆動量だけ駆動させても、出退方向における基準位置から出退ズレ量だけずれた補正用位置に載置体を正確に位置させることができないといったように、載置体の引退位置からの突出量を物品の基準位置からのズレ量に対応して正確に調整することができていなかった。   As described above, in the conventional article transport apparatus, the corrected exit / exit drive amount acquired by the operation control unit may not exactly match the deviation amount from the reference position in the exit / exit direction of the article. Even if it is driven by the adaptive exit / exit drive amount corrected to the adaptive exit / exit drive amount obtained by adding / subtracting the amount to / from the corrected exit / exit drive amount, the correction position deviates from the reference position in the exit / exit direction by the exit / exit displacement amount The amount of protrusion of the mounting body from the retraction position cannot be accurately adjusted in accordance with the amount of deviation from the reference position of the article so that the mounting body cannot be accurately positioned.

本発明は、上記実情に鑑みてなされたものであり、その目的は、載置体の引退位置からの突出量を、載置体の出退方向における物品の基準位置からのズレ量に対応した突出量となるように精度よく調整することができる物品搬送装置を提供する点にある。   The present invention has been made in view of the above circumstances, and its purpose is to correspond to the amount of protrusion from the retraction position of the mounting body to the amount of deviation from the reference position of the article in the retracting direction of the mounting body. The object of the present invention is to provide an article conveying device that can be adjusted with high accuracy so as to obtain a protruding amount.

この目的を達成するために、本発明に係る物品搬送装置の第1特徴構成は、移動経路に沿って移動される移動体と、前記移動体側に設けられた駆動手段により揺動軸心周りに揺動操作される揺動体の揺動端部側に連結されて、前記駆動手段による前記揺動体の揺動作動に連動して前記移動体上に位置する移動用の引退位置と前記移動体の外方側に位置する移載用の突出位置との間で出退作動し、かつ昇降操作自在に設けられた物品載置支持用の載置体と、前記駆動手段の駆動量を検出する駆動量検出手段と、前記移動経路に沿って位置する物品支持部に対する物品移載用停止位置に前記移動体を移動させるように前記移動体の移動作動を制御し、且つ、前記移動体が前記物品移載用停止位置に停止する状態において前記物品支持部に支持された物品を取り出す又は前記物品支持部に物品を卸すように前記載置体の出退作動及び昇降作動を制御する運転制御手段が設けられ、前記物品支持部に支持された物品についての前記載置体の出退方向における基準位置からのズレ量である出退ズレ量を検出するための物品状態検出センサーが、前記載置体を前記引退位置から予め設定された基準突出量だけ突出させるときに前記物品に備えられた被検出体を検出作用する状態で、前記載置体に設けられ、前記運転制御手段が、前記載置体を前記引退位置から前記基準突出量だけ突出させるときに、前記物品状態検出センサー及び前記駆動量検出手段の検出情報に基づいて前記出退ズレ量を求め、前記出退方向における前記基準位置から前記出退方向で前記出退ズレ量だけずれた補正用位置に対して前記載置体を位置させるように前記駆動量検出手段の検出情報に基づいて前記載置体の出退作動を制御するように構成された物品搬送装置において、前記運転制御手段が、前記載置体を前記引退位置から前記基準突出量だけ突出させるときに、前記物品状態検出センサーが前記被検出体を検出作用するセンサー検出タイミングにおける前記載置体の前記出退方向での位置についての、前記駆動手段の単位駆動量当たりの前記載置体の前記出退方向での単位出退量である変換用単位出退量を求め、かつ、前記補正用位置に対して前記載置体を位置させるための前記駆動手段の駆動量として、前記出退方向での前記載置体の出退量を前記駆動手段の駆動量に変換するときに前記変換用単位出退量による変換を行って、前記センサー検出タイミングにおける前記駆動量検出手段の検出情報に基づいて、前記補正用位置に対して前記載置体を位置させるための前記駆動手段の駆動量を求めるように構成されている点にある。   In order to achieve this object, the first characteristic configuration of the article transporting apparatus according to the present invention includes a moving body that is moved along a moving path and a driving means provided on the moving body side around the swing axis. A retraction position for movement located on the moving body in conjunction with a swinging operation of the swinging body by the driving means is connected to the swinging end side of the swinging body to be swung, and the moving body A mounting body for supporting the article placement, which is provided so as to be able to move up and down with respect to the projecting position for transfer located on the outer side and is freely movable up and down, and a drive for detecting the driving amount of the driving means A moving detection unit for controlling the movement of the moving body so as to move the moving body to an article transfer stop position with respect to an article supporting unit positioned along the movement path; In the state of stopping at the transfer stop position, it is supported by the article support section. The above-mentioned mounting body with respect to the article supported by the above-mentioned article supporting part, provided with operation control means for controlling the exit / retreat operation and lifting / lowering operation of the above-mentioned mounting body so as to take out the article or to wholesale the article to the article supporting part When the article state detection sensor for detecting the amount of displacement, which is the amount of displacement from the reference position in the exit / retreat direction, causes the placement body to protrude from the retracted position by a preset reference protrusion amount, The article is provided in the mounting body in a state in which the object to be detected provided in the article is detected, and the operation control means causes the mounting body to protrude from the retraction position by the reference protrusion amount. The advancing / retreating amount is obtained based on detection information of the state detection sensor and the driving amount detecting means, and the correction position shifted from the reference position in the advancing / retreating direction by the advancing / retreating amount is corrected. In the article conveying apparatus configured to control the moving operation of the placing body based on the detection information of the driving amount detecting means so as to position the placing body, the operation control means includes When the object is projected from the retraction position by the reference protrusion amount, the article state detection sensor detects the object to be detected. A conversion unit withdrawal / retraction amount, which is a unit withdrawal / retraction amount in the withdrawal / retraction direction of the placement body per unit drive amount of the driving means, is obtained, and the placement body is positioned with respect to the correction position. As the driving amount of the driving means for making the conversion amount by the conversion unit withdrawing / retracting amount when converting the withdrawal amount of the placing body in the retracting direction into the driving amount of the driving means, Sensor detection timing The driving amount of the driving means for positioning the above-described body with respect to the correction position is determined on the basis of detection information of the driving amount detection means.

すなわち、運転制御手段は、載置体を引退位置から基準突出量だけ突出させるべく、駆動量検出手段の検出情報に基づいて駆動手段を作動させる。物品状態検出センサーは、載置体を引退位置から予め設定された基準突出量だけ突出させるときに物品に備えられた被検出体を検出作用する状態で載置体に設けられているので、載置体を引退位置から基準突出量だけ突出させるときに、物品状態検出センサーが物品の被検出体を検出することになる。その検出タイミングで駆動量検出手段にて検出される駆動手段の駆動量が、基準位置に位置していると仮定した物品に対して載置体を突出させた場合に予定される物品状態検出センサーの検出タイミングにおける駆動量検出手段にて検出される駆動量と異なっていれば、物品が基準位置であるときに予定される駆動量検出手段の駆動量と異なった分だけ物品が基準位置からずれていることがわかる。このように、物品の基準位置からの出退ズレ量を、物品状態検出センサー及び駆動量検出手段の検出情報に基づいて、物品が基準位置に位置する場合とそうでない場合との夫々におけるセンサー検出タイミングにおける載置体の位置に対する物品の相対位置の違いから求めることができる。   That is, the operation control means operates the drive means based on the detection information of the drive amount detection means so that the mounting body protrudes from the retracted position by the reference protrusion amount. The article state detection sensor is provided on the mounting body in a state of detecting the detected body provided on the article when the mounting body is protruded from the retraction position by a preset reference protrusion amount. When the object is projected from the retraction position by the reference protrusion amount, the article state detection sensor detects the article to be detected. An article state detection sensor that is expected when the mounting body projects from an article on the assumption that the drive amount of the drive means detected by the drive amount detection means at the detection timing is located at the reference position If the drive amount is different from the drive amount detected by the drive amount detection means at the detection timing, the article is shifted from the reference position by an amount different from the drive amount of the drive amount detection means planned when the article is at the reference position. You can see that In this way, the amount of deviation from the reference position of the article is detected based on the detection information of the article state detection sensor and the driving amount detection means, when the article is located at the reference position and when it is not. It can be determined from the difference in the relative position of the article with respect to the position of the mounting body at the timing.

そして、運転制御手段は、基準位置から出退方向で出退ズレ量だけずれた補正用位置に対して載置体を位置させるように駆動量検出手段の検出情報に基づいて載置体の出退作動を制御することで、載置体を補正用位置に位置させることになる。   Then, the operation control means moves the placement body on the basis of the detection information of the drive amount detection means so as to position the placement body with respect to the correction position that is shifted from the reference position in the withdrawal / retraction direction by the amount of displacement. By controlling the retracting operation, the mounting body is positioned at the correction position.

ここで、揺動体の揺動作動による揺動端部側の変位のうち載置体の出退方向に寄与する成分は揺動体の姿勢により異なるので、載置体の出退方向での位置が異なると揺動体の姿勢が異なることから、駆動手段の駆動量が同じであっても異なる量だけ載置体を出退方向で移動させることになる。したがって、載置体の出退方向での位置が異なると、単位駆動量当たりの載置体の出退方向での単位出退量は異なることになる。   Here, the component contributing to the moving direction of the mounting body among the displacement on the rocking end side due to the rocking operation of the rocking body varies depending on the posture of the rocking body. If they are different, the posture of the swinging body is different, so that even if the driving amount of the driving means is the same, the mounting body is moved in the retracting direction by a different amount. Therefore, if the position of the placement body in the direction of withdrawal is different, the unit withdrawal amount in the direction of withdrawal of the placement body per unit driving amount is different.

そのため、基準位置から出退方向で出退ズレ量だけずれた補正用位置に対して載置体を位置させる場合には、載置体の出退方向の位置に応じた精度のよい単位出退量に基づいて、出退ズレ量に対応する駆動量を補正駆動量として求めれば、例えば、載置体を引退位置から基準突出量だけ突出させるために必要な駆動手段の基準駆動量を補正駆動量で補正して補正後の駆動量を駆動手段に指令することや、載置体を引退位置から基準突出量だけ突出させた位置から補正用位置に位置させるための補正作動用の出退量を求めて補正駆動量を駆動手段に指令することで、載置体を補正用位置に対して精度良く位置させることができる。   Therefore, when the mounting body is positioned with respect to the correction position that is shifted from the reference position in the retracting direction by the retracting / withdrawing amount, the unit exit / exit with high accuracy according to the position of the mounting body in the retracting direction. If the driving amount corresponding to the amount of displacement is calculated as the corrected driving amount based on the amount, for example, the reference driving amount of the driving means necessary for causing the mounting body to protrude by the reference protruding amount from the retracted position is corrected and driven. Commanding the driving means after correction by the amount to the driving means, or for the correction operation to place the mounting body at the correction position from the position protruding from the retraction position by the reference protrusion amount Thus, the corrective driving amount is commanded to the driving means, so that the mounting body can be accurately positioned with respect to the correction position.

また、物品の基準位置からの出退ズレ量を求めるにしても、センサー検出タイミングにおける載置体の出退方向での位置についての単位出退量として精度のよいものを用いれば、物品が基準位置に位置する場合とそうでない場合との夫々におけるセンサー検出タイミングにおける載置体の位置に対する物品の相対位置の違いを精度良く計測することができ、こにより、センサー検出タイミングにおける駆動量検出手段の検出情報に基づいて出退ズレ量を精度良く求めることができる。   Further, even when the amount of deviation from the reference position of the article is obtained, if the accurate unit is used as the unit withdrawal amount for the position in the direction of withdrawal of the mounting body at the sensor detection timing, the article is the reference It is possible to accurately measure the difference in the relative position of the article with respect to the position of the mounting body at the sensor detection timing in each of the case where the position is located and the case where the position is not, so that the driving amount detecting means of the sensor detection timing can be measured. Based on the detection information, the amount of displacement can be obtained with high accuracy.

本発明によれば、運転制御手段は、センサー検出タイミングにおける載置体の出退方向での位置についての単位出退量である変換用単位出退量を求めるので、センサー検出タイミングにおける載置体の位置での単位出退量として精度の良いものを用いることができる。そして、物品状態検出センサーが物品の被検出体に対して検出作用するときの載置体の出退方向での位置は、載置体が引退位置から基準突出量だけ突出したときの位置に極めて近く、この位置での単位出退量である変換用単位出退量を用いて出退ズレ量に対応する駆動量を求めることで、基準位置から出退方向で出退ズレ量だけずれた補正用位置に対して載置体を位置させるために必要な補正駆動量を精度良く求めることができる。また、変換用単位出退量を用いることで、物品が基準位置に位置する場合とそうでない場合との夫々におけるセンサー検出タイミングにおける載置体の位置に対する物品の相対位置の違いを精度良く計測できるので、出退ズレ量を精度良く求めることができる。   According to the present invention, the operation control means obtains the conversion unit withdrawal / retraction amount, which is the unit withdrawal / retraction amount for the position of the placement body in the withdrawal / retraction direction at the sensor detection timing, so the placement body at the sensor detection timing. A unit with a high accuracy can be used as the unit withdrawal amount at the position. The position of the mounting body when the article state detection sensor detects the article to be detected is extremely different from the position when the mounting body protrudes from the retraction position by the reference protrusion amount. Nearly, by calculating the drive amount corresponding to the exit / exit amount using the conversion unit exit / exit amount, which is the unit exit / exit amount at this position, a correction shifted by the exit / exit amount in the exit / exit direction from the reference position It is possible to accurately obtain the correction driving amount necessary for positioning the mounting body with respect to the use position. Further, by using the conversion unit withdrawal amount, it is possible to accurately measure the difference in the relative position of the article with respect to the position of the mounting body at the sensor detection timing when the article is positioned at the reference position and when it is not. Therefore, it is possible to accurately calculate the amount of displacement.

したがって、物品の出退方向での出退ズレ量を精度よく計測して、その出退ズレ量に対応した補正駆動量として精度の良いものを用いて、駆動手段の駆動量を求めることになるので、載置体の引退位置からの突出量を、載置体の出退方向における物品の基準位置からのズレ量に対応した突出量となるように、精度よく調整することができる物品搬送装置を得るに至った。   Therefore, the amount of displacement of the article in the direction of exit / retreat is accurately measured, and the drive amount of the drive means is obtained by using an accurate correction drive amount corresponding to the amount of exit / retreat. Therefore, the article conveying apparatus capable of accurately adjusting the protruding amount from the retracted position of the mounting body to be a protruding amount corresponding to the deviation amount of the article from the reference position in the retracting direction of the mounting body. I came to get.

本発明に係る物品搬送装置の第2特徴構成は、前記運転制御手段が、前記補正用位置に対して前記載置体を位置させるための前記駆動手段の駆動量を求めるに当たり、前記センサー検出タイミングにおける前記駆動量検出手段の検出情報に基づいて前記出退ズレ量を求め、その求めた前記出退ズレ量を前記変換用単位出退量により前記駆動手段の駆動量に変換して前記駆動手段の駆動量を求めるように構成されている点にある。   According to a second characteristic configuration of the article transporting apparatus according to the present invention, the operation control means determines the sensor detection timing when determining the driving amount of the driving means for positioning the mounting body with respect to the correction position. The amount of displacement is determined based on the detection information of the drive amount detection means in the above, and the calculated amount of displacement is converted into the drive amount of the drive means by the conversion unit withdrawal amount. The driving amount is determined to be obtained.

すなわち、運転制御手段は、出退ズレ量だけずれた補正用位置に対して載置体を位置させるために必要な補正駆動量を、出退ズレ量変換用単位出退量により駆動手段の駆動量に変換して求めるので、駆動手段を駆動させたときに、出退ズレ量に精度良く一致した量だけ載置体が出退する。これにより、補正用位置に対して載置体を位置させるために駆動手段の作動が制御された結果、実際に載置体が位置する位置についての基準位置に対する出退ズレ量と、物品状態検出センサー及び駆動量検出手段の検出情報に基づいて求めた出退ズレ量とが精度良く一致することになる。したがって、出退ズレ量が与えられた場合に、載置体の引退位置からの突出量を精度よく調整することができる。   That is, the operation control means determines the correction drive amount necessary to position the mounting body with respect to the correction position shifted by the amount of withdrawal / extraction, and the drive means drive by the unit withdrawal / extraction amount for the amount of exit / exit deviation conversion. Since it is obtained by converting into an amount, when the driving means is driven, the placing body is withdrawn / withdrawn by an amount that accurately matches the withdrawing / withdrawing amount. As a result, the operation of the driving means is controlled to position the mounting body with respect to the correction position, and as a result, the amount of deviation from the reference position with respect to the position where the mounting body is actually positioned, and the article state detection The exit / exit amount obtained based on the detection information of the sensor and the drive amount detection means coincides with high accuracy. Therefore, when the amount of displacement is given, the amount of protrusion from the retracted position of the mounting body can be adjusted with high accuracy.

本発明に係る物品搬送装置の第3特徴構成は、前記運転制御手段が、前記出退ズレ量を求めるに当たり、前記センサー検出タイミングにおける前記駆動量検出手段にて検出した前記駆動手段の駆動量を前記変換用単位出退量にて前記載置体の出退量に変換して前記出退ズレ量を求めるように構成されている点にある。   According to a third characteristic configuration of the article conveying apparatus according to the present invention, when the operation control unit obtains the amount of displacement, the drive amount of the drive unit detected by the drive amount detection unit at the sensor detection timing is calculated. In the point which is converted into the amount of withdrawing / withdrawing of the above-mentioned object by the amount of unit withdrawing / withdrawing for conversion, the amount of withdrawal / withdrawal is obtained.

すなわち、運転制御手段は、物品状態検出センサー及び駆動量検出手段の検出情報に基づいて出退ズレ量を求める場合に、センサー検出タイミングにおける載置体の出退方向での位置についての単位出退量である変換用単位出退量にて、センサー検出タイミングにおける駆動手段の駆動量を載置体の出退量に変換して出退ズレ量を求めることになる。つまり、基準位置に位置していると仮定した物品に対して載置体を突出させた場合に予定される物品状態検出センサーの検出タイミングにおける駆動量検出手段にて検出される駆動量と実際のセンサー検出タイミングにおける駆動量検出手段にて検出される駆動量との差を、センサー検出タイミングにおける載置体の出退方向での位置についての単位出退量である変換用単位出退量にて出退量に変換することで、駆動量の差として表される出退ズレ量を精度良く出退ズレ量に換算することができる。したがって、物品の出退ズレ量を精度よく求めることができる。   That is, when the operation control means obtains the amount of displacement, based on the detection information of the article state detection sensor and the drive amount detection means, the unit control of the position of the mounting body in the direction of exit / retreat at the sensor detection timing. With the conversion unit withdrawal amount, which is the amount, the drive amount of the drive means at the sensor detection timing is converted into the withdrawal amount of the mounting body to obtain the withdrawal / retraction amount. That is, the drive amount detected by the drive amount detection means at the detection timing of the article state detection sensor scheduled when the mounting body is projected with respect to the article assumed to be located at the reference position and the actual amount The difference from the drive amount detected by the drive amount detection means at the sensor detection timing is a conversion unit exit / exit amount that is a unit exit / exit amount with respect to the position of the mounting body in the sensor detection timing By converting into the amount of withdrawal / withdrawal, the amount of departure / withdrawal represented as the difference in drive amount can be accurately converted to the amount of withdrawal / withdrawal. Therefore, it is possible to accurately determine the amount of article withdrawal and withdrawal.

本発明に係る物品搬送装置の第4特徴構成は、前記運転制御手段が、前記物品支持部に支持された物品を取り出すために前記載置体を突出作動させる場合に、前記センサー検出タイミングにおける前記駆動量検出手段の検出情報に基づいて、前記補正用位置に対して前記載置体を位置させるための前記駆動手段の駆動量を求めるように構成されている点にある。   According to a fourth characteristic configuration of the article transporting apparatus according to the present invention, when the operation control means causes the placing body to project and operate to take out the article supported by the article support section, the sensor detection timing is Based on the detection information of the driving amount detecting means, the driving amount of the driving means for positioning the above-described body with respect to the correction position is obtained.

すなわち、運転制御手段は、物品支持部に支持された物品を取り出すべく載置体を突出作動させる場合に、補正用位置に対して載置体を位置させるための駆動手段の駆動量を求めるので、移載対象である物品が基準位置からずれていれば、その出退ズレ量を実際の移載対象の物品における被検出体を検出作用する物品状態検出センサー及び駆動量検出手段の検出情報に基づいて求めることになる。そして、補正用位置に対して載置体を位置させるように駆動量検出手段の検出情報に基づいて載置体の出退作動を制御することで、載置体を基準突出量から出退方向で移載対象の物品の実際の出退ズレ量だけずれた補正用位置に対して位置させることができる。   That is, the operation control means obtains the driving amount of the driving means for positioning the mounting body with respect to the correction position when the mounting body is operated to protrude to take out the article supported by the article support section. If the article to be transferred is deviated from the reference position, the amount of displacement is used as the detection information of the article state detection sensor and the drive amount detection means for detecting the detected object in the actual article to be transferred. Will be based on. Then, the placement body is moved away from the reference protrusion amount by controlling the withdrawal operation of the placement body based on the detection information of the driving amount detection means so as to position the placement body with respect to the correction position. Thus, it can be positioned with respect to the correction position shifted by the actual amount of displacement of the article to be transferred.

説明を加えると、例えば、運転制御手段は、載置体を引退位置から突出作動させ始めてからの駆動手段の駆動量が、基準突出量に対応する駆動手段の基準駆動量を、出退ズレ量だけ載置体を出退方向に出退させるために必要な補正駆動量だけ補正した適応駆動量となるように、駆動手段の作動を制御すればよい。この場合、運転制御手段は、載置体を引退位置から突出作動させるときに、まず、載置体を引退位置から突出作動させ始めてからの駆動手段の駆動量が基準駆動量となるように、駆動量検出手段の検出情報に基づいて、駆動手段の作動を制御する。そして、センサー検出タイミング後、出退ズレ量が算出されると、その出退ズレ量に対応した補正駆動量だけ基準駆動量を補正して適応駆動量を算出し、載置体を引退位置から突出作動させ始めてからの駆動手段の駆動量が適応駆動量となるように駆動手段の作動を制御する。したがって、運転制御手段は、載置体を突出作動させ始めてからの駆動手段の駆動量が基準駆動量となるように駆動手段の作動を制御する状態から、同駆動量が適応駆動量となるように駆動手段の作動を制御する状態に切り換えることで、載置体を補正用位置に対して位置させることができる。つまり、運転制御手段は、載置体を引退位置から突出させるべく駆動手段の駆動を開始した後から載置体を補正用位置に対して位置させるまで、一貫して駆動手段の駆動量が目標駆動量になるように駆動手段の作動を制御することになり、運転制御手段の制御態様を維持したまま、目標駆動量を基準駆動量から適応駆動量に変更するだけで、載置体を補正用位置に対して位置させることができる。また、引退位置からの突出を開始してからの出退作動中に、目標駆動量を基準駆動量から適応駆動量に変更することも可能であるので、載置体を基準突出量までわざわざ突出させることなく、又は、基準突出量だけ突出させた時点で停止させることなく、載置体を補正用位置に対して円滑に位置させることも可能となる。   In other words, for example, the operation control means determines that the drive amount of the drive means after starting the projecting operation of the mounting body from the retracted position is equal to the reference drive amount of the drive means corresponding to the reference protrusion amount. It is only necessary to control the operation of the driving means so that the adaptive driving amount is corrected by the correction driving amount necessary for moving the mounting body in the retracting direction. In this case, when the operation control means causes the mounting body to project from the retracted position, first, the driving amount of the driving means after starting to project the mounting body from the retracted position becomes the reference driving amount. Based on the detection information of the drive amount detection means, the operation of the drive means is controlled. Then, after the sensor detection timing, when the withdrawal displacement amount is calculated, the adaptive drive amount is calculated by correcting the reference drive amount by the correction drive amount corresponding to the withdrawal displacement amount, and the mounting body is moved from the retraction position. The operation of the drive means is controlled so that the drive amount of the drive means after starting the protrusion operation becomes the adaptive drive amount. Therefore, the operation control means is configured so that the drive amount becomes the adaptive drive amount from the state in which the operation of the drive unit is controlled so that the drive amount of the drive unit after starting the projecting operation of the mounting body becomes the reference drive amount. By switching to the state in which the operation of the driving means is controlled, the mounting body can be positioned with respect to the correction position. That is, the operation control means consistently sets the drive amount of the drive means from the start of driving of the drive means to project the placement body from the retracted position until the placement body is positioned with respect to the correction position. The operation of the drive means will be controlled so that the drive amount becomes the same, and the mounting body can be corrected simply by changing the target drive amount from the reference drive amount to the adaptive drive amount while maintaining the control mode of the operation control means. It can be positioned relative to the service position. In addition, it is possible to change the target drive amount from the reference drive amount to the adaptive drive amount during the retreat operation after starting the protrusion from the retraction position, so that the mounting body protrudes to the reference protrusion amount. It is also possible to smoothly place the mounting body with respect to the correction position without making it stop, or without stopping when the base protrusion is made to protrude.

また、例えば、運転制御手段は、載置体を引退位置から基準突出量だけ突出させた後に、出退ズレ量だけ載置体を出退方向に出退させるために必要な補正駆動量だけ駆動手段を作動させるように駆動手段の作動を制御することによっても、載置体を基準突出量から出退方向で移載対象の物品の実際の出退ズレ量だけずれた補正用位置に対して位置させることができる。   In addition, for example, the operation control means drives the mounting body by a correction driving amount necessary for moving the mounting body in the withdrawing / withdrawing direction after the mounting body protrudes from the retraction position by the reference protrusion amount. Also by controlling the operation of the driving means so as to operate the means, the correction position deviates from the reference protrusion amount by the actual withdrawal displacement amount of the article to be transferred in the withdrawal direction. Can be positioned.

このように、移載対象の物品の基準位置からの実際の出退ズレ量を求めて、その実際の出退ズレ量だけ基準位置からずれた位置を補正用位置とすることで、物品を取り出すときの載置体の引退位置からの突出量を、移載対象の物品の出退方向の基準位置からの実際の出退ズレ量に適切に対応した突出量とすることができる。   In this way, the actual withdrawal amount from the reference position of the article to be transferred is obtained, and the position shifted from the reference position by the actual withdrawal amount is set as the correction position, and the article is taken out. The amount of protrusion from the retracted position of the mounting body at that time can be a protrusion amount that appropriately corresponds to the actual amount of displacement from the reference position in the direction of withdrawal of the article to be transferred.

本発明に係る物品搬送装置の第5特徴構成は、前記物品状態検出センサーが、前記移動経路の長手方向に並ぶ一対の検出部を備えて構成され、前記運転制御手段が、前記載置体を前記引退位置から前記基準突出量だけ突出させるときに、一対の前記検出部の夫々が前記被検出体を検出作用するまでの前記出退方向での距離差を、一対の前記検出部の夫々が前記被検出体を検出作用したときの前記駆動量検出手段にて検出する駆動量の差を前記変換用単位出退量にて変換して求め、その求めた距離差から前記物品支持部に支持された物品についての平面視における基準姿勢からの傾きを求めるように構成されている点にある。   According to a fifth characteristic configuration of the article transporting apparatus according to the present invention, the article state detection sensor includes a pair of detection units arranged in a longitudinal direction of the movement path, and the operation control means includes the mounting body. When projecting by the reference projection amount from the retraction position, the distance difference in the withdrawal direction until each of the pair of detection units detects the detected object is determined by each of the pair of detection units. A difference in drive amount detected by the drive amount detection means when the detected object is detected is converted by the conversion unit withdrawal amount, and is supported on the article support unit from the obtained distance difference. It is the point which is comprised so that the inclination from the reference | standard attitude | position in planar view about the performed article | item may be calculated | required.

載置体を引退位置から基準突出量だけ突出させるときに、物品支持部に支持された物品の姿勢は基準姿勢になっているものとして載置体を突出する。よって、物品支持部に支持された物品の姿勢が基準姿勢から傾いていると、載置体を引退位置から基準突出量だけ突出させるときに、一方の検出部が被検出体を検出したときの駆動量検出手段にて検出する駆動量と他方の検出部が被検出体を検出したときの駆動量検出手段にて検出する駆動量との間に差が生じる。そこで、その差を一対の検出部の夫々が被検出体を検出作用するまでの出退方向での距離差として捉えることができ、その距離差から基準姿勢からの傾きを求めることができる。よって、求めた傾きを補正することにより載置体にて基準姿勢の物品を載置することができる。しかも、基準姿勢からの傾きを求めるに当たり、駆動量の差を出退方向での距離差に変換するときに変換用単位出退量により変換するので、より正確な基準姿勢からの傾きを求めることができ、載置体に基準姿勢の物品を載置することを正確に行える。   When the mounting body is protruded from the retraction position by the reference protrusion amount, the mounting body protrudes assuming that the posture of the article supported by the article support portion is the reference posture. Therefore, when the posture of the article supported by the article support portion is tilted from the reference posture, when the detection unit detects the detected object when the mounting body protrudes from the retraction position by the reference protrusion amount. There is a difference between the drive amount detected by the drive amount detection means and the drive amount detected by the drive amount detection means when the other detection unit detects the detection target. Therefore, the difference can be grasped as a distance difference in the exit / retreat direction until each of the pair of detection units detects the detection object, and the inclination from the reference posture can be obtained from the distance difference. Therefore, the article in the reference posture can be placed on the placement body by correcting the obtained inclination. In addition, when calculating the inclination from the reference posture, when converting the difference in drive amount into the distance difference in the exit / exit direction, conversion is performed using the conversion unit exit / exit amount, so that more accurate inclination from the reference posture can be obtained. It is possible to accurately place the article in the reference posture on the placing body.

本発明に係る物品搬送装置の第6特徴構成は、前記揺動体は、前記移動体側に揺動自在に支持される操作アームと、前記操作アームの先端側に揺動自在に連結される揺動アームとからなる屈伸式の2連リンクアームを備えて構成され、かつ、前記駆動手段により前記操作アームが揺動作動されるに伴って、前記載置体を前記出退方向に沿って直線移動させるように構成されている点にある。   According to a sixth characteristic configuration of the article transporting apparatus according to the present invention, the swinging body includes an operation arm that is swingably supported on the movable body side, and a swing that is swingably connected to a distal end side of the operation arm. The above-mentioned body is linearly moved along the withdrawing / retracting direction as the operating arm is swung by the driving means. It is in the point where it is constituted so that.

すなわち、揺動体は、屈伸式の2連リンクアームを備えて構成されているので、載置体の引退位置側で屈曲し、突出位置側で伸長することで、載置体を引退位置と突出位置との間で出退作動させることになる。そのため、載置体を出退作動させるときの揺動体の姿勢変化は、載置体の出退ストロークの割に出退方向で側方への張り出しが少なくて済む。したがって、揺動体と外部との干渉の問題が生じ難い。   That is, since the rocking body is configured to include a bending-extension-type double link arm, it bends at the retracted position side of the mounting body and extends at the projecting position side, so that the mounting body protrudes from the retracted position. It will be moved in and out of the position. For this reason, the change in the posture of the swinging body when the mounting body is withdrawn / retracted is less likely to project in the lateral direction in the retracting / retracting direction for the retracting stroke of the mounting body. Therefore, the problem of interference between the oscillator and the outside hardly occurs.

また、載置体を出退方向に沿って直線移動させるものであるから、出退量を補正した場合でも、載置体が当該出退方向から外れることはないので、載置体の平面視における姿勢や、出退方向と交差する方向における位置、例えば、移動体の移動経路の長手方向における位置も調整する場合であっても、これらの調整に影響を与え難い状態で出退方向における位置を調整することができる。   In addition, since the mounting body is moved linearly along the exit / retreat direction, the placement body does not deviate from the exit / retreat direction even when the withdrawal amount is corrected. Even if the position in the direction intersecting the exit / retreat direction, for example, the position in the longitudinal direction of the moving path of the moving body is also adjusted, the position in the exit / retreat direction is difficult to affect these adjustments. Can be adjusted.

本発明に係る物品搬送装置の第7特徴構成は、前記運転制御手段は、前記操作アーム及び前記揺動アームが上下方向視で上下に重なる重複姿勢であるときの前記駆動量検出手段の検出情報を基準検出情報として記憶自在に構成され、かつ、前記載置体を前記基準突出量だけ突出せるときに、前記センサー検出タイミングにおける前記駆動量検出手段の検出情報と前記基準検出情報とに基づいて、前記センサー検出タイミングにおける前記操作アームについての前記重複姿勢からの揺動角度を検出する揺動角度検出手段と、前記操作アーム及び前記揺動アームが前記重複姿勢であるときの前記載置体の前記出退方向での位置についての前記単位出退量を、前記揺動角度検出手段の検出情報に基づいて変換することで、前記センサー検出タイミングにおける前記載置体の前記出退方向での位置についての前記単位出退量を取得する単位出退量変換手段とを備えて構成されている点にある。   A seventh characteristic configuration of the article transporting apparatus according to the present invention is the detection information of the driving amount detecting means when the operation control means is in an overlapping posture in which the operation arm and the swing arm overlap vertically in a vertical view. Can be stored as reference detection information, and when the mounting body is protruded by the reference protrusion amount, based on the detection information of the drive amount detection means and the reference detection information at the sensor detection timing , A swing angle detecting means for detecting a swing angle from the overlapping posture of the operation arm at the sensor detection timing, and the mounting body when the operation arm and the swing arm are in the overlapping posture. The sensor detection timing is converted by converting the unit withdrawal amount with respect to the position in the withdrawal direction based on detection information of the swing angle detection means. In that it is constituted by a unit extending and retracting amount conversion means for acquiring the unit out Shisaryou about the position in the projecting and retracting direction before described mounting body in.

すなわち、運転制御手段は、揺動角度検出手段を機能させて、基準検出情報として記憶している揺動体が重複姿勢であるときの駆動量検出手段の検出情報と、センサー検出タイミングにおける駆動量検出手段の検出情報とから、センサー検出タイミングにおける操作アームについての重複姿勢からの揺動角度を求める。   That is, the operation control means causes the swing angle detection means to function so that the detection information of the drive amount detection means when the swing body stored as the reference detection information is in the overlapping posture and the drive amount detection at the sensor detection timing. From the detection information of the means, the swing angle from the overlapping posture of the operation arm at the sensor detection timing is obtained.

揺動体が重複姿勢であるときは、揺動体の揺動端部における揺動軌跡に対する接線方向が出退方向を向くことになるので、揺動体の揺動端部についての揺動角度に対する変化率ベクトルは、出退方向を向くことになる。そして、揺動体が重複姿勢から揺動して揺動角度が増すにつれて、揺動体の揺動端部についての揺動角度に対する変化率ベクトルのうち出退方向の成分は、揺動体の重複姿勢からの揺動角度に応じて減少してくことになる。このとき、揺動体の揺動端部についての揺動角度の変化に対する変化率ベクトルは、その揺動角度の余弦成分だけが出退方向に寄与するので、揺動端部の変化率ベクトルの出退方向成分と揺動角度との関係は定まっている。   When the oscillating body is in an overlapping posture, the tangential direction with respect to the oscillating trajectory at the oscillating end of the oscillating body faces the exit / retreat direction. The vector will turn in the exit / exit direction. Then, as the swinging body swings from the overlapping posture and the swinging angle increases, the component in the retracting direction of the change rate vector with respect to the swinging angle of the swinging end of the swinging body is determined from the overlapping posture of the swinging body. It decreases according to the rocking angle. At this time, the change rate vector for the change in the swing angle of the swing end of the swing body is only the cosine component of the swing angle contributes to the exit / retreat direction. The relationship between the backward component and the swing angle is fixed.

また、重複姿勢であるときの単位出退量は、駆動手段の単位駆動量をその単位駆動量で揺動する角度が揺動半径に対して十分小さくなる値にすれば、単位駆動量あたりの揺動体の揺動角度は、弧度法での角度として十分小さな値となるので、ある半径についての微小角度に立つ円弧長とその半径を底辺とし頂角がその微小角度からなる直角三角形の正接との近似関係を適用することで、揺動体の揺動半径と駆動手段の単位駆動量による揺動角度とから求めることができる。   Further, the unit withdrawal / retreat amount in the overlapping posture is the unit drive amount per unit drive amount if the unit drive amount of the drive means is set to a value that makes the swing angle with the unit drive amount sufficiently small with respect to the swing radius. Since the rocking angle of the rocking body is a sufficiently small value as an angle in the arc method, the arc length standing at a minute angle with respect to a certain radius and the tangent of a right triangle with the radius as the base and the apex angle consisting of the minute angle By applying this approximate relationship, it can be obtained from the rocking radius of the rocking body and the rocking angle by the unit driving amount of the driving means.

したがって、運転制御手段は、単位出退量変換手段を機能させて、揺動体が重複姿勢であるときの載置体の出退方向での位置についての単位出退量を、センサー検出タイミングにおける操作アームについての重複姿勢からの揺動角度に基づいて変換することで、揺動角度の変化に対する揺動端部の変化率ベクトルのうち出退方向に寄与する成分の大きさを、揺動角度に応じた単位出退量として抽出することができる。   Therefore, the operation control unit operates the unit withdrawal / retraction amount conversion unit to change the unit withdrawal amount with respect to the position in the withdrawal / retraction direction of the mounting body when the swinging body is in the overlapping posture at the sensor detection timing. By converting based on the swing angle from the overlapping posture of the arm, the magnitude of the component that contributes to the retracting direction of the change rate vector of the swing end with respect to the change of the swing angle is changed to the swing angle. It can be extracted as a corresponding unit withdrawal amount.

このようにして、重複姿勢での単位出退量を基準にすることで、揺動アームと操作アームが重なるという機械的に位置関係を現出し易い姿勢を基準に揺動角度を算出して、揺動角度に応じた単位出退量を求めることができるので、単位出退量変換手段にて基準からの揺動角度を算出する場合の精度が向上し、もって、揺動角度に応じた単位出退量を精度良く求めることができる。   In this way, by calculating the swing angle on the basis of the posture in which the swing arm and the operation arm overlap with each other and the position where the swing arm and the operation arm easily appear, based on the unit withdrawal amount in the overlapping posture. Since the unit withdrawal / retraction amount according to the swing angle can be obtained, the accuracy when calculating the swing angle from the reference by the unit withdrawal / retraction amount conversion means is improved, so that the unit according to the swing angle is improved. The withdrawal amount can be obtained with high accuracy.

本発明に係る物品搬送装置の第8特徴構成は、前記操作アーム及び前記揺動アームの夫々に、前記重複姿勢において平面視で軸心が一致する位置に係合孔が設けられ、前記重複姿勢における前記揺動体に対して、装着状態で前記係合孔の双方に嵌合して前記操作アーム及び前記揺動アームを前記重複姿勢に位置決めするための位置決め用部材を着脱自在に備えている点にある。   An eighth characteristic configuration of the article transporting apparatus according to the present invention is such that an engagement hole is provided in each of the operation arm and the swing arm at a position where the axes coincide with each other in a plan view in the overlapping posture. The oscillating body in FIG. 5 is detachably provided with a positioning member that fits in both the engagement holes in the mounted state to position the operation arm and the oscillating arm in the overlapping posture. It is in.

すなわち、位置決め用部材を重複姿勢における揺動体に対して、装着操作することで、操作アーム及び揺動アームに対して、重複姿勢において平面視で軸心が一致する位置に設けられた係合孔の双方に位置決め用部材が嵌合する。これにより、操作アーム及び揺動アームが重複姿勢に位置決めされる。このように、位置決め用部材を係合孔に嵌合させるだけの簡単な操作により、操作アーム及び揺動アームを重複姿勢に位置決めすることができる。   That is, by engaging the positioning member with respect to the swinging body in the overlapping posture, the engagement hole provided at the position where the axial center coincides with the operation arm and the swinging arm in a plan view in the overlapping posture. The positioning member is fitted to both of them. Thereby, the operation arm and the swing arm are positioned in the overlapping posture. As described above, the operation arm and the swing arm can be positioned in an overlapping posture by a simple operation of simply fitting the positioning member into the engagement hole.

位置決め用部材を装着状態で維持しておけば、操作アーム及び揺動アームは、重複姿勢に位置決めされた状態で維持されるので、揺動体の重複姿勢における駆動量検出手段の検出情報を基準検出情報として確実に記録することができる。   If the positioning member is maintained in the mounted state, the operation arm and the swing arm are maintained in the overlapping posture, so that the detection information of the drive amount detection means in the overlapping posture of the swing body is detected as a reference. It can be reliably recorded as information.

自動倉庫の縦断面図Vertical section of automated warehouse 自動倉庫の横断面図Cross section of automated warehouse スタッカークレーンの側面図Side view of stacker crane 物品の斜視図Perspective view of the article 物品移載装置の縦断面図Longitudinal sectional view of article transfer device 引退状態におけるスタッカークレーンの平面図Top view of the stacker crane in the retired state 引退状態におけるスタッカークレーンの正面図Front view of stacker crane in retired state 突出状態におけるスタッカークレーンの平面図Top view of the stacker crane in the protruding state 突出状態におけるスタッカークレーンの正面図Front view of stacker crane in protruding state 制御ブロック図Control block diagram センサー検出タイミングにおける揺動体の姿勢等を示す図The figure which shows the posture etc. of the rocking body in the sensor detection timing 物品支持部に支持された物品についての、平面視における基準姿勢からの傾きを求めるための説明図Explanatory drawing for calculating | requiring the inclination from the reference | standard attitude | position in planar view about the articles | goods supported by the article | item support part. (a)物品支持部に支持された物品についての、載置体の出退方向における基準位置からのズレ量を求めるための説明図(b)基準位置に基準姿勢で物品支持部に支持された物品と、基準突出量及びセンサー検出タイミングとの関係を示す図(A) Explanatory drawing for obtaining the amount of deviation from the reference position in the exit / retreat direction of the mounting body for the article supported by the article support part (b) Supported by the article support part at the reference position at the reference position The figure which shows the relationship between articles | goods, reference | standard protrusion amount, and sensor detection timing 運転制御装置の記憶部に記憶されている制御パレメータを示す図The figure which shows the control parameter memorize | stored in the memory | storage part of an operation control apparatus. 運転制御装置が実行する常時掬い移載作動のフローチャートFlow chart of constantly moving transfer operation performed by the operation control device 運転制御装置が実行する先端パルスレート算出処理のフローチャートFlow chart of tip pulse rate calculation processing executed by operation control device 作業者が行う重複姿勢ティーチング作業のフローチャートFlowchart of overlapping posture teaching work performed by workers (a)重複姿勢における載置体の位置及びリンク機構の姿勢を示す図(b)アーム芯出し冶具の嵌合操作の説明図(A) The figure which shows the position of the mounting body in a duplication attitude | position, and the attitude | position of a link mechanism (b) Explanatory drawing of fitting operation of an arm centering jig

本発明に係る物品搬送装置を自動倉庫に適応した実施形態を図面に基づいて説明する。
この自動倉庫は、図1及び図2に示すように、クリーンルーム内に設置されており、物品収納部1を縦横に並べて複数備えた物品収納棚2と、物品収納棚2の前方の移動空間3を移動して物品収納部1に支持された物品4を取り出す又は物品収納部1に物品4を卸す作業を行う物品搬送装置としてのスタッカークレーン5とが設けられている。そして、図示は省略するが、クリーンルームでは、天井部から複数の孔部が形成された床部に向けて浄化空気を通風して浮遊する塵埃を床部の下方に排出するように構成されている。前記物品4は、例えば、複数のガラス基板を収納した収納カセットにて構成されている。
An embodiment in which an article transporting apparatus according to the present invention is applied to an automatic warehouse will be described with reference to the drawings.
As shown in FIGS. 1 and 2, this automatic warehouse is installed in a clean room, and has an article storage shelf 2 provided with a plurality of article storage units 1 arranged vertically and horizontally, and a moving space 3 in front of the article storage shelf 2. A stacker crane 5 is provided as an article transporting device that takes out the article 4 supported by the article storage unit 1 and takes the article 4 out of the article storage unit 1. And although illustration is abbreviate | omitted, in the clean room, it is comprised so that purified dust may be ventilated from the ceiling part toward the floor part in which the several hole part was formed, and the dust which floats may be discharged | emitted below the floor part. . The article 4 is constituted by, for example, a storage cassette that stores a plurality of glass substrates.

前記物品収納棚2は、前方側を互いに向かい合わせてその間に移動空間3を形成する状態で一対設けられている。各物品収納棚2は、棚横幅方向に間隔を隔てて立設された前後一対の支柱6と、前後一対の支柱6に亘る状態で支持されて棚上下方向に間隔を隔てて設けられた載置支持部7とから構成されている。そして、各物品収納部1は、左右一対の載置支持部7により物品4の棚横幅方向の両端部を載置支持する状態で物品4を収納するように構成されている。   A pair of the article storage shelves 2 are provided in a state where the front sides face each other and a moving space 3 is formed therebetween. Each article storage shelf 2 is supported in a state extending across the pair of front and rear columns 6 erected with a space in the width direction of the shelf and the pair of front and rear columns 6 and is provided with a space in the vertical direction of the shelf. It is comprised from the mounting support part 7. FIG. Each article storage unit 1 is configured to store the article 4 in a state in which both ends of the article 4 in the shelf width direction are placed and supported by the pair of left and right placement support parts 7.

前記物品収納部1は、物品として、図4に示すように、ガラス基板等の板状物品を保持可能な物品保持体4を収納自在に構成されている。前記物品保持体4は、格子状に形成された上枠体4a及び下枠体4bと、上枠体4aと下枠体4bとを連結する複数の連結体4cと、連結体4cに上下方向に間隔を隔てて設置されて水平方向に対向する連結体4c同士を連結するワイヤ状の支持部4dとから構成されている。そして、各支持部4dにて載置支持する状態で板状物品を上下方向に間隔を隔てて並べて保持しており、物品保持体4の上部、下部、及び、側部の全てにおいて空気流動可能に構成されている。なお、以下では、物品保持体4を単に物品4として説明する。   As shown in FIG. 4, the article storage unit 1 is configured to store an article holder 4 that can hold a plate-like article such as a glass substrate as an article. The article holding body 4 includes an upper frame body 4a and a lower frame body 4b formed in a lattice shape, a plurality of coupling bodies 4c that couple the upper frame body 4a and the lower frame body 4b, and a vertical direction to the coupling body 4c. And a wire-like support portion 4d that connects the connecting bodies 4c that are horizontally spaced and are connected to each other. The plate-like article is held in a vertically spaced manner in a state where it is placed and supported by each support part 4d, and air can flow in all of the upper part, the lower part, and the side part of the article holder 4. It is configured. In the following description, the article holder 4 is simply referred to as the article 4.

外部から物品収納棚2へ物品4を搬入する又は物品収納棚2から外部に物品4を搬出するための物品搬出入部8が、棚横幅方向において物品収納棚2に隣接する箇所に設置されている。物品搬出入部8は、例えば、物品4を載置搬送する搬送コンベヤにて構成されている。   An article loading / unloading portion 8 for carrying the article 4 from the outside to the article storage shelf 2 or for carrying the article 4 to the outside from the article storage shelf 2 is installed at a location adjacent to the article storage shelf 2 in the shelf width direction. . The article carry-in / out section 8 is configured by, for example, a transport conveyor that places and transports the articles 4.

また、物品搬出入部8の他に、物品4に対して所定の処理を行う物品処理設備9との間で物品4の搬出入を行うための物品搬出入用の物品載置部10が設けられている。この物品載置部10は、図1に示すように、物品収納棚2における一番下段に相当する物品収納部1に代えて備えられている。そして、物品処理設備9が、物品収納棚2の前後幅方向において物品収納棚2に隣接する箇所に設けられ、物品載置部10が、物品収納棚2の前後幅方向において物品処理設備9に隣接する箇所に設けられている。   In addition to the article carry-in / out section 8, an article placement section 10 for carrying in / out the article 4 to / from the article processing facility 9 that performs predetermined processing on the article 4 is provided. ing. As shown in FIG. 1, the article placement section 10 is provided in place of the article storage section 1 corresponding to the lowermost stage in the article storage shelf 2. The article processing facility 9 is provided at a location adjacent to the article storage shelf 2 in the front-rear width direction of the article storage shelf 2, and the article placement unit 10 is provided in the article processing facility 9 in the front-rear width direction of the article storage shelf 2. It is provided at an adjacent location.

前記物品載置部10では、スタッカークレーン5にて物品4が卸されると、図外の位置規制装置にて物品4を授受用適正位置に位置規制する。そして、物品4である収納カセットに収納されたガラス基板に対して物品処理設備9にて所定の処理を行うときには、物品処理設備9に備えた移載装置が、物品4である収納カセットからガラス基板を1枚ずつ取り出す。また、物品処理設備9における所定の処理が終了したガラス基板を物品4である収納カセットに収納するときには、物品処理設備9に備えた移載装置が位置規制装置にて授受用適正位置に位置規制された物品4である収納カセットに1枚ずつ収納する。   In the article placement section 10, when the article 4 is unloaded by the stacker crane 5, the position of the article 4 is restricted to an appropriate transfer position by a position restriction device (not shown). When a predetermined processing is performed on the glass substrate stored in the storage cassette that is the article 4 by the article processing facility 9, the transfer device provided in the article processing facility 9 transfers the glass from the storage cassette that is the article 4 to the glass. Take out the substrates one by one. Further, when the glass substrate that has been subjected to the predetermined processing in the article processing facility 9 is stored in the storage cassette that is the article 4, the transfer device provided in the article processing facility 9 is position-regulated by the position-regulating device at an appropriate transfer position. One by one is stored in the storage cassette that is the article 4 that has been processed.

前記移動空間3には、物品収納棚2の棚横幅方向の全範囲及び物品搬出入部8に亘る移動経路としての走行レール11が床部に左右一対設置されている。そして、スタッカークレーン5が走行レール11上を水平移動するように設けられている。前記スタッカークレーン5は、図3に示すように、走行レール11に沿って走行自在な移動体としての走行台車12、その走行台車12に立設された昇降マスト13に沿って昇降自在な昇降台14、その昇降台14に装着された物品移載装置15を備えて構成されている。   In the moving space 3, a pair of right and left traveling rails 11 are installed on the floor portion as a moving path extending over the entire range of the article storage shelf 2 in the width direction of the shelf and the article loading / unloading section 8. A stacker crane 5 is provided so as to move horizontally on the traveling rail 11. As shown in FIG. 3, the stacker crane 5 includes a traveling carriage 12 as a movable body that can travel along the traveling rail 11, and a lifting platform that can be moved up and down along a lifting mast 13 that stands on the traveling carriage 12. 14 and an article transfer device 15 mounted on the lifting platform 14.

前記スタッカークレーン5は、走行台車12の走行作動、昇降台14の昇降作動、及び、物品移載装置15の移載作動により、物品収納部1、物品搬出入部8、及び、物品載置部10に支持された物品4を取り出す又は物品収納部1、物品搬出入部8、及び、物品載置部10に物品4を卸すように構成されている。   The stacker crane 5 includes an article storage unit 1, an article carry-in / out unit 8, and an article placement unit 10 by a traveling operation of the traveling carriage 12, an elevation operation of the lifting platform 14, and a transfer operation of the article transfer device 15. The article 4 supported by the product is taken out or the article 4 is wholesaled to the article storage unit 1, the article carry-in / out unit 8, and the article placement unit 10.

そして、物品支持部41が、物品収納部1、物品搬出入部8、及び、物品載置部10を含めて構成されている。   The article support unit 41 includes the article storage unit 1, the article carry-in / out unit 8, and the article placement unit 10.

前記スタッカークレーン5において、昇降マスト13は、走行台車12の前端部と後端部の夫々に1つずつ前後一対設けられている。そして、昇降マスト13の上端部には、前後一対の昇降マスト13の上端部同士を連結する上部フレーム16が設けられている。   In the stacker crane 5, a pair of front and rear masts 13 are provided in the front and rear ends of the traveling carriage 12, one on each side. An upper frame 16 that connects the upper ends of the pair of front and rear masts 13 is provided at the upper end of the lift mast 13.

前記昇降台14は、走行台車12に立設した前後一対の昇降マスト13にて昇降自在に案内支持されており、その左右両側に連結した一対の昇降用ワイヤ17にて吊下げ支持されている。前記昇降用ワイヤ17の夫々は、昇降マスト13の上部に設けられた案内プーリ18に巻き掛けられて、走行台車12の端部に装備した巻き取りドラム20に巻回されている。   The lifting platform 14 is supported and supported by a pair of front and rear lifting masts 13 erected on the traveling carriage 12, and is supported by a pair of lifting wires 17 connected to the left and right sides thereof. . Each of the elevating wires 17 is wound around a guide pulley 18 provided on the upper portion of the elevating mast 13 and is wound around a take-up drum 20 provided at an end of the traveling carriage 12.

前記巻き取りドラム20の夫々には、インバータ式の昇降用電動モータ21が設けられている。そして、2つの昇降用電動モータ21が同期して正逆に回転駆動することにより、一対の昇降用ワイヤ17の繰り出し操作や巻き取り操作を行い、昇降台14を昇降作動させるように構成されている。   Each of the winding drums 20 is provided with an inverter type lifting electric motor 21. The two lifting electric motors 21 are synchronously rotated in the forward and reverse directions so that the lifting and lowering operation of the pair of lifting wires 17 is performed and the lifting platform 14 is moved up and down. Yes.

前記走行台車12には、昇降台14の下面に設置された反射板22に向けて昇降台14の昇降方向に沿って測距用のビーム光を投射して、昇降台14の昇降方向における昇降台14の昇降位置を検出する昇降用レーザ測距計23が設けられている。昇降用レーザ測距計23は、反射板22にて反射される光を受光することにより、昇降台14の昇降方向における昇降台14までの距離を検出して、昇降台14の昇降位置を検出するように構成されている。   The traveling carriage 12 is projected with a beam beam for distance measurement along the raising / lowering direction of the lifting platform 14 toward the reflection plate 22 installed on the lower surface of the lifting platform 14, so that the lifting platform 14 is lifted / lowered in the lifting / lowering direction. An elevating laser range finder 23 for detecting the elevating position of the table 14 is provided. The elevating laser range finder 23 detects the distance to the elevating table 14 in the elevating direction of the elevating table 14 by receiving the light reflected by the reflecting plate 22, and detects the elevating position of the elevating table 14. Is configured to do.

前記スタッカークレーン5において、走行台車12の横幅方向の両端部の夫々には、走行レール11の長手方向に間隔を隔てて一対の走行車輪24が配置されている。一対の走行車輪24のうち、一方の走行車輪は駆動車輪24aとして構成され、他方の走行車輪は遊転自在な従動車輪24bとして構成されている。走行台車12の横幅方向の両端部に配置された駆動車輪24aの夫々には、インバータ式の走行用電動モータ25(図1参照)が設けられている。そして、2つの走行用電動モータ25が同期して正逆に回転駆動することにより、走行台車12を走行レール11に沿って走行させるように構成されている。   In the stacker crane 5, a pair of traveling wheels 24 are arranged at both ends in the width direction of the traveling carriage 12 with an interval in the longitudinal direction of the traveling rail 11. Of the pair of traveling wheels 24, one traveling wheel is configured as a driving wheel 24a, and the other traveling wheel is configured as a freely driven driven wheel 24b. An inverter type traveling electric motor 25 (see FIG. 1) is provided on each of the drive wheels 24a disposed at both ends in the width direction of the traveling carriage 12. The two traveling electric motors 25 are driven to rotate forward and backward synchronously, so that the traveling carriage 12 travels along the traveling rail 11.

前記走行台車12には、走行レール11の一端部に設置された反射板26に向けて走行レール11の長手方向に沿って測距用のビーム光を投射して、走行台車12の走行方向における走行台車12の走行位置を検出する走行用レーザ測距計27が設けられている。走行用レーザ測距計27は、反射板26にて反射される光を受光することにより、走行台車12の走行方向における走行台車12までの距離を検出して、走行台車12の走行位置を検出するように構成されている。   A beam beam for distance measurement is projected onto the traveling carriage 12 along the longitudinal direction of the traveling rail 11 toward the reflector 26 installed at one end of the traveling rail 11, so A traveling laser range finder 27 that detects the traveling position of the traveling carriage 12 is provided. The traveling laser range finder 27 detects the distance to the traveling carriage 12 in the traveling direction of the traveling carriage 12 by receiving the light reflected by the reflecting plate 26 and detects the traveling position of the traveling carriage 12. Is configured to do.

前記物品移載装置15は、図1、図2及び図3並びに図6〜図9に示すように、昇降台14に対して旋回用上下軸心P0周りに旋回操作自在に支持された旋回台28、及び、物品4を載置支持する載置体29を旋回台28に対して出退自在に支持するリンク機構30を一対備えている。旋回台28は、旋回台28の下方側に設置された旋回用電動モータ31の作動により旋回用上下軸心P0周りで旋回作動されるように構成されている。   As shown in FIGS. 1, 2, 3 and 6 to 9, the article transfer device 15 is a swivel base supported so as to be capable of swiveling around a swivel vertical axis P0 with respect to the lift 14. 28 and a pair of link mechanisms 30 for supporting the placing body 29 for placing and supporting the article 4 with respect to the swivel base 28 so as to be retractable. The swivel base 28 is configured to be swiveled around the swivel upper and lower axis P0 by the operation of a swivel electric motor 31 installed on the lower side of the swivel base 28.

前記リンク機構30は、旋回台28に対して基端部が第1上下軸心P1周りで回動自在に連結された操作アームとしての第1アーム32、及び、その第1アーム32の先端部に対して第2上下軸心P2周りで回動自在に連結され且つ載置体29に対して第3上下軸心P3周りで回動自在に連結された揺動アームとしての第2アーム33を備えた屈伸式の2連リンクアームにて構成されたいわゆるスカラアームを用いている。   The link mechanism 30 includes a first arm 32 as an operation arm whose base end is connected to the swivel base 28 so as to be rotatable around the first vertical axis P1, and a distal end portion of the first arm 32. And a second arm 33 as a swinging arm that is pivotally connected around the second vertical axis P2 and is pivotally connected to the mounting body 29 around the third vertical axis P3. A so-called SCARA arm composed of a double-stretch type link arm provided is used.

図5に示すように、前記載置体29を突出作動又は引退作動させるために、第1アーム32の基端部に相当する箇所で旋回台28の下方側に出退用電動モータ34及び減速機が設けられている。前記出退用電動モータ34は、その回転駆動軸が各モータ別に設けられた減速機の入力軸に連動連結され、減速機の出力軸が第1アーム32に連動連結された状態で、一対の第1アーム32の夫々に対応して一対設けられている。一対の出退用電動モータ34が同期して作動することにより、各出退用電動モータに各別に備えられた減速機に対してモータ出力回転軸の回転作動が入力され、所定の減速比(本実施形態では、1/119としている。)にて減速された減速機の出力軸の回転作動により、一対の第1アーム32を同期して第1上下軸心P1周りで揺動させる。そして、図6では図示は省略するが、第1アーム32の動きと第2アーム33との動きを連係させるために、第1上下軸心P1における軸部及び第2上下軸心P2における軸部にチェーンが掛け渡されている。また、第1上下軸心及び第2上下軸心の距離と第2上下軸心及び第3上下軸心の距離(図11参照。)とは同じ距離C[mm]となっている。   As shown in FIG. 5, in order to cause the mounting body 29 to project or retract, the retracting electric motor 34 and the deceleration are provided below the swivel 28 at a position corresponding to the base end of the first arm 32. A machine is provided. In the state where the electric motor 34 for exit / retreat is linked to the input shaft of the speed reducer provided for each motor and the output shaft of the speed reducer is linked to the first arm 32, A pair is provided corresponding to each of the first arms 32. When the pair of exit / exit electric motors 34 operate in synchronization, the rotation operation of the motor output rotation shaft is input to the reduction gears provided separately for each of the exit / exit electric motors, and a predetermined reduction ratio ( In the present embodiment, the rotation speed of the output shaft of the speed reducer decelerated at 1/119) causes the pair of first arms 32 to swing around the first vertical axis P1 in synchronization. Although not shown in FIG. 6, in order to link the movement of the first arm 32 and the movement of the second arm 33, the shaft portion in the first vertical axis P <b> 1 and the shaft portion in the second vertical axis P <b> 2. A chain is stretched over. The distance between the first vertical axis and the second vertical axis and the distance between the second vertical axis and the third vertical axis (see FIG. 11) are the same distance C [mm].

これにより、一対のリンク機構30は、第1アーム32の揺動方向及び揺動量が第2アーム33の揺動方向及び揺動量と逆方向で同量となる状態で、出退用電動モータ34によって、第1アーム32を連動させてそれぞれの第1上下軸心P1周りで揺動操作し、揺動する第1アーム32によって一対の第2アーム33を介して載置体29の基端側を押し操作したり引き操作したりすることにより、載置体29を旋回台28に対して載置体29の前後方向に出退操作する。   As a result, the pair of link mechanisms 30 is configured such that the swinging direction and swinging amount of the first arm 32 are the same in the direction opposite to the swinging direction and swinging amount of the second arm 33, and so on. Thus, the first arm 32 is interlocked to swing around the first vertical axis P1, and the base arm side of the mounting body 29 is moved by the swinging first arm 32 via the pair of second arms 33. By pushing or pulling, the mounting body 29 is moved back and forth in the front-rear direction of the mounting body 29 with respect to the swivel base 28.

このようにして、一対の出退用電動モータ34が同期して作動することにより、リンク機構30の第1アーム32及び第2アーム33は、図8及び図9に示す如く載置体29の先端側が物品収納部1に届くように旋回台28から収納棚2の方に長く突出した物品収納や物品取り出しのための突出姿勢と、図6及び図7に示す如く載置体29の全体が突出位置よりも旋回台28の方に引退した物品搬送のための引退姿勢とに切り換え操作される。第1アーム32及び第2アーム33が引退姿勢であるときに載置体29の位置が引退位置であり、第1アーム32及び第2アーム33が突出姿勢であるときの載置体29の位置が突出位置である。そして、一対の出退用電動モータ34によるリンク機構30における第1アーム32及び第2アーム33の揺動作動に連動して、載置体29が、移動体12上に位置する引退位置と走行台車12の外方に位置する突出位置との間で、出退方向に沿って直線移動するように構成されている。つまり、リンク機構30を構成する第1アーム32及び第2アーム33は、載置体29を引退位置に位置させる引退姿勢から載置体29を突出位置に位置させる突出姿勢に姿勢変更自在に構成されており、一対の出退用電動モータ34にて本願発明の駆動手段が構成されている。   In this way, the pair of exit / retreat electric motors 34 are operated in synchronization with each other, whereby the first arm 32 and the second arm 33 of the link mechanism 30 are connected to the mounting body 29 as shown in FIGS. A protruding posture for storing and taking out articles that protrudes long from the swivel base 28 toward the storage shelf 2 so that the front end side reaches the article storage unit 1, and the entire mounting body 29 as shown in FIGS. The operation is switched to the retreating posture for conveying the article retired toward the swivel base 28 from the protruding position. The position of the mounting body 29 is the retracted position when the first arm 32 and the second arm 33 are in the retracted position, and the position of the mounting body 29 when the first arm 32 and the second arm 33 are in the protruding position. Is the protruding position. Then, in conjunction with the swinging operation of the first arm 32 and the second arm 33 in the link mechanism 30 by the pair of exit / retreat electric motors 34, the placement body 29 travels with the retraction position located on the movable body 12. It is comprised so that it may linearly move along the exit / retreat direction between the protrusion positions located outside the carriage 12. That is, the first arm 32 and the second arm 33 constituting the link mechanism 30 are configured so that their postures can be changed from a retracted posture in which the mounting body 29 is positioned in the retracted position to a protruding posture in which the mounting body 29 is positioned in the protruding position. The drive means of the present invention is constituted by a pair of exit / exit electric motors 34.

前記旋回台28の旋回位置が第1基準旋回位置又は第2基準旋回位置であることを検出する基準旋回位置検出センサー35が設けられている。前記第1基準旋回位置は、物品保管棚2の前後幅方向において走行レール11に対して一方側に位置する物品支持部41に対して物品4を移載するときの基準旋回位置である。前記第2基準旋回位置は、物品保管棚2の前後幅方向において走行レール11に対して他方側に位置する物品支持部41に対して物品4を移載するときの基準旋回位置であり、第1基準旋回位置から180度旋回した位置である。   A reference turning position detection sensor 35 for detecting that the turning position of the turntable 28 is the first reference turning position or the second reference turning position is provided. The first reference turning position is a reference turning position when the article 4 is transferred to the article support portion 41 located on one side of the traveling rail 11 in the front-rear width direction of the article storage shelf 2. The second reference turning position is a reference turning position when the article 4 is transferred to the article support portion 41 located on the other side with respect to the traveling rail 11 in the front-rear width direction of the article storage shelf 2. This is a position that is turned 180 degrees from the one reference turning position.

前記基準旋回位置検出センサー35については、投受光式のセンサーにて構成されている。そして、基準旋回位置検出センサー35は、旋回台28に設置された被検出板にて投光した光が遮光されることにより、旋回台28の旋回位置が第1基準旋回位置又は第2基準旋回位置であることを検出するように構成されている。また、旋回用電動モータ31には、基準旋回位置検出センサー35にて第1基準旋回位置又は第2基準旋回位置を検出してからの旋回台28の旋回量を検出することにより旋回台28の旋回位置を検出する旋回用ロータリエンコーダ38が設けられている。   The reference turning position detection sensor 35 is composed of a light projecting / receiving sensor. The reference turning position detection sensor 35 is configured such that the turning position of the turntable 28 is the first reference turn position or the second reference turn by blocking the light projected by the detection plate installed on the turntable 28. It is comprised so that it may detect that it is a position. Further, the turning electric motor 31 detects the turning amount of the turntable 28 after detecting the first reference turning position or the second reference turning position by the reference turning position detection sensor 35, so A turning rotary encoder 38 for detecting the turning position is provided.

前記載置体29がその出退範囲の突出側限度付近に設定された先端パルスレート検出ゾーンZの引退側位置に位置していることを検出する先端ゾーン検出センサー36、及び、前記載置体29がその出退範囲の引退側限度に引退され引退位置に位置していることを検出する引退位置検出センサー37が設けられている。先端ゾーン検出センサー36及び引退位置検出センサー37は、基準旋回位置検出センサー35と同様に、投受光式のセンサーにて構成されている。   The tip zone detection sensor 36 for detecting that the placement body 29 is located at the retraction side position of the tip pulse rate detection zone Z set near the protrusion side limit of the withdrawal / retraction range, and the placement body A retirement position detection sensor 37 is provided for detecting that 29 is retired to the retirement limit of the retreat range and located at the retirement position. The tip zone detection sensor 36 and the retraction position detection sensor 37 are configured by a light projecting / receiving type sensor, like the reference turning position detection sensor 35.

先端ゾーン検出センサー36は、載置体29の先端部が、物品支持部41に支持されている物品4の下枠体4bにおける、出退方向の突出側で最奥側に位置する底部最奥横フレーム4tよりも出退方向で引退側に位置するときに、第1アーム32の基端部に設置された被検出板にて投光した光が遮光されることにより、載置体29が先端パルスレート検出ゾーンZの引退側端部に位置していることを検出する。これにより、載置体29を突出作動させた場合に、載置体29が先端パルスレート検出ゾーンZに入ったことを検出できるようになっている。なお、先端ゾーン検出センサー36用の被検出板は、第1アーム32の基端部において位置変更自在に設けられており、物品保持体4における底部最奥横フレーム4tの位置等の設備の仕様に応じて、第1アーム32の基端部における位置が調整されている。   The front end zone detection sensor 36 has a bottom innermost portion in which the front end portion of the mounting body 29 is located on the farthest rear side in the protruding side in the retracting direction in the lower frame body 4b of the article 4 supported by the article support portion 41. When the light is projected by the detection plate installed at the base end portion of the first arm 32 when positioned on the retraction side in the retracting direction from the horizontal frame 4t, the mounting body 29 is blocked. It is detected that it is located at the retreat side end of the tip pulse rate detection zone Z. Thereby, when the mounting body 29 is protruded, it can be detected that the mounting body 29 has entered the tip pulse rate detection zone Z. The plate to be detected for the front end zone detection sensor 36 is provided at the base end portion of the first arm 32 so that the position of the plate can be changed, and the specifications of equipment such as the position of the bottom innermost horizontal frame 4t in the article holder 4 are provided. Accordingly, the position of the first arm 32 at the base end is adjusted.

引退位置検出センサー37は、リンク機構30が引退姿勢であるときの第1アーム32の基端部に設置された被検出板にて投光した光が遮光されることにより、載置体29が引退位置(ホームポジションHP)に位置していることを検出する。   The retraction position detection sensor 37 is configured such that the light that is projected by the detection plate installed at the base end portion of the first arm 32 when the link mechanism 30 is in the retraction posture is blocked, so that the mounting body 29 is It is detected that the vehicle is in the retirement position (home position HP).

出退用電動モータ34には、出退用電動モータ34の出力軸の回転駆動量を検出する駆動量検出手段としての出退用ロータリエンコーダ39が設けられている。本実施形態においては、出退用ロータリエンコーダ39として、分解能が17bitのアブソリュート式のロータリエンコーダを用いており、また、減速機の減速比が1/119であるので、出退用ロータリエンコーダ39は217×119カウントで出退用電動モータ34における減速機出力軸の1回転(360°)を検出する。つまり、出退用ロータリエンコーダ39が1カウント出力すれば、減速機の出力軸が、360°/(217×119)だけ回転駆動したことになる。そして、第1アーム32の揺動操作量は、減速機の出力軸の回転駆動量に一致するので、出退用ロータリエンコーダ39の出力が1カウント変化すれば、360°/(217×119)だけ第1アーム32が揺動操作されたことになる。 The exit / exit electric motor 34 is provided with an exit / exit rotary encoder 39 as drive amount detecting means for detecting the rotational drive amount of the output shaft of the exit / exit electric motor 34. In the present embodiment, an absolute rotary encoder having a resolution of 17 bits is used as the rotary encoder 39, and the reduction ratio of the reduction gear is 1/119. One rotation (360 °) of the speed reducer output shaft in the electric motor 34 for withdrawal is detected at 2 17 × 119 counts. That is, if the rotary encoder 39 for exit / exit outputs 1 count, the output shaft of the speed reducer is driven to rotate by 360 ° / (2 17 × 119). Since the swing operation amount of the first arm 32 coincides with the rotational drive amount of the output shaft of the speed reducer, if the output of the rotary encoder 39 is changed by 1 count, 360 ° / (2 17 × 119 ), The first arm 32 is swung.

この出退用ロータリエンコーダ39の1カウント当たりの第1アーム32の揺動操作角度は、後述する運転制御装置40の記憶部に予め登録される装置仕様データとしての減速機の減速比データD5及びエンコーダ分解能データD6(図14(b)参照)に基づいて、運転制御装置40に備えられた算出用プログラムにより装置立ち上げ時に算出され、算出された値は、後述する基準パルスレートデータD1、重複姿勢パルスカウントデータD2、ホームポジション角度データD3といった各種パラメータデータ(図14(a)参照)と共に、1パルス当たり揺動角度データD4として運転制御装置40の記憶部に記憶される。   The swinging operation angle of the first arm 32 per count of the rotary encoder 39 for exit / exit is a reduction gear ratio data D5 of the reduction gear as device specification data registered in advance in a storage unit of the operation control device 40 described later and Based on the encoder resolution data D6 (see FIG. 14B), the calculation program provided in the operation control device 40 is calculated at the time of startup of the device, and the calculated value is a reference pulse rate data D1, which will be described later. Along with various parameter data (see FIG. 14A) such as posture pulse count data D2 and home position angle data D3, it is stored in the storage unit of the operation control device 40 as swing angle data D4 per pulse.

図10に示すように、スタッカークレーン5の運転を制御する運転制御手段としての運転制御装置40が設けられている。この運転制御装置40は、物品支持部41に対する物品移載用停止位置に物品移載装置15を移動させるべく、走行台車12の走行作動及び昇降台14の昇降作動を制御し、且つ、物品移載装置15を物品移載用停止位置に停止させた状態において物品支持部41に支持された物品4を取り出す又は物品支持部41に物品4を卸すべく、物品移載装置15の移載作動を制御するように構成されている。   As shown in FIG. 10, an operation control device 40 is provided as an operation control means for controlling the operation of the stacker crane 5. The operation control device 40 controls the traveling operation of the traveling carriage 12 and the raising / lowering operation of the lifting platform 14 to move the article transfer device 15 to the article transfer stop position with respect to the article support portion 41, and the article transfer operation. In the state where the loading device 15 is stopped at the article transfer stop position, the transfer operation of the article transfer device 15 is performed in order to take out the article 4 supported by the article support unit 41 or to take the article 4 to the article support unit 41. Configured to control.

前記運転制御装置40は、走行用レーザ測距計27の検出情報に基づいて、走行台車12の走行方向における物品移載用停止位置に物品移載装置15を移動させるべく、走行台車12の走行作動を制御する走行制御部40a、昇降用レーザ測距計23の検出情報に基づいて、昇降台14の昇降方向における物品移載用停止位置に物品移載装置15を移動させるべく、昇降台14の昇降作動を制御する昇降制御部40b、物品支持部41に支持された物品4を取り出す又は物品支持部41に物品4を卸すべく、物品移載装置15の移載作動を制御する移載制御部40cから構成されている。   Based on the detection information of the traveling laser rangefinder 27, the operation control device 40 travels the traveling carriage 12 to move the article transfer device 15 to the article transfer stop position in the traveling direction of the traveling carriage 12. In order to move the article transfer device 15 to the article transfer stop position in the lifting / lowering direction of the lifting / lowering table 14 based on the detection information of the traveling control unit 40a for controlling the operation and the laser rangefinder 23 for lifting / lowering, the lifting / lowering table 14 Lifting control unit 40b for controlling the lifting / lowering operation of the article, transfer control for controlling the transfer operation of the article transfer device 15 to take out the article 4 supported by the article support part 41 or to take the article 4 to the article support part 41 It is comprised from the part 40c.

前記走行制御部40aは、走行用電動モータ25を作動させて走行台車12を走行作動させ、走行用レーザ測距計27にて検出される走行台車12の走行位置が走行台車12の走行方向における物品移載用停止位置になると、走行用電動モータ25を作動停止させて走行台車12の走行方向における物品移載用停止位置に物品移載装置15を位置させる。   The travel control unit 40 a operates the travel electric motor 25 to operate the travel cart 12, and the travel position of the travel cart 12 detected by the travel laser rangefinder 27 is in the travel direction of the travel cart 12. When the article transfer stop position is reached, the traveling electric motor 25 is deactivated, and the article transfer device 15 is positioned at the article transfer stop position in the traveling direction of the traveling carriage 12.

前記昇降制御部40bは、昇降用電動モータ21を作動させて昇降台14を昇降作動させ、昇降用レーザ測距計23にて検出される昇降台14の昇降位置が昇降台14の昇降方向における物品移載用停止位置になると、昇降用電動モータ21を作動停止させて昇降台14の昇降方向における物品移載用停止位置に物品移載装置15を位置させる。ちなみに、物品支持部41に物品4を卸すときには、物品支持部41に支持された物品4を取り出すときよりも、昇降台14の昇降方向における物品移載用停止位置が設定距離だけ上方側に設定されている。   The lifting control unit 40b operates the lifting electric motor 21 to lift and lower the lifting platform 14, and the lifting position of the lifting platform 14 detected by the lifting laser range finder 23 is in the lifting direction of the lifting platform 14. When the article transfer stop position is reached, the lifting electric motor 21 is deactivated, and the article transfer device 15 is positioned at the article transfer stop position in the lifting / lowering direction of the lifting platform 14. Incidentally, when the article 4 is unloaded on the article support section 41, the article transfer stop position in the lifting / lowering direction of the lifting platform 14 is set upward by a set distance than when the article 4 supported by the article support section 41 is taken out. Has been.

前記物品支持部41に支持された物品4を取り出すときには、移載制御部40cが、旋回用ロータリエンコーダ38の検出情報に基づいて旋回用電動モータ34の作動を制御して載置体29の出退方向を調整した後、出退用ロータリエンコーダ39の検出情報に基づいて出退用電動モータ34の作動を制御して載置体29を突出作動させる。そして、移載制御部40cは、載置体29を突出作動させた後、昇降制御部40bにて設定距離だけ昇降台14を上昇させることにより、物品支持部41に支持された物品4を載置体29に載置支持させる。その後、移載制御部40cは、出退用ロータリエンコーダ39の検出情報に基づいて出退用電動モータ34の作動を制御して載置体29を引退作動させる。このとき、引退位置検出センサー37にて載置体29が引退位置であることを検出すると、載置体29の引退作動を停止させる。   When the article 4 supported by the article support unit 41 is taken out, the transfer control unit 40 c controls the operation of the turning electric motor 34 based on the detection information of the turning rotary encoder 38 to remove the placement body 29. After adjusting the retreating direction, the mounting body 29 is caused to project by controlling the operation of the retreating electric motor 34 based on the detection information of the retreating rotary encoder 39. Then, the transfer control unit 40c places the article 4 supported by the article support unit 41 by causing the mounting body 29 to protrude and then raising the lifting platform 14 by a set distance by the lifting control unit 40b. It is placed and supported on the mounting body 29. Thereafter, the transfer control unit 40 c controls the operation of the electric motor 34 for withdrawal and withdrawal based on the detection information of the rotary encoder 39 for withdrawal and retraction of the mounting body 29. At this time, when the retraction position detection sensor 37 detects that the placement body 29 is at the retraction position, the retraction operation of the placement body 29 is stopped.

なお、載置体29が引退位置であるときの出退用ロータリエンコーダ39のカウント値について出退作動の繰り返しによって誤差が蓄積され、突出作動開始時における出退用ロータリエンコーダ39の初期値が変化することを防止するため、移載制御部40cでは、引退位置検出センサー37にて載置体29が引退位置であることを検出したときに、出退用ロータリエンコーダ39のカウント値をリセットしている。これにより、載置体29が引退位置に位置しているときの出退用ロータリエンコーダ39のカウント値は必ず「0」となる。   It should be noted that errors are accumulated by repeating the retreat operation when the mounting body 29 is at the retreat position, and the initial value of the retreat rotary encoder 39 at the start of the protrusion operation changes. In order to prevent this, the transfer control unit 40c resets the count value of the rotary encoder 39 for withdrawal when the retraction position detection sensor 37 detects that the placement body 29 is at the retraction position. Yes. As a result, the count value of the rotary encoder 39 when the mounting body 29 is located at the retracted position is always “0”.

前記物品支持部41に物品4を卸すときには、載置体29を突出作動させた後において、昇降制御部40bにて設定距離だけ昇降台14を下降させる動作だけが異なり、その他の動作については、物品支持部41に支持された物品4を取り出すときと同様の動作である。   When the article 4 is wholesaled on the article support section 41, after the placing body 29 is protruded and operated, only the operation of lowering the lifting platform 14 by a set distance by the lifting control section 40b is different. This is the same operation as when the article 4 supported by the article support section 41 is taken out.

このようにして、運転制御装置40が、スタッカークレーン5の運転を制御することにより、物品搬出入部8に支持された物品4を取り出してその取り出した物品4を物品収納部1に卸す作業や、物品収納部1に支持された物品4を取り出してその取り出した物品4を物品載置部10に卸す作業等を行い、物品搬出入部8と物品収納部1と物品載置部10との間で物品4を搬送するように構成されている。   In this way, the operation control device 40 controls the operation of the stacker crane 5 to take out the article 4 supported by the article carry-in / out section 8 and wholesale the taken-out article 4 to the article storage section 1, The article 4 supported by the article storage unit 1 is taken out and the taken-out article 4 is unloaded to the article placement unit 10, and the like between the article carry-in / out unit 8, the article storage unit 1, and the article placement unit 10. The article 4 is configured to be conveyed.

前記物品支持部41に支持された物品4を適正に取り出す為には、突出作動させた載置体29に対して、物品支持部41に支持された物品4の姿勢及び位置が適正な姿勢及び位置にあることが必要となる。つまり、物品支持部41に支持されている物品4について、平面視における基準姿勢(例えば、走行レール11の長手方向に平行又は略平行な姿勢)であり、走行レール11の長手方向における基準位置(例えば、走行レール11の長手方向において突出された載置体29の中心と物品支持部41に支持された物品4の中心とが上下に重複する位置)に位置し、且つ、載置体29の出退方向における基準位置(例えば、載置体29の出退方向において突出された載置体29の中心と物品支持部41に支持された物品4の中心とが上下に重複する位置)に位置することが必要である。   In order to properly take out the article 4 supported by the article support part 41, the posture and position of the article 4 supported by the article support part 41 with respect to the projecting and actuated mounting body 29 are appropriate and It needs to be in position. That is, the article 4 supported by the article support unit 41 has a reference posture in plan view (for example, a posture parallel or substantially parallel to the longitudinal direction of the traveling rail 11), and a reference position in the longitudinal direction of the traveling rail 11 ( For example, the center of the mounting body 29 projecting in the longitudinal direction of the traveling rail 11 and the center of the article 4 supported by the article support portion 41 are vertically positioned), and Position at the reference position in the exit / retreat direction (for example, the position where the center of the mounting body 29 protruding in the retracting direction of the mounting body 29 and the center of the article 4 supported by the article support portion 41 overlap vertically) It is necessary to.

そこで、物品支持部41に支持された物品4に対して突出作動された載置体29の姿勢及び位置が物品4に対して適正な姿勢及び位置になるように、走行台車12についての基準停止位置、載置体29についての基準出退方向及び載置体29についての基準突出量が予め定められており、運転制御装置40が、各物品支持部41の夫々について、走行台車12をその基準停止位置に停止させるための原点位置からの基準距離、旋回台28を基準出退方向に向けるために第1基準旋回位置又は第2基準旋回位置から旋回させる基準旋回駆動量DP、及び、載置体29を引退位置から基準突出量だけ突出させるための基準出退駆動量DQを記憶部に記憶している。なお、これらの基準値は、実際の距離や角度としては記憶されておらず、各駆動量に対応する制御パラメータに換算した値にて記憶されている。例えば、基準出退駆動量DQであれば、載置体29を引退位置から基準突出量だけ突出させるのに必要な駆動量だけ駆動させたときの出退用ロータリエンコーダ39の出力パルスについてのカウント値CNT(TOP)が記憶されている。   Therefore, the reference stop for the traveling carriage 12 is performed so that the posture and position of the mounting body 29 that is protruded and operated with respect to the article 4 supported by the article support portion 41 become an appropriate posture and position with respect to the article 4. The position, the reference exit / retreat direction for the mounting body 29 and the reference protrusion amount for the mounting body 29 are determined in advance, and the operation control device 40 uses the traveling carriage 12 as a reference for each of the article support portions 41. A reference distance from the origin position for stopping at the stop position, a reference turning drive amount DP for turning from the first reference turning position or the second reference turning position to direct the turntable 28 in the reference exit / retreat direction, and mounting A reference advancing / retreating drive amount DQ for causing the body 29 to protrude from the retraction position by a reference protrusion amount is stored in the storage unit. These reference values are not stored as actual distances and angles, but are stored as values converted into control parameters corresponding to the respective driving amounts. For example, in the case of the reference advancing / retreating drive amount DQ, the count of the output pulses of the retreating rotary encoder 39 when the mounting body 29 is driven by the drive amount necessary to project the mounting body 29 by the reference protrusion amount. The value CNT (TOP) is stored.

しかしながら、物品支持部41の据付誤差や物品4を物品支持部41に卸す際の移載誤差等により、物品支持部41に支持されている物品4が基準姿勢から傾いた姿勢で基準位置からずれた位置に位置することがあるので、物品支持部41に支持された物品4についての、平面視における基準姿勢からの傾き、走行レール11の長手方向における基準位置からのズレ量、及び、載置体29の出退方向における基準位置からのズレ量を求めるようにしている。   However, due to an installation error of the article support unit 41 or a transfer error when the article 4 is unloaded to the article support unit 41, the article 4 supported by the article support unit 41 is displaced from the reference position in a posture inclined from the reference posture. The position of the article 4 supported by the article support portion 41 from the reference position in plan view, the amount of deviation from the reference position in the longitudinal direction of the traveling rail 11, and the placement The amount of deviation from the reference position in the exit / retreat direction of the body 29 is obtained.

図6〜図9に示すように、物品支持部41に支持された物品4についての、平面視における基準姿勢からの傾き、走行レール11の長手方向における基準位置からのズレ量、及び、載置体29の出退方向における基準位置からのズレ量を検出するとともに、載置体29が先端パルスレート検出位置まで突出したことを検出するための物品状態検出センサー44が、載置体29の先端部の上面部に設けられている。前記物品状態検出センサー44は、走行レール11の長手方向に並ぶ一対の検出部として第1先端センサー46a及び第2先端センサー46bを備えて構成されている。   As shown in FIGS. 6 to 9, the inclination of the article 4 supported by the article support portion 41 from the reference posture in plan view, the amount of deviation from the reference position in the longitudinal direction of the traveling rail 11, and the placement An article state detection sensor 44 for detecting the amount of deviation from the reference position in the exit / retreat direction of the body 29 and detecting that the mounting body 29 protrudes to the tip pulse rate detection position is provided at the tip of the mounting body 29. It is provided on the upper surface part of the part. The article state detection sensor 44 includes a first tip sensor 46 a and a second tip sensor 46 b as a pair of detection units arranged in the longitudinal direction of the traveling rail 11.

第1先端センサー46a及び第2先端センサー46bの夫々は、例えば、フォトインタラプタ型センサーであり、上向きに投光した光が、物品4における下枠体4bの出退方向で突出側に位置するフレーム部分である被検出体としての底部最奥横フレーム4tにて反射されて、その反射された光を受光することにより底部最奥横フレーム4tの端部を検出するように構成されている。また、物品4を取り出すために載置体29が物品4に対して突出されるときの物品4の下枠体4bと載置体29との上下方向の距離に基づいてこれらのセンサーの検出感度が調整されている。   Each of the first tip sensor 46a and the second tip sensor 46b is, for example, a photo interrupter type sensor, and a frame in which the light projected upward is located on the protruding side in the direction in which the lower frame body 4b of the article 4 protrudes and retracts. It is configured to detect the end of the bottom innermost horizontal frame 4t by receiving the reflected light reflected by the bottom innermost horizontal frame 4t serving as a part to be detected. Further, the detection sensitivity of these sensors based on the vertical distance between the lower frame body 4b of the article 4 and the placement body 29 when the placement body 29 is protruded with respect to the article 4 in order to take out the article 4. Has been adjusted.

このように、物品状態検出センサー44は、載置体29を引退位置から基準突出量だけ突出させる(出退用ロータリエンコーダ39の出力パルスについてのカウント値が、基準突出量に対応した基準出退駆動量DQを示すカウント値CNT(TOP)になるように出退用電動モータ34を作動させる。)ときに、物品4における底部最奥横フレーム4tを検出作用するように設けられている。これにより、載置体29が、先端パルスレート検出ゾーンZに入ったことを先端ゾーン検出センサー36にて検出した後、載置体29の先端部が出退方向で物品4における底部最奥横フレーム4tに達する位置である先端パルスレート検出位置まで突出したことを検出することができるようになっている。   In this manner, the article state detection sensor 44 causes the mounting body 29 to protrude from the retracted position by the reference protrusion amount (the count value for the output pulse of the exit / retreat rotary encoder 39 corresponds to the reference protrusion / retraction amount). When the electric motor 34 is operated so that the count value CNT (TOP) indicating the driving amount DQ is obtained.), The bottom innermost horizontal frame 4t of the article 4 is provided to detect. Thereby, after detecting that the placing body 29 has entered the leading edge pulse rate detection zone Z by the leading edge zone detection sensor 36, the tip end portion of the placing body 29 is in the withdrawal direction and the bottommost side of the bottom of the article 4. It is possible to detect the protrusion to the tip pulse rate detection position, which is the position reaching the frame 4t.

そして、第1先端センサー46a及び第2先端センサー46bと底部最奥横フレーム4tとの位置関係については、走行台車12が基準停止位置に停止した状態で、載置体29を基準出退方向に基準突出量だけ突出させたときに、物品支持部41に支持された物品4が、平面視における基準姿勢であり、走行レール11の長手方向における基準位置に位置し、且つ、載置体29の出退方向における基準位置に位置していれば、図13(b)で示すように、第1先端センサー46a及び第2先端センサー46bの夫々が底部最奥横フレーム4tにおける第1標準点Ga及び第2標準点Gbの直下に位置するように設定されている。   And about the positional relationship of the 1st front-end | tip sensor 46a and the 2nd front-end | tip sensor 46b, and the bottom part innermost horizontal frame 4t, in the state which the traveling vehicle 12 stopped to the reference | standard stop position, the mounting body 29 is made into a reference | standard exit / retreat direction. When the article 4 is projected by the reference protrusion amount, the article 4 supported by the article support portion 41 is in the reference posture in plan view, is located at the reference position in the longitudinal direction of the traveling rail 11, and If it is located at the reference position in the exit / retreat direction, as shown in FIG. 13B, each of the first tip sensor 46a and the second tip sensor 46b is connected to the first standard point Ga and the bottom innermost lateral frame 4t. It is set to be located immediately below the second standard point Gb.

前記運転制御装置40は、物品支持部41に対する基準停止位置に物品移載装置15を位置させた状態において載置体29を基準出退方向に突出作動させて、載置体29が先端パルスレート検出ゾーンZに入ってからの物品状態検出センサー44にて検出される情報に基づいて、物品支持部41に支持された物品4についての、平面視における基準姿勢からの傾き、走行レール11の長手方向における基準位置からのズレ量、及び、載置体29の出退方向における基準位置からのズレ量を求めるように構成されている。   The operation control device 40 causes the placement body 29 to project in the reference exit / retreat direction in a state where the article transfer device 15 is positioned at the reference stop position with respect to the article support portion 41, so that the placement body 29 has a tip pulse rate. Based on information detected by the article state detection sensor 44 after entering the detection zone Z, the inclination of the article 4 supported by the article support unit 41 from the reference posture in plan view and the length of the traveling rail 11 The amount of deviation from the reference position in the direction and the amount of deviation from the reference position in the direction in which the mounting body 29 is withdrawn / retracted are determined.

まず、物品支持部41に支持された物品4についての平面視における基準姿勢からの傾きの求め方について説明する。
図12に示すように、物品支持部41に支持された物品4が平面視における基準姿勢から角度θ1だけ傾いている場合を考える。物品支持部41に基準姿勢からの傾いた状態で支持された物品4を載置体29に対して適正な姿勢とするためには、旋回台28を角度θ1だけ旋回作動させることになる。そこで、物品支持部41に支持された物品4についての平面視における基準姿勢からの傾きを、載置体29に対する物品4の姿勢を平面視における適正な補正用姿勢とするために旋回台28を旋回作動させる旋回補正量P(角度)として求める。図12において、Mは旋回台28を旋回作動させるときの旋回中心を示している。
First, a description will be given of how to obtain the inclination from the reference posture in plan view of the article 4 supported by the article support unit 41.
As shown in FIG. 12, a case is considered where the article 4 supported by the article support section 41 is inclined by an angle θ1 from the reference posture in plan view. In order to make the article 4 supported by the article support portion 41 in an inclined state from the reference attitude with respect to the mounting body 29, the swivel base 28 is turned by an angle θ1. Therefore, in order to set the inclination of the article 4 supported by the article support unit 41 from the reference posture in plan view to the correct correction posture in plan view, the posture of the article 4 with respect to the mounting body 29 is adjusted. Obtained as a turning correction amount P (angle) for turning operation. In FIG. 12, M indicates the turning center when the turntable 28 is turned.

物品4が基準姿勢から傾いている角度θ1は、三角形S1の内角θ2と等しくなる。そして、三角形S1は直角三角形であるので、下記の(式1)の関係式が成り立つ。
θ1=θ2=arctan(L1/L2) ・・・・・(式1)
ただし、L1は、載置体29を基準出退方向から角度θ1だけ傾いた方向に突出作動させるときに、物品状態検出センサー44のうちの図12中左側に位置する第2先端センサー46bが、底部最奥横フレーム4tの出退方向で引退側の端部4teを検出するときの突出量と物品状態検出センサー44のうちの図12中右側に位置する第1先端センサー46aが底部最奥横フレーム4tの端部4teを検出するときの突出量との差に相当する出退方向についての距離である。L2は、走行レール11の長手方向における第1先端センサー46a及び第2先端センサー46bの設置間隔である。
The angle θ1 at which the article 4 is inclined from the reference posture is equal to the inner angle θ2 of the triangle S1. Since the triangle S1 is a right triangle, the following relational expression (Formula 1) holds.
θ1 = θ2 = arctan (L1 / L2) (Equation 1)
However, when L1 projects and operates the mounting body 29 in the direction inclined by the angle θ1 from the reference exit / retreat direction, the second tip sensor 46b located on the left side in FIG. The first tip sensor 46a located on the right side in FIG. 12 of the protrusion amount and the article state detection sensor 44 when detecting the retreat side end 4te in the retreating direction of the bottom deepest horizontal frame 4t is the bottom deepest side. This is the distance in the exit / retreat direction corresponding to the difference from the protrusion amount when detecting the end 4te of the frame 4t. L <b> 2 is an installation interval of the first tip sensor 46 a and the second tip sensor 46 b in the longitudinal direction of the traveling rail 11.

前記載置体29を突出作動させたときに、一対の物品状態検出センサー44のうちの一方が底部最奥横フレーム4tの端部4teを検出する状態となったときの出退用ロータリエンコーダ39の出力パルスについてのカウント値である1次センサー検出タイミング値CNT(ON1)と、双方が底部最奥横フレーム4tの端部4teを検出する状態となったときの出退用ロータリエンコーダ39の出力パルスについてのカウント値である2次センサー検出タイミング値CNT(ON2)との差から、出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量(例えば、出退用ロータリエンコーダ39の1カウント分の出退量)を用いて、距離L1を求めることができる。そして、L2が既定値であるので、(式1)にて角度θ1を求めることができる。   When the placement body 29 is operated to protrude, one of the pair of article state detection sensors 44 is in a state of detecting the end 4te of the bottom innermost horizontal frame 4t. The primary sensor detection timing value CNT (ON1), which is a count value for the output pulse of, and the output of the rotary encoder 39 for exit / retreat when both are in the state of detecting the end 4te of the bottom innermost horizontal frame 4t Based on the difference from the secondary sensor detection timing value CNT (ON2) that is a count value for the pulse, the unit exit / retreat amount in the exit / retreat direction of the mounting body 29 per unit drive amount of the exit / exit electric motor 34 (for example, The distance L1 can be obtained using the amount of exit / retreat for one count of the rotary encoder 39. Since L2 is a predetermined value, the angle θ1 can be obtained by (Expression 1).

そして、物品Aの平面視における基準姿勢からの傾きである角度θ1が求まれば、旋回用ロータリエンコーダ38の1パルス当たりの旋回角度は記憶部に予め記憶されているので、旋回台28を角度θ1だけ旋回作動させるために必要な補正旋回駆動量DPadjを求めることができ、旋回台28を基準旋回位置検出センサー35にて検出される第1基準旋回位置又は第2基準旋回位置から旋回させる基準旋回量(角度)に対応する旋回用電動モータ31についての基準旋回駆動量DPを、補正旋回駆動量DPadjにて補正して、旋回用電動モータ31の適応旋回駆動量DP´を求めることができる。   When the angle θ1, which is the inclination of the article A from the reference orientation in plan view, is obtained, the turning angle per pulse of the turning rotary encoder 38 is stored in advance in the storage unit. A correction turning drive amount DPadj required for turning operation by θ1 can be obtained, and a reference for turning the turntable 28 from the first reference turning position or the second reference turning position detected by the reference turning position detection sensor 35. The reference turning drive amount DP for the turning electric motor 31 corresponding to the turning amount (angle) can be corrected by the corrected turning drive amount DPadj to obtain the adaptive turning drive amount DP ′ of the turning electric motor 31. .

このようにして、運転制御装置40は、載置体29を基準突出量だけ突出作動させるときに、一対の物品状態検出センサー44及び出退用ロータリエンコーダの検出情報に基づいて、物品支持部41に支持された物品4についての載置体29の平面視における基準姿勢からの傾きを、変換用単位出退量としての先端パルスレートR(ON)を基準として求めるように構成され、かつ、物品支持部41に支持された物品4についての、平面視における基準姿勢からの傾きを示す角度θ1に基づいて、載置体29の出退方向を補正するように構成されている。   In this way, when the operation control device 40 causes the mounting body 29 to project by the reference projection amount, the article support unit 41 is based on the detection information of the pair of article state detection sensors 44 and the exit / retreat rotary encoder. The inclination of the mounting body 29 with respect to the article 4 supported on the plane in a plan view is obtained on the basis of the tip pulse rate R (ON) as the conversion unit withdrawal amount, and the article The article 4 supported by the support unit 41 is configured to correct the direction in which the mounting body 29 is withdrawn based on the angle θ1 indicating the inclination from the reference posture in plan view.

次に、物品支持部41に支持された物品4についての載置体29の出退方向における基準位置からのズレ量の求め方について説明する。
前記物品支持部41に基準位置からずれた状態で支持された物品4を載置体29の出退方向における適正な位置とするためには、載置体29の突出量を補正することになる。そこで、物品支持部41に支持された物品4についての載置体29の出退方向における基準位置からのズレ量を、載置体29に対する物品4の位置を載置体29の出退方向における適正な補正位置とするために載置体29を出退作動させる出退補正量Q(距離)として求める。
Next, a description will be given of how to obtain the amount of deviation from the reference position in the direction in which the placing body 29 moves out and with respect to the article 4 supported by the article support portion 41.
In order to set the article 4 supported by the article support portion 41 in a state shifted from the reference position to an appropriate position in the direction in which the placing body 29 is withdrawn, the amount of protrusion of the placing body 29 is corrected. . Therefore, the amount of deviation of the article 4 supported by the article support unit 41 from the reference position in the direction of withdrawal of the mounting body 29 from the reference position, and the position of the article 4 relative to the mounting body 29 in the direction of withdrawal of the mounting body 29. In order to obtain an appropriate correction position, it is obtained as an exit / extraction correction amount Q (distance) for moving the mounting body 29 out and out.

図13(b)に示すように、載置体29を引退位置から基準突出量だけ突出させる場合に、一対の物品状態検出センサー44の双方がオンとなってから突出作動する距離をL4とすると、基準位置に位置する物品4に対して、載置体29を標準状態で位置させる場合、すなわち、走行台車12を基準停止位置に停止させ、基準出退方向に沿って、引退位置から基準突出量だけ出退方向に突出させる場合は、距離L4は、底部最奥横フレーム4tの端部4teから第1標準点Ga及び第2標準点Gbまでの出退方向における距離L7と一致するため、一対の物品状態検出センサー44の双方が同時にオンとなってから距離L4だけ突出することで引退位置からの突出量が基準突出量に達する。   As shown in FIG. 13B, when the mounting body 29 is protruded from the retracted position by the reference protrusion amount, the distance of the protrusion operation after both the pair of article state detection sensors 44 are turned on is L4. When the placing body 29 is positioned in the standard state with respect to the article 4 positioned at the reference position, that is, the traveling carriage 12 is stopped at the reference stop position, and the reference protrusion is made from the retracted position along the reference exit / retreat direction. When projecting in the retracting direction by the amount, the distance L4 coincides with the distance L7 in the retracting direction from the end 4te of the bottom innermost lateral frame 4t to the first standard point Ga and the second standard point Gb. Since both the pair of article state detection sensors 44 are simultaneously turned on and project by the distance L4, the projecting amount from the retreat position reaches the reference projecting amount.

載置体29の出退方向が基準出退方向でない状態で載置体29を引退位置から出退方向に突出させると、図13(a)に示すように、引退位置からの突出量が基準突出量に達するまでに、先ず、一対の物品状態検出センサー44の一方(図13(a)で例示するものでは、第2先端センサー46b)がオンとなり、その後、載置体29が出退方向に距離L1だけ突出作動した後に他方のもの(図13(a)で例示するものでは、第1先端センサー46a)がオンとなる。その後、一対の物品状態検出センサー44の双方が同時にオンとなった状態で距離L4だけ突出することで載置体29の引退位置からの突出量が基準突出量に達する。したがって、一対の物品状態検出センサー44の一方がオンとなってから距離L1+L4だけ突出作動し、他方がオンとなってから距離L4だけ突出作動したときに載置体29の引退位置からの突出量が基準突出量に達する。   When the mounting body 29 is protruded from the retracted position in the retracting direction in a state where the retracting direction of the mounting body 29 is not the reference retracting direction, as shown in FIG. Before reaching the protruding amount, first, one of the pair of article state detection sensors 44 (second tip sensor 46b in the example illustrated in FIG. 13A) is turned on, and then the mounting body 29 is moved in and out. After the projecting operation by the distance L1, the other one (in the example illustrated in FIG. 13A, the first tip sensor 46a) is turned on. Thereafter, the protrusion amount from the retracted position of the mounting body 29 reaches the reference protrusion amount by protruding the distance L4 while both the pair of article state detection sensors 44 are simultaneously turned on. Therefore, when one of the pair of article state detection sensors 44 is turned on, the projection operation is performed for the distance L1 + L4, and when the other is activated, the projection operation is performed for the distance L4. Reaches the reference protrusion amount.

つまり、このような姿勢及び位置に位置する物品4は、物品4が基準姿勢であるとしたときに載置体29を基準突出量だけ突出させると、第1先端センサー46aがオン後の突出量(L4)と、第2先端センサー46bがオン後の突出量(L1+L4)との平均L4´(L4+L1/2)だけ、第1先端センサー46a及び第2先端センサー46bの双方が同時にオンとなってから突出作動するような出退方向の位置に位置していることになる。   That is, when the article 4 located in such a posture and position projects the mounting body 29 by the reference protrusion amount when the article 4 is in the reference posture, the protrusion amount after the first tip sensor 46a is turned on. Both the first tip sensor 46a and the second tip sensor 46b are simultaneously turned on by an average L4 ′ (L4 + L1 / 2) of (L4) and the protrusion amount (L1 + L4) after the second tip sensor 46b is turned on. It is located at a position in the exit / retreat direction so as to project.

そして、物品4が基準姿勢で出退方向の基準位置に位置していれば、載置体29を基準突出量だけ突出させたときには、第1先端センサー46a及び第2先端センサー46bの双方が同時にオンとなってから上記L7だけ突出作動するので、一対の物品状態検出センサー44の検出情報に基づいて求められる物品4の出退方向における出退補正量Qは、下記の(式2)で与えられる。
Q=L7−L4´=L7−(L4+L1/2) ・・・・・(式2)
If the article 4 is positioned at the reference position in the retracting direction in the reference posture, when the mounting body 29 is protruded by the reference protrusion amount, both the first tip sensor 46a and the second tip sensor 46b are simultaneously used. Since the projecting operation is performed by L7 after being turned on, the exit / withdrawal correction amount Q in the exit / withdrawal direction of the article 4 obtained based on the detection information of the pair of article state detection sensors 44 is given by It is done.
Q = L7−L4 ′ = L7− (L4 + L1 / 2) (Formula 2)

物品4が基準位置から出退方向で突出側にずれていると、載置体29を引退位置から基準突出量だけ突出させるときに、一対の物品状態検出センサー44の双方が底部最奥横フレーム4tの端部4teを検出する状態となるタイミング(本件のセンサー検出タイミングに相当)が遅れるので、一対の物品状態検出センサー44の双方が底部最奥横フレーム4tの端部4teを検出する状態となってからの載置体29の出退方向で突出側への移動距離L4´は小さくなる。そのため、物品4が基準位置から出退方向で突出側にずれていると、距離L4´が距離L7よりも小さくなり、出退補正量Qとして正の値が得られ、この場合は、載置体29の出退方向の位置を物品4に対して適正な補正用位置とするために、出退方向で基準突出量が増加側(突出側)に補正される。   If the article 4 is shifted from the reference position to the protruding side in the retracting direction, both the pair of article state detection sensors 44 are positioned at the bottom innermost horizontal frame when the mounting body 29 is protruded from the retracted position by the reference protruding amount. Since the timing for detecting the end portion 4te of 4t (corresponding to the sensor detection timing in this case) is delayed, both the pair of article state detection sensors 44 detect the end portion 4te of the bottom innermost horizontal frame 4t; After that, the moving distance L4 ′ toward the projecting side becomes smaller in the direction in which the mounting body 29 moves out and out. Therefore, when the article 4 is shifted from the reference position to the protruding side in the retracting direction, the distance L4 ′ becomes smaller than the distance L7, and a positive value is obtained as the retracting / leaving correction amount Q. In order to set the position of the body 29 in the exit / retreat direction to an appropriate correction position with respect to the article 4, the reference protrusion amount is corrected to the increase side (protrusion side) in the exit / retreat direction.

逆に、物品4が基準位置から出退方向で引退側にずれていると、距離L4´が距離L7よりも大きくなり、出退補正量Qとして負の値が得られ、この場合は、載置体29の出退方向の位置を物品4に対して適正な位置とするために、出退方向で基準突出量が減少側(突出側)に補正される。   On the contrary, if the article 4 is displaced from the reference position toward the retreating side in the retreating direction, the distance L4 ′ becomes larger than the distance L7, and a negative value is obtained as the retreating correction amount Q. In order to set the position of the placement body 29 in the exit / retreat direction to an appropriate position with respect to the article 4, the reference protrusion amount is corrected to the decrease side (protrusion side) in the exit / retreat direction.

上記距離L1は、前述の通り、載置体29を突出作動させたときに、1次センサー検出タイミング値CNT(ON1)と2次センサー検出タイミング値CNT(ON2)との差から、出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量を用いて求めることができる。   As described above, the distance L1 is used for entering and exiting from the difference between the primary sensor detection timing value CNT (ON1) and the secondary sensor detection timing value CNT (ON2) when the mounting body 29 is operated to protrude. It can be obtained by using the unit withdrawal amount in the withdrawal / retraction direction of the mounting body 29 per unit drive amount of the electric motor 34.

また、上記距離L4は、載置体29を突出作動させたときに、2次センサー検出タイミング値CNT(ON2)と、載置体29を引退位置から基準突出量だけ突出作動させるための、出退用ロータリエンコーダ39の出力パルスについての目標カウント値CNT(TOP)との差から、出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量を用いて求めることができる。   In addition, the distance L4 is the second sensor detection timing value CNT (ON2) when the mounting body 29 is operated to project, and the output for operating the mounting body 29 by the reference projection amount from the retracted position. From the difference from the target count value CNT (TOP) for the output pulse of the retreat rotary encoder 39, the unit retreat amount in the retreat direction of the mounting body 29 per unit drive amount of the retreat electric motor 34 is used. Can be obtained.

そして、物品4の出退方向におけるズレ量が出退補正量Qとして求まれば、出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量を用いて、載置体29を出退補正量Qだけ出退作動させるために必要な補正出退駆動量DQadjを求めることができ、載置体29を引退位置から突出させる基準突出量に対応する出退用電動モータ34についての基準出退駆動量DQを補正出退駆動量DQadjにて補正して、出退用電動モータ34の適応出退駆動量DQ´を求めることができる。   And if the deviation | shift amount in the withdrawing / withdrawing direction of the article | item 4 is calculated | required as the withdrawing / withdrawing correction amount Q, the unit withdrawing / withdrawing amount in the withdrawing / withdrawing direction of the mounting body 29 per unit driving amount of the withdrawing / withdrawing electric motor 34 is used. Thus, a corrected exit / retreat drive amount DQadj required for moving the mounting body 29 by the retracting / leaving correction amount Q can be obtained, and the output corresponding to the reference protrusion amount for projecting the mounting body 29 from the retracted position is obtained. The reference exit / exit drive amount DQ for the withdrawal electric motor 34 can be corrected by the corrected exit / exit drive amount DQadj to determine the adaptive exit / exit drive amount DQ ′ of the exit / exit electric motor 34.

このようにして、運転制御装置40は、載置体29を基準突出量だけ突出作動させるときに、一対の物品状態検出センサー44及び出退用ロータリエンコーダ39の検出情報に基づいて、物品支持部41に支持された物品4についての載置体29の出退方向における基準位置からのズレ量を、出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量を用いて求めるように構成され、かつ、物品支持部41に支持された物品4についての、出退方向における基準位置からのズレ量に基づいて、載置体29の突出量を補正するように構成されている。   In this way, when the operation control device 40 causes the mounting body 29 to project by the reference projection amount, the operation support device 40 is based on the detection information of the pair of article state detection sensors 44 and the rotary encoder 39 for exit and withdrawal. 41, the amount of deviation from the reference position in the exit / retraction direction of the mounting body 29 with respect to the article 4 supported by 41 is determined by the unit output in the exit / retraction direction of the mounting body 29 per unit drive amount of the exit / retreat electric motor 34. The amount of protrusion of the mounting body 29 is corrected based on the amount of deviation from the reference position in the exit / retreat direction for the article 4 that is configured to be obtained using the withdrawal amount and is supported by the article support portion 41. It is configured as follows.

また、詳述はしないが、運転制御装置40は、載置体29を引退位置から移動補正量検出用の所定出退量だけ突出させた状態において、走行台車12を走行レール11の長手方向に移動させたときに、載置体29の出退方向に直交する方向に分散して載置体29に一対設けられた図外の側端部材検出部のうちの少なくとも一方が、物品4の側端部を検出するまでに走行台車12についての移動量に基づいて、物品支持部41に支持された物品4についての、走行レール11の長手方向における基準位置からのズレ量を移動補正量として求めるように構成されている。そして、物品支持部41に支持された物品4についての、走行レール11の長手方向における基準位置からのズレ量に基づいて、走行台車12の走行停止位置を補正するように構成されている。   Although not described in detail, the operation control device 40 moves the traveling carriage 12 in the longitudinal direction of the traveling rail 11 in a state where the mounting body 29 protrudes from the retracted position by a predetermined amount of movement correction amount detection. When moved, at least one of the non-illustrated side end member detectors provided in a pair in the mounting body 29 in a direction perpendicular to the direction of the loading / unloading of the mounting body 29 is on the article 4 side. Based on the amount of movement of the traveling carriage 12 until the end portion is detected, the amount of deviation from the reference position in the longitudinal direction of the traveling rail 11 of the article 4 supported by the article support 41 is obtained as a movement correction amount. It is configured as follows. The travel stop position of the traveling carriage 12 is corrected based on the amount of deviation from the reference position in the longitudinal direction of the traveling rail 11 for the article 4 supported by the article support portion 41.

上記の通り、運転制御装置40は、載置体29を引退位置から基準突出量だけ突出作動させる際に、物品支持部41に支持された物品4についての、平面視における基準姿勢からの傾きを旋回補正量Pとして求め、載置体29の出退方向における基準位置からのズレ量を出退補正量Qとして求め、走行レール11の長手方向における基準位置からのズレ量を移動補正量として求める。そして、旋回補正量P、出退補正量Q、及び、移動補正量に相当する各駆動手段についての補正駆動量を求め、それらの補正駆動量にて基準駆動量を補正した適応駆動量に基づいて作動させることで、載置体29を物品4に対して適正な姿勢及び位置とすることで、物品4を適正に掬い取ることができるようになっている。   As described above, when the operation control device 40 causes the mounting body 29 to project from the retracted position by the reference projection amount, the operation control device 40 determines the inclination of the article 4 supported by the article support unit 41 from the reference posture in plan view. Obtained as the turning correction amount P, the amount of deviation from the reference position in the exit / retreat direction of the mounting body 29 is obtained as the exit / retreat correction amount Q, and the amount of deviation from the reference position in the longitudinal direction of the traveling rail 11 is obtained as the movement correction amount. . Then, a correction drive amount for each drive means corresponding to the turning correction amount P, the exit / exit correction amount Q, and the movement correction amount is obtained, and based on the adaptive drive amount obtained by correcting the reference drive amount with these correction drive amounts. Thus, the article 4 can be properly scooped by placing the mounting body 29 in an appropriate posture and position with respect to the article 4.

そして、運転制御装置40は、旋回補正量Pとしての角度θ1や出退補正量Qとしての上述の距離L7−L4´を算出するために必要な距離L1や距離L4を取得する場合や、取得した出退補正量Qとしての距離「L7−L4´」から補正出退駆動量DQadjを求める場合において、出退用電動モータ34を駆動させたときの駆動量とその駆動による載置体29の出退方向の位置の変化量との関係として、物品状態検出センサー44が物品4の底部最奥横フレーム4tの出退方向で引退側の端部4teを検出する状態となるセンサー検出タイミングにおける載置体29の出退方向での位置についての、出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量である先端パルスレートR(ON)を算出している。   The operation control device 40 acquires the distance L1 and the distance L4 necessary for calculating the angle θ1 as the turning correction amount P and the above-described distance L7-L4 ′ as the exit / extraction correction amount Q. In the case where the corrected exit / exit drive amount DQadj is obtained from the distance “L7−L4 ′” as the exit / exit correction amount Q, the drive amount when the electric motor 34 for exit / exit is driven and the placement body 29 by the drive are driven. As the relationship with the change amount of the position in the withdrawal / retreat direction, the article state detection sensor 44 is mounted at the sensor detection timing at which the end 4te on the withdrawal side is detected in the withdrawal / retreat direction of the bottom innermost horizontal frame 4t of the article 4. The tip pulse rate R (ON), which is the unit withdrawal amount in the exit / retreat direction of the mounting body 29 per unit drive amount of the exit / retreat electric motor 34, for the position in the exit / retreat direction of the placement body 29 is calculated. doing.

出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量について図11に基づいて説明する。   With reference to FIG. 11, a description will be given of the unit withdrawal amount in the withdrawal / retraction direction of the mounting body 29 per unit drive amount of the withdrawal / retraction electric motor 34.

載置体29が引退位置に位置していると一対のリンク機構30の第1アーム32及び第2アーム33(図11では一方のリンク機構30のみ示している。)は引退姿勢である。この状態から載置体29を基準突出量だけ突出させるべく、出退用電動モータ34を作動させると、一対のリンク機構30の第1アーム32及び第2アーム33は、引退姿勢から、第1アーム32及び第2アーム33の揺動作動を伴って、第1アーム32と第2アーム33とが上下方向視で重複する重複姿勢を経て姿勢変化する。   When the mounting body 29 is located at the retracted position, the first arm 32 and the second arm 33 (only one link mechanism 30 is shown in FIG. 11) of the pair of link mechanisms 30 are in the retracted posture. When the electric motor 34 for withdrawal is operated to project the mounting body 29 by the reference projection amount from this state, the first arm 32 and the second arm 33 of the pair of link mechanisms 30 are moved from the retracted posture to the first. With the swinging motion of the arm 32 and the second arm 33, the first arm 32 and the second arm 33 change their postures through overlapping postures that overlap in a vertical view.

一対のリンク機構30の第1アーム32及び第2アーム33の夫々は、第1上下軸心P1及び第2上下軸心P2の距離と第2上下軸心P2及び第3上下軸心P3の距離が共に距離C[mm]であるから、出退用電動モータ34の単位駆動量を出退用ロータリエンコーダ39の「1カウント」とした場合、1カウント当たりの第1アーム32の第2上下軸心P2の、その揺動軌跡(円弧)に沿った変位(以下、円弧長パルスレートRともいう。)は、(2πC/360°)×[1パルス当たり揺動角度θc]となる。1パルスあたり揺動角度θc[°/pulse]は、前述の通り、運転制御装置40の記憶部に1パルスあたり揺動角度データD4として演算結果が記憶されており、距離C[mm]については、運転制御装置40の記憶部にアーム長データD7として登録されている。   The first arm 32 and the second arm 33 of the pair of link mechanisms 30 respectively have a distance between the first vertical axis P1 and the second vertical axis P2 and a distance between the second vertical axis P2 and the third vertical axis P3. Are the distance C [mm], and therefore, when the unit drive amount of the electric motor 34 for exit / exit is “1 count” of the rotary encoder 39 for exit / exit, the second vertical axis of the first arm 32 per count The displacement (hereinafter also referred to as arc length pulse rate R) of the center P2 along the swing locus (arc) is (2πC / 360 °) × [swing angle θc per pulse]. As described above, the calculation result of the oscillation angle θc [° / pulse] per pulse is stored as the oscillation angle data D4 per pulse in the storage unit of the operation control device 40. For the distance C [mm], The arm length data D7 is registered in the storage unit of the operation control device 40.

出退用ロータリエンコーダ39の1カウント当たりの第2上下軸心P2の揺動軌跡に沿った変位は微小であるから、この変位は、第2上下軸心P2の揺動軌跡における位置についての接線方向の変位と見做せる。そして、第1アーム32及び第2アーム33が重複姿勢となっているときの第1アーム32の揺動位相であると当該接線方向の変位は全てが載置体29の出退方向に寄与することになる。したがって、円弧長パルスレートRは、第1アーム32及び第2アーム33が重複姿勢となっているときの第1アーム32の第2上下軸心P2の出退方向の変位を示している。   Since the displacement along the swing locus of the second vertical axis P2 per count of the rotary encoder 39 is very small, this displacement is tangent to the position of the second vertical axis P2 on the swing locus. It can be regarded as a displacement in the direction. When the first arm 32 and the second arm 33 are in the overlapping posture, the displacement in the tangential direction all contributes to the moving direction of the mounting body 29 when the first arm 32 swings. It will be. Therefore, the arc long pulse rate R indicates the displacement of the second arm axis P2 of the first arm 32 in the retracting direction when the first arm 32 and the second arm 33 are in the overlapping posture.

本実施形態では、運転制御装置40は、重複姿勢のリンク機構30における第1アーム32の位相を基準とした第1アーム32の角度θに基づいて円弧長パルスレートRを変換して先端パルスレートR(ON)を求めるため、円弧長パルスレートRは、先端パルスレートR(ON)を算出するための基準パルスレートRとして管理されている。この基準パルスレートRは、運転制御装置40に備えられた算出用プログラムにより装置立ち上げ時に算出され、一旦算出されると、運転制御装置40の記憶部に基準パルスレートデータD1として記憶されている。   In the present embodiment, the operation control device 40 converts the arc length pulse rate R based on the angle θ of the first arm 32 with respect to the phase of the first arm 32 in the link mechanism 30 in the overlapping posture to convert the tip pulse rate. In order to obtain R (ON), the arc length pulse rate R is managed as a reference pulse rate R for calculating the tip pulse rate R (ON). The reference pulse rate R is calculated when the apparatus is started up by a calculation program provided in the operation control device 40. Once calculated, the reference pulse rate R is stored in the storage unit of the operation control device 40 as reference pulse rate data D1. .

第1アーム32及び第2アーム33が姿勢変化するときの第1アーム32の揺動方向は、第2アーム33の揺動方向と逆方向であるから、第1アーム32の揺動作動により、第2アーム33の第3上下軸心P3側に枢支連結された載置体29は、第1アーム32の揺動作動により発生する第1上下軸心P1周りの第2上下軸心P2の変位のうち出退方向に寄与する成分と、第2アーム33の揺動作動により発生する第2上下軸心P2周りの第3上下軸心P3周りの変位のうち出退方向に寄与する成分との和だけ、出退方向に変位することになる。   The swinging direction of the first arm 32 when the posture of the first arm 32 and the second arm 33 changes is opposite to the swinging direction of the second arm 33. The mounting body 29 pivotally connected to the third vertical axis P3 side of the second arm 33 has a second vertical axis P2 around the first vertical axis P1 generated by the swinging operation of the first arm 32. Of the displacement, a component that contributes to the retracting direction, and a component that contributes to the retracting direction of the displacement around the third vertical axis P3 around the second vertical axis P2 generated by the swing operation of the second arm 33 Will be displaced in the direction of withdrawal.

また、重複姿勢から第1アーム32及び第2アーム33が姿勢変化して、第1アーム32が重複姿勢である時の位相(以下、重複位相ともいう。)から角度θだけ揺動した位相まで揺動しているとすると、このときの出退用電動モータ34の単位駆動量当たりの第1アーム32の第2上下軸心P2の変位のうち出退方向に寄与する成分はcosθ倍され、同様に、第2アーム33の第3上下軸心P3の変位のうち出退方向に寄与する成分もcosθ倍されることになる。   Further, from the overlapping posture, the first arm 32 and the second arm 33 are changed in posture, and from the phase when the first arm 32 is in the overlapping posture (hereinafter also referred to as the overlapping phase) to the phase swung by the angle θ. If it is swinging, the component contributing to the retracting direction of the displacement of the second vertical axis P2 of the first arm 32 per unit driving amount of the retracting electric motor 34 at this time is multiplied by cos θ, Similarly, the component contributing to the retracting direction of the displacement of the third vertical axis P3 of the second arm 33 is also multiplied by cos θ.

したがって、第1アーム32及び第2アーム33が重複姿勢から姿勢変化して、第1アーム32が、第2アーム33と重複する重複位相から角度θだけ揺動した状態での1パルス当たりの出退方向の変位である単位出退量R(θ)は、下記の(式3)で与えられる。
R(θ)=R×2cosθ ・・・・・(式3)
Therefore, the first arm 32 and the second arm 33 change their posture from the overlapping posture, and the first arm 32 is output per pulse in a state where the first arm 32 is swung by the angle θ from the overlapping phase overlapping the second arm 33. The unit retreat amount R (θ), which is the displacement in the retreat direction, is given by the following (Equation 3).
R (θ) = R × 2cosθ (Formula 3)

このように、単位出退量R(θ)は、基準パルスレートRと第1アーム32の重複位相からの角度θにより求めることができる。そして、第1アーム32の重複位相からの揺動角度θは、第1アーム32の重複位相における出退用ロータリエンコーダ39の出力パルスについてのカウント値CNT(SP)と第1アーム32が重複位相から揺動角度θだけ揺動したときの出退用ロータリエンコーダ39の出力パルスについてのカウント値との差、及び、記憶部に1パルスあたり揺動角度データD4として記憶されている1パルスあたり揺動角度θc[°/pulse]から求めることができる。また、第1アーム32の重複位相における出退用ロータリエンコーダ39の出力パルスについてのカウント値CNT(SP)は、本件の基準検出情報に相当するものであり、後述する重複姿勢ティーチング作業により運転制御装置40の記憶部に重複姿勢パルスカウントデータD2として記憶されている。   Thus, the unit withdrawal / retraction amount R (θ) can be obtained from the reference pulse rate R and the angle θ from the overlapping phase of the first arm 32. Then, the swing angle θ from the overlapping phase of the first arm 32 is such that the count value CNT (SP) for the output pulse of the rotary encoder 39 in the overlapping phase of the first arm 32 and the overlapping phase of the first arm 32 are the same. From the count value of the output pulse of the rotary encoder 39 for exit / retreat when the actuator swings by the swing angle θ, and the swing per pulse stored as the swing angle data D4 per pulse in the storage unit It can be obtained from the moving angle θc [° / pulse]. Further, the count value CNT (SP) for the output pulse of the rotary encoder 39 for the first arm 32 in the overlapping phase corresponds to the reference detection information of this case, and the operation control is performed by the overlapping posture teaching work described later. It is stored in the storage unit of the device 40 as overlapping posture pulse count data D2.

先端パルスレートR(ON)は、センサー検出タイミングにおける載置体29の出退方向での位置についての単位出退量R(θ)であるから、図11に示すように、センサー検出タイミングにおける第1アーム32の揺動角度θ(SP-ON)に基づいて基準パルスレートRを(式3)にて変換することで先端パルスレートR(ON)を求めることができる。   The tip pulse rate R (ON) is a unit exit / withdrawal amount R (θ) for the position of the mounting body 29 in the exit / retreat direction at the sensor detection timing, and as shown in FIG. The tip pulse rate R (ON) can be obtained by converting the reference pulse rate R by (Equation 3) based on the swing angle θ (SP-ON) of one arm 32.

センサー検出タイミングは、本実施形態では、一対の物品状態検出センサー44の双方が底部最奥横フレーム4tの端部4teを検出する状態となるタイミングであるので、載置体29を引退位置から基準突出量だけ突出作動させる場合に一対の物品状態検出センサー44の双方がオン状態になったときの出退用ロータリエンコーダ39の出力パルスについてのカウント値CNT(ON2)にてセンサー検出タイミングが与えられる。   In this embodiment, the sensor detection timing is a timing at which both of the pair of article state detection sensors 44 detect the end 4te of the bottom innermost horizontal frame 4t. When the projecting operation is performed by the projecting amount, the sensor detection timing is given by the count value CNT (ON2) for the output pulse of the rotary encoder 39 for exit / exit when both the pair of article state detection sensors 44 are turned on. .

物品支持部41に支持されている物品4が、例えば、図12や図13(a)に示すように基準姿勢から傾いていると、載置体29を引退位置から基準突出量だけ突出させるときの第1先端センサー46a及び第2先端センサー46bがオン状態になるタイミングは異なるが、この場合、センサー検出タイミングを示す出退用ロータリエンコーダ39の出力パルスについてのカウント値CNT(ON2)としては、第1先端センサー46a及び第2先端センサー46bがオン状態となるタイミングのうち遅いほうのタイミングでのカウント値となる。   When the article 4 supported by the article support portion 41 is inclined from the reference posture as shown in FIGS. 12 and 13A, for example, when the mounting body 29 is protruded from the retracted position by the reference protrusion amount. Although the timing at which the first tip sensor 46a and the second tip sensor 46b are turned on is different, in this case, the count value CNT (ON2) for the output pulse of the rotary encoder 39 that indicates the sensor detection timing is as follows: The count value is the later timing among the timings at which the first tip sensor 46a and the second tip sensor 46b are turned on.

センサー検出タイミングにおける第1アーム32の揺動角度θ(SP-ON)を求めるために必要となる重複姿勢パルスカウントCNT(SP)の登録作業について、図17に示す作業フローに基づいて説明する。   The registration work of the overlapping posture pulse count CNT (SP) necessary for obtaining the swing angle θ (SP-ON) of the first arm 32 at the sensor detection timing will be described based on the work flow shown in FIG.

作業者は、運転制御装置40を図外のキースイッチにてマニュアルモードに切り換え操作する(#B1)。その後、作業者は、インチング指令を指令自在な手動操作式の指令手段にてインチング動作を指令することで、出退用電動モータ34をインチング動作させて、図18(a)に示すように、第1アーム32と第2アーム33とが上下方向視で重複する重複姿勢に第1アーム32及び第2アーム33を姿勢変化させる(#B2)。このときの載置体29の出退方向の位置は引退位置より突出側の教示位置となっている。   The operator switches the operation control device 40 to the manual mode with a key switch (not shown) (# B1). Thereafter, the operator instructs the inching operation by an inching operation by an inching command freely commandable command means, thereby causing the electric motor 34 for ingress / egress to perform an inching operation, as shown in FIG. The postures of the first arm 32 and the second arm 33 are changed to an overlapping posture in which the first arm 32 and the second arm 33 overlap in a vertical view (# B2). At this time, the position of the mounting body 29 in the withdrawing / retracting direction is the teaching position on the protruding side from the retreating position.

そして、図18(b)に示すように、位置決め用部材としてのアーム芯出し冶具45を、上側に位置する第2アーム33のアーム芯出し穴47に貫通させ、下側に位置する第1アーム32のアーム芯出し穴48に挿入させるように上方側から両アーム芯出し穴47・48に挿通する(#B3)。両アーム芯出し穴47・48は、第1アーム32及び第2アーム33の夫々に対して、第1アーム32及び第2アーム33が重複姿勢であると平面視で軸心が一致する位置に設けられている。したがって、アーム芯出し冶具45をアーム芯出し穴47・48の双方に嵌合させることで、インチング指令では調整しきれない重複姿勢からのズレを極力小さくして、第1アームの揺動基端側の第1上下軸心P1と第2アームの揺動端部側の第3軸心P3とが一致する状態で、第1アーム32及び第2アーム33を位置決めすることができる。   Then, as shown in FIG. 18B, the arm centering jig 45 as a positioning member is passed through the arm centering hole 47 of the second arm 33 located on the upper side, and the first arm located on the lower side. The two arm centering holes 47 and 48 are inserted from above to be inserted into the 32 arm centering holes 48 (# B3). Both arm centering holes 47 and 48 are located at positions where the axial centers of the first arm 32 and the second arm 33 coincide with each other when the first arm 32 and the second arm 33 overlap with each other in plan view. Is provided. Therefore, by fitting the arm centering jig 45 into both the arm centering holes 47 and 48, the deviation from the overlapping posture that cannot be adjusted by the inching command is minimized, and the swing base end of the first arm is reduced. The first arm 32 and the second arm 33 can be positioned in a state where the first vertical axis P1 on the side coincides with the third axis P3 on the swing end portion side of the second arm.

そして、作業者は、ティーチング指令を指令自在な手動操作式の指令手段にてティーチング指令を指令する(#B4)。これにより、運転制御装置40は、この時点の出退用ロータリエンコーダ39の出力パルスについてのカウント値CNT(SP)を取得し、重複姿勢パルスカウントデータD2として記憶部に格納する。   Then, the operator issues a teaching command using a manually operated command means that can command the teaching command (# B4). As a result, the operation control apparatus 40 acquires the count value CNT (SP) for the output pulse of the exit / retreat rotary encoder 39 at this time, and stores it in the storage unit as overlapping posture pulse count data D2.

なお、このとき、運転制御装置40は、載置体29が引退位置(ホームポジションHP)に位置するとき(リンク機構30が引退姿勢となるとき)の第1アーム32の揺動角度θ(HP-SP)を、1パルス当たり揺動角度データD4に格納された1パルスあたり揺動角度θc[°/pulse]基づいて算出し、ホームポジション角度データD3として記憶部に格納する。重複姿勢パルスカウントCNT(SP)の登録が完了すると、作業者は、アーム芯出し冶具45を抜き取って、運転制御装置40を図外のキースイッチにて通常運転モードに切り換え操作して、ティーチング作業を終了する。   At this time, the operation control device 40 determines that the swing angle θ (HP) of the first arm 32 when the mounting body 29 is located at the retracted position (home position HP) (when the link mechanism 30 is in the retracted position). -SP) is calculated based on the swing angle θc [° / pulse] per pulse stored in the swing angle data D4 per pulse, and is stored in the storage unit as the home position angle data D3. When the registration of the overlapping posture pulse count CNT (SP) is completed, the operator pulls out the arm centering jig 45 and switches the operation control device 40 to the normal operation mode with a key switch (not shown) to perform teaching work. Exit.

次に、通常運転モードで実行される物品4の掬い動作を行う常時移載動作における運転制御手段40の制御内容を、図15のフローチャートに基づいて説明する。なお、以下の説明では、図15の各ステップを示す場合、「ステップ」という文言は省略して単にステップ番号にて示すことにする。   Next, the control content of the operation control means 40 in the constant transfer operation for performing the scooping operation of the article 4 executed in the normal operation mode will be described based on the flowchart of FIG. In the following description, when each step in FIG. 15 is shown, the word “step” is omitted and is simply indicated by a step number.

まず、運転制御装置40は、物品4が支持された物品支持部41に対する物品移載用停止位置に物品移載装置15を移動させるべく、走行制御部40aにて走行台車12の走行作動を制御し且つ昇降制御部40bにて昇降台14の昇降作動を制御し、物品移載装置15を物品移載用停止位置に停止させる(#M1)。   First, the operation control device 40 controls the traveling operation of the traveling carriage 12 by the traveling control unit 40a in order to move the article transfer device 15 to the article transfer stop position with respect to the article support unit 41 on which the article 4 is supported. And the raising / lowering operation | movement of the raising / lowering stand 14 is controlled by the raising / lowering control part 40b, and the goods transfer apparatus 15 is stopped in the stop position for goods transfer (# M1).

そして、運転制御装置40は、移載制御部40cにて物品移載装置15の移載作動を制御して載置体29の突出作動を開始する(#M2)。この突出作動では、載置体29が引退位置から基準突出量だけ突出するように、出退用ロータリエンコーダ39の出力パルスのカウント値(以下、単に出退用ロータリエンコーダ39のカウント値ともいう)に基づいて出退用電動モータ34の作動が制御される。運転制御装置40の記憶部には基準突出量に対応する出退用電動モータ34の駆動量である基準出退駆動量DQを示すカウント値としてCNT(TOP)が予め設定されている。   And the operation control apparatus 40 controls the transfer operation | movement of the article transfer apparatus 15 in the transfer control part 40c, and starts the protrusion operation | movement of the mounting body 29 (# M2). In this projecting operation, the count value of the output pulse of the retracting rotary encoder 39 (hereinafter also simply referred to as the count value of the retracting rotary encoder 39) so that the mounting body 29 projects from the retracted position by the reference projecting amount. Based on this, the operation of the electric motor 34 is controlled. In the storage unit of the operation control device 40, CNT (TOP) is set in advance as a count value indicating the reference exit / retreat drive amount DQ that is the drive amount of the exit / retreat electric motor 34 corresponding to the reference protrusion amount.

突出作動を開始すると、運転制御装置40は、先端ゾーン検出センサー36の検出情報に基づいて、載置体29の出退方向の位置が、図9に示す先端パルスレート検出ゾーンZに達したか否かを監視する(#M3)。そして、載置体29の出退方向の位置が先端パルスレート検出ゾーンZに達した後、一対の物品状態検出センサー44がオン状態になったか否かを監視する(#M4)。このように、一対の物品状態検出センサー44のオン状態の監視を、載置体29が先端パルスレート検出ゾーンZに達した後に行うことで、一対の物品状態検出センサー44が物品4の底部に備えられた横フレームのうち底部最奥横フレーム4t以外のものに検出作用してオン状態となっても、その検出情報を無視することができ、一対の物品状態検出センサー44による底部最奥横フレーム4tの端部4teの検出を確実なものとすることができる。   When the protrusion operation is started, the operation control device 40 determines whether the position of the mounting body 29 has reached the tip pulse rate detection zone Z shown in FIG. 9 based on the detection information of the tip zone detection sensor 36. Whether or not is monitored (# M3). Then, after the position of the loading / unloading body 29 reaches the tip pulse rate detection zone Z, it is monitored whether the pair of article state detection sensors 44 are turned on (# M4). In this way, the pair of article state detection sensors 44 are monitored at the bottom of the article 4 by monitoring the ON state of the pair of article state detection sensors 44 after the placement body 29 reaches the tip pulse rate detection zone Z. Even if the detected horizontal frames other than the bottom innermost horizontal frame 4t are detected and turned on, the detected information can be ignored, and the bottom innermost horizontal by the pair of article state detection sensors 44 can be ignored. The detection of the end 4te of the frame 4t can be ensured.

一対の物品状態検出センサー44がオン状態になるまでに、載置体29の引退位置からの突出量が基準突出量に達した場合、すなわち、出退用ロータリエンコーダ39のカウント値がCNT(TOP)に達した場合は、物品支持部41に支持されている物品4が基準位置から許容範囲以上に出退方向で突出側又は引退側にずれた位置に位置しているか、何らかの制御異常が発生しているとして、異常停止させるようにしている(#M5・#M6)。   When the protrusion amount from the retracted position of the mounting body 29 reaches the reference protrusion amount before the pair of article state detection sensors 44 are turned on, that is, the count value of the rotary encoder 39 for withdrawal is set to CNT (TOP ), The article 4 supported by the article support part 41 is located at a position shifted from the reference position to the protruding side or the retracting side in the retracting direction beyond the allowable range, or some control abnormality has occurred. As a result, an abnormal stop is performed (# M5 and # M6).

運転制御装置40は、#M4において、一対の物品状態検出センサー44の第1先端センサー46a及び第2先端センサー46bの夫々がオン状態になったときに、出退用ロータリエンコーダ39のカウント値を、1次センサー検出タイミング値CNT(ON1)及び2次センサー検出タイミング値CNT(ON2)として取得する。   In # M4, the operation control device 40 sets the count value of the rotary encoder 39 for exit / retreat when the first tip sensor 46a and the second tip sensor 46b of the pair of article state detection sensors 44 are turned on. Obtained as a primary sensor detection timing value CNT (ON1) and a secondary sensor detection timing value CNT (ON2).

一対の物品状態検出センサー44の双方がオン状態となると、#M7へ移行し、先端パルスレート算出処理が実行される。詳しくは後述するが、この処理では、基準パルスレートRを、センサー検出タイミングにおける第1アーム32の重複姿勢からの揺動角度θ(SP-ON)に基づいて(式3)にて変換して先端パルスレートR(ON)を求める。   When both of the pair of article state detection sensors 44 are turned on, the process proceeds to # M7, and the tip pulse rate calculation process is executed. As will be described in detail later, in this process, the reference pulse rate R is converted by (Equation 3) based on the swing angle θ (SP-ON) from the overlapping posture of the first arm 32 at the sensor detection timing. Obtain the tip pulse rate R (ON).

#M8では、1次センサー検出タイミング値CNT(ON1)と2次センサー検出タイミング値CNT(ON2)との差を先端パルスレートR(ON)にて距離L1に換算して、(式1)により旋回補正量P(角度)を求める。   In # M8, the difference between the primary sensor detection timing value CNT (ON1) and the secondary sensor detection timing value CNT (ON2) is converted into the distance L1 at the tip pulse rate R (ON), and (Equation 1) A turning correction amount P (angle) is obtained.

#M9では、1次センサー検出タイミング値CNT(ON1)と2次センサー検出タイミング値CNT(ON2)との差を先端パルスレートR(ON)にて距離L1に換算し、同様に、基準突出量に対応した基準出退駆動量DQを示すカウント値CNT(TOP)と2次センサー検出タイミング値CNT(ON2)との差を先端パルスレートR(ON)にて距離L4に換算して、(式2)により出退補正量Q(距離)を求める。   In # M9, the difference between the primary sensor detection timing value CNT (ON1) and the secondary sensor detection timing value CNT (ON2) is converted to the distance L1 at the tip pulse rate R (ON), and similarly, the reference protrusion amount The difference between the count value CNT (TOP) indicating the reference drive / retreat driving amount DQ corresponding to the value and the secondary sensor detection timing value CNT (ON2) is converted into the distance L4 at the tip pulse rate R (ON), The exit / exit correction amount Q (distance) is obtained by 2).

#M10では、旋回台28を基準旋回位置検出センサー35にて検出される第1基準旋回位置又は第2基準旋回位置から旋回させる基準旋回量(角度)に対応する旋回用電動モータ31についての基準旋回駆動量DPを示す旋回用ロータリエンコーダ38のカウント値を、旋回補正量P(角度)分の補正旋回駆動量DPadjを示すカウント値に1パルス当たりの旋回角度を用いて補正して、旋回用電動モータ31の適応旋回駆動量DP´を示すカウント値を求める。   In # M10, the reference for the electric motor 31 for turning corresponding to the reference turning amount (angle) for turning the turntable 28 from the first reference turning position or the second reference turning position detected by the reference turning position detection sensor 35. The count value of the turning rotary encoder 38 indicating the turning drive amount DP is corrected using the turning angle per pulse to the count value indicating the corrected turning drive amount DPadj corresponding to the turning correction amount P (angle). A count value indicating the adaptive turning drive amount DP ′ of the electric motor 31 is obtained.

#M11では、載置体29を引退位置から突出させる基準突出量(距離)に対応する出退用電動モータ34についての基準出退駆動量DQを示す出退用ロータリエンコーダ39のカウント値を、出退補正量Q(距離)分の補正出退駆動量DQadjを示すカウント値に先端パルスレートR(ON)を用いて補正して、出退用電動モータ34の適応出退駆動量DQ´を示すカウント値を求める。   In # M11, the count value of the rotary encoder 39 for exit / exit indicating the reference exit / exit drive amount DQ for the exit / exit electric motor 34 corresponding to the reference projection amount (distance) for projecting the mounting body 29 from the retracted position is By correcting the count value indicating the corrected exit / exit drive amount DQadj for the exit / exit correction amount Q (distance) using the tip pulse rate R (ON), the adaptive exit / exit drive amount DQ ′ of the exit / exit electric motor 34 is obtained. Obtain the count value shown.

#M12では、旋回用ロータリエンコーダ38のカウント値が、適応旋回駆動量DP´を示すカウント値(#M10で求めたカウント値)となるように、旋回用電動モータ31の作動を制御して、旋回台28を旋回作動させる。   In # M12, the operation of the turning electric motor 31 is controlled so that the count value of the turning rotary encoder 38 becomes the count value indicating the adaptive turning drive amount DP ′ (the count value obtained in # M10). The swivel base 28 is swung.

#M13では、出退用ロータリエンコーダ39のカウント値が、適応出退駆動量DQ´を示すカウント値(#M11で求めたカウント値)となるように、出退用電動モータ34の作動を制御して、載置体29を出退作動させる。   In # M13, the operation of the exit / exit electric motor 34 is controlled so that the count value of the exit / exit rotary encoder 39 becomes the count value indicating the adaptive exit / exit drive amount DQ '(the count value obtained in # M11). Then, the mounting body 29 is moved out and out.

その後、運転制御装置40は、#M14で、適応旋回駆動量DP´を示すカウント値を今回の掬い動作の移載対象箇所である物品支持部41についての新たな基準旋回駆動量DPとして更新記録し、#M15で、適応出退駆動量DQ´を示すカウント値を今回の掬い動作の移載対象箇所である物品支持部41についての新たな基準出退駆動量DQとして更新記録する。   Thereafter, in # M14, the operation control device 40 updates and records the count value indicating the adaptive turning drive amount DP ′ as a new reference turning drive amount DP for the article support portion 41 that is the transfer target location of the current scooping operation. Then, in # M15, the count value indicating the adaptive exit / exit drive amount DQ 'is updated and recorded as a new reference exit / exit drive amount DQ for the article support portion 41 that is the transfer target location of the present scooping operation.

ここで、図15のフローでは省略しているが、#M7〜#M15の処理が完了するまでのいずれかの時期に、物品支持部41に支持された物品4についての走行レール11の長手方向における基準位置からのズレ量を移動補正量として求める移動補正量算出処理、及び、走行制御部40aを機能させて、求めた移動補正量に基づいて、走行台車12の走行停止位置を補正する停止位置補正用移動処理を実行する。これにより、物品支持部41に支持された物品4が、走行レール11の長手方向における基準位置からずれていても、物品4に対する載置体29の走行方向での位置を適正な位置とすることができる。   Here, although omitted in the flow of FIG. 15, the longitudinal direction of the traveling rail 11 for the article 4 supported by the article support portion 41 at any time until the processing of # M7 to # M15 is completed. The movement correction amount calculation process for determining the amount of deviation from the reference position as the movement correction amount, and the stop for correcting the travel stop position of the traveling carriage 12 based on the calculated movement correction amount by causing the travel control unit 40a to function. The position correction moving process is executed. Thereby, even if the article 4 supported by the article support portion 41 is deviated from the reference position in the longitudinal direction of the traveling rail 11, the position of the mounting body 29 with respect to the article 4 in the traveling direction is set to an appropriate position. Can do.

そして、運転制御装置40は、#M16で、昇降制御部40bを機能させて、昇降台14を設定昇降ストロークだけ昇降させる。このとき、物品4が基準姿勢から傾いた姿勢で基準位置からずれた位置にて物品支持部41に支持されても、載置体29は掬い対象のこの物品4に対して適正な姿勢及び位置で下方側に位置する状態となっているので、物品4は、載置体29に対して適正な姿勢及び位置となる状態で載置体29にて載置支持される。   And the operation control apparatus 40 makes the raising / lowering control part 40b function by # M16, and raises / lowers the raising / lowering stand 14 only a set raising / lowering stroke. At this time, even if the article 4 is supported by the article support unit 41 at a position that is inclined from the reference position and deviated from the reference position, the mounting body 29 is in an appropriate posture and position with respect to the object 4 to be scooped. Therefore, the article 4 is placed and supported by the placing body 29 in a state where the article 4 is in an appropriate posture and position with respect to the placing body 29.

こうして物品4を掬い上げた後、運転制御装置40は、#M17で、再び移載制御部40cを機能させて、出退用ロータリエンコーダ39のカウント値に基づいて引退速度を制御しながら、物品4を支持した状態の載置体29を引退作動させ、引退位置検出センサー37にて載置体29が引退位置に位置することが検出されると、載置体29の引退作動を停止させる。そして、出退用ロータリエンコーダ39のカウント値を「0」にリセットして、移載作動を完了する。   After the article 4 is scooped up in this way, the operation control device 40 causes the transfer control unit 40c to function again at # M17, while controlling the retraction speed based on the count value of the exit / retreat rotary encoder 39, When the mounting body 29 in the state of supporting 4 is retreated, and the retraction position detection sensor 37 detects that the mounting body 29 is located at the retraction position, the retraction operation of the mounting body 29 is stopped. Then, the count value of the exit / retreat rotary encoder 39 is reset to “0” to complete the transfer operation.

このように、運転制御装置40は、物品4の基準姿勢からの傾き、走行レール11の長手方向における基準位置からのズレ量、出退方向における基準位置からのズレ量を実際の移載対象の物品4に対して検出作用する物品状態検出センサー44の検出情報を用いて求めて、これら傾きやズレ量を解消するように走行台車12及び物品移載装置15の作動を制御することで、物品4に対して載置体29が適正な姿勢及び位置なる状態で物品4を救い上げることができる。   In this way, the operation control device 40 determines the inclination of the article 4 from the reference posture, the amount of deviation from the reference position in the longitudinal direction of the traveling rail 11, and the amount of deviation from the reference position in the exit / retreat direction as the actual transfer target. By using the detection information of the article state detection sensor 44 that detects the article 4 and controlling the operation of the traveling carriage 12 and the article transfer device 15 so as to eliminate the inclination and the deviation amount, the article can be obtained. The article 4 can be rescued in a state in which the mounting body 29 is in an appropriate posture and position with respect to 4.

次に、図15の常時掬い移載作動の制御フローにおける#M7の先端パルスレート算出処理について、図16に示すフローチャートに基づいて説明する。   Next, the tip pulse rate calculation processing of # M7 in the control flow of the constantly scooping transfer operation of FIG. 15 will be described based on the flowchart shown in FIG.

まず、#A1で、センサー検出タイミングにおける出退用ロータリエンコーダ39のカウント値CNT(ON)を取得する。本実施形態では、センサー検出タイミングとして、一対の物品状態検出センサー44の双方が底部最奥横フレーム4tの端部4teを検出する状態となるタイミングであるので、載置体29を引退位置から基準突出量だけ突出作動させる場合に一対の物品状態検出センサー44の双方がオン状態になったときの出退用ロータリエンコーダ39の出力パルスについてのカウント値CNT(ON2)がカウント値CNT(ON)として取得される。   First, at # A1, the count value CNT (ON) of the rotary encoder 39 for exit / exit at the sensor detection timing is acquired. In the present embodiment, since the sensor detection timing is a timing at which both of the pair of article state detection sensors 44 detect the end 4te of the bottom innermost horizontal frame 4t, the mounting body 29 is referred to the reference position from the retracted position. The count value CNT (ON2) for the output pulse of the rotary encoder 39 for exiting / exiting when both the pair of article state detection sensors 44 are turned on when the projection operation is performed by the projection amount is the count value CNT (ON). To be acquired.

#A2で、記憶部に重複姿勢パルスカウントデータD2として記憶されている第1アーム32の重複位相における出退用ロータリエンコーダ39の出力パルスについてのカウント値CNT(SP)と、センサー検出タイミングにおける出退用ロータリエンコーダ39のカウント値CNT(ON)との差を算出する。このカウント値の差は、リンク機構30が重複姿勢からセンサー検出タイミング時の姿勢となるまでの出退用ロータリエンコーダ39の変化量であるから、リンク機構30が重複姿勢からセンサー検出タイミング時の姿勢となるまでの出退用電動モータ34の駆動量を示しており、センサー検出タイミングにおける第1アーム32の重複位相からの揺動角度θ(SP-ON)を示している。   In # A2, the count value CNT (SP) for the output pulse of the rotary encoder 39 for exit and retraction in the overlap phase of the first arm 32 stored as overlap posture pulse count data D2 in the storage unit and the output at the sensor detection timing The difference from the count value CNT (ON) of the retraction rotary encoder 39 is calculated. The difference between the count values is the amount of change in the rotary encoder 39 for moving the link mechanism 30 from the overlapping posture to the posture at the sensor detection timing. The driving amount of the electric motor 34 for exiting / retreating until the position becomes is shown, and the swing angle θ (SP-ON) from the overlapping phase of the first arm 32 at the sensor detection timing is shown.

#A3で、記憶部に1パルスあたり揺動角度データD4として記憶されている1パルスあたり揺動角度θc[°/pulse]に基づいて、#A2で算出した、カウント値[pulse]の差から、センサー検出タイミングにおける第1アーム32の重複位相からの揺動角度θ(SP-ON)を算出する。   In # A3, from the difference of the count value [pulse] calculated in # A2 based on the swing angle θc [° / pulse] per pulse stored as the swing angle data D4 per pulse in the storage unit Then, the swing angle θ (SP-ON) from the overlapping phase of the first arm 32 at the sensor detection timing is calculated.

#A2及び#A3により運転制御装置40は、載置体29を基準突出量だけ突出せるときに、センサー検出タイミングにおける出退用ロータリエンコーダ39の検出情報と基準検出情報としての重複姿勢パルスカウント値CNT(SP)とに基づいて、センサー検出タイミングにおける第1アーム32についての重複姿勢からの揺動角度θ(SP-ON)を検出している。したがって、運転制御装置40に組み込まれた制御プログラム(さらに、具体的には、#A2及び#A3の処理)により揺動角度検出手段が構成されている。   When # A2 and # A3 cause the operation control device 40 to project the mounting body 29 by the reference protrusion amount, the detection information of the rotary encoder 39 for exit and exit at the sensor detection timing and the overlapping posture pulse count value as the reference detection information Based on CNT (SP), the swing angle θ (SP-ON) from the overlapping posture of the first arm 32 at the sensor detection timing is detected. Therefore, the swing angle detecting means is configured by a control program (more specifically, processing of # A2 and # A3) incorporated in the operation control device 40.

#A4で、先端パルスレートR(ON)を算出する。先端パルスレートR(ON)は、第1アーム32の重複位相からの揺動角度θが上記揺動角度θ(SP-ON)であるときの単位出退量R(θ)であるから、先端パルスレートR(ON)は、(式3)においてθ=θ(SP-ON)とすることで算出できる。   In # A4, the tip pulse rate R (ON) is calculated. Since the tip pulse rate R (ON) is the unit retreat amount R (θ) when the swing angle θ from the overlapping phase of the first arm 32 is the swing angle θ (SP-ON), The pulse rate R (ON) can be calculated by setting θ = θ (SP-ON) in (Equation 3).

#A4により運転制御装置40は、第1アーム32及び第2アーム33が重複姿勢であるときの載置体29の出退方向での位置についての単位出退量R(θ)を、揺動角度検出手段の検出情報(#A2及び#A3の処理結果)に基づいて変換することで、センサー検出タイミングにおける載置体29の出退方向での位置についての単位出退量すなわち先端パルスレートR(ON)を取得している。したがって、運転制御装置40に組み込まれた制御プログラム(さらに、具体的には、#A4の処理)により変換用単位出退量取得手段が構成されている。   By # A4, the operation control device 40 swings the unit retreat amount R (θ) with respect to the position of the mounting body 29 in the retreat direction when the first arm 32 and the second arm 33 are in the overlapping posture. By converting based on the detection information of the angle detection means (processing results of # A2 and # A3), the unit withdrawal amount, that is, the tip pulse rate R with respect to the position of the mounting body 29 in the withdrawal direction at the sensor detection timing. (ON) is acquired. Therefore, the control unit incorporated in the operation control device 40 (more specifically, the processing of # A4) constitutes a conversion unit withdrawal / acquisition amount acquisition means.

本実施形態では、旋回補正量Pや出退補正量Qを算出する際の出退用ロータリエンコーダ39のカウント値の変化に基づいて距離L1や距離L4を計測する場合、及び、出退補正量Q(距離)に相当する出退用ロータリエンコーダ39のカウント値を算出する場合に、先端パルスレートR(ON)を用いることにより、距離L1や距離L4を精度よく計測でき、また、出退補正量Q(距離)に相当する出退用ロータリエンコーダ39のカウント値を精度良く算出することができる。したがって、基準姿勢から傾いた姿勢で基準位置からずれた位置に位置している移載対象の物品4のズレ量を精度良く求めることができる。しかも、その傾きやズレ量に応じて載置体29の出退方向や出退量を補正する場合には、補正駆動量を移載対象の物品4に対して適切な姿勢及び位置に精度良く合わせることができるような駆動量とすることができる。   In the present embodiment, when the distance L1 and the distance L4 are measured based on the change in the count value of the rotary encoder 39 for exit / exit when calculating the turning correction amount P and the exit / exit correction amount Q, and the exit / exit correction amount When calculating the count value of the rotary encoder 39 for exit and exit corresponding to Q (distance), the distance L1 and the distance L4 can be accurately measured by using the tip pulse rate R (ON), and the exit / exit correction is performed. The count value of the rotary encoder 39 for exit and exit corresponding to the quantity Q (distance) can be calculated with high accuracy. Therefore, it is possible to accurately obtain the amount of deviation of the article 4 to be transferred, which is located at a position that is tilted from the reference position and deviated from the reference position. In addition, when correcting the moving direction and the moving amount of the mounting body 29 according to the inclination and the amount of deviation, the correction driving amount is accurately set to an appropriate posture and position with respect to the article 4 to be transferred. The driving amount can be adjusted to match.

〔別実施形態〕
以下、本発明の別実施形態を列記する。
(1)上記実施形態では、センサー検出タイミングとして、一対の物品状態検出センサー44の双方がオン状態になるときを採用しているが、一対の物品状態検出センサー44の一方がオン状態になるときや、一方がオン状態になってから所定時間又は所定出退駆動量だけ突出作動させたときや、双方がオン状態になってから所定時間又は所定出退駆動量だけ突出作動させたときなど、センサー検出タイミングは上記実施形態に記載のものに限られるものではない。
[Another embodiment]
Hereinafter, other embodiments of the present invention will be listed.
(1) In the above embodiment, the sensor detection timing is when both the pair of article state detection sensors 44 are turned on, but when one of the pair of article state detection sensors 44 is turned on. Or, when one of them is turned on for a predetermined time or a predetermined drive-out drive amount after being turned on, or when it is operated for a predetermined time or a predetermined drive-out drive amount after both are turned on, etc. The sensor detection timing is not limited to that described in the above embodiment.

(2)上記実施形態では、物品状態検出センサーが載置体の出退方向で突出側の端部箇所に設けられ、被検出体が物品の出退方向で突出側の端部箇所に位置するものを例示したが、これに限らず、例えば、物品状態検出センサーが載置体の出退方向で引退側の端部箇所に設けられ、被検出体が物品の出退方向で引退側の端部箇所に位置するものや、物品状態検出センサーが載置体の出退方向で中間箇所に設けられ、被検出体が物品の出退方向で中間箇所に位置するもの等であってもよく、物品状態検出センサーの載置体における位置及び被検出体の物品における位置は適宜変更可能である。 (2) In the above-described embodiment, the article state detection sensor is provided at the end portion on the protruding side in the retracting direction of the mounting body, and the detected body is positioned at the end portion on the protruding side in the exiting and retracting direction of the article. However, the present invention is not limited to this. For example, an article state detection sensor is provided at an end portion on the withdrawal side in the direction of withdrawal of the mounting body, and the object to be detected is located at the end on the withdrawal side in the direction of withdrawal of the article. It may be one that is located at a part, or an article state detection sensor is provided at an intermediate location in the direction of withdrawal of the mounting body, and the detected object is located at an intermediate location in the direction of withdrawal of the article, etc. The position of the article state detection sensor on the mounting body and the position of the detected body on the article can be changed as appropriate.

なお、上記実施形態では、被検出体が、物品の構成枠体である底部最奥横フレーム4tにて構成されたものを例示したが、被検出体としては、例えば、物品4の底面に取り付けられる反射板等、物品に付加されるものであってもよい。   In the above-described embodiment, the object to be detected is exemplified by the bottom innermost horizontal frame 4t that is a component frame of the article. However, the object to be detected is attached to the bottom surface of the article 4, for example. It may be added to the article, such as a reflector.

(3)上記実施形態では、物品状態検出センサーが一対のセンサーにて構成されたものを例示したが、物品状態検出センサーが一つ又は3つ以上のセンサーで構成されたものであってもよい。 (3) In the above embodiment, the article state detection sensor is configured by a pair of sensors, but the article state detection sensor may be configured by one or three or more sensors. .

(4)上記実施形態では、物品状態検出センサーがフォトインタラプタ型センサーであるものを例示したが、近接センサー等、他の方式のセンサーにて代用できる。 (4) In the above embodiment, the article state detection sensor is a photo interrupter type sensor, but other types of sensors such as a proximity sensor can be used instead.

(5)上記実施形態では、上下の収納部に亘って昇降移動する昇降台14の昇降作動を利用して、卸しや掬いの移載動作において載置体29が昇降移動するスタッカークレーンを例示したが、これに限らず、例えば、掬い動作のための昇降作動を行う昇降テーブルを移動体に備えたものや、移動体を移動経路に沿って案内する移動案内レールが昇降自在に設けられたもの、つまりは移動体自体が昇降するもの等であってもよい。 (5) In the above-described embodiment, the stacker crane in which the mounting body 29 moves up and down in the wholesale or scooping transfer operation using the lifting and lowering operation of the lifting platform 14 that moves up and down across the upper and lower storage units is exemplified. However, the present invention is not limited to this, for example, a moving body equipped with an elevating table that performs an elevating operation for a scooping operation, or a moving guide rail that guides the moving body along a moving path is provided to be movable up and down That is, the moving body itself may be moved up and down.

(6)上記実施形態では、リンク機構30の第1アーム32及び第2アーム33をアーム芯出し冶具45により重複姿勢で位置決めするものを例示したが、リンク機構30の第1アーム32及び第2アーム33の一方又は双方に重複姿勢確認用のマーキングを付しておいて、インチング指令を指令操作する作業者がマーキングを目視することで重複姿勢であることを確認できるようにしてもよい。また、アーム芯出し冶具45が嵌合される係合孔47は、第1アーム32及び第2アーム33の側部に取り付けたブラケット等に形成してもよい。 (6) In the embodiment described above, the first arm 32 and the second arm 33 of the link mechanism 30 are positioned in the overlapping posture by the arm centering jig 45, but the first arm 32 and the second arm of the link mechanism 30 are illustrated. One or both of the arms 33 may be provided with a marking for confirming the overlapping posture, and an operator who commands and operates the inching command may confirm the overlapping posture by visually observing the marking. Further, the engagement hole 47 into which the arm centering jig 45 is fitted may be formed in a bracket or the like attached to the side portions of the first arm 32 and the second arm 33.

(7)上記実施形態では、駆動量検出手段が、駆動手段としての出退用電動モータ36の出力回転軸の回転数を検出するものを例示したが、これに限らず、例えば、駆動量検出手段としては、第1アーム32の揺動操作量を直接検出するもの等であってもよい。 (7) In the above-described embodiment, the drive amount detection unit exemplifies the detection of the rotation speed of the output rotation shaft of the electric motor 36 for exit / retreat as the drive unit. However, the present invention is not limited to this. As a means, a means for directly detecting the swing operation amount of the first arm 32 may be used.

(8)上記実施形態では、載置体29がパルスレート検出ゾーンZに達したことを、先端ゾーン検出センサー36にて検出するものを例示したが、これに代えて、出退用ロータリエンコーダ39のカウント値に基づいて、載置体29がパルスレート検出ゾーンZに達したことを検出するものであってもよい。 (8) In the above-described embodiment, an example in which the tip zone detection sensor 36 detects that the mounting body 29 has reached the pulse rate detection zone Z has been exemplified. Based on the count value, it may be detected that the mounting body 29 has reached the pulse rate detection zone Z.

(9)上記実施形態では、載置体を引退位置から基準突出量だけ突出作動させる最中に、基準突出量に対応する駆動手段の基準駆動量を補正駆動量だけ補正した適応駆動量に補正して、載置体を引退位置から突出作動させ始めてからの駆動手段の駆動量がこの適応駆動量になるように、駆動手段の作動を制御するものを例示したが、これに限らず、載置体を引退位置から基準突出量だけ突出作動させて一旦突出作動を停止した後に出退作動を再開して、載置体の出退作動を停止した後の駆動手段の駆動量が補正駆動量となるように、駆動手段の作動を制御するものであってもよい。 (9) In the above embodiment, the reference drive amount of the driving means corresponding to the reference protrusion amount is corrected to the adaptive drive amount corrected by the correction drive amount while the mounting body is operated to protrude by the reference protrusion amount from the retracted position. In this example, the drive means is controlled so that the drive amount of the drive means after the placement body starts to protrude from the retracted position becomes the adaptive drive amount. The driving amount of the driving means after the mounting body is protruded from the retraction position by the reference protruding amount, the protruding operation is once stopped and then the retracting operation is resumed, and the driving means after the stopping operation of the mounting body is stopped is the corrected driving amount. The operation of the driving means may be controlled so that

(10)上記実施形態では、実際に物品支持部41に移載対象の物品4を支持させることにより、その物品支持部41に支持される物品4についての、平面視における基準姿勢からの傾き、載置体29の出退方向における基準位置からのズレ量、及び、走行レール11の長手方向における基準位置からのズレ量を求めているが、平面視における基準姿勢からの傾き、載置体29の出退方向における基準位置からのズレ量、及び、走行レール11の長手方向における基準位置からのズレ量を求めるためのダミー物品を物品支持部41に支持させて、その物品支持部41に支持されるダミー物品についての、平面視における基準姿勢からの傾き、載置体29の出退方向における基準位置からのズレ量、及び、走行レール11の長手方向における基準位置からのズレ量を求めることができる。この場合、求めたズレ量は変換用単位出退量に基づいて駆動量に変換された値にて学習駆動量として各物品支持部に対応させて記憶しておけばよい。そして、物品の搬送作業時において物品支持部に支持されている物品を取り出す際には、運転制御手段が、駆動手段の駆動量が当該物品支持部に対応して記憶されている学習駆動量となるように駆動手段の作動を制御すればよい。 (10) In the embodiment described above, the article support unit 41 actually supports the article 4 to be transferred, thereby tilting the article 4 supported by the article support unit 41 from the reference posture in plan view, The amount of deviation from the reference position in the exit / retreat direction of the mounting body 29 and the amount of deviation from the reference position in the longitudinal direction of the traveling rail 11 are obtained. The inclination from the reference posture in plan view, the mounting body 29 A dummy article for determining the amount of deviation from the reference position in the exit / retreat direction and the amount of deviation from the reference position in the longitudinal direction of the traveling rail 11 is supported by the article support portion 41 and supported by the article support portion 41. Of the dummy article to be tilted from the reference position in plan view, the amount of deviation from the reference position in the direction in which the mounting body 29 is withdrawn, and the base in the longitudinal direction of the traveling rail 11 It can be determined shift amount from the position. In this case, the obtained shift amount may be stored in correspondence with each article support unit as a learning drive amount with a value converted into a drive amount based on the conversion unit withdrawal amount. Then, when taking out the article supported by the article support unit during the article transport operation, the operation control means includes a learning drive amount in which the drive amount of the drive means is stored corresponding to the article support unit. What is necessary is just to control the action | operation of a drive means so that it may become.

(11)上記実施形態では、揺動体が移動体側に揺動自在に支持される操作アームと、操作アームの先端側に揺動自在に連結される揺動アームとからなる屈伸式の2連リンクアームを備えて構成されたものを例示したが、揺動体の具体的構成はこれに限られず、例えば、移動体側に揺動自在に支持される単一のアームを備えて構成されたものであってもよい。 (11) In the above-described embodiment, the bending-extension-type double link including the operating arm that is swingably supported on the movable body side and the swinging arm that is swingably connected to the distal end side of the operating arm. Although an example in which the arm is provided is illustrated, the specific structure of the oscillating body is not limited thereto. For example, the oscillating body is configured to include a single arm that is swingably supported on the movable body side. May be.

1,8,10,41 物品支持部
4 物品
4t 被検出体
5 物品搬送装置
11 移動経路
12 移動体
29 載置体
30 揺動体
32 操作アーム
33 揺動アーム
34 駆動手段
39 駆動量検出手段
40 運転制御手段
44 物品状態検出センサー
45 位置決め用部材
46a,46b 一対の検出部
47,48 係合孔
L1 距離差
P 基準姿勢からの傾き
Q 出退ズレ量
DQadj 補正駆動量
DQ´ 適応駆動量
R(ON) 変換用単位出退量
R(θ) 単位出退量
CNT(SP) 基準検出情報
CNT(ON),CNT(ON2) センサー検出タイミング
1, 8, 10, 41 Article support unit 4 Article 4t Detected object 5 Article conveying device 11 Moving path 12 Moving body 29 Mounted body 30 Oscillating body 32 Operating arm 33 Oscillating arm 34 Driving means 39 Driving amount detecting means 40 Operation Control means 44 Article state detection sensor 45 Positioning members 46a and 46b A pair of detection portions 47 and 48 Engagement hole L1 Distance difference P Inclination Q from reference posture QLeading / leaving amount DQadj Correction drive amount DQ 'Adaptive drive amount R (ON ) Unit withdrawal amount R (θ) Unit withdrawal amount
CNT (SP) reference detection information
CNT (ON), CNT (ON2) sensor detection timing

Claims (8)

移動経路に沿って移動される移動体と、
前記移動体側に設けられた駆動手段により揺動軸心周りに揺動操作される揺動体の揺動端部側に連結されて、前記駆動手段による前記揺動体の揺動作動に連動して前記移動体上に位置する移動用の引退位置と前記移動体の外方側に位置する移載用の突出位置との間で出退作動し、かつ昇降操作自在に設けられた物品載置支持用の載置体と、
前記駆動手段の駆動量を検出する駆動量検出手段と、
前記移動経路に沿って位置する物品支持部に対する物品移載用停止位置に前記移動体を移動させるように前記移動体の移動作動を制御し、且つ、前記移動体が前記物品移載用停止位置に停止する状態において前記物品支持部に支持された物品を取り出す又は前記物品支持部に物品を卸すように前記載置体の出退作動及び昇降作動を制御する運転制御手段が設けられ、
前記物品支持部に支持された物品についての前記載置体の出退方向における基準位置からのズレ量である出退ズレ量を検出するための物品状態検出センサーが、前記載置体を前記引退位置から予め設定された基準突出量だけ突出させるときに前記物品に備えられた被検出体を検出作用する状態で、前記載置体に設けられ、
前記運転制御手段が、前記載置体を前記引退位置から前記基準突出量だけ突出させるときに、前記物品状態検出センサー及び前記駆動量検出手段の検出情報に基づいて前記出退ズレ量を求め、前記出退方向における前記基準位置から前記出退方向で前記出退ズレ量だけずれた補正用位置に対して前記載置体を位置させるように前記駆動量検出手段の検出情報に基づいて前記載置体の出退作動を制御するように構成された物品搬送装置であって、
前記運転制御手段が、前記載置体を前記引退位置から前記基準突出量だけ突出させるときに、前記物品状態検出センサーが前記被検出体を検出作用するセンサー検出タイミングにおける前記載置体の前記出退方向での位置についての、前記駆動手段の単位駆動量当たりの前記載置体の前記出退方向での単位出退量である変換用単位出退量を求め、かつ、前記補正用位置に対して前記載置体を位置させるための前記駆動手段の駆動量として、前記出退方向での前記載置体の出退量を前記駆動手段の駆動量に変換するときに前記変換用単位出退量による変換を行って、前記センサー検出タイミングにおける前記駆動量検出手段の検出情報に基づいて、前記補正用位置に対して前記載置体を位置させるための前記駆動手段の駆動量を求めるように構成されている物品搬送装置。
A moving body that is moved along the movement path;
The drive means provided on the movable body side is connected to the swing end portion side of the swing body that is swing-operated around the swing axis, and is linked to the swing operation of the swing body by the drive means. For article placement support provided to move back and forth between a retraction position for movement located on the movable body and a protruding position for transfer located on the outer side of the movable body, and to be movable up and down A mounting body of
Drive amount detection means for detecting the drive amount of the drive means;
The moving body is controlled to move so as to move the moving body to an article transfer stop position with respect to an article support portion positioned along the movement path, and the moving body is moved to the article transfer stop position. Operation control means is provided for controlling the exit / retreat operation and the lifting / lowering operation of the mounting body so as to take out the article supported by the article support section in the state of being stopped or to wholesale the article to the article support section,
An article state detection sensor for detecting an amount of displacement, which is an amount of deviation from a reference position in the direction of withdrawal of the placement object with respect to the article supported by the article support unit, the retraction of the placement object. In a state of detecting the detected object provided in the article when protruding from the position by a preset reference protrusion amount, the object is provided in the above described body,
When the operation control means causes the mounting body to protrude from the retraction position by the reference protrusion amount, the amount of displacement is determined based on detection information of the article state detection sensor and the drive amount detection means, The above description is based on the detection information of the driving amount detecting means so as to position the mounting body with respect to the correction position that is shifted by the amount of displacement in the exit / retreat direction from the reference position in the exit / retreat direction. An article transporting device configured to control an exit / retreat operation of the body,
When the operation control means causes the object body to protrude from the retraction position by the reference protrusion amount, the output of the object body at the sensor detection timing at which the article state detection sensor detects the object to be detected. For the position in the retreat direction, a conversion unit retreat amount that is a unit retreat amount in the retreat direction of the mounting body per unit drive amount of the driving means is obtained, and the correction position is On the other hand, as the driving amount of the driving means for positioning the mounting body, the conversion unit output when converting the retracting amount of the mounting body in the retracting direction into the driving amount of the driving means. Conversion based on the retraction amount is performed, and based on the detection information of the drive amount detection means at the sensor detection timing, the drive amount of the drive means for positioning the above-described body relative to the correction position is obtained. Ni It has been that the article transport device.
前記運転制御手段が、前記補正用位置に対して前記載置体を位置させるための前記駆動手段の駆動量を求めるに当たり、前記センサー検出タイミングにおける前記駆動量検出手段の検出情報に基づいて前記出退ズレ量を求め、その求めた前記出退ズレ量を前記変換用単位出退量により前記駆動手段の駆動量に変換して前記駆動手段の駆動量を求めるように構成されている請求項1記載の物品搬送装置。   When the operation control means obtains the drive amount of the drive means for positioning the mounting body with respect to the correction position, the output is based on the detection information of the drive amount detection means at the sensor detection timing. 2. A configuration is provided in which a displacement amount is obtained, and the obtained displacement amount is converted into a drive amount of the drive means by the conversion unit withdrawal amount to obtain a drive amount of the drive means. The article conveying apparatus according to the description. 前記運転制御手段が、前記出退ズレ量を求めるに当たり、前記センサー検出タイミングにおける前記駆動量検出手段にて検出した前記駆動手段の駆動量を前記変換用単位出退量にて前記載置体の出退量に変換して前記出退ズレ量を求めるように構成されている請求項2記載の物品搬送装置。   When the operation control means obtains the amount of displacement, the drive amount of the drive means detected by the drive amount detection means at the sensor detection timing is converted into the conversion unit withdrawal amount of the mounting body. The article conveying apparatus according to claim 2, wherein the article conveying apparatus is configured to obtain the withdrawal / retreat amount by converting into a withdrawal / retreat amount. 前記運転制御手段が、前記物品支持部に支持された物品を取り出すために前記載置体を突出作動させる場合に、前記センサー検出タイミングにおける前記駆動量検出手段の検出情報に基づいて、前記補正用位置に対して前記載置体を位置させるための前記駆動手段の駆動量を求めるように構成されている請求項1〜3の何れか1項に記載の物品搬送装置。   In the case where the operation control means causes the mounting body to project and operate in order to take out the article supported by the article support section, the correction control is performed based on the detection information of the drive amount detection means at the sensor detection timing. The article conveying apparatus according to any one of claims 1 to 3, wherein the article conveying device is configured to obtain a driving amount of the driving means for positioning the mounting body with respect to a position. 前記物品状態検出センサーが、前記移動経路の長手方向に並ぶ一対の検出部を備えて構成され、
前記運転制御手段が、前記載置体を前記引退位置から前記基準突出量だけ突出させるときに、一対の前記検出部の夫々が前記被検出体を検出作用するまでの前記出退方向での距離差を、一対の前記検出部の夫々が前記被検出体を検出作用したときの前記駆動量検出手段にて検出する駆動量の差を前記変換用単位出退量にて変換して求め、その求めた距離差から前記物品支持部に支持された物品についての平面視における基準姿勢からの傾きを求めるように構成されている請求項1〜4の何れか1項に記載の物品搬送装置。
The article state detection sensor includes a pair of detection units arranged in the longitudinal direction of the movement path,
When the operation control means causes the mounting body to protrude from the retraction position by the reference protrusion amount, a distance in the retracting direction until each of the pair of the detection units detects the detection object. The difference is obtained by converting the difference in drive amount detected by the drive amount detecting means when each of the pair of detection units detects the detected object by the conversion unit withdrawal amount, The article conveyance device according to any one of claims 1 to 4, wherein the article conveyance device is configured to obtain an inclination from a reference posture in a plan view of an article supported by the article support unit from the obtained distance difference.
前記揺動体は、前記移動体側に揺動自在に支持される操作アームと、前記操作アームの先端側に揺動自在に連結される揺動アームとからなる屈伸式の2連リンクアームを備えて構成され、かつ、前記駆動手段により前記操作アームが揺動作動されるに伴って、前記載置体を前記出退方向に沿って直線移動させるように構成されている請求項1〜5の何れか1項記載の物品搬送装置。   The oscillating body includes a bending-extension-type double link arm including an operation arm that is swingably supported on the movable body side, and a swing arm that is swingably connected to a distal end side of the operation arm. 6. The structure according to claim 1, wherein the mounting body is linearly moved along the withdrawing / retracting direction as the operating arm is oscillated by the driving means. Item conveying apparatus of Claim 1. 前記運転制御手段は、前記操作アーム及び前記揺動アームが上下方向視で上下に重なる重複姿勢であるときの前記駆動量検出手段の検出情報を基準検出情報として記憶自在に構成され、かつ、前記載置体を前記基準突出量だけ突出せるときに、前記センサー検出タイミングにおける前記駆動量検出手段の検出情報と前記基準検出情報とに基づいて、前記センサー検出タイミングにおける前記操作アームについての前記重複姿勢からの揺動角度を検出する揺動角度検出手段と、前記操作アーム及び前記揺動アームが前記重複姿勢であるときの前記載置体の前記出退方向での位置についての前記単位出退量を、前記揺動角度検出手段の検出情報に基づいて変換することで、前記変換用単位出退量を取得する変換用単位出退量取得手段とを備えて構成されている請求項6記載の物品搬送装置。   The operation control means is configured to be able to store detection information of the drive amount detection means as reference detection information when the operation arm and the swing arm are overlapped in a vertical direction as viewed in the vertical direction, The overlapping posture of the operation arm at the sensor detection timing based on the detection information of the drive amount detection means and the reference detection information at the sensor detection timing when the described body is protruded by the reference protrusion amount Swinging angle detecting means for detecting a swinging angle from the unit, and the unit retracting amount with respect to the position of the mounting body in the retracting direction when the operating arm and the swinging arm are in the overlapping posture Is converted on the basis of the detection information of the swing angle detection means, and includes a conversion unit withdrawal amount obtaining means for obtaining the conversion unit withdrawal amount. Has been that an article carrying apparatus according to claim 6, wherein. 前記操作アーム及び前記揺動アームの夫々に、前記重複姿勢において平面視で軸心が一致する位置に係合孔が設けられ、
前記重複姿勢における前記揺動体に対して、装着状態で前記係合孔の双方に嵌合して前記操作アーム及び前記揺動アームを前記重複姿勢に位置決めするための位置決め用部材を着脱自在に備えている請求項7記載の物品搬送装置。
Each of the operation arm and the swing arm is provided with an engagement hole at a position where the axes coincide with each other in plan view in the overlapping posture,
The oscillating body in the overlapping posture is detachably provided with a positioning member that fits in both the engagement holes in the mounted state and positions the operation arm and the oscillating arm in the overlapping posture. The article conveying device according to claim 7 .
JP2009056893A 2009-03-10 2009-03-10 Article conveying device Active JP5278749B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2009056893A JP5278749B2 (en) 2009-03-10 2009-03-10 Article conveying device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2009056893A JP5278749B2 (en) 2009-03-10 2009-03-10 Article conveying device

Publications (2)

Publication Number Publication Date
JP2010208802A JP2010208802A (en) 2010-09-24
JP5278749B2 true JP5278749B2 (en) 2013-09-04

Family

ID=42969417

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2009056893A Active JP5278749B2 (en) 2009-03-10 2009-03-10 Article conveying device

Country Status (1)

Country Link
JP (1) JP5278749B2 (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5718379B2 (en) * 2013-01-15 2015-05-13 東京エレクトロン株式会社 Substrate storage processing apparatus, substrate storage processing method, and substrate storage processing storage medium
WO2015001907A1 (en) * 2013-07-03 2015-01-08 村田機械株式会社 Conveyance system
JP2016124679A (en) * 2015-01-06 2016-07-11 ユニキャリア株式会社 Method of transferring by transfer device with conveying truck, and transfer device with conveying truck
CN116864424B (en) * 2023-09-05 2023-11-14 上海图双精密装备有限公司 Tab self-correction system and method for silicon wafer cassette and lithography machine

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3663686B2 (en) * 1995-09-25 2005-06-22 株式会社豊田自動織機 Fork control device of crane equipment
JPH11312726A (en) * 1998-04-30 1999-11-09 Olympus Optical Co Ltd Substrate carrying device
JP2000194418A (en) * 1998-12-25 2000-07-14 Murata Mach Ltd Position correction system for ummanned carriage
JP2001166830A (en) * 1999-12-07 2001-06-22 Tsubakimoto Chain Co Method and device for specifying target position of carrier
JP2002370184A (en) * 2001-06-19 2002-12-24 Daifuku Co Ltd Transfer device
JP2005193303A (en) * 2003-12-26 2005-07-21 Mitsubishi Heavy Ind Ltd Substrate transporting device
JP4378653B2 (en) * 2007-01-12 2009-12-09 株式会社ダイフク Article conveying device

Also Published As

Publication number Publication date
JP2010208802A (en) 2010-09-24

Similar Documents

Publication Publication Date Title
JP4378653B2 (en) Article conveying device
TWI409199B (en) Article storage facility and method for operating same
JP4499038B2 (en) Thin plate substrate transfer apparatus and transfer control method thereof
JP6273084B2 (en) Robot system and workpiece transfer method
US9187243B2 (en) Plate-shaped member transfer facility
TWI721222B (en) Article transport facility
US20120321426A1 (en) Transfer robot
JP4930853B2 (en) Wafer transfer device
JP5278749B2 (en) Article conveying device
WO2016125752A1 (en) Substrate transfer robot and substrate transfer method
US20050011851A1 (en) Transporting apparatus having vertically movable holding portion
TWI507278B (en) Handling robotic diagnostic system
JP4506255B2 (en) Wafer position teaching method and robot thereof
JP2013018617A (en) Carrying vehicle
KR101876255B1 (en) Stacker crane
JP2009233788A (en) Method of controlling carrier robot
JP5755842B2 (en) Work transfer system
JP2007323111A (en) Positioning controller
JP2001225909A (en) Learning method for load taking in/out device
JP4401829B2 (en) Automatic teaching device for stacker crane
JP2007273683A (en) Substrate transfer device, manufacturing device of display panel using it, substrate transfer method, and manufacturing method of display panel using it
JPH04341444A (en) Automatic paper-roll mounting device
JP2008311299A (en) Wafer positioning apparatus and wafer laminating apparatus having the same
JP2011148575A (en) Transfer device
JP2006103908A (en) Stacker crane

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20110331

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20130110

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20130207

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20130408

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130508

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

Ref document number: 5278749

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

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