JPH02159905A - Speed control method for linear motor drive moving body - Google Patents
Speed control method for linear motor drive moving bodyInfo
- Publication number
- JPH02159905A JPH02159905A JP63313177A JP31317788A JPH02159905A JP H02159905 A JPH02159905 A JP H02159905A JP 63313177 A JP63313177 A JP 63313177A JP 31317788 A JP31317788 A JP 31317788A JP H02159905 A JPH02159905 A JP H02159905A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- moving body
- pulse
- linear motor
- proximity switch
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims description 11
- 238000001514 detection method Methods 0.000 claims description 28
- 239000004020 conductor Substances 0.000 claims description 23
- 239000000696 magnetic material Substances 0.000 description 9
- 230000001276 controlling effect Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- XEEYBQQBJWHFJM-UHFFFAOYSA-N Iron Chemical compound [Fe] XEEYBQQBJWHFJM-UHFFFAOYSA-N 0.000 description 2
- XAGFODPZIPBFFR-UHFFFAOYSA-N aluminium Chemical compound [Al] XAGFODPZIPBFFR-UHFFFAOYSA-N 0.000 description 2
- 229910052782 aluminium Inorganic materials 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 238000007796 conventional method Methods 0.000 description 2
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 229910052742 iron Inorganic materials 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
Landscapes
- Non-Mechanical Conveyors (AREA)
- Control Of Vehicles With Linear Motors And Vehicles That Are Magnetically Levitated (AREA)
Abstract
Description
【発明の詳細な説明】
(産業上の利用分野)
本発明は、移動体側にリニアモーター用二次導体を設け
、走行経路側にリニアモーターの一次側本体を配設した
システムに於ける前記移動体の速度制御方法に関するも
のである。Detailed Description of the Invention (Industrial Field of Application) The present invention provides a method for moving a linear motor in a system in which a secondary conductor for a linear motor is provided on the moving body side and a primary main body of the linear motor is provided on the traveling route side. It concerns a method of controlling the speed of the body.
(従来の技術)
上記のようなリニアモーター駆動の移動体の速度制御は
、移動体の現在速度に基づいて前記リニアモーターの一
次側本体に対する給電条件(電圧、電流、周波数等)を
制御することによって行われるが、リニアモーターの一
次側本体が走行経路側にあるため、前記移動体の現在速
度を検出する手段も走行経路側に配設するのが一般的で
ある。(Prior Art) Speed control of a moving body driven by a linear motor as described above involves controlling power supply conditions (voltage, current, frequency, etc.) to the primary body of the linear motor based on the current speed of the moving body. However, since the primary main body of the linear motor is located on the traveling route side, it is common that means for detecting the current speed of the moving object is also provided on the traveling route side.
然して、移動体の現在速度を走行経路側から検出する一
般的な手段としては、前記移動体に接して回転する回転
体にパルスエンコーダーを連動させ、このパルスエンコ
ーダーの出力パルス周期又は単位時間当たりのパルス数
から移動体の速度を演算する方法が知られているが、移
動体と前記回転体とが接し始めから暫くの間は両者間に
滑りを伴うので、移動体の移動速度と回転体の周速度と
が完全に一致しない、従って従来は、前記パルスエンコ
ーダーの出力パルスを最初から利用するのではなく、回
転体が移動体と接し始める位置よりも一定距離だけ進ん
だ基準位置を設定し、この基準位置まで移動体が進んだ
後の前記パルスエンコーダーの出力パルスを利用して速
度を演算していた。However, as a general means of detecting the current speed of a moving object from the traveling route side, a pulse encoder is interlocked with a rotating body that rotates in contact with the moving object, and the output pulse period or per unit time of the pulse encoder is A method of calculating the speed of a moving object from the number of pulses is known, but since there is slippage between the moving object and the rotating object for a while after they begin contact, the moving speed of the moving object and the rotating object are Therefore, conventionally, instead of using the output pulses of the pulse encoder from the beginning, a reference position is set a certain distance ahead of the position where the rotating body starts contacting the moving body. The velocity was calculated using the output pulses of the pulse encoder after the moving body had advanced to this reference position.
(発明が解決しようとする課!り
上記のような従来の方法では、前記基準位置が一定不変
であるため、前記回転体に対する移動体の突入速度や回
転体と移動体との間の当接面の表面状態等の変化によっ
て、移動体と回転体との間に滑りを伴う距離が変化した
場合、特に移動体が予想速度よりも高速で前記回転***
置に突入した場合には、移動体の移動速度とパルスエン
コーダーの出力パルス周期とが一致していない状況で速
度演算を行うことになり、高精度の速度制御が行えなく
なる問題点があった。このような問題点を解消するため
に、前記基準位1を前記回転体から走行方向に出来る限
り離して設定すると、当該基準位置から下手側の速度制
御に利用出来る経路長さが短くなり、無理な速度制御を
行わなければならなくなる。(Issues to be solved by the invention!) In the conventional method as described above, since the reference position remains constant, If the distance between the moving body and the rotating body changes due to a change in the surface condition of the surface, etc., and especially if the moving body enters the rotating body position at a higher speed than expected, the moving body There was a problem in that the speed calculation had to be performed in a situation where the moving speed of the motor and the output pulse period of the pulse encoder did not match, making it impossible to perform high-precision speed control.In order to solve this problem, If the reference position 1 is set as far away from the rotating body as possible in the running direction, the length of the path that can be used for speed control on the downstream side from the reference position becomes shorter, making it necessary to perform unreasonable speed control.
(t1題を解決するための手段)
本発明は上記のような従来の問題点を解決するために、
前記移動体の走行経路側に、前記移動体の前端から走行
方向に沿って等間隔おきに並設された被検出部を検出す
る近接スイッチと、前記移動体に接して回転する回転体
及びこれに連動するパルスエンコーダーとを配設し、前
記近接スイッチの検出パルスに基づいて演算される速度
Aと前記パルスエンコーダーの出力パルスに基づいて演
算される速度Bとを比較し、両速度A、Bの差が一定値
以下となった以後は、前記速度Bに基づいて前記リニア
モーターの一次側本体を制御することを特徴とするリニ
アモーター駆動の移動体に於ける速度制御方法を従案す
るものである。(Means for solving problem t1) In order to solve the above-mentioned conventional problems, the present invention
A proximity switch for detecting detection target parts arranged on the traveling route side of the moving body at regular intervals along the running direction from the front end of the moving body, and a rotating body that rotates in contact with the moving body; A pulse encoder interlocked with the proximity switch is provided, and a speed A calculated based on the detection pulse of the proximity switch is compared with a speed B calculated based on the output pulse of the pulse encoder, and both speeds A and B are compared. This invention provides a speed control method for a linear motor-driven moving object, characterized in that after the difference between the two becomes less than a certain value, the primary main body of the linear motor is controlled based on the speed B. It is.
尚、前記速度Bに基づく速度制御を開始するまで、前記
速度Aに基づいて前記リニアモーターの一次側本体を制
御することも出来るし、前記近接スイッチの検出パルス
の幅又は周期が一定しきい値よりも小さくないとき、即
ち移動体の速度が、前記回転体と移動体との間に滑りが
生じる恐れのない低速であるとき、前記速度Aの演算を
行わずに前記速度Bの演算のみを行い、当該速度Bに基
づいて前記リニアモーターの一次側本体を制御すること
も可能である。Incidentally, the primary side body of the linear motor may be controlled based on the speed A until the speed control based on the speed B is started, or the width or period of the detection pulse of the proximity switch may be set to a constant threshold value. When the speed of the moving body is not smaller than , that is, when the speed of the moving body is low enough to prevent slipping between the rotating body and the moving body, only the calculation of the speed B is performed without calculating the speed A. It is also possible to control the primary body of the linear motor based on the speed B.
(実施例)
以下に本発明の一実施例を添付の例示図に基づいて説明
する。(Example) An example of the present invention will be described below based on the attached illustrative drawings.
第1図及び第2図に於いて、(1)はパレット形の搬送
用移動体であって、当該搬送用移動体(1)の走行経路
側には、搬送用移動体(1)の左右両側辺を支持する支
持用水平軸ホイール(2)と、搬送用移動体(1)の左
右両側面に近接する案内用垂直軸ローラー(3) とが
適当間隔おきに配設されている。又、前記搬送用移動体
(1)の左右両側には、リニアモーター用二次導体(4
)が全長にわたって付設されており、走行経路側には、
前記案内用垂直軸ローラー(3)間でリニアモーター用
−次側本体(5)が適当間隔おきに配設されている。In FIGS. 1 and 2, (1) is a pallet-shaped transporting body, and the left and right sides of the transporting mobile body (1) are located on the traveling route side of the transporting mobile body (1). Supporting horizontal shaft wheels (2) supporting both sides and guiding vertical shaft rollers (3) close to both left and right sides of the conveyance moving body (1) are arranged at appropriate intervals. Further, secondary conductors for linear motors (4
) is attached along the entire length, and on the driving route side,
Next-side main bodies (5) for the linear motor are arranged at appropriate intervals between the guide vertical shaft rollers (3).
前記二次導体(4)は、第3図及び第4図に示すように
鉄等の厚手の帯板状磁性材(6)の表面側に上下巾方向
に長い突条部(7)を二次導体長さ方向に等間隔おきに
一体形成し、この各突条部(7)の表面が面一に露出す
るように前記帯板状磁性材(6)の表面側にアルミニウ
ム等の非磁性電導材(8)を被覆して成るセグメントタ
イプのものである。As shown in FIGS. 3 and 4, the secondary conductor (4) has two protrusions (7) long in the vertical width direction on the surface side of a thick strip-shaped magnetic material (6) such as iron. The second conductor is integrally formed at equal intervals in the length direction, and a non-magnetic material such as aluminum is attached to the surface side of the strip-shaped magnetic material (6) so that the surface of each protrusion (7) is exposed flush. It is of a segment type and is coated with a conductive material (8).
尚、前記帯板状磁性材(6)の全中にわたって前記突条
部(7)を形成し、この帯板状磁性材(6)の全体を、
前記突条部(7)の表面が面一に露出するようにアルミ
ニウム等の非磁性電導材(8)内にインサートすること
も出来る。The protrusion portion (7) is formed throughout the strip-shaped magnetic material (6), and the entire strip-shaped magnetic material (6) is
It can also be inserted into a non-magnetic conductive material (8) such as aluminum so that the surface of the protrusion (7) is exposed flush.
前記搬送用移動体(1)の走行経路中には、第1図に示
すように当該移動体の停止位置(9)が設定され、少な
くともこの停止位置(9)に前記リニアモーター用−次
側本体(5)が配設されており、この停止位置(9)の
入口に、第1図及び第4回に示すように前記搬送用移動
体(1)の片側の二次導体(4)の表面に対向する近接
スイッチ(10)と、この近接スイッチ(10)よりも
下手側で前記搬送用移動体(1)の底面に当接して回転
する回転体(11)とが配設され、当該回転体(11)
にはパルスエンコーダー(12)が連動連結されている
。尚、前記回転体(11)は、前記搬送用移動体(1)
の底面より若干上方の位置と下方の位置との間で上下移
動可能に支持されると共に、スプリングによって上向き
に付勢されている。As shown in FIG. 1, a stop position (9) of the moving body (1) is set in the travel path of the conveyance moving body (1), and at least a stop position (9) for the linear motor is set at this stop position (9). A main body (5) is provided, and a secondary conductor (4) on one side of the conveyance moving body (1) is placed at the entrance of this stop position (9) as shown in FIG. A proximity switch (10) facing the surface, and a rotary body (11) that rotates in contact with the bottom surface of the conveyance moving body (1) on the lower side of the proximity switch (10) are arranged, Rotating body (11)
A pulse encoder (12) is interlocked with the . Note that the rotating body (11) is the same as the conveying moving body (1).
It is supported to be movable up and down between a position slightly above and a position slightly below the bottom surface of the body, and is biased upward by a spring.
前記近接スイッチ(]0)は、前記二次導体(4)に於
ける非磁性電導材(8)の表面に対向するときはオフ状
態で、磁性材(6)から成る突条部(7)の表面に対向
するときのみオン状態となるように、二次導体(4)と
の間の間隙が設定されている。換言すれば、前記二次導
体(4)の磁性材(6)から成る突条部(7)が近接ス
イッチ(10)の検出対象である被検出部、即ち搬送用
移動体(1)の前端から走行方向に沿って等間隔おきに
並設された被検出部、を兼用している。The proximity switch (]0) is in an OFF state when facing the surface of the non-magnetic conductive material (8) in the secondary conductor (4), and the protrusion portion (7) made of the magnetic material (6) A gap between the secondary conductor (4) and the secondary conductor (4) is set so that the conductor is turned on only when facing the surface of the secondary conductor (4). In other words, the protrusion (7) made of the magnetic material (6) of the secondary conductor (4) is the detection target of the proximity switch (10), that is, the front end of the conveyance moving body (1). It also serves as detected parts arranged in parallel at equal intervals along the running direction.
上記の搬送装置に於いて、全てのリニアモーター用−次
側本体(5)に通電するか、又は搬送用移動体(1)が
通過するときだけ通電することにより、従来周知のよう
に当該−次側本体(5)と搬送用移動体(1)側の二次
導体(4)との間の磁気作用により当該搬送用移動体(
1)に推力が与えられ、当該搬送用移動体(1)が前記
ホイール(2)及びローラー(3)によって規制される
走行経路上を走行することになり、当該搬送用移動体(
1)上に載置される被搬送物を搬送することが出来る。In the above-mentioned conveyance device, by energizing all of the linear motor next-side main bodies (5), or by energizing only when the conveyance moving body (1) passes, the concerned − Due to the magnetic action between the next main body (5) and the secondary conductor (4) on the side of the conveying body (1), the conveying body (
A thrust is applied to the transport vehicle (1), and the transport vehicle (1) travels on a travel path regulated by the wheels (2) and rollers (3).
1) It is possible to transport objects placed thereon.
このとき、前記二次導体(4)がセグメントタイプのも
のであるため、磁性板の表面全体を非磁性電導材で被覆
した通常タイプのものと比較してリニアモーター特性が
向上し、効率良く搬送用移動体(1)を推進させること
が出来る。At this time, since the secondary conductor (4) is of the segment type, the linear motor characteristics are improved compared to the normal type in which the entire surface of the magnetic plate is coated with a non-magnetic conductive material, and the conveyance is efficient. The moving body (1) can be propelled.
然して前記搬送用移動体(1)を停止位置(9)で停止
させるように、当該停止位置(9)にあるリニアモータ
ー用−次側本体(5)を使用して速度制御するのである
が、この速度制御には、第4図に示すように近接スイッ
チ(10)の検出パルス(10a)と前記パルスエンコ
ーダー(12)の出力パルス(12a)とに基づいて搬
送用移動体(1)の現在速度を演算すると共に、演算さ
れた現在速度と予め設定された減速プログラムとに従っ
て減速指令(13a)を出力する速度制御用マイクロコ
ンピュータ−(13)と、前記減速指令(13a)に従
って、前記停止位il!(9)にあるリニアモーターの
一次側本体(5)に対する給電を制御するモーターコン
トローラー(14)とが使用される。However, in order to stop the transporting moving body (1) at the stop position (9), the speed is controlled using the next main body (5) for the linear motor located at the stop position (9). This speed control is performed based on the detection pulse (10a) of the proximity switch (10) and the output pulse (12a) of the pulse encoder (12) as shown in FIG. A speed control microcomputer (13) that calculates the speed and outputs a deceleration command (13a) according to the calculated current speed and a preset deceleration program; Il! A motor controller (14) for controlling power supply to the primary body (5) of the linear motor in (9) is used.
次に上記の速度制御方法を第5図及び第6図に基づいて
説明する。Next, the above speed control method will be explained based on FIGS. 5 and 6.
前記搬送用移動体(1)が停止位置(9)の入口を通過
するとき、当該搬送用移動体(1)に於けるリニアモー
ター用二次導体(4)の、磁性材(6)から成る突条部
(7)の表面が近接スイッチ(IQ)の直前を通過する
ときのみ、当該近接スイッチ(10)がオン動作するた
め、第5図に示すように当該近接スイッチ(10)から
搬送用移動体(1)の走行速度に比例した時間間隔で検
出パルス(10a)が出力される一方、前記パルスエン
コーダー(12)に連動スる回転体(11)は、前記近
接スイッチ(10)が搬送用移動体(1)の二次導体(
4)に対向する時期よりも若干遅れて当該搬送用移動体
(1)の底面に当接し、当該搬送用移動体(1)の移動
に伴って回転するので、この回転体(11)に連動する
パルスエンコーダー(12)から出力パルス(12a)
が生じる。しかしながら、回転体(11)が搬送用移動
体(1)に接した直後は両者間に滑りがあるため、回転
体(11)の周速度は搬送用移動体(1)の走行速度よ
りも遅れており、搬送用移動体(1)が進むにつれて回
転体(11)の周速度が徐々に搬送用移動体(1)の走
行速度に追いつき、成る時期T0より両者間の滑りがな
くなって搬送用移動体(1)の走行速度と回転体(11
)の周速度とが一致することになる。即ち、前記時期T
、より以前の回転体(11)の回転不安定期では、パル
スエンコーダー(12)からの出力パルス(12a)の
時間間隔は搬送用移動体(1)の走行速度と比例しない
が、前記時期T0より以降の回転体(II)の安定期で
は、前記出力パルス(12a)の時間間隔は搬送用移動
体(1)の走行速度と比例することになる。この場合の
出力パルス(12a)の単位時間当たりのパルス、数は
、前記近接スイッチ(10)からの検出パルス(10a
)の単位時間当たりのパルス数よりも桁違いに多いこと
は勿論である。When the conveying moving body (1) passes through the entrance of the stop position (9), the secondary conductor (4) for the linear motor in the conveying moving body (1) is made of a magnetic material (6). Since the proximity switch (10) is turned on only when the surface of the protrusion (7) passes directly in front of the proximity switch (IQ), as shown in FIG. Detection pulses (10a) are output at time intervals proportional to the traveling speed of the moving body (1), while the rotating body (11) interlocked with the pulse encoder (12) is conveyed by the proximity switch (10). The secondary conductor of the moving body (1) for
4), it comes into contact with the bottom surface of the conveyance moving body (1) a little later than when it faces 4), and rotates as the conveyance moving body (1) moves, so it is linked to this rotating body (11). Output pulse (12a) from pulse encoder (12) to
occurs. However, immediately after the rotating body (11) contacts the conveying moving body (1), there is slippage between the two, so the circumferential speed of the rotating body (11) is slower than the running speed of the conveying moving body (1). As the conveyance moving body (1) advances, the circumferential speed of the rotating body (11) gradually catches up with the traveling speed of the conveyance movable body (1), and from the time T0, the slippage between the two disappears and the conveyance The traveling speed of the moving body (1) and the rotating body (11)
) will match the circumferential velocity. That is, the period T
In the period of unstable rotation of the rotating body (11) earlier than , the time interval of the output pulses (12a) from the pulse encoder (12) is not proportional to the traveling speed of the conveyance moving body (1), but from the time T0 During the subsequent stable period of the rotating body (II), the time interval of the output pulse (12a) will be proportional to the traveling speed of the conveyance moving body (1). In this case, the number of output pulses (12a) per unit time is the detection pulse (10a) from the proximity switch (10).
) is, of course, orders of magnitude higher than the number of pulses per unit time.
第6図のフローチャートに示すように、近接スイッチ(
10)から検出パルス(10a)が出力されると、その
パルス幅の時間も。が計測され、予め設定された時間t
1、即ち搬送用移動体(1)の回転体(11)に対する
突入速度で、回転体(11)と搬送用移動体(1)との
間に滑りを生ぜしめないであろうと考えられる低速度時
の検出パルス(loa)のパルス幅の時間t1、と実際
のパルス幅の時間t0とが比較これ、t0≧L1でない
場合、即ち搬送用移動体O’)の速度が回転体(11)
と搬送用移動体(1)との間に滑りを生ぜしめないであ
ろうと考えられる速度よりも高速である場合のみ、前記
近接スイッチ(10)の検出パルス(10a)に基づい
て、例えば当該検出パルス(10a)のパルス幅の時間
t。と突条部(7)の幅の長さとから、搬送用移動体(
1)の現在速度Aが演算される。そして近接スイッチ(
10)の検出パルス(10a)の計数によって求められ
る搬送用移動体(1)の各速度制御位置での現在速度A
と設定速度との差をゼロとするように、停止位置(9)
にあるリニアモーターの一次側本体(5)に対する給電
を制御し、搬送用移動体(1)の走行速度を減速させる
。As shown in the flowchart in Figure 6, the proximity switch (
When the detection pulse (10a) is output from 10), the time of the pulse width is also determined. is measured and a preset time t
1, that is, the speed at which the conveying moving body (1) enters the rotating body (11), a low speed that is considered not to cause slippage between the rotating body (11) and the conveying moving body (1). Compare the time t1 of the pulse width of the detection pulse (LOA) with the time t0 of the actual pulse width.If t0≧L1, that is, the speed of the conveyance moving body O') is lower than the speed of the rotating body (11)
Based on the detection pulse (10a) of the proximity switch (10), for example, the detection Pulse width time t of pulse (10a). From the length and the width of the protrusion (7), the transportation moving body (
1) The current speed A is calculated. and a proximity switch (
10) Current speed A of the conveying moving body (1) at each speed control position determined by counting the detection pulses (10a)
Set the stop position (9) so that the difference between the speed and the set speed is zero.
The power supply to the primary main body (5) of the linear motor located at the main body (5) is controlled to reduce the traveling speed of the conveyance moving body (1).
一方、搬送用移動体(1)の走行によって前記のように
パルスエンコーダー(12)かう出力パルス(12a)
が生じるようになると、当該出力パルス(12a)に基
づいて、例えば単位時間当たりの出力パルス(12a)
の計数値から、搬送用移動体(1)の現在速度Bが演算
される。そしてこの現在速度Bが演算されると、同時に
前記のように近接スイッチ(10)の検出パルス(lo
a)に基づいて演算されている現在速度Aと前記現在速
度Bとの絶対値の差が演算されると共に、その差が予め
設定されたしきい値Cと比較される。ここで前記しきい
値Cは、そのときに前記のように近接スイッチ(10)
の検出パルス(10a)に基づいて演算されている現在
速度Aの数%の値に設定されており、両速度A、Bの絶
対値の差がしきい値Cよりも小さくなったとき、即ち再
演算速度A、 Bに実質的な差がなくなったとき、換
言すれば第5図に示す不安定期から安定期に切り換わる
時期T0に至ったとき、現在速度Aに基づいて行ってい
た搬送用移動体(1)の速度制御を現在速度Bに基づく
速度制御に切り換える。このとき、速度#Jmのための
搬送用移動体(1)の位置検出は、前記と同様に近接ス
イッチ(10)の検出パルス(10a)の計数によって
行われている。On the other hand, as described above, the output pulse (12a) is generated by the pulse encoder (12) as the transportation moving body (1) travels.
When the output pulse (12a) starts to occur, for example, the output pulse (12a) per unit time is
The current speed B of the transportation moving body (1) is calculated from the counted value. When this current speed B is calculated, at the same time, the detection pulse (lo
The difference in absolute value between the current speed A calculated based on a) and the current speed B is calculated, and the difference is compared with a preset threshold C. where said threshold C is then determined by the proximity switch (10) as described above.
is set to a value of several percent of the current speed A calculated based on the detection pulse (10a) of When there is no substantial difference between the recalculated speeds A and B, in other words, when the period T0 when the unstable period switches to the stable period shown in FIG. The speed control of the moving body (1) is switched to speed control based on the current speed B. At this time, the position detection of the conveyance moving body (1) for the speed #Jm is performed by counting the detection pulses (10a) of the proximity switch (10) in the same manner as described above.
更に搬送用移動体(1)が走行して、近接スイッチ(1
0)の検出パルス(loa)の計数値が予め設定された
設定値Nとなったとき、パルスエンコーダー(12)の
出力パルス(12a)の計数値をゼロリセットし、新た
に出力パルス(12a)を計数開始する。そして以後の
速度制御に於ける搬送用移動体(1)の位置検出は、前
記パルスエンコーダー(12)の出力パルス(12a)
の計数値に基づいて行う。尚、前記設定値Nが得られる
ときの搬送用移動体(1)の位置は、パルスエンコーダ
ー(12)の出力パルス(12a)が不安定期から安定
期に切り換わる時期T0に相当する位置よりも下手側で
、如何なる状況下でも必ず前記時期T0を経過した後に
検出パルス(10a)の計数値が設定値Nとなるように
、設定値Nが設定されている。Furthermore, the conveyance moving body (1) travels and the proximity switch (1)
When the count value of the detected pulse (loa) of 0) reaches the preset setting value N, the count value of the output pulse (12a) of the pulse encoder (12) is reset to zero, and a new output pulse (12a) is generated. Start counting. Then, the position detection of the transport moving body (1) in the subsequent speed control is performed using the output pulse (12a) of the pulse encoder (12).
This is done based on the count value. Note that the position of the conveyance moving body (1) when the set value N is obtained is lower than the position corresponding to the time T0 when the output pulse (12a) of the pulse encoder (12) switches from the unstable period to the stable period. On the lower side, a set value N is set so that the counted value of the detection pulse (10a) always reaches the set value N after the time T0 has elapsed under any circumstances.
前記のように最終的には搬送用移動体(1)の速度制御
は、パルスエンコーダー(12)の出力パルス(12a
)から演算される現在速度Bと、同パルス(12a)の
計数によって検出される搬送用移動体(1)の位置とに
基づいて行われ、第5図に示すように所定の減速経過線
VCを描いて搬送用移動体(1)が減速するように、停
止位置(9)にあるリニアモーター用−次側本体(5)
の給電が制御され、そして前記パルスエンコーダー(1
2)の出力パルス(12a)の計数値が予め設定された
設定値Pnとなったとき、搬送用移動体(1)が停止す
るように、停止位W(9)にあるリニアモーター用−次
側本体(5)に対する給電が断たれる。この結果、搬送
用移動体(1)が第1図に仮想線で示すように停止位置
(9)に停止することになるが、このとき搬送用移動体
(1)を支持している適当個数のホイール(2)を制動
手段(15)で制動するように構成することも出来る。As mentioned above, the speed control of the conveyance moving body (1) is ultimately performed using the output pulse (12a) of the pulse encoder (12).
) and the position of the conveying moving body (1) detected by counting the pulses (12a), and as shown in FIG. The next main body (5) for the linear motor at the stop position (9) is drawn so that the transport moving body (1) decelerates.
The power supply of the pulse encoder (1) is controlled, and the pulse encoder (1
2) When the count value of the output pulse (12a) reaches a preset value Pn, the conveyance moving body (1) is stopped. The power supply to the side body (5) is cut off. As a result, the conveying moving body (1) will stop at the stop position (9) as shown by the imaginary line in FIG. The wheel (2) can also be configured to be braked by a braking means (15).
尚、第6図のフローチャートに示すように、近接スイッ
チ(10)からの検出パルス(10a)のパルス幅の時
間も。と予め設定された時間【、との比較の結果、t、
≧t、であった場合、即ち搬送用移動体(1)の速度が
回転体(11)と搬送用移動体(1)との間に滑りを生
ぜしめないであろうと考えられる速度と同一か又はそれ
よりも低速であった場合には、近接スイッチ(10)の
検出パルス(10a)に基づく現在速度Aの演算と、こ
の現在速度Aを使用した速度制御は行わずに、パルスエ
ンコーダー(12)か転出力パルス(12a)が生じる
のを待って、当該出力パルス(12a)に基づく現在速
度Bの演算と、この現在速度Bを使用する速度制御とを
行うことになる。Incidentally, as shown in the flowchart of FIG. 6, the pulse width time of the detection pulse (10a) from the proximity switch (10) is also determined. As a result of the comparison between and the preset time [, t,
If ≧t, that is, is the speed of the conveying moving body (1) the same as the speed that would not cause slippage between the rotating body (11) and the conveying moving body (1)? or if the speed is lower than that, the pulse encoder (12 ), the current speed B is calculated based on the output pulse (12a), and speed control using this current speed B is performed.
又、第5図に減速経過線VC”で示すように、近接スイ
ッチ(10)の検出パルス(10a)に基づいて演算さ
れた現在速度Aとパルスエンコーダー(12)の出力パ
ルス(12a)に基づいて演算された現在速度Bとの間
に問題となる程の差がなくなる時期T。までは速度制御
を一切行わず、当該時期T0以後のみ、パルスエンコー
ダー(12)の出力パルス(12a)に基づいて演算さ
れた現在速度Bに基づく速度制御を行っても良い。In addition, as shown by the deceleration progress line VC'' in Fig. 5, the speed is calculated based on the current speed A calculated based on the detection pulse (10a) of the proximity switch (10) and the output pulse (12a) of the pulse encoder (12). No speed control is performed until the time T when there is no longer a difference between the current speed B and the current speed B calculated by The speed control may be performed based on the current speed B calculated by the following steps.
(発明の作用及び効果)
以上のように本発明によるリニアモーター駆動の移動体
の速度制御方法によれば、移動体が如何なる速度で進入
してきても、当該移動体とパルスエンコーダー駆動用回
転体との間の滑りが無くなるか又は許容範囲内まで低下
したことを、移動体側の等間隔おきの被検出部(実施例
では二次導体の突条部(7)が兼用)を検出する近接ス
イッチの検出パルスに基づいて演算される速度Aと前記
パルスエンコーダーの出力パルスに基づいて演算される
速度Bとの差が一定値以下となったことにより正確に検
出することが出来、このように両速度A、 Bの差が一
定値以下となった以後、前記パルスエンコーダーの出力
パルスに基づいて演算される速度Bに基づいて前記リニ
アモーターの一次側本体を制御して、前記搬送用移動体
の速度制御を行うのであるから、演算される速度と実際
の速度との間の誤差が掻めて小さくなり、速度制御を極
めて高精度に行うことが出来る。(Operations and Effects of the Invention) As described above, according to the method for controlling the speed of a linear motor-driven moving body according to the present invention, no matter what speed the moving body approaches, the moving body and the rotary body for driving the pulse encoder are connected to each other. The proximity switch detects whether the slippage between the two has been eliminated or has decreased to within the allowable range by detecting the detected parts at equal intervals on the moving body side (in the embodiment, the protrusions (7) of the secondary conductor also serve as the protrusions). Accurate detection is possible when the difference between the speed A calculated based on the detection pulse and the speed B calculated based on the output pulse of the pulse encoder is below a certain value. After the difference between A and B becomes equal to or less than a certain value, the primary main body of the linear motor is controlled based on the speed B calculated based on the output pulses of the pulse encoder, and the speed of the conveyance moving body is adjusted. Since the control is performed, the error between the calculated speed and the actual speed is greatly reduced, and speed control can be performed with extremely high precision.
しかも従来のように、移動体とパルスエンコーダー駆動
用回転体との間の滑りが無くなるであろう基準位置、即
ち速度演算開始位置、を予測して設定する必要はなく、
勿論、前記回転体に対する移動体の突入速度や回転体と
移動体との間の当接面の表面状態等の変化によって、移
動体と回転体との間に滑りを伴う距離が変化しても、全
く支障なく所期通りの正確な現在速度の演算を行うこと
が出来る。又、前記基準位置(速度演算開始位置)を前
記回転体から走行方向に出来る限り離して設定した場合
のように、速度制御に利用出来る経路長さが短くなると
云うような不都合も伴わない尚、実施例のように、前記
パルスエンコーダーの出力パルスから演算される速度B
に基づく速度制御を開始するまで、前記近接スイッチの
検出パルスから演算される速度Aに基づいて前記リニア
モーターの一次側本体を制御することにより、全体の速
度制御経路長さを長くし、無理のない円滑な速度制御が
可能となる。Moreover, unlike conventional methods, there is no need to predict and set a reference position where there will be no slippage between the moving body and the rotating body for driving the pulse encoder, that is, the speed calculation start position.
Of course, even if the sliding distance between the moving body and the rotating body changes due to changes in the entry speed of the moving body to the rotating body, the surface condition of the contact surface between the rotating body and the moving body, etc. , the current speed can be calculated accurately as expected without any problems. Further, unlike the case where the reference position (speed calculation start position) is set as far away from the rotating body in the traveling direction as possible, there is no inconvenience such as shortening of the path length that can be used for speed control. As in the embodiment, the speed B calculated from the output pulses of the pulse encoder
By controlling the primary side body of the linear motor based on the speed A calculated from the detection pulse of the proximity switch until speed control based on Smooth speed control is possible.
又、実施例に示したように、前記近接スイッチの検出パ
ルスの幅又は周期が一定しきい値よりも小さくないとき
、即ち、移動体の進入速度が十分に低くて、パルスエン
コーダー駆動用回転体と移動体との間に当初から滑りが
生じないであろうことが予想される場合、前記速度Aの
演算を行わずに前記速度Bの演算のみを行い、当該速度
Bに基づいて前記リニアモーターの一次側本体を制御す
るようにすれば、移動体の進入速度が一定速度以下であ
るときには無駄な速度演算作用を省いて自動的に速度制
御開始時期を早め、しかも速度制御の当初から正確に演
算された現在速度に基づいて高精度の速度制御が可能と
なる。Further, as shown in the embodiment, when the width or period of the detection pulse of the proximity switch is not smaller than a certain threshold value, that is, when the approaching speed of the moving object is sufficiently low, the rotating body for driving the pulse encoder is If it is predicted that there will be no slippage between the moving object and the moving object from the beginning, only the speed B is calculated without calculating the speed A, and the linear motor is adjusted based on the speed B. If the primary body is controlled, when the moving object's approach speed is below a certain speed, unnecessary speed calculation operations will be eliminated and the speed control start time will be advanced automatically, and speed control will be performed accurately from the beginning. Highly accurate speed control is possible based on the calculated current speed.
第1図は平面図、第2図は正面図、第3図は搬送用移動
体の斜視図、第4図は要部の拡大縦断正面図と制御系を
示すブロック線図、第5図は近接スイッチの検出パルス
、パルスエンコーダーの出力パルス、及び減速経過線を
示す図、第6図は制御手順を説明するフローチャートで
ある。
(1)・・・搬送用移動体、(4)・・・リニアモータ
ー用二次導体、(5)・・・リニアモーター用−次側本
体、(6)・・・帯板状磁性材、(7)・・・突条部(
近接スイッチに対する被検出部)、(8)・・・非磁性
電導材、(9)・・・停止位置、(10)・・・近接ス
イッチ、(loa)・・・近接スイッチの検出パルス、
(11)・・・パルスエンコーダー駆動用回転体、(1
2)・・・パルスエンコーダー(12a)・・・パルス
エンコーダーの出力パルス、(13)・・・速度制御用
マイクロコンピュータ−1(14)・・・モーターコン
トローラーFig. 1 is a plan view, Fig. 2 is a front view, Fig. 3 is a perspective view of the conveyance moving body, Fig. 4 is an enlarged longitudinal sectional front view of the main parts and a block diagram showing the control system, and Fig. 5 is a block diagram showing the control system. FIG. 6 is a flowchart illustrating the control procedure, which is a diagram showing detection pulses of the proximity switch, output pulses of the pulse encoder, and deceleration progress lines. (1)...Transportation moving body, (4)...Secondary conductor for linear motor, (5)...Next main body for linear motor, (6)...Strip-shaped magnetic material, (7)... Projection (
(detected part for the proximity switch), (8)...Nonmagnetic conductive material, (9)...Stop position, (10)...Proximity switch, (LOA)...Detection pulse of the proximity switch,
(11)...Rotating body for driving pulse encoder, (1
2) Pulse encoder (12a) Pulse encoder output pulse, (13) Speed control microcomputer-1 (14) Motor controller
Claims (3)
走行経路側にリニアモーターの一次側本体を配設したシ
ステムに於いて、前記走行経路側に、前記移動体の前端
から走行方向に沿って等間隔おきに並設された被検出部
を検出する近接スイッチと、前記移動体に接して回転す
る回転体及びこれに連動するパルスエンコーダーとを配
設し、前記近接スイッチの検出パルスに基づいて演算さ
れる速度Aと前記パルスエンコーダーの出力パルスに基
づいて演算される速度Bとを比較し、両速度A、Bの差
が一定値以下となった以後は、前記速度Bに基づいて前
記リニアモーターの一次側本体を制御することを特徴と
するリニアモーター駆動の移動体の速度制御方法。(1) A secondary conductor for the linear motor is provided on the moving body side,
In a system in which a primary main body of a linear motor is disposed on a traveling route side, detected parts are detected that are arranged in parallel at regular intervals along a traveling direction from a front end of the moving body on the traveling route side. A proximity switch, a rotating body rotating in contact with the moving body, and a pulse encoder interlocked therewith are disposed, and the speed A is calculated based on the detection pulse of the proximity switch and the output pulse of the pulse encoder. The linear motor is characterized in that the primary side main body of the linear motor is controlled based on the speed B after the difference between both speeds A and B becomes equal to or less than a certain value. A method for controlling the speed of a motor-driven moving object.
前記速度Aに基づいて前記リニアモーターの一次側本体
を制御することを特徴とする特許請求の範囲第(1)項
に記載のリニアモーター駆動の移動体の速度制御方法。(2), until the speed control based on the speed B is started,
The method for controlling the speed of a moving body driven by a linear motor according to claim 1, wherein the primary main body of the linear motor is controlled based on the speed A.
一定しきい値よりも小さくないとき、前記速度Aの演算
を行わずに前記速度Bの演算のみを行い、当該速度Bに
基づいて前記リニアモーターの一次側本体を制御するこ
とを特徴とする特許請求の範囲第(1)項に記載のリニ
アモーター駆動の移動体の速度制御方法。(3) When the width or period of the detection pulse of the proximity switch is not smaller than a certain threshold, only the speed B is calculated without calculating the speed A, and the speed B is calculated based on the speed B. A method for controlling the speed of a moving body driven by a linear motor according to claim (1), characterized in that the primary main body of the linear motor is controlled.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP63313177A JP2597169B2 (en) | 1988-12-12 | 1988-12-12 | Speed control method of moving body driven by linear motor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP63313177A JP2597169B2 (en) | 1988-12-12 | 1988-12-12 | Speed control method of moving body driven by linear motor |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH02159905A true JPH02159905A (en) | 1990-06-20 |
JP2597169B2 JP2597169B2 (en) | 1997-04-02 |
Family
ID=18038032
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP63313177A Expired - Lifetime JP2597169B2 (en) | 1988-12-12 | 1988-12-12 | Speed control method of moving body driven by linear motor |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2597169B2 (en) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62126805A (en) * | 1985-11-27 | 1987-06-09 | Shinko Electric Co Ltd | Speed detector in conveyor |
-
1988
- 1988-12-12 JP JP63313177A patent/JP2597169B2/en not_active Expired - Lifetime
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS62126805A (en) * | 1985-11-27 | 1987-06-09 | Shinko Electric Co Ltd | Speed detector in conveyor |
Also Published As
Publication number | Publication date |
---|---|
JP2597169B2 (en) | 1997-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JPH02159905A (en) | Speed control method for linear motor drive moving body | |
JPH06245328A (en) | Magnetic levitation transfer system employing linear motor | |
JP2801442B2 (en) | Linear transfer device | |
JP2514089B2 (en) | Linear motor driven moving body fixed position stop control method | |
JP2001057713A (en) | Device for detecting speed and position of linear motor drive carrying vehicle | |
JP2592671B2 (en) | Transfer device driven by linear motor | |
JP2624665B2 (en) | Control device for linear induction motor | |
JP2665609B2 (en) | Traveling control method of moving body driven by linear motor | |
JPH0344746Y2 (en) | ||
JP3267056B2 (en) | Traveling control method and device for tracked bogie | |
JPH06351286A (en) | Linear transfer system | |
JP3366923B2 (en) | Truck traveling speed control method in separation zone of transfer device | |
JP2592668B2 (en) | Transfer equipment | |
JPH0630524B2 (en) | Traveling control device for moving body for carrier device | |
JPH07306716A (en) | Method for controlling travel of moving body and device therefor | |
JPS62274314A (en) | Run position detecting method for moving device | |
JPH0652961B2 (en) | Linear motor type transport device | |
JPH02236707A (en) | Travel controller for unmanned vehicle | |
JPH0340821Y2 (en) | ||
JPH01292404A (en) | Steering device for unmanned carrier vehicle | |
JPH03102007A (en) | Positioning device for linear transport dolly | |
JPH02246706A (en) | Fixed position stop control method for linear motor drive moving body | |
JPH044408A (en) | Running controller for unmanned vehicle | |
JPH03178593A (en) | Linear conveying apparatus | |
JPH0140598B2 (en) |