JP5278749B2 - Article conveying device - Google Patents
Article conveying device Download PDFInfo
- 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
Links
- 238000001514 detection method Methods 0.000 claims description 265
- 238000012937 correction Methods 0.000 claims description 77
- 238000012546 transfer Methods 0.000 claims description 70
- 238000006073 displacement reaction Methods 0.000 claims description 45
- 238000006243 chemical reaction Methods 0.000 claims description 28
- 230000036544 posture Effects 0.000 description 114
- 230000003044 adaptive effect Effects 0.000 description 24
- 230000007246 mechanism Effects 0.000 description 17
- 238000012545 processing Methods 0.000 description 17
- 230000008859 change Effects 0.000 description 13
- 230000001276 controlling effect Effects 0.000 description 13
- 230000003028 elevating effect Effects 0.000 description 12
- LLYXJBROWQDVMI-UHFFFAOYSA-N 2-chloro-4-nitrotoluene Chemical compound CC1=CC=C([N+]([O-])=O)C=C1Cl LLYXJBROWQDVMI-UHFFFAOYSA-N 0.000 description 11
- 239000003638 chemical reducing agent Substances 0.000 description 6
- 239000011521 glass Substances 0.000 description 6
- 238000000034 method Methods 0.000 description 6
- 230000009467 reduction Effects 0.000 description 6
- 230000032258 transport Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 5
- 239000000758 substrate Substances 0.000 description 5
- 238000000605 extraction Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 238000009434 installation Methods 0.000 description 3
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 230000007423 decrease Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 239000000428 dust Substances 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000010355 oscillation Effects 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000005856 abnormality Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000000903 blocking effect Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
Images
Landscapes
- Warehouses Or Storage Devices (AREA)
- Container, Conveyance, Adherence, Positioning, Of Wafer (AREA)
Abstract
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.
しなしながら、上述した従来の物品搬送装置によれば、運転制御手段は、単位駆動量当たりの変位量が一定であるとして、物品支持体に支持されている物品の実際の位置と基準位置との出退方向でのズレ量に対応した補正出退駆動量を取得するので、載置体が、出退駆動手段により揺動軸心周りに揺動操作される揺動体の揺動端部側に連結されて、出退駆動手段による揺動体の揺動作動に連動して出退作動するものであると、補正出退駆動量は、物品の出退方向における基準位置からのズレ量に正確に対応したものとはなっていないという問題がある。 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.
本発明に係る物品搬送装置を自動倉庫に適応した実施形態を図面に基づいて説明する。
この自動倉庫は、図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
前記物品収納棚2は、前方側を互いに向かい合わせてその間に移動空間3を形成する状態で一対設けられている。各物品収納棚2は、棚横幅方向に間隔を隔てて立設された前後一対の支柱6と、前後一対の支柱6に亘る状態で支持されて棚上下方向に間隔を隔てて設けられた載置支持部7とから構成されている。そして、各物品収納部1は、左右一対の載置支持部7により物品4の棚横幅方向の両端部を載置支持する状態で物品4を収納するように構成されている。
A pair of the
前記物品収納部1は、物品として、図4に示すように、ガラス基板等の板状物品を保持可能な物品保持体4を収納自在に構成されている。前記物品保持体4は、格子状に形成された上枠体4a及び下枠体4bと、上枠体4aと下枠体4bとを連結する複数の連結体4cと、連結体4cに上下方向に間隔を隔てて設置されて水平方向に対向する連結体4c同士を連結するワイヤ状の支持部4dとから構成されている。そして、各支持部4dにて載置支持する状態で板状物品を上下方向に間隔を隔てて並べて保持しており、物品保持体4の上部、下部、及び、側部の全てにおいて空気流動可能に構成されている。なお、以下では、物品保持体4を単に物品4として説明する。
As shown in FIG. 4, the
外部から物品収納棚2へ物品4を搬入する又は物品収納棚2から外部に物品4を搬出するための物品搬出入部8が、棚横幅方向において物品収納棚2に隣接する箇所に設置されている。物品搬出入部8は、例えば、物品4を載置搬送する搬送コンベヤにて構成されている。
An article loading /
また、物品搬出入部8の他に、物品4に対して所定の処理を行う物品処理設備9との間で物品4の搬出入を行うための物品搬出入用の物品載置部10が設けられている。この物品載置部10は、図1に示すように、物品収納棚2における一番下段に相当する物品収納部1に代えて備えられている。そして、物品処理設備9が、物品収納棚2の前後幅方向において物品収納棚2に隣接する箇所に設けられ、物品載置部10が、物品収納棚2の前後幅方向において物品処理設備9に隣接する箇所に設けられている。
In addition to the article carry-in / out
前記物品載置部10では、スタッカークレーン5にて物品4が卸されると、図外の位置規制装置にて物品4を授受用適正位置に位置規制する。そして、物品4である収納カセットに収納されたガラス基板に対して物品処理設備9にて所定の処理を行うときには、物品処理設備9に備えた移載装置が、物品4である収納カセットからガラス基板を1枚ずつ取り出す。また、物品処理設備9における所定の処理が終了したガラス基板を物品4である収納カセットに収納するときには、物品処理設備9に備えた移載装置が位置規制装置にて授受用適正位置に位置規制された物品4である収納カセットに1枚ずつ収納する。
In the
前記移動空間3には、物品収納棚2の棚横幅方向の全範囲及び物品搬出入部8に亘る移動経路としての走行レール11が床部に左右一対設置されている。そして、スタッカークレーン5が走行レール11上を水平移動するように設けられている。前記スタッカークレーン5は、図3に示すように、走行レール11に沿って走行自在な移動体としての走行台車12、その走行台車12に立設された昇降マスト13に沿って昇降自在な昇降台14、その昇降台14に装着された物品移載装置15を備えて構成されている。
In the moving
前記スタッカークレーン5は、走行台車12の走行作動、昇降台14の昇降作動、及び、物品移載装置15の移載作動により、物品収納部1、物品搬出入部8、及び、物品載置部10に支持された物品4を取り出す又は物品収納部1、物品搬出入部8、及び、物品載置部10に物品4を卸すように構成されている。
The
そして、物品支持部41が、物品収納部1、物品搬出入部8、及び、物品載置部10を含めて構成されている。
The
前記スタッカークレーン5において、昇降マスト13は、走行台車12の前端部と後端部の夫々に1つずつ前後一対設けられている。そして、昇降マスト13の上端部には、前後一対の昇降マスト13の上端部同士を連結する上部フレーム16が設けられている。
In the
前記昇降台14は、走行台車12に立設した前後一対の昇降マスト13にて昇降自在に案内支持されており、その左右両側に連結した一対の昇降用ワイヤ17にて吊下げ支持されている。前記昇降用ワイヤ17の夫々は、昇降マスト13の上部に設けられた案内プーリ18に巻き掛けられて、走行台車12の端部に装備した巻き取りドラム20に巻回されている。
The
前記巻き取りドラム20の夫々には、インバータ式の昇降用電動モータ21が設けられている。そして、2つの昇降用電動モータ21が同期して正逆に回転駆動することにより、一対の昇降用ワイヤ17の繰り出し操作や巻き取り操作を行い、昇降台14を昇降作動させるように構成されている。
Each of the winding
前記走行台車12には、昇降台14の下面に設置された反射板22に向けて昇降台14の昇降方向に沿って測距用のビーム光を投射して、昇降台14の昇降方向における昇降台14の昇降位置を検出する昇降用レーザ測距計23が設けられている。昇降用レーザ測距計23は、反射板22にて反射される光を受光することにより、昇降台14の昇降方向における昇降台14までの距離を検出して、昇降台14の昇降位置を検出するように構成されている。
The traveling
前記スタッカークレーン5において、走行台車12の横幅方向の両端部の夫々には、走行レール11の長手方向に間隔を隔てて一対の走行車輪24が配置されている。一対の走行車輪24のうち、一方の走行車輪は駆動車輪24aとして構成され、他方の走行車輪は遊転自在な従動車輪24bとして構成されている。走行台車12の横幅方向の両端部に配置された駆動車輪24aの夫々には、インバータ式の走行用電動モータ25(図1参照)が設けられている。そして、2つの走行用電動モータ25が同期して正逆に回転駆動することにより、走行台車12を走行レール11に沿って走行させるように構成されている。
In the
前記走行台車12には、走行レール11の一端部に設置された反射板26に向けて走行レール11の長手方向に沿って測距用のビーム光を投射して、走行台車12の走行方向における走行台車12の走行位置を検出する走行用レーザ測距計27が設けられている。走行用レーザ測距計27は、反射板26にて反射される光を受光することにより、走行台車12の走行方向における走行台車12までの距離を検出して、走行台車12の走行位置を検出するように構成されている。
A beam beam for distance measurement is projected onto the traveling
前記物品移載装置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
前記リンク機構30は、旋回台28に対して基端部が第1上下軸心P1周りで回動自在に連結された操作アームとしての第1アーム32、及び、その第1アーム32の先端部に対して第2上下軸心P2周りで回動自在に連結され且つ載置体29に対して第3上下軸心P3周りで回動自在に連結された揺動アームとしての第2アーム33を備えた屈伸式の2連リンクアームにて構成されたいわゆるスカラアームを用いている。
The
図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
これにより、一対のリンク機構30は、第1アーム32の揺動方向及び揺動量が第2アーム33の揺動方向及び揺動量と逆方向で同量となる状態で、出退用電動モータ34によって、第1アーム32を連動させてそれぞれの第1上下軸心P1周りで揺動操作し、揺動する第1アーム32によって一対の第2アーム33を介して載置体29の基端側を押し操作したり引き操作したりすることにより、載置体29を旋回台28に対して載置体29の前後方向に出退操作する。
As a result, the pair of
このようにして、一対の出退用電動モータ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
前記旋回台28の旋回位置が第1基準旋回位置又は第2基準旋回位置であることを検出する基準旋回位置検出センサー35が設けられている。前記第1基準旋回位置は、物品保管棚2の前後幅方向において走行レール11に対して一方側に位置する物品支持部41に対して物品4を移載するときの基準旋回位置である。前記第2基準旋回位置は、物品保管棚2の前後幅方向において走行レール11に対して他方側に位置する物品支持部41に対して物品4を移載するときの基準旋回位置であり、第1基準旋回位置から180度旋回した位置である。
A reference turning
前記基準旋回位置検出センサー35については、投受光式のセンサーにて構成されている。そして、基準旋回位置検出センサー35は、旋回台28に設置された被検出板にて投光した光が遮光されることにより、旋回台28の旋回位置が第1基準旋回位置又は第2基準旋回位置であることを検出するように構成されている。また、旋回用電動モータ31には、基準旋回位置検出センサー35にて第1基準旋回位置又は第2基準旋回位置を検出してからの旋回台28の旋回量を検出することにより旋回台28の旋回位置を検出する旋回用ロータリエンコーダ38が設けられている。
The reference turning
前記載置体29がその出退範囲の突出側限度付近に設定された先端パルスレート検出ゾーンZの引退側位置に位置していることを検出する先端ゾーン検出センサー36、及び、前記載置体29がその出退範囲の引退側限度に引退され引退位置に位置していることを検出する引退位置検出センサー37が設けられている。先端ゾーン検出センサー36及び引退位置検出センサー37は、基準旋回位置検出センサー35と同様に、投受光式のセンサーにて構成されている。
The tip
先端ゾーン検出センサー36は、載置体29の先端部が、物品支持部41に支持されている物品4の下枠体4bにおける、出退方向の突出側で最奥側に位置する底部最奥横フレーム4tよりも出退方向で引退側に位置するときに、第1アーム32の基端部に設置された被検出板にて投光した光が遮光されることにより、載置体29が先端パルスレート検出ゾーンZの引退側端部に位置していることを検出する。これにより、載置体29を突出作動させた場合に、載置体29が先端パルスレート検出ゾーンZに入ったことを検出できるようになっている。なお、先端ゾーン検出センサー36用の被検出板は、第1アーム32の基端部において位置変更自在に設けられており、物品保持体4における底部最奥横フレーム4tの位置等の設備の仕様に応じて、第1アーム32の基端部における位置が調整されている。
The front end
引退位置検出センサー37は、リンク機構30が引退姿勢であるときの第1アーム32の基端部に設置された被検出板にて投光した光が遮光されることにより、載置体29が引退位置(ホームポジションHP)に位置していることを検出する。
The retraction
出退用電動モータ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
この出退用ロータリエンコーダ39の1カウント当たりの第1アーム32の揺動操作角度は、後述する運転制御装置40の記憶部に予め登録される装置仕様データとしての減速機の減速比データD5及びエンコーダ分解能データD6(図14(b)参照)に基づいて、運転制御装置40に備えられた算出用プログラムにより装置立ち上げ時に算出され、算出された値は、後述する基準パルスレートデータD1、重複姿勢パルスカウントデータD2、ホームポジション角度データD3といった各種パラメータデータ(図14(a)参照)と共に、1パルス当たり揺動角度データD4として運転制御装置40の記憶部に記憶される。
The swinging operation angle of the
図10に示すように、スタッカークレーン5の運転を制御する運転制御手段としての運転制御装置40が設けられている。この運転制御装置40は、物品支持部41に対する物品移載用停止位置に物品移載装置15を移動させるべく、走行台車12の走行作動及び昇降台14の昇降作動を制御し、且つ、物品移載装置15を物品移載用停止位置に停止させた状態において物品支持部41に支持された物品4を取り出す又は物品支持部41に物品4を卸すべく、物品移載装置15の移載作動を制御するように構成されている。
As shown in FIG. 10, an
前記運転制御装置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
前記走行制御部40aは、走行用電動モータ25を作動させて走行台車12を走行作動させ、走行用レーザ測距計27にて検出される走行台車12の走行位置が走行台車12の走行方向における物品移載用停止位置になると、走行用電動モータ25を作動停止させて走行台車12の走行方向における物品移載用停止位置に物品移載装置15を位置させる。
The
前記昇降制御部40bは、昇降用電動モータ21を作動させて昇降台14を昇降作動させ、昇降用レーザ測距計23にて検出される昇降台14の昇降位置が昇降台14の昇降方向における物品移載用停止位置になると、昇降用電動モータ21を作動停止させて昇降台14の昇降方向における物品移載用停止位置に物品移載装置15を位置させる。ちなみに、物品支持部41に物品4を卸すときには、物品支持部41に支持された物品4を取り出すときよりも、昇降台14の昇降方向における物品移載用停止位置が設定距離だけ上方側に設定されている。
The lifting
前記物品支持部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
なお、載置体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
前記物品支持部41に物品4を卸すときには、載置体29を突出作動させた後において、昇降制御部40bにて設定距離だけ昇降台14を下降させる動作だけが異なり、その他の動作については、物品支持部41に支持された物品4を取り出すときと同様の動作である。
When the
このようにして、運転制御装置40が、スタッカークレーン5の運転を制御することにより、物品搬出入部8に支持された物品4を取り出してその取り出した物品4を物品収納部1に卸す作業や、物品収納部1に支持された物品4を取り出してその取り出した物品4を物品載置部10に卸す作業等を行い、物品搬出入部8と物品収納部1と物品載置部10との間で物品4を搬送するように構成されている。
In this way, the
前記物品支持部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
そこで、物品支持部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
しかしながら、物品支持部41の据付誤差や物品4を物品支持部41に卸す際の移載誤差等により、物品支持部41に支持されている物品4が基準姿勢から傾いた姿勢で基準位置からずれた位置に位置することがあるので、物品支持部41に支持された物品4についての、平面視における基準姿勢からの傾き、走行レール11の長手方向における基準位置からのズレ量、及び、載置体29の出退方向における基準位置からのズレ量を求めるようにしている。
However, due to an installation error of the
図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
第1先端センサー46a及び第2先端センサー46bの夫々は、例えば、フォトインタラプタ型センサーであり、上向きに投光した光が、物品4における下枠体4bの出退方向で突出側に位置するフレーム部分である被検出体としての底部最奥横フレーム4tにて反射されて、その反射された光を受光することにより底部最奥横フレーム4tの端部を検出するように構成されている。また、物品4を取り出すために載置体29が物品4に対して突出されるときの物品4の下枠体4bと載置体29との上下方向の距離に基づいてこれらのセンサーの検出感度が調整されている。
Each of the
このように、物品状態検出センサー44は、載置体29を引退位置から基準突出量だけ突出させる(出退用ロータリエンコーダ39の出力パルスについてのカウント値が、基準突出量に対応した基準出退駆動量DQを示すカウント値CNT(TOP)になるように出退用電動モータ34を作動させる。)ときに、物品4における底部最奥横フレーム4tを検出作用するように設けられている。これにより、載置体29が、先端パルスレート検出ゾーンZに入ったことを先端ゾーン検出センサー36にて検出した後、載置体29の先端部が出退方向で物品4における底部最奥横フレーム4tに達する位置である先端パルスレート検出位置まで突出したことを検出することができるようになっている。
In this manner, the article
そして、第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 |
前記運転制御装置40は、物品支持部41に対する基準停止位置に物品移載装置15を位置させた状態において載置体29を基準出退方向に突出作動させて、載置体29が先端パルスレート検出ゾーンZに入ってからの物品状態検出センサー44にて検出される情報に基づいて、物品支持部41に支持された物品4についての、平面視における基準姿勢からの傾き、走行レール11の長手方向における基準位置からのズレ量、及び、載置体29の出退方向における基準位置からのズレ量を求めるように構成されている。
The
まず、物品支持部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
As shown in FIG. 12, a case is considered where the
物品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
θ1 = θ2 = arctan (L1 / L2) (Equation 1)
However, when L1 projects and operates the mounting
前記載置体29を突出作動させたときに、一対の物品状態検出センサー44のうちの一方が底部最奥横フレーム4tの端部4teを検出する状態となったときの出退用ロータリエンコーダ39の出力パルスについてのカウント値である1次センサー検出タイミング値CNT(ON1)と、双方が底部最奥横フレーム4tの端部4teを検出する状態となったときの出退用ロータリエンコーダ39の出力パルスについてのカウント値である2次センサー検出タイミング値CNT(ON2)との差から、出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量(例えば、出退用ロータリエンコーダ39の1カウント分の出退量)を用いて、距離L1を求めることができる。そして、L2が既定値であるので、(式1)にて角度θ1を求めることができる。
When the
そして、物品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
このようにして、運転制御装置40は、載置体29を基準突出量だけ突出作動させるときに、一対の物品状態検出センサー44及び出退用ロータリエンコーダの検出情報に基づいて、物品支持部41に支持された物品4についての載置体29の平面視における基準姿勢からの傾きを、変換用単位出退量としての先端パルスレートR(ON)を基準として求めるように構成され、かつ、物品支持部41に支持された物品4についての、平面視における基準姿勢からの傾きを示す角度θ1に基づいて、載置体29の出退方向を補正するように構成されている。
In this way, when the
次に、物品支持部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
In order to set the
図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
載置体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
つまり、このような姿勢及び位置に位置する物品4は、物品4が基準姿勢であるとしたときに載置体29を基準突出量だけ突出させると、第1先端センサー46aがオン後の突出量(L4)と、第2先端センサー46bがオン後の突出量(L1+L4)との平均L4´(L4+L1/2)だけ、第1先端センサー46a及び第2先端センサー46bの双方が同時にオンとなってから突出作動するような出退方向の位置に位置していることになる。
That is, when the
そして、物品4が基準姿勢で出退方向の基準位置に位置していれば、載置体29を基準突出量だけ突出させたときには、第1先端センサー46a及び第2先端センサー46bの双方が同時にオンとなってから上記L7だけ突出作動するので、一対の物品状態検出センサー44の検出情報に基づいて求められる物品4の出退方向における出退補正量Qは、下記の(式2)で与えられる。
Q=L7−L4´=L7−(L4+L1/2) ・・・・・(式2)
If the
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
逆に、物品4が基準位置から出退方向で引退側にずれていると、距離L4´が距離L7よりも大きくなり、出退補正量Qとして負の値が得られ、この場合は、載置体29の出退方向の位置を物品4に対して適正な位置とするために、出退方向で基準突出量が減少側(突出側)に補正される。
On the contrary, if the
上記距離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
また、上記距離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
そして、物品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 |
このようにして、運転制御装置40は、載置体29を基準突出量だけ突出作動させるときに、一対の物品状態検出センサー44及び出退用ロータリエンコーダ39の検出情報に基づいて、物品支持部41に支持された物品4についての載置体29の出退方向における基準位置からのズレ量を、出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量を用いて求めるように構成され、かつ、物品支持部41に支持された物品4についての、出退方向における基準位置からのズレ量に基づいて、載置体29の突出量を補正するように構成されている。
In this way, when the
また、詳述はしないが、運転制御装置40は、載置体29を引退位置から移動補正量検出用の所定出退量だけ突出させた状態において、走行台車12を走行レール11の長手方向に移動させたときに、載置体29の出退方向に直交する方向に分散して載置体29に一対設けられた図外の側端部材検出部のうちの少なくとも一方が、物品4の側端部を検出するまでに走行台車12についての移動量に基づいて、物品支持部41に支持された物品4についての、走行レール11の長手方向における基準位置からのズレ量を移動補正量として求めるように構成されている。そして、物品支持部41に支持された物品4についての、走行レール11の長手方向における基準位置からのズレ量に基づいて、走行台車12の走行停止位置を補正するように構成されている。
Although not described in detail, the
上記の通り、運転制御装置40は、載置体29を引退位置から基準突出量だけ突出作動させる際に、物品支持部41に支持された物品4についての、平面視における基準姿勢からの傾きを旋回補正量Pとして求め、載置体29の出退方向における基準位置からのズレ量を出退補正量Qとして求め、走行レール11の長手方向における基準位置からのズレ量を移動補正量として求める。そして、旋回補正量P、出退補正量Q、及び、移動補正量に相当する各駆動手段についての補正駆動量を求め、それらの補正駆動量にて基準駆動量を補正した適応駆動量に基づいて作動させることで、載置体29を物品4に対して適正な姿勢及び位置とすることで、物品4を適正に掬い取ることができるようになっている。
As described above, when the
そして、運転制御装置40は、旋回補正量Pとしての角度θ1や出退補正量Qとしての上述の距離L7−L4´を算出するために必要な距離L1や距離L4を取得する場合や、取得した出退補正量Qとしての距離「L7−L4´」から補正出退駆動量DQadjを求める場合において、出退用電動モータ34を駆動させたときの駆動量とその駆動による載置体29の出退方向の位置の変化量との関係として、物品状態検出センサー44が物品4の底部最奥横フレーム4tの出退方向で引退側の端部4teを検出する状態となるセンサー検出タイミングにおける載置体29の出退方向での位置についての、出退用電動モータ34の単位駆動量当たりの載置体29の出退方向での単位出退量である先端パルスレートR(ON)を算出している。
The
出退用電動モータ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
載置体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
一対のリンク機構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
出退用ロータリエンコーダ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
本実施形態では、運転制御装置40は、重複姿勢のリンク機構30における第1アーム32の位相を基準とした第1アーム32の角度θに基づいて円弧長パルスレートRを変換して先端パルスレートR(ON)を求めるため、円弧長パルスレートRは、先端パルスレートR(ON)を算出するための基準パルスレートRとして管理されている。この基準パルスレートRは、運転制御装置40に備えられた算出用プログラムにより装置立ち上げ時に算出され、一旦算出されると、運転制御装置40の記憶部に基準パルスレートデータD1として記憶されている。
In the present embodiment, the
第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
また、重複姿勢から第1アーム32及び第2アーム33が姿勢変化して、第1アーム32が重複姿勢である時の位相(以下、重複位相ともいう。)から角度θだけ揺動した位相まで揺動しているとすると、このときの出退用電動モータ34の単位駆動量当たりの第1アーム32の第2上下軸心P2の変位のうち出退方向に寄与する成分はcosθ倍され、同様に、第2アーム33の第3上下軸心P3の変位のうち出退方向に寄与する成分もcosθ倍されることになる。
Further, from the overlapping posture, the
したがって、第1アーム32及び第2アーム33が重複姿勢から姿勢変化して、第1アーム32が、第2アーム33と重複する重複位相から角度θだけ揺動した状態での1パルス当たりの出退方向の変位である単位出退量R(θ)は、下記の(式3)で与えられる。
R(θ)=R×2cosθ ・・・・・(式3)
Therefore, the
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
先端パルスレート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
センサー検出タイミングは、本実施形態では、一対の物品状態検出センサー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
物品支持部41に支持されている物品4が、例えば、図12や図13(a)に示すように基準姿勢から傾いていると、載置体29を引退位置から基準突出量だけ突出させるときの第1先端センサー46a及び第2先端センサー46bがオン状態になるタイミングは異なるが、この場合、センサー検出タイミングを示す出退用ロータリエンコーダ39の出力パルスについてのカウント値CNT(ON2)としては、第1先端センサー46a及び第2先端センサー46bがオン状態となるタイミングのうち遅いほうのタイミングでのカウント値となる。
When the
センサー検出タイミングにおける第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
作業者は、運転制御装置40を図外のキースイッチにてマニュアルモードに切り換え操作する(#B1)。その後、作業者は、インチング指令を指令自在な手動操作式の指令手段にてインチング動作を指令することで、出退用電動モータ34をインチング動作させて、図18(a)に示すように、第1アーム32と第2アーム33とが上下方向視で重複する重複姿勢に第1アーム32及び第2アーム33を姿勢変化させる(#B2)。このときの載置体29の出退方向の位置は引退位置より突出側の教示位置となっている。
The operator switches the
そして、図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
そして、作業者は、ティーチング指令を指令自在な手動操作式の指令手段にてティーチング指令を指令する(#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
なお、このとき、運転制御装置40は、載置体29が引退位置(ホームポジションHP)に位置するとき(リンク機構30が引退姿勢となるとき)の第1アーム32の揺動角度θ(HP-SP)を、1パルス当たり揺動角度データD4に格納された1パルスあたり揺動角度θc[°/pulse]基づいて算出し、ホームポジション角度データD3として記憶部に格納する。重複姿勢パルスカウントCNT(SP)の登録が完了すると、作業者は、アーム芯出し冶具45を抜き取って、運転制御装置40を図外のキースイッチにて通常運転モードに切り換え操作して、ティーチング作業を終了する。
At this time, the
次に、通常運転モードで実行される物品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
まず、運転制御装置40は、物品4が支持された物品支持部41に対する物品移載用停止位置に物品移載装置15を移動させるべく、走行制御部40aにて走行台車12の走行作動を制御し且つ昇降制御部40bにて昇降台14の昇降作動を制御し、物品移載装置15を物品移載用停止位置に停止させる(#M1)。
First, the
そして、運転制御装置40は、移載制御部40cにて物品移載装置15の移載作動を制御して載置体29の突出作動を開始する(#M2)。この突出作動では、載置体29が引退位置から基準突出量だけ突出するように、出退用ロータリエンコーダ39の出力パルスのカウント値(以下、単に出退用ロータリエンコーダ39のカウント値ともいう)に基づいて出退用電動モータ34の作動が制御される。運転制御装置40の記憶部には基準突出量に対応する出退用電動モータ34の駆動量である基準出退駆動量DQを示すカウント値としてCNT(TOP)が予め設定されている。
And the
突出作動を開始すると、運転制御装置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
一対の物品状態検出センサー44がオン状態になるまでに、載置体29の引退位置からの突出量が基準突出量に達した場合、すなわち、出退用ロータリエンコーダ39のカウント値がCNT(TOP)に達した場合は、物品支持部41に支持されている物品4が基準位置から許容範囲以上に出退方向で突出側又は引退側にずれた位置に位置しているか、何らかの制御異常が発生しているとして、異常停止させるようにしている(#M5・#M6)。
When the protrusion amount from the retracted position of the mounting
運転制御装置40は、#M4において、一対の物品状態検出センサー44の第1先端センサー46a及び第2先端センサー46bの夫々がオン状態になったときに、出退用ロータリエンコーダ39のカウント値を、1次センサー検出タイミング値CNT(ON1)及び2次センサー検出タイミング値CNT(ON2)として取得する。
In # M4, the
一対の物品状態検出センサー44の双方がオン状態となると、#M7へ移行し、先端パルスレート算出処理が実行される。詳しくは後述するが、この処理では、基準パルスレートRを、センサー検出タイミングにおける第1アーム32の重複姿勢からの揺動角度θ(SP-ON)に基づいて(式3)にて変換して先端パルスレートR(ON)を求める。
When both of the pair of article
#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
#M11では、載置体29を引退位置から突出させる基準突出量(距離)に対応する出退用電動モータ34についての基準出退駆動量DQを示す出退用ロータリエンコーダ39のカウント値を、出退補正量Q(距離)分の補正出退駆動量DQadjを示すカウント値に先端パルスレートR(ON)を用いて補正して、出退用電動モータ34の適応出退駆動量DQ´を示すカウント値を求める。
In # M11, the count value of the
#M12では、旋回用ロータリエンコーダ38のカウント値が、適応旋回駆動量DP´を示すカウント値(#M10で求めたカウント値)となるように、旋回用電動モータ31の作動を制御して、旋回台28を旋回作動させる。
In # M12, the operation of the turning
#M13では、出退用ロータリエンコーダ39のカウント値が、適応出退駆動量DQ´を示すカウント値(#M11で求めたカウント値)となるように、出退用電動モータ34の作動を制御して、載置体29を出退作動させる。
In # M13, the operation of the exit / exit
その後、運転制御装置40は、#M14で、適応旋回駆動量DP´を示すカウント値を今回の掬い動作の移載対象箇所である物品支持部41についての新たな基準旋回駆動量DPとして更新記録し、#M15で、適応出退駆動量DQ´を示すカウント値を今回の掬い動作の移載対象箇所である物品支持部41についての新たな基準出退駆動量DQとして更新記録する。
Thereafter, in # M14, the
ここで、図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
そして、運転制御装置40は、#M16で、昇降制御部40bを機能させて、昇降台14を設定昇降ストロークだけ昇降させる。このとき、物品4が基準姿勢から傾いた姿勢で基準位置からずれた位置にて物品支持部41に支持されても、載置体29は掬い対象のこの物品4に対して適正な姿勢及び位置で下方側に位置する状態となっているので、物品4は、載置体29に対して適正な姿勢及び位置となる状態で載置体29にて載置支持される。
And the
こうして物品4を掬い上げた後、運転制御装置40は、#M17で、再び移載制御部40cを機能させて、出退用ロータリエンコーダ39のカウント値に基づいて引退速度を制御しながら、物品4を支持した状態の載置体29を引退作動させ、引退位置検出センサー37にて載置体29が引退位置に位置することが検出されると、載置体29の引退作動を停止させる。そして、出退用ロータリエンコーダ39のカウント値を「0」にリセットして、移載作動を完了する。
After the
このように、運転制御装置40は、物品4の基準姿勢からの傾き、走行レール11の長手方向における基準位置からのズレ量、出退方向における基準位置からのズレ量を実際の移載対象の物品4に対して検出作用する物品状態検出センサー44の検出情報を用いて求めて、これら傾きやズレ量を解消するように走行台車12及び物品移載装置15の作動を制御することで、物品4に対して載置体29が適正な姿勢及び位置なる状態で物品4を救い上げることができる。
In this way, the
次に、図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
#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
#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
#A2及び#A3により運転制御装置40は、載置体29を基準突出量だけ突出せるときに、センサー検出タイミングにおける出退用ロータリエンコーダ39の検出情報と基準検出情報としての重複姿勢パルスカウント値CNT(SP)とに基づいて、センサー検出タイミングにおける第1アーム32についての重複姿勢からの揺動角度θ(SP-ON)を検出している。したがって、運転制御装置40に組み込まれた制御プログラム(さらに、具体的には、#A2及び#A3の処理)により揺動角度検出手段が構成されている。
When # A2 and # A3 cause the
#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
#A4により運転制御装置40は、第1アーム32及び第2アーム33が重複姿勢であるときの載置体29の出退方向での位置についての単位出退量R(θ)を、揺動角度検出手段の検出情報(#A2及び#A3の処理結果)に基づいて変換することで、センサー検出タイミングにおける載置体29の出退方向での位置についての単位出退量すなわち先端パルスレートR(ON)を取得している。したがって、運転制御装置40に組み込まれた制御プログラム(さらに、具体的には、#A4の処理)により変換用単位出退量取得手段が構成されている。
By # A4, the
本実施形態では、旋回補正量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
〔別実施形態〕
以下、本発明の別実施形態を列記する。
(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
(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
(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
(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
(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
(8)上記実施形態では、載置体29がパルスレート検出ゾーンZに達したことを、先端ゾーン検出センサー36にて検出するものを例示したが、これに代えて、出退用ロータリエンコーダ39のカウント値に基づいて、載置体29がパルスレート検出ゾーンZに達したことを検出するものであってもよい。
(8) In the above-described embodiment, an example in which the tip
(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
(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
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〜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.
前記重複姿勢における前記揺動体に対して、装着状態で前記係合孔の双方に嵌合して前記操作アーム及び前記揺動アームを前記重複姿勢に位置決めするための位置決め用部材を着脱自在に備えている請求項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 .
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)
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)
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 |
-
2009
- 2009-03-10 JP JP2009056893A patent/JP5278749B2/en active Active
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 |