JPH0796478A - Control device for vertical movement of handling mechanism of carrying device - Google Patents

Control device for vertical movement of handling mechanism of carrying device

Info

Publication number
JPH0796478A
JPH0796478A JP5240114A JP24011493A JPH0796478A JP H0796478 A JPH0796478 A JP H0796478A JP 5240114 A JP5240114 A JP 5240114A JP 24011493 A JP24011493 A JP 24011493A JP H0796478 A JPH0796478 A JP H0796478A
Authority
JP
Japan
Prior art keywords
speed
sub
handling mechanism
motor
drive
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.)
Pending
Application number
JP5240114A
Other languages
Japanese (ja)
Inventor
Makoto Toyoda
誠 豊田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Yamaha Motor Co Ltd
Original Assignee
Yamaha Motor Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Yamaha Motor Co Ltd filed Critical Yamaha Motor Co Ltd
Priority to JP5240114A priority Critical patent/JPH0796478A/en
Publication of JPH0796478A publication Critical patent/JPH0796478A/en
Pending legal-status Critical Current

Links

Classifications

    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Landscapes

  • Manipulator (AREA)
  • Lift-Guide Devices, And Elevator Ropes And Cables (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

PURPOSE:To keep a handling mechanism in the horizontal condition by keeping the same rotational speed of a main driving motor as that of a sub driving motor, and appropriately correct the inclination of the handling mechanism at the initial position. CONSTITUTION:A motor speed deviation computing part 64 is provided in a sub control part 52B to control a sub motor 11B, the real deviation between the driving speed of a main motor 11A and the sub motor 11B is obtained, and the computed value is outputted to a speed control means 66 through a D/A converter 65. The previous speed command value for the sub motor 11B is inputted to this speed control means 66 through a CPU 51, a ratch circuit 58 and a D/A converter 59, the driving speed deviation obtained by the motor speed deviation computing part 64 is added to this previous speed command value to set the present speed command value to the sub motor 11B.

Description

【発明の詳細な説明】Detailed Description of the Invention

【0001】[0001]

【産業上の利用分野】本発明は、主,副の走行台車と、
これらが連結されたフレームに吊り下げ式に昇降可能に
支持されたハンドリング機構とを有し、各走行台車に個
々に装備された複数の駆動モータにより上記ハンドリン
グ機構を昇降させる搬送装置のハンドリング機構昇降制
御装置に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention
A handling mechanism supported by a frame to which these are connected in a suspending manner so as to be able to ascend and descend, and a plurality of drive motors individually provided to each traveling carriage raises and lowers the handling mechanism. The present invention relates to a control device.

【0002】[0002]

【従来の技術】従来、工場の組立てラインにおいて、モ
ノレールに沿って移動する搬送装置により各種物品の搬
送を行うことは一般に行われている。上記搬送装置とし
ては、例えばモノレール上を転動する駆動輪を有する走
行台車と、この走行台車に対して吊り下げ式に昇降可能
とされたハンドリング機構と、このハンドリング機構を
昇降させる巻き上げ機構とを備えたものが知られてい
る。
2. Description of the Related Art Conventionally, in an assembly line of a factory, it has been common practice to carry various articles by a carrying device that moves along a monorail. Examples of the transfer device include a traveling carriage having drive wheels that roll on a monorail, a handling mechanism that can be lifted up and down with respect to the traveling carriage, and a hoisting mechanism that raises and lowers the handling mechanism. Those equipped are known.

【0003】上記の搬送装置においては、走行台車の走
行駆動と、巻き上げ機構を作動させることによるハンド
リング機構昇降駆動とが、モータを駆動源として行われ
る。特に最近では、駆動系の合理化、コンパクト化を図
るように、走行台車に装備した1つのモータを走行駆動
とハンドリング機構昇降駆動とに兼用し、クラッチ手段
等を介し、モータの駆動力を駆動輪に伝達する状態と、
巻き上げ機構に伝達する状態とに切換可能とするものも
知られている。
In the above-mentioned transport device, the traveling drive of the traveling carriage and the raising / lowering drive of the handling mechanism by operating the hoisting mechanism are performed by using the motor as a drive source. Particularly in recent years, in order to rationalize and downsize the drive system, one motor equipped on the traveling carriage is used both for traveling drive and for raising and lowering the handling mechanism, and the driving force of the motor is driven through the clutch means or the like. The state of being transmitted to
There is also known one that can be switched to a state in which it is transmitted to a hoisting mechanism.

【0004】[0004]

【発明が解決しようとする課題】ところで、大きな荷物
の搬送に用いる搬送装置として、複数の走行台車をフレ
ームを介して連結するとともに、上記フレームに配設し
た複数の巻き上げ機構により、比較的大型のハンドリン
グ機構を吊持するようにしたものがある。このような搬
送装置では、走行用のモータとハンドリング機構昇降用
のモータとを別個に設けるのが一般的であるが、合理化
等のためには、各走行台車に設けられているモータを走
行用とハンドリング機構昇降用とに兼用することが好ま
しい。
By the way, as a carrying device for carrying a large load, a plurality of traveling carriages are connected via a frame, and a plurality of hoisting mechanisms arranged on the frame make it relatively large. There is a thing that suspends the handling mechanism. In such a transfer device, it is general to provide a motor for traveling and a motor for raising and lowering the handling mechanism separately, but for the sake of rationalization, the motor provided in each traveling carriage is used for traveling. It is also preferable to use both for raising and lowering the handling mechanism.

【0005】このようにするための構造としては、各走
行台車のモータに複数の巻き上げ機構をそれぞれ伝導機
構及びクラッチ手段を介して接続し、ハンドリング機構
の昇降時には、クラッチ手段を締結して各モータの動力
を複数の巻き上げ機構に伝達し、かつ各モータを個別に
同一速度で駆動するように制御することが考えられる。
As a structure for doing so, a plurality of hoisting mechanisms are connected to the motor of each traveling carriage through a transmission mechanism and a clutch means, and when the handling mechanism is moved up and down, the clutch means is fastened to each motor. It is conceivable to transmit the power of (1) to a plurality of hoisting mechanisms and control each motor so that they are individually driven at the same speed.

【0006】しかし、このように各モータを制御して
も、昇降中における各巻き上げ機構の負荷のばらつき等
により、モータ間で駆動速度に偏差が生じ、この偏差の
蓄積により、昇降中にハンドリング機構が傾動するとい
った問題がある。また、各モータが同一速度で駆動され
たとしても、ハンドリング機構が初期位置、すなわち上
昇位置において傾いていたのでは、ハンドリング機構は
常に傾いた状態のままとなるのでこれを補正する必要も
ある。
However, even if the respective motors are controlled in this way, a deviation in the driving speed occurs between the motors due to variations in the load of the hoisting mechanisms during ascent and descent, and the handling mechanism during the ascent and descent due to the accumulation of this deviation. There is a problem of tilting. Further, even if each motor is driven at the same speed, if the handling mechanism is tilted at the initial position, that is, in the raised position, the handling mechanism will always remain tilted, and this must be corrected.

【0007】本発明は、上記問題を解決するためになさ
れたものであり、主,副の走行台車に個々に設けられた
主,副の駆動モータによりハンドリング機構昇降用の巻
き上げ機構を駆動するときに、主,副の駆動モータの回
転速度を同一に保つことにより、ハンドリング機構を水
平状態に保つことができ、また、初期位置におけるハン
ドリング機構の傾きを好適に補正できる搬送装置のハン
ドリング機構昇降制御装置をを提供することを目的とし
ている。
The present invention has been made in order to solve the above problems, and when the hoisting mechanism for raising and lowering the handling mechanism is driven by the main and sub drive motors individually provided on the main and sub traveling carriages, respectively. In addition, by keeping the rotation speeds of the main and sub drive motors the same, the handling mechanism can be maintained in a horizontal state, and the handling mechanism lifting control of the transporting device that can appropriately correct the inclination of the handling mechanism at the initial position. The purpose is to provide a device.

【0008】[0008]

【課題を解決するための手段】本発明は、フレームを介
して相互に連結された主,副の走行台車と、上記フレー
ムに吊り下げ式に昇降可能に支持されたハンドリング機
構と、上記各走行台車に個々に装備された主,副の駆動
モータと、これらの各駆動モータにより駆動され、上記
ハンドリング機構を昇降させる巻き上げ機構とを備え、
上記各駆動モータの駆動速度を示す情報に基づいて上記
ハンドリング機構の昇降を制御する装置であって、上記
主駆動モータを制御する主制御部と、上記副駆動モータ
を制御する副制御部とを有し、上記副制御部に、上記主
駆動モータの現実の駆動速度と上記副駆動モータの現実
の駆動速度の偏差を演算する速度偏差演算手段と、副駆
動モータに対する前回の速度指令値に上記速度偏差演算
手段での演算結果を加味して副駆動モータに対する速度
指令値を発生する速度制御手段とを備えたものである
(請求項1)。
DISCLOSURE OF THE INVENTION The present invention is directed to a main and a secondary traveling carriage which are interconnected via a frame, a handling mechanism which is supported by the frame so as to be able to be lifted and lowered, and each of the traveling vehicles. The main and sub drive motors individually mounted on the carriage, and the hoisting mechanism that is driven by each of these drive motors to raise and lower the handling mechanism,
A device for controlling the raising and lowering of the handling mechanism based on information indicating the drive speed of each drive motor, comprising a main control unit for controlling the main drive motor and a sub control unit for controlling the sub drive motor. The sub control unit has a speed deviation calculation means for calculating a deviation between the actual drive speed of the main drive motor and the actual drive speed of the sub drive motor, and the previous speed command value for the sub drive motor. And a speed control means for generating a speed command value for the auxiliary drive motor in consideration of the calculation result of the speed deviation calculation means (claim 1).

【0009】また、上記副制御部に、上記ハンドリング
機構が上昇位置にある状態で、ハンドリング機構の傾き
状態を検知する傾状態検知手段と、これにより検出され
たハンドリング機構の傾き状態に応じて、上記巻き上げ
機構を作動させてハンドリング機構の傾きを補正するべ
く上記主,副いずれかの駆動モータを駆動制御する傾状
態補正制御手段とを備えたものである(請求項2)。
Further, in the sub-control unit, the tilt state detecting means for detecting the tilt state of the handling mechanism when the handling mechanism is in the raised position, and the tilt state of the handling mechanism detected by the tilt state detecting means, The tilt state correction control means for driving and controlling either the main drive motor or the sub drive motor to correct the inclination of the handling mechanism by operating the winding mechanism is provided (claim 2).

【0010】[0010]

【作用】本発明によれば、ハンドリング機構の昇降時に
は主駆動モータと副駆動モータの現実の駆動速度偏差に
応じて、副駆動モータの駆動速度が主駆動モータの駆動
速度に一致するように制御され、これによって主,副駆
動モータ間の駆動速度が同一に保たれる。従って、主,
副の駆動モータにより駆動される巻き上げ機構は共に同
一の速度で駆動されるので、ハンドリング機構は確実に
水平状態のまま昇降されることになる(請求項1)。
According to the present invention, when the handling mechanism is moved up and down, the drive speed of the sub drive motor is controlled so as to match the drive speed of the main drive motor according to the actual drive speed deviation between the main drive motor and the sub drive motor. As a result, the drive speeds between the main and sub drive motors are kept the same. Therefore, Lord,
Since the hoisting mechanisms driven by the sub drive motors are both driven at the same speed, the handling mechanism is surely moved up and down in the horizontal state (claim 1).

【0011】また、初期位置、すなわち上昇位置におい
て、ハンドリング機構に傾きが生じている場合には、こ
れを補正するべき主,副いずれかの駆動モータが駆動さ
れて、ハンドリング機構が水平状態に補正される(請求
項2)。
Further, when the handling mechanism is tilted at the initial position, that is, in the raised position, either the main or sub drive motor for correcting the tilt is driven to correct the handling mechanism to the horizontal state. (Claim 2).

【0012】[0012]

【実施例】本発明の実施例を図面に基づいて説明する。Embodiments of the present invention will be described with reference to the drawings.

【0013】図1及び図2は本発明のハンドリング機構
昇降装置が適用される搬送装置の一実施例を示し、図3
は、搬送装置の駆動系等を示す模式図である。
1 and 2 show an embodiment of a carrier device to which the handling mechanism lifting device of the present invention is applied, and FIG.
FIG. 3 is a schematic view showing a drive system of a transfer device and the like.

【0014】これらの図において、1はレール(モノレ
ール)であり、支持アーム2を介して工場の組立てライ
ンの天井に吊り下げられている。このモノレール1に沿
って移動する搬送装置は、複数の走行台車を備え、図示
の実施例では、主及び副の2台の走行台車3A,3Bを
備えている。
In these drawings, reference numeral 1 denotes a rail (monorail), which is hung from a ceiling of a factory assembly line via a support arm 2. The transport device that moves along the monorail 1 includes a plurality of traveling carriages, and in the illustrated embodiment, includes two main traveling carriages 3A and 3B.

【0015】上記両走行台車3A,3Bは、モノレール
1の下方でハンドリング機構支持用のフレーム4を介し
て相互に連結され、つまり、前後方向及び左右方向の桟
体を結合してなるフレーム4に上記走行台車3A,3B
の下端部が連結されている。上記フレーム4には、後に
詳述するような複数の巻き上げ機構からなる昇降装置を
介し、ハンドリング機構5が吊り下げ状態で昇降可能に
支持されている。
The traveling carriages 3A and 3B are connected to each other below the monorail 1 via a frame 4 for supporting a handling mechanism, that is, to a frame 4 formed by connecting crosspieces in the front-rear direction and the left-right direction. The traveling vehicles 3A, 3B
The lower ends of are connected. A handling mechanism 5 is supported on the frame 4 so as to be able to move up and down in a suspended state via an elevating device composed of a plurality of hoisting mechanisms which will be described in detail later.

【0016】上記ハンドリング機構5は、荷物の保持及
び荷積み、荷降し等の処理を行うもので、図示の例で
は、上記フレーム4の下方に位置する上部枠6と、この
上部枠6にガイド部材7を介して上端部が取付けられた
左右一対の可動枠8と、この両可動枠8がモータ等の駆
動手段(図示せず)で駆動されて、最大間隔で互い離間
した状態と、所定間隔まで接近した状態とにわたって移
動することにより、荷物の保持等の処理を行うことがで
きるようになっている。
The handling mechanism 5 performs processing such as holding, loading, and unloading of luggage. In the illustrated example, the upper frame 6 located below the frame 4 and the upper frame 6 A pair of left and right movable frames 8 whose upper ends are attached via guide members 7, and a state in which both movable frames 8 are driven by a drive means (not shown) such as a motor and are separated from each other at a maximum interval, By moving over the state of approaching to a predetermined interval, processing such as holding of luggage can be performed.

【0017】上記各走行台車3A,3Bには、それぞ
れ、走行用の駆動源とハンドリング機構昇降用の駆動源
とを兼ねる主モータ11A,副モータ11Bが装備され
るとともに、これらのモータ11A,11Bにより駆動
されてモノレール1上を転動する駆動輪12が設けられ
ている。さらに走行台車3A,3Bには、モノレールに
下側及び側面側から接するロアローラやガイドローラが
具備されており、これらのローラにより走行台車3A,
3Bがモノレール1に対して支持されている。
Each of the traveling vehicles 3A and 3B is equipped with a main motor 11A and an auxiliary motor 11B which also serve as a drive source for traveling and a drive source for raising and lowering the handling mechanism, and these motors 11A and 11B are also provided. Drive wheels 12 that are driven by and roll on the monorail 1 are provided. Further, the traveling carriages 3A and 3B are provided with lower rollers and guide rollers which come into contact with the monorail from the lower side and the side surface side.
3B is supported with respect to the monorail 1.

【0018】図3に示すように、上記各走行台車3A,
3Bにおいては、上記各モータ11A,11Bから出力
軸17が突出し、この出力軸17上に、上記駆動輪12
が回転自在に支持されるとともに、電磁クラッチからな
る走行クラッチ18及び電磁ブレーキからなる走行ブレ
ーキ19が駆動輪12の両側に配置されている。そし
て、走行クラッチ18がON、走行ブレーキ19がOF
Fのときにモータ11A,11Bの動力が駆動輪12に
伝達されるようになっている。また、昇降装置への伝導
のため、走行クラッチ18の側方で出力軸17上にタイ
ミングプーリ21が設けられるとともに、走行台車3
A,3Bの下部とフレーム4との連結個所に枢支された
横軸24にタイミングプーリ23が設けられ、これらの
タイミングプーリ21,23にタイミングベルト22が
掛け渡されている。
As shown in FIG. 3, the traveling vehicles 3A,
In 3B, the output shaft 17 projects from the motors 11A and 11B, and the drive wheels 12 are placed on the output shaft 17.
Is rotatably supported, and a traveling clutch 18 composed of an electromagnetic clutch and a traveling brake 19 composed of an electromagnetic brake are arranged on both sides of the drive wheel 12. Then, the traveling clutch 18 is turned on and the traveling brake 19 is turned off.
When F, the power of the motors 11A and 11B is transmitted to the drive wheels 12. A timing pulley 21 is provided on the output shaft 17 at the side of the traveling clutch 18 for conduction to the lifting device, and the traveling carriage 3
A timing pulley 23 is provided on a horizontal shaft 24 pivotally supported at a connecting portion between the lower portions of A and 3B and the frame 4, and a timing belt 22 is stretched around these timing pulleys 21 and 23.

【0019】一方、ハンドリング機構支持用のフレーム
4には、その一側方部(図2では左側)に、主走行台車
3Aの主モータ11Aから伝達される動力で駆動される
一対の巻き上げ機構26A,26A′が設けられるとと
もに、他側方部(図2では右側)に、副走行台車3Bの
副モータ11Bから伝達される動力で駆動される一対の
巻き上げ機構26B,26B′が設けられている。上記
各巻き上げ機構26A,26A′,26B,26B′
は、それぞれドラム27と、このドラム27から導出さ
れたベルト28と、ガイドローラ29とを有し、上記各
ドラム27がフレーム4の両側方部の前後方向中間部
(図1では左右方向中間部)に配置されるとともに、各
ガイドローラ29がフレーム4の両側方部の前後両側
(図1では左右両側)に配置され、各ドラム27から導
出されたベルト28が各ガイドローラ29を経て下方に
延びた状態で、各ベルト28の先端がハンドリング機構
5の上部枠6に結合されている。つまり、ハンドリング
機構5は、各ドラム27から導出される4本のベルト2
8により支持されるようになっている。
On the other hand, in the frame 4 for supporting the handling mechanism, a pair of hoisting mechanisms 26A driven by the power transmitted from the main motor 11A of the main traveling carriage 3A is provided on one side portion (left side in FIG. 2) of the frame 4. , 26A ', and a pair of hoisting mechanisms 26B, 26B' driven by the power transmitted from the auxiliary motor 11B of the auxiliary traveling vehicle 3B on the other side (right side in FIG. 2). . Each of the winding mechanisms 26A, 26A ', 26B, 26B'
Each have a drum 27, a belt 28 led out from the drum 27, and a guide roller 29. The drums 27 are arranged in the front-rear direction intermediate portions on both side portions of the frame 4 (in the left-right direction intermediate portion in FIG. 1). ), The guide rollers 29 are arranged on both front and rear sides (both left and right sides in FIG. 1) of both side portions of the frame 4, and the belts 28 led out from the respective drums 27 pass downward through the respective guide rollers 29. In the extended state, the tip of each belt 28 is joined to the upper frame 6 of the handling mechanism 5. That is, the handling mechanism 5 includes the four belts 2 that are led out from the respective drums 27.
8 is supported.

【0020】上記一側方部の一対の巻き上げ機構26
A,26A′は、その各ドラム27の軸端に設けられた
タイミングギア31,32が互いに噛合することにより
同期回転し、また上記他側方部の一対の巻き上げ機構2
6B,26B′も、各ドラム27軸端のタイミングギア
31,32が互いに噛合することにより同期回転するよ
うに構成されており、これによって巻き上げ機構26A
及び巻き上げ機構26A′からのベルト28の導出量が
等しくなるようにされている。同様に、巻き上げ機構2
6B及び巻き上げ機構2B′からのベルト28の導出量
も等しくされている。
A pair of hoisting mechanisms 26 at the one side portion
A and 26A 'rotate synchronously when the timing gears 31 and 32 provided at the shaft ends of the drums 27 mesh with each other, and the pair of winding mechanisms 2 on the other side portion.
6B and 26B 'are also configured to rotate synchronously by the timing gears 31 and 32 at the shaft ends of the drums 27 meshing with each other, whereby the winding mechanism 26A.
Also, the amount of the belt 28 drawn out from the winding mechanism 26A 'is made equal. Similarly, the winding mechanism 2
6B and the amount of the belt 28 drawn out from the winding mechanism 2B 'are also equal.

【0021】上記走行台車3Aの主モータ11Aからの
動力を巻き上げ機構26A、26A′に伝達する伝動機
構は、図3に示すように、上記横軸24にベベルギア3
3,34、縦軸35及びベベルギア36,37を介して
連結された入力軸38と、この入力軸38上に回転自在
に支持されたスプロケット39と、タイミングギア3
1,32を介して連動する2つのドラム27のうちの一
方のドラムの軸に取付けられたスプロケット40と、こ
れらのスプロケット39,40に掛け渡されたチェーン
41とを有する。さらに、上記入力軸38上のスプロケ
ット39の両側に、電磁クラッチからなる昇降クラッチ
42及び電磁ブレーキからなる昇降ブレーキ43を具備
している。なお、上記副走行台車3Bの副モータ11B
からの動力を巻き上げ機構26B,26B′に伝達する
伝達機構も同様に構成されている。
As shown in FIG. 3, the transmission mechanism for transmitting the power from the main motor 11A of the traveling carriage 3A to the hoisting mechanisms 26A and 26A 'is provided with the bevel gear 3 on the horizontal shaft 24 as shown in FIG.
3, 34, the vertical axis 35 and the bevel gears 36, 37, the input shaft 38, the sprocket 39 rotatably supported on the input shaft 38, and the timing gear 3
It has a sprocket 40 attached to the shaft of one of the two drums 27 that are interlocked via 1, 32, and a chain 41 hung on these sprockets 39, 40. Further, on both sides of the sprocket 39 on the input shaft 38, a lifting clutch 42 composed of an electromagnetic clutch and a lifting brake 43 composed of an electromagnetic brake are provided. The auxiliary motor 11B of the auxiliary traveling vehicle 3B
The transmission mechanism for transmitting the power from the power source to the hoisting mechanisms 26B and 26B 'is similarly configured.

【0022】そして、両伝動機構における昇降クラッチ
42がON、昇降ブレーキ43がOFFのときに各モー
タ11A,11Bの動力が巻き上げ機構26A,26
A′,26B,26B′に伝達されるようになってい
る。
When the lifting clutch 42 and the lifting brake 43 of both transmission mechanisms are ON and the lifting brake 43 is OFF, the power of the motors 11A, 11B is raised by the hoisting mechanisms 26A, 26.
A ', 26B, 26B' are transmitted.

【0023】ところで、上記フレーム4には、上記ハン
ドリング機構5が上昇位置にある状態で、ハンドリング
機構5の傾き状態を検知する第1及び第2リミットSW
71a,71b(図4に示す)が設けられている。具体
的には、フレーム4の一側方部(図2では左側)に第1
リミットSW71aが、フレーム4の他側方部(図2で
は右側)に第2リミットSW71bが装備されており、
ハンドリング機構5が水平な状態で上昇されたときにの
み両リミットSW71a及び71bが共にONされるよ
うになっている。
By the way, the frame 4 has first and second limit SWs for detecting the tilted state of the handling mechanism 5 when the handling mechanism 5 is in the raised position.
71a and 71b (shown in FIG. 4) are provided. Specifically, the first portion is provided on one side portion (left side in FIG. 2) of the frame 4.
The limit SW 71a is provided with the second limit SW 71b on the other side portion (right side in FIG. 2) of the frame 4,
Both limit SWs 71a and 71b are turned on only when the handling mechanism 5 is raised in a horizontal state.

【0024】上記各モータ11A,11Bに対する制御
系は、図4に示すような構成となってる。これについて
具体的に説明すると、上記各モータ11A,11Bの駆
動を制御するコントローラ50は、上記搬送装置を統括
制御するCPU51と、主モータ11Aの駆動を制御す
る主制御部52Aと、副モータ11Bの駆動を制御する
副制御部52Bとから構成されており、図示の実施例で
は、CPU51が主制御部52Aに一体に組み込まれた
構成となっている。また、上記各モータ11A,11B
には、その駆動位置を検出するエンコーダ56A,56
Bが具備され、このエンコーダ56A,56Bからの信
号が各制御部52A,52Bに出力されることで駆動位
置の情報が得られるようになっている。特に、エンコー
ダ56Aから出力信号は、上記主制御部52Aの速度検
出手段57において、その単位時間当りの位置変化量
(エンコーダ56Aの出力の微分値)が演算されること
で駆動速度の情報として出力されるようになっている。
The control system for the motors 11A and 11B is constructed as shown in FIG. This will be described in detail. A controller 50 that controls the drive of the motors 11A and 11B includes a CPU 51 that controls the transport device, a main controller 52A that controls the drive of the main motor 11A, and a sub motor 11B. And a sub-control unit 52B for controlling the drive of the main control unit 52A. In the illustrated embodiment, the CPU 51 is integrally incorporated in the main control unit 52A. In addition, each of the motors 11A and 11B described above
Include encoders 56A and 56A for detecting the drive position.
B is provided and the signals from the encoders 56A and 56B are output to the control units 52A and 52B to obtain information on the drive position. In particular, the output signal from the encoder 56A is output as drive speed information by calculating the position change amount per unit time (differential value of the output of the encoder 56A) in the speed detecting means 57 of the main control unit 52A. It is supposed to be done.

【0025】上記主制御部52Aは、上記CPU51か
ら発生された目標位置と上記エンコーダ56Aから出力
される現実の駆動位置との偏差値を演算する位置制御手
段53と、この位置制御手段53での演算値と上記速度
検出手段57からの現実の駆動速度とに基づいて主モー
タ11Aに対する速度指令値を演算、出力する速度制御
手段54と、この速度制御手段54からの速度指令値に
応じた電流を上記主モータ11Aに供給するドライバ5
5とを備えて主モータ11Aの駆動を制御するようにな
っている。
The main controller 52A calculates the deviation value between the target position generated from the CPU 51 and the actual drive position output from the encoder 56A, and the position control means 53. A speed control means 54 for calculating and outputting a speed command value for the main motor 11A based on the calculated value and the actual drive speed from the speed detection means 57, and a current corresponding to the speed command value from the speed control means 54. Driver 5 for supplying the above to the main motor 11A
5, and controls the drive of the main motor 11A.

【0026】一方、上記副制御部52Bには、上記エン
コーダ56A及び上記エンコーダ56Bから出力される
信号に基づいて主モータ11Aと副モータ11Bとの駆
動速度偏差を演算するモータ速度偏差演算部64が設け
られている。
On the other hand, the sub-control section 52B has a motor speed deviation calculation section 64 for calculating the drive speed deviation between the main motor 11A and the sub motor 11B based on the signals output from the encoder 56A and the encoder 56B. It is provided.

【0027】上記モータ速度偏差演算部64は、後述の
荷台傾き検出手段62からの制御信号の入力があった場
合にのみ作動し、この場合に、主モータ11A及び副モ
ータ11Bの単位時間当りの位置変化量から各モータ1
1A,11Bの駆動速度を演算し、これに基づいて速度
偏差を求め、その演算結果に応じた信号をD/Aコンバ
ータ65を介して速度制御手段66に出力するととも
に、合わせてエラー検出手段68に出力するようになっ
ている。このとき、モータ速度偏差演算部64での速度
偏差値が所定値以上の場合には、上記各モータ11A,
11Bに何らかの駆動異常が生じているとしてさらに後
述のエラー処理手段70にエラー信号を出力するように
なってる。
The motor speed deviation calculating section 64 operates only when a control signal is input from the bed tilt detecting means 62, which will be described later. In this case, the main motor 11A and the auxiliary motor 11B per unit time are operated. Each motor 1 from the position change amount
The drive speeds of 1A and 11B are calculated, the speed deviation is obtained based on the calculated drive speed, and a signal corresponding to the calculated result is output to the speed control means 66 via the D / A converter 65, and the error detection means 68 is also added. It is designed to output to. At this time, when the speed deviation value in the motor speed deviation calculating section 64 is equal to or more than the predetermined value, the motors 11A,
An error signal is further output to the error processing means 70, which will be described later, assuming that some drive abnormality has occurred in 11B.

【0028】上記速度制御手段66には、上記CPU5
1に接続されるラッチ回路58からの出力信号がD/A
コンバータ59を介して入力されるようになっており、
速度制御手段66では、このラッチ回路58からの情報
と、上記モータ速度偏差演算部64で求められた速度偏
差値とから副モータ11Bに対する速度指令値を演算し
てドライバ67に出力する。そして、ドライバ67で
は、この速度指令値に応じた電流を上記主モータ1Bに
供給するようになっている。ここで、上記速度制御手段
66で求められた速度指令値は、上述のようにドライバ
67に出力されると同時にCPU51を介してラッチ回
路58にも出力されるようになっている。すなわち、速
度制御手段66から出力された当該速度指令値は、CP
U51を介してラッチ回路58で一旦保持され、速度制
御手段66において次回の速度指令値が演算される際に
速度制御手段66に出力される。そして、速度制御手段
66において、当該速度指令値に上記モータ速度偏差演
算部64で求められた速度偏差値が加算されることで次
回の速度指令値が決定されるようになっている。
The speed control means 66 includes the CPU 5
The output signal from the latch circuit 58 connected to 1 is D / A
It is designed to be input via the converter 59,
The speed control means 66 calculates a speed command value for the auxiliary motor 11B from the information from the latch circuit 58 and the speed deviation value obtained by the motor speed deviation calculating section 64, and outputs the speed command value to the driver 67. Then, the driver 67 supplies a current according to the speed command value to the main motor 1B. Here, the speed command value obtained by the speed control means 66 is output to the driver 67 as described above, and at the same time, output to the latch circuit 58 via the CPU 51. That is, the speed command value output from the speed control means 66 is CP
It is temporarily held in the latch circuit 58 via U51, and is output to the speed control means 66 when the next speed command value is calculated in the speed control means 66. Then, the speed control means 66 determines the next speed command value by adding the speed deviation value obtained by the motor speed deviation calculation unit 64 to the speed command value.

【0029】上記副制御部52Bには、さらに荷台傾き
検出手段62と、これに接続される荷台傾き補正制御手
段63とが組み込まれており、この荷台傾き検出手段6
2に第1及び第2リミットSW71a,71bからのO
N信号及び後述の速度トルク切換手段61からの制御信
号が入力される一方、この荷台傾き検出手段62から上
記モータ速度偏差演算部64に制御信号が出力されるよ
うになっている。
The sub-control section 52B further incorporates a cargo bed tilt detection means 62 and a cargo bed tilt correction control means 63 connected thereto, and the cargo bed tilt detection means 6 is provided.
2 from the first and second limit SW 71a, 71b
While the N signal and the control signal from the speed torque switching means 61 which will be described later are input, the control signal is output from the platform inclination detecting means 62 to the motor speed deviation calculating section 64.

【0030】上記荷台傾き検出手段62は、速度トルク
切換手段61からの制御信号の入力があった場合に第1
及び第2リミットSW71a,71bからの入力信号の
有無を判断する。この際、この判断結果において、両リ
ミットSW71a,71bのいずれか一方のON信号し
か入力されていない場合には、その結果を上記荷台傾き
補正制御手段63に出力し、それ以外の場合には、上記
モータ速度偏差演算部64に作動指令信号を出力するよ
うになっている。荷台傾き補正制御手段63では、これ
に応じて荷台傾き検出手段62にリミットSW71a,
71bの両方のON信号が入力されるまで、すなわち上
記ハンドリング機構5が水平な状態となるまで上記各モ
ータ11A,11Bのいずれか一方を駆動制御する。
The bed platform inclination detecting means 62 is the first when the control signal is input from the speed torque switching means 61.
Also, the presence / absence of an input signal from the second limit SW 71a, 71b is determined. At this time, in the determination result, if only one of the ON signals of both the limit SWs 71a and 71b is input, the result is output to the platform tilt correction control means 63, and in the other cases, An operation command signal is output to the motor speed deviation calculator 64. In the platform tilt correction control means 63, in response to this, the platform tilt detection means 62 is provided with the limit SW 71a,
One of the motors 11A and 11B is driven and controlled until both ON signals of 71b are input, that is, until the handling mechanism 5 is in a horizontal state.

【0031】さらに、上記コントローラ50には、上記
CPU51により切換制御される速度トルク切換手段6
1が設けられている。
Further, the controller 50 has a speed / torque switching means 6 which is switch-controlled by the CPU 51.
1 is provided.

【0032】この速度トルク切換手段61は、上記搬送
装置が走行される場合に各モータ11A,11Bを同一
トルクで駆動させるトルク制御状態と、ハンドリング機
構5が昇降される場合に各モータ11A,11Bを同一
速度で駆動させる速度制御状態とに切換可能とされてお
り、上記CPU51により切換制御される。つまり、搬
送装置走行時とハンドリング機構昇降時とに応じ、上記
速度制御手段54から上記CPU51を介して与えられ
る速度指令信号を上記ドライバ67及び後述のエラー検
出手段69に出力する状態と、昇降制御指令信号を副制
御部52Bに出力する状態とに速度トルク切換手段61
が切換えられるようになっている。より具体的には、速
度トルク切換手段61がトルク制御状態とされた場合に
は、速度トルク切換手段61から昇降制御指令信号の出
力は行われず、従って、上記モータ速度偏差演算部64
が作動されることがない。そして、副モータ11Bに
は、速度トルク切換手段61を介してドライバ67に入
力される上記速度制御手段54からの速度指令信号に応
じた駆動電流が供給され、これによって両モータ11
A,11Bが同一の駆動電流により同一トルクで駆動さ
れるようになっている。
The speed / torque switching means 61 has a torque control state in which the motors 11A and 11B are driven with the same torque when the transport device is running, and the motors 11A and 11B when the handling mechanism 5 is moved up and down. Can be switched to a speed control state in which is driven at the same speed, and the CPU 51 controls the switching. That is, a state in which a speed command signal given from the speed control means 54 via the CPU 51 is output to the driver 67 and an error detection means 69, which will be described later, according to the traveling of the transport device and the lifting of the handling mechanism, and the lifting control. The speed / torque switching means 61 is in a state of outputting a command signal to the sub control unit 52B.
Can be switched. More specifically, when the speed torque switching means 61 is in the torque control state, the speed torque switching means 61 does not output the elevation control command signal. Therefore, the motor speed deviation computing section 64 is provided.
Is never activated. Then, the auxiliary motor 11B is supplied with a drive current corresponding to the speed command signal from the speed control means 54 inputted to the driver 67 via the speed torque switching means 61, whereby both motors 11B are driven.
A and 11B are driven with the same torque by the same drive current.

【0033】一方、速度トルク切換手段61が速度制御
状態の下では、速度制御手段54からの速度指令信号が
速度トルク切換手段61で遮断されるとともに、昇降制
御指令信号が出力される。これに応じて、荷台傾き検出
手段62が作動し、さらにこの荷台傾き検出手段62か
らの作動信号に応じて、上記モータ速度偏差演算部64
が作動されるので、速度制御手段66では、上述のよう
に各モータ11A,11B間の駆動速度偏差に基づいた
速度指令値が演算され、この速度指令値に応じた駆動電
流が副モータ11Bに供給される。その結果副モータ1
1Bは、その駆動速度が主モータ11Aの駆動速度と一
致するようにその速度が制御される。
On the other hand, when the speed torque switching means 61 is in the speed control state, the speed command signal from the speed control means 54 is cut off by the speed torque switching means 61 and the elevation control command signal is output. In response to this, the platform tilt detection means 62 operates, and further, in response to the operation signal from the platform tilt detection means 62, the motor speed deviation computing section 64.
The speed control means 66 calculates the speed command value based on the drive speed deviation between the motors 11A and 11B as described above, and the drive current corresponding to the speed command value is supplied to the sub motor 11B. Supplied. As a result, secondary motor 1
The speed of 1B is controlled so that its drive speed matches the drive speed of the main motor 11A.

【0034】上記エラー検出手段69は、上記速度制御
手段54で発生された速度指令値が所定の値以上等であ
る場合に、エラー処理手段70にエラー信号を出力する
ものである。エラー処理手段70には、上述のようにモ
ータ速度偏差演算部68に接続されたエラー検出手段6
8からのエラー信号も入力されるようになっており、エ
ラー検出手段68,69の少なくとも一方からのエラー
信号の入力があった場合に上記主制御部52A及び副制
御部52Bの各ドライバ55,67に制御信号を出力す
るようになっている。そして、このエラー処理手段70
からの制御信号の出力があった場合には、各モータ11
A,11Bの駆動に何らかの異常が生じたとして各モー
タ11A,11Bの駆動を停止し、図外の報知手段によ
りエラー発生を作業者に報知するようになっている。
The error detecting means 69 outputs an error signal to the error processing means 70 when the speed command value generated by the speed control means 54 is a predetermined value or more. The error processing means 70 has the error detecting means 6 connected to the motor speed deviation calculating section 68 as described above.
8 is also inputted, and when the error signal is inputted from at least one of the error detecting means 68, 69, the respective drivers 55 of the main control section 52A and the sub-control section 52B, A control signal is output to 67. Then, the error processing means 70
When a control signal is output from each motor 11
When some abnormality occurs in the drive of A and 11B, the drive of the motors 11A and 11B is stopped, and the operator is notified of the error occurrence by the notifying means (not shown).

【0035】ここで、上記搬送装置におけるハンドリン
グ機構5の昇降制御について図5のフローチャートを用
いて説明する。
Now, the raising / lowering control of the handling mechanism 5 in the above-mentioned transfer device will be described with reference to the flowchart of FIG.

【0036】まず、同図のステップS1で上記搬送装置
が走行モードから昇降モードへ切換られたか否かの判断
がなされ、搬送装置が走行モードにある場合にはステッ
プS3に移行される。ステップS3では、各走行台車3
A,3Bにおける走行クラッチ18がON、走行ブレー
キがOFFとされた状態で、両走行台車3A,3Bのモ
ータ11A,11Bが駆動されることにより、その動力
が駆動輪12に伝えられ、両走行台車3A,3Bがモノ
レール1に沿って走行する。この場合、上述のようにC
PU51から発生される目標位置に基づいて主制御部5
2Aの速度制御手段54で速度指令値が演算、出力され
るとともに、上記速度トルク切換手段61がトルク制御
状態とされ、これによって各モータ11A,11Bが共
に上記速度制御手段54からの速度指令値に基づいて駆
動制御される。この際、昇降クラッチ42がOFF、昇
降ブレーキ43がONとされることにより、ハンドリン
グ機構5は初期位置、すなわち上昇位置に保持されて
る。
First, in step S1 of the figure, it is judged whether or not the transport device is switched from the traveling mode to the elevating mode. If the transport device is in the traveling mode, the process proceeds to step S3. In step S3, each traveling carriage 3
With the traveling clutch 18 in A and 3B being ON and the traveling brake being OFF, the motors 11A and 11B of both traveling carriages 3A and 3B are driven, and the power thereof is transmitted to the drive wheels 12 to drive both traveling. The trucks 3A and 3B travel along the monorail 1. In this case, as described above, C
Main controller 5 based on the target position generated from PU 51
The speed command value is calculated and output by the speed control means 54 of 2A, and the speed torque switching means 61 is brought into the torque control state, whereby both the motors 11A and 11B are speed command values from the speed control means 54. Is controlled based on At this time, the lifting clutch 42 is turned off and the lifting brake 43 is turned on, so that the handling mechanism 5 is held at the initial position, that is, the raised position.

【0037】一方、ステップS1で、搬送装置がハンド
リング機構5の昇降モードとされた場合、すなわち、荷
積み、荷降し等の作業を行うべき所定位置に走行台車3
A、3Bが達した場合にはステップS2に移行される。
ステップS2では、走行クラッチ18がOFF、走行ブ
レーキがONとされることにより走行が停止されるとと
もに、昇降クラッチ42がON、昇降ブレーキがOFF
に切換られることにより、両モータ11A,11Bの動
力が巻き上げ機構26A,26A′,26B,26B′
に伝えられ、ハンドリング機構5の昇降動作が行われる
ことになる。この際、先ず上記速度トルク切換手段61
が速度制御状態に切換られ、ステップS4でハンドリン
グ機構5が水平状態にあるか否か、すなわち、上記両リ
ミットSW71a,71bからのON信号が副制御部5
2Bの荷台傾き検出手段62に入力されているか否かの
判断がなされる。ここで、ハンドリング機構5が傾いて
いる場合(ステップS4でNO)には、ステップS11
に移行され、ハンドリング機構5において走行台車3A
側が上昇位置にあるか否か、すなわちリミットSW71
aからのON信号の入力があるか否かの判断がなされ
る。この際、走行台車3A側が上昇位置にある場合、す
なわち走行台車3B側が下がった状態で、それ故にリミ
ットSW71bからのON信号の入力がない場合(ステ
ップS11でYES)には、ステップS12に移行さ
れ、ここで、ハンドリング機構5において走行台車3B
側を引き上げるべく副モータ11Bが駆動される。そし
て、ハンドリング機構5が水平状態に達する、すなわち
上記荷台傾き検出手段62にリミットSW71bからの
ON信号が入力されると、副モータ11Bの駆動が停止
されるとともに、エンコーダ56bがリセットされ、ス
テップS4へとリターンされる(ステップS13、S1
4)。
On the other hand, in step S1, when the carrying device is set to the raising / lowering mode of the handling mechanism 5, that is, the traveling carriage 3 is moved to a predetermined position where work such as loading and unloading should be performed.
When A and 3B have been reached, the process proceeds to step S2.
In step S2, the traveling clutch 18 is turned off and the traveling brake is turned on to stop traveling, and the lifting clutch 42 is turned on and the lifting brake is turned off.
The power of both motors 11A and 11B is changed to the hoisting mechanism 26A, 26A ', 26B, 26B'.
Then, the lifting and lowering operation of the handling mechanism 5 is performed. At this time, first, the speed torque switching means 61
Is switched to the speed control state, and whether or not the handling mechanism 5 is in the horizontal state in step S4, that is, the ON signals from the both limit SWs 71a and 71b are the sub-control unit 5.
It is determined whether or not the input has been made to the 2B loading platform inclination detection means 62. Here, when the handling mechanism 5 is tilted (NO in step S4), step S11
Is moved to the traveling mechanism 3A in the handling mechanism 5.
Whether the side is in the raised position, that is, the limit SW71
It is determined whether or not the ON signal is input from a. At this time, when the traveling vehicle 3A side is in the raised position, that is, when the traveling vehicle 3B side is lowered, and therefore there is no ON signal input from the limit SW 71b (YES in step S11), the process proceeds to step S12. Here, the traveling carriage 3B in the handling mechanism 5
The sub motor 11B is driven to pull up the side. Then, when the handling mechanism 5 reaches the horizontal state, that is, when the ON signal from the limit SW 71b is input to the platform tilt detection means 62, the drive of the auxiliary motor 11B is stopped and the encoder 56b is reset, and step S4 is performed. Is returned to (steps S13, S1
4).

【0038】一方、上記ステップS11でNOの場合に
は、ステップS15に移行され、ハンドリング機構5に
おいて走行台車3B側が上昇位置にあるか否か、すなわ
ちリミットSW71bからのON信号の入力があるか否
かの判断がなされる。この際、走行台車3B側が上昇位
置にある場合、すなわち走行台車3A側が下がった状態
で、それ故にリミットSW71aからのON信号の入力
がない場合(ステップS11でYES)には、ステップ
S16に移行され、ここで、ハンドリング機構5におい
て走行台車3A側を引き上げるべく、主モータ11Aが
駆動される。そして、ハンドリング機構5が水平状態に
達する、すなわち上記荷台傾き検出手段62にリミット
SW71aからのON信号が入力されると、主モータ1
1Aの駆動が停止されるとともに、エンコーダ56aが
リセットされ、ステップS4へとリターンされる(ステ
ップS17、18)。
On the other hand, in the case of NO at step S11, the process proceeds to step S15 and whether or not the traveling carriage 3B side is in the raised position in the handling mechanism 5, that is, whether or not an ON signal is input from the limit SW 71b. The decision is made. At this time, when the traveling vehicle 3B side is in the raised position, that is, when the traveling vehicle 3A side is in a lowered state, and therefore no ON signal is input from the limit SW 71a (YES in step S11), the process proceeds to step S16. Here, the main motor 11A is driven in order to pull up the traveling carriage 3A side in the handling mechanism 5. Then, when the handling mechanism 5 reaches the horizontal state, that is, when the ON signal from the limit SW 71a is input to the platform tilt detection means 62, the main motor 1
The drive of 1A is stopped, the encoder 56a is reset, and the process returns to step S4 (steps S17 and S18).

【0039】ここで、上記ステップS4でハンドリング
機構5が傾いている(ステップS4で常にNO)にも拘
らず、ステップS11及びステップS15で常にNOの
場合には、荷台傾き検出手段62になんらかの異常が生
じているとして、例えば図外の報知手段により作業者に
報知するようになっている。
Here, if the handling mechanism 5 is tilted in step S4 (always NO in step S4) but NO in steps S11 and S15, some abnormality is detected in the loading platform tilt detection means 62. If an error has occurred, the operator is informed by, for example, notifying means (not shown).

【0040】一方、上記ステップS4で、ハンドリング
機構5が水平であることが判定された場合には、主制御
部52Aの速度制御手段54において発生された速度指
令値が、CPU51、副制御部52Bのラッチ回路58
及びD/Aコンバータを介して速度制御手段66に出力
されるとともに、副制御部52Bのモータ速度偏差演算
部64において主モータ11Aと副モータ11Bとの速
度偏差値が演算される(ステップS5〜S7)。そし
て、この演算値がD/Aコンバータ65を介して速度制
御手段66に出力されと、速度制御手段66において、
上記ラッチ回路58を介して入力された速度指令値に上
記の速度偏差値が加算されて副モータ11Bに対する速
度指令値が決定され、この速度指令値に基づいて副モー
タ11Bが駆動される(ステップS8、S9)。
On the other hand, when it is determined in step S4 that the handling mechanism 5 is horizontal, the speed command value generated by the speed control means 54 of the main controller 52A is the CPU 51 and the sub controller 52B. Latch circuit 58
And to the speed control means 66 via the D / A converter, and the speed deviation value between the main motor 11A and the sub motor 11B is calculated in the motor speed deviation calculator 64 of the sub controller 52B (steps S5 to S5). S7). Then, when this calculated value is output to the speed control means 66 via the D / A converter 65, the speed control means 66
The speed deviation value is input to the speed command value input via the latch circuit 58 to determine the speed command value for the sub motor 11B, and the sub motor 11B is driven based on the speed command value (step S8, S9).

【0041】そして、その後ステップS10において、
副制御部52Bの速度制御手段66から速度指令が発生
された否かの判断がなされ、発生された場合には、ステ
ップS6にリターンされ、それ以後は、副制御部52B
において速度制御手段66から発生された当該速度指令
値がCPU51、ラッチ回路58及びD/Aコンバータ
65を介して速度制御手段66へと出力される。従っ
て、ハンドリング機構5が目標位置に達するまでは、副
制御部52Bにおいて速度制御手段66から発生される
速度指令値に、現実の各モータ11A,11B間の速度
偏差が加算されつつ副モータ11Bに対する速度指令値
が設定されるので、この動作を繰り返すことによって、
副モータ11Bと主モータ11Aとが同一の速度で駆動
されることになる。
Then, in step S10,
It is judged whether or not a speed command is generated from the speed control means 66 of the sub control unit 52B, and if it is generated, the process returns to step S6, and thereafter, the sub control unit 52B.
The speed command value generated from the speed control means 66 is output to the speed control means 66 via the CPU 51, the latch circuit 58 and the D / A converter 65. Therefore, until the handling mechanism 5 reaches the target position, the speed deviation between the actual motors 11A and 11B is added to the speed command value generated from the speed control means 66 in the sub control unit 52B, and the sub motor 11B is added. Since the speed command value is set, by repeating this operation,
The sub motor 11B and the main motor 11A are driven at the same speed.

【0042】一方、ステップS10において、速度制御
手段66から速度指令が発生されていない場合(ステッ
プS10でNO)、すなわちハンドリング機構5が目標
位置に達し、それ故に副モータ11Bの駆動速度が0と
なった場合には、スタートへリターンされて本フローチ
ャートが終了される。
On the other hand, in step S10, when the speed command is not issued from the speed control means 66 (NO in step S10), that is, the handling mechanism 5 reaches the target position, and therefore the driving speed of the auxiliary motor 11B becomes 0. If so, the process is returned to the start and this flowchart is ended.

【0043】このように、上記搬送装置においては、ハ
ンドリング機構5の昇降時に、各モータ11A,11B
の駆動速度が同一になるように駆動制御することで、巻
き上げ機構26A,26A′、26B、26B′から導
出されるベルト28の量を同一にすることができるの
で、これによってハンドリング機構5の昇降に際して
は、その水平状態を好適に確保することができる。
As described above, in the above-described transfer device, when the handling mechanism 5 is moved up and down, the motors 11A and 11B are moved.
By controlling the driving so that the driving speeds of the belts are the same, the amounts of the belts 28 derived from the winding mechanisms 26A, 26A ', 26B, and 26B' can be made to be the same. In that case, the horizontal state can be suitably secured.

【0044】また、上記実施例においては、ハンドリン
グ機構5の初期位置において、その傾きを検出し、傾き
が生じている場合には、それを補正するようにしている
ので、ベルト28の導出量が同一であるにも拘らずハン
ドリング機構5に傾動が生じるといった不都合を招くこ
とがないようにされている。
Further, in the above embodiment, the inclination of the handling mechanism 5 is detected at the initial position, and if the inclination is generated, it is corrected. Even if they are the same, the handling mechanism 5 is prevented from inclining.

【0045】なお、搬送装置の具体的構成はこの例に限
られるものでなく、例えば、ハンドリング機構5の昇降
用のモータと搬送装置走行用のモータを兼用せずに個別
に設ける等、本発明の要旨を逸脱しない範囲で適宜変更
可能である。
The specific construction of the carrier device is not limited to this example. For example, the motor for raising and lowering the handling mechanism 5 and the motor for traveling the carrier device may be individually provided without being combined. Can be appropriately changed without departing from the scope of the present invention.

【0046】[0046]

【発明の効果】以上説明したように、本発明は、主,副
の駆動モータにより巻き上げ機構を作動させてハンドリ
ング機構を昇降させる搬送装置において、副駆動モータ
を駆動制御する副制御部の速度偏差演算手段で、主駆動
モータと副駆動モータの現実の駆動速度偏差を求め、速
度制御手段によりこの駆動速度偏差がなくなる方向に副
駆動モータを制御するようにしたので、副駆動モータに
おいては、その駆動速度が主駆動モータの駆動速度に確
実に一致するように制御され、これによって主,副の駆
動モータの駆動速度が同一に保たれる。従って、ハンド
リング機構の昇降に際しては、巻き上げ機構が同一速度
で駆動されることになり、これによってハンドリング機
構の水平状態が好適に確保される。
As described above, according to the present invention, the speed deviation of the sub-control unit for controlling the drive of the sub-driving motor in the carrying device in which the hoisting mechanism is operated by the main and sub-driving motors to raise and lower the handling mechanism. Since the calculation means obtains the actual drive speed deviation between the main drive motor and the sub drive motor, and the speed control means controls the sub drive motor in the direction in which this drive speed deviation disappears. The drive speed is controlled so as to surely match the drive speed of the main drive motor, so that the drive speeds of the main and auxiliary drive motors are kept the same. Therefore, when the handling mechanism is moved up and down, the hoisting mechanism is driven at the same speed, which ensures the horizontal state of the handling mechanism.

【0047】また、上記ハンドリング機構が上昇位置に
ある状態で、ハンドリング機構の傾き状態を検知する傾
き状態検知手段と、これにより検出されたハンドリング
機構の傾き状態に応じて、上記巻き上げ機構を作動させ
てハンドリング機構の傾きを補正するべく上記主,副い
ずれかの駆動モータを駆動させる傾き状態補正制御手段
とを備えることで、初期位置におけるハンドリング機構
の傾きを好適に補正できる。
Further, while the handling mechanism is in the raised position, the tilt state detecting means for detecting the tilt state of the handling mechanism and the hoisting mechanism are operated according to the tilt state of the handling mechanism detected by the tilt state detecting means. The inclination of the handling mechanism at the initial position can be appropriately corrected by providing the inclination state correction control means for driving either the main drive motor or the auxiliary drive motor to correct the inclination of the handling mechanism.

【図面の簡単な説明】[Brief description of drawings]

【図1】本発明のハンドリング機構昇降制御装置が適用
される搬送装置を示す正面略図である。
FIG. 1 is a schematic front view showing a carrying device to which a handling mechanism lifting / lowering control device of the present invention is applied.

【図2】同搬送装置の側面図である。FIG. 2 is a side view of the transfer device.

【図3】搬送装置の駆動系を示す模式図である。FIG. 3 is a schematic diagram showing a drive system of a transfer device.

【図4】搬送装置の制御系を示すブロック図である。FIG. 4 is a block diagram showing a control system of the transport device.

【図5】ハンドリング機構の昇降制御の一例を示すフロ
ーチャートである。
FIG. 5 is a flowchart showing an example of lifting control of a handling mechanism.

【符号の説明】[Explanation of symbols]

11A 主モータ 11B 副モータ 50 コントローラ 51 CPU 52A 主制御部 52B 副制御部 53 位置制御手段 54,66 速度制御手段 55,67 ドライバ 56A,56B エンコーダ 57 速度検出手段 58 ラッチ回路 59,65 D/Aコンバータ 61 速度トルク切換手段 62 荷台傾き検出手段 63 荷台傾き補正制御手段 64 モータ速度偏差演算部 68,69 エラー検出手段 70 エラー処理手段 71a 第1リミットSW 71b 第2リミットSW 11A main motor 11B sub motor 50 controller 51 CPU 52A main control unit 52B sub control unit 53 position control unit 54, 66 speed control unit 55, 67 driver 56A, 56B encoder 57 speed detection unit 58 latch circuit 59, 65 D / A converter 61 speed torque switching means 62 bed tilt detection means 63 bed tilt correction control means 64 motor speed deviation calculation section 68, 69 error detection means 70 error processing means 71a first limit SW 71b second limit SW

Claims (2)

【特許請求の範囲】[Claims] 【請求項1】 フレームを介して相互に連結された主,
副の走行台車と、上記フレームに吊り下げ式に昇降可能
に支持されたハンドリング機構と、上記各走行台車に個
々に装備された主,副の駆動モータと、これらの各駆動
モータにより駆動され、上記ハンドリング機構を昇降さ
せる巻き上げ機構とを備え、上記各駆動モータの駆動速
度を示す情報に基づいて上記ハンドリング機構の昇降を
制御する装置であって、上記主駆動モータを制御する主
制御部と、上記副駆動モータを制御する副制御部とを有
し、上記副制御部に、上記主駆動モータの現実の駆動速
度と上記副駆動モータの現実の駆動速度の偏差を演算す
る速度偏差演算手段と、この速度偏差演算手段で演算さ
れた偏差に応じて副駆動モータに対する制御量を調整す
ることにより、上記偏差をなくす方向に副駆動モータを
制御する速度制御手段とを備えたことを特徴とする搬送
装置のハンドリング機構昇降制御装置。
1. Mains connected to each other through a frame,
A sub-traveling vehicle, a handling mechanism supported by the frame so that it can be lifted up and down, a main drive motor and a sub-driving motor individually equipped in each traveling car, and driven by each of these drive motors. A device for controlling the raising and lowering of the handling mechanism based on information indicating the driving speed of each of the drive motors, including a winding mechanism for raising and lowering the handling mechanism, and a main control unit for controlling the main drive motor, A sub-control unit for controlling the sub-driving motor, wherein the sub-control unit calculates a deviation between an actual driving speed of the main driving motor and an actual driving speed of the sub-driving motor. A speed control for controlling the sub drive motor in a direction to eliminate the deviation by adjusting the control amount for the sub drive motor according to the deviation calculated by the speed deviation calculation means. Handling mechanism elevation control apparatus for conveying apparatus characterized by comprising a stage.
【請求項2】 上記副制御部に、上記ハンドリング機構
が上昇位置にある状態で、ハンドリング機構の傾き状態
を検知する傾き状態検知手段と、これにより検出された
ハンドリング機構の傾き状態に応じて、上記巻き上げ機
構を作動させてハンドリング機構の傾きを補正するべく
上記主,副いずれかの駆動モータを駆動制御する傾き状
態補正制御手段とを備えたことを特徴とする上記請求項
1記載の搬送装置のハンドリング機構昇降制御装置。
2. The sub-control unit includes tilt state detecting means for detecting a tilt state of the handling mechanism when the handling mechanism is in a raised position, and a tilt state detecting means for detecting a tilt state of the handling mechanism. 2. The transport apparatus according to claim 1, further comprising: tilt state correction control means for driving and controlling either the main drive motor or the sub drive motor so as to correct the tilt of the handling mechanism by operating the winding mechanism. Lifting control device for handling mechanism.
JP5240114A 1993-09-27 1993-09-27 Control device for vertical movement of handling mechanism of carrying device Pending JPH0796478A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP5240114A JPH0796478A (en) 1993-09-27 1993-09-27 Control device for vertical movement of handling mechanism of carrying device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP5240114A JPH0796478A (en) 1993-09-27 1993-09-27 Control device for vertical movement of handling mechanism of carrying device

Publications (1)

Publication Number Publication Date
JPH0796478A true JPH0796478A (en) 1995-04-11

Family

ID=17054702

Family Applications (1)

Application Number Title Priority Date Filing Date
JP5240114A Pending JPH0796478A (en) 1993-09-27 1993-09-27 Control device for vertical movement of handling mechanism of carrying device

Country Status (1)

Country Link
JP (1) JPH0796478A (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000108794A (en) * 1998-10-08 2000-04-18 Yamaha Motor Co Ltd Robot conveying device
DE102011007010A1 (en) 2010-04-23 2011-10-27 The Yokohama Rubber Co., Ltd. Rubber-metal composite and pneumatic tire using this
JP2015231435A (en) * 2014-06-09 2015-12-24 トヨタ自動車株式会社 Walking training device
JP6644212B1 (en) * 2019-05-30 2020-02-12 三菱電機株式会社 Work transfer system

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000108794A (en) * 1998-10-08 2000-04-18 Yamaha Motor Co Ltd Robot conveying device
DE102011007010A1 (en) 2010-04-23 2011-10-27 The Yokohama Rubber Co., Ltd. Rubber-metal composite and pneumatic tire using this
JP2015231435A (en) * 2014-06-09 2015-12-24 トヨタ自動車株式会社 Walking training device
JP6644212B1 (en) * 2019-05-30 2020-02-12 三菱電機株式会社 Work transfer system
WO2020240792A1 (en) * 2019-05-30 2020-12-03 三菱電機株式会社 Mobile robot

Similar Documents

Publication Publication Date Title
KR101798896B1 (en) Hand Lift Truck
JP5590838B2 (en) Belt conveyor equipment
US7205730B2 (en) Article transport vehicle
JP3787351B1 (en) Loading / unloading device
KR20070107977A (en) Apparatus for lifting conveyor for transferring pallet and the controlling method
JPH0796478A (en) Control device for vertical movement of handling mechanism of carrying device
JP3524695B2 (en) Positioning device for loading cargo
JP3767306B2 (en) Travel control method for moving body
JP2005248668A (en) Vehicle carrying-in/out method and elevator type parking device
JP3382324B2 (en) Windshield conveyor for automobiles
JP2008105844A (en) Transporting device
CN114506778B (en) Well heavy equipment transportation erection equipment with focus self-adaptation
JPH07149408A (en) Drive controller for stacker crane
JP4314521B2 (en) Article conveying device
JP3115962B2 (en) Lifting device for handling mechanism of transport device
JP3237938B2 (en) Elevation control device of transfer device
JPH0739866Y2 (en) Transport device using self-propelled body
JPH07157039A (en) Conveyor device
JP3952764B2 (en) How to move a moving object
JPH08175381A (en) Unmanned truck
JP3911998B2 (en) Moving body
JPH05162989A (en) Elevation transporting device
JP2004060156A (en) Method for entering and leaving parking apparatus and the parking apparatus
JP4257589B2 (en) Article transfer device
JP3529424B2 (en) Transfer device