JPS63191210A - Positioning control system for actuator - Google Patents
Positioning control system for actuatorInfo
- Publication number
- JPS63191210A JPS63191210A JP2243587A JP2243587A JPS63191210A JP S63191210 A JPS63191210 A JP S63191210A JP 2243587 A JP2243587 A JP 2243587A JP 2243587 A JP2243587 A JP 2243587A JP S63191210 A JPS63191210 A JP S63191210A
- Authority
- JP
- Japan
- Prior art keywords
- actuator
- relative position
- marker
- motor
- microcomputer
- 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
Links
- 239000003550 marker Substances 0.000 claims abstract description 22
- 238000001514 detection method Methods 0.000 claims description 12
- 238000000034 method Methods 0.000 claims description 4
- 230000002441 reversible effect Effects 0.000 abstract description 5
- 230000001186 cumulative effect Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Landscapes
- Control Of Position Or Direction (AREA)
Abstract
Description
【発明の詳細な説明】
(産業上の利用分野)
本発明は、複数の位置+1tlを移動するようにしたモ
ータ駆動アクチュエータの位置決め制御方式に関するも
のである。DETAILED DESCRIPTION OF THE INVENTION (Field of Industrial Application) The present invention relates to a positioning control system for a motor-driven actuator that moves a plurality of positions +1tl.
(従来の技術)
従来のこの種のアクチュエータの位置決め制御方式は、
第2図に示す構成を有している。すなわち、11はマイ
クロコンピュータであって、小型モータ駆動回路12お
よび可逆カウンタ15を制御、監視する。13はパルス
エンコーダ14を直結した小型のモータであって、アク
チュエータを駆動する。(Prior art) The conventional positioning control method for this type of actuator is as follows:
It has the configuration shown in FIG. That is, 11 is a microcomputer that controls and monitors the small motor drive circuit 12 and the reversible counter 15. A small motor 13 is directly connected to a pulse encoder 14 and drives an actuator.
このような従来のものでは、マイクロコンピュータ11
が小型モータ駆動回路12に信号を伝達してモータ13
を回転させることにより、アクチュエータ(図示されて
いない)を移動させる。アクチュエータを目的の位置で
停止9位置決めさせる場合、モータ13に直結されたパ
ルスエンコーダ14より出力されるパルス信号を、可逆
カウンタ15によって積算し、モータ13の回転方向に
応じたカウント値に変換する。その積算されたカウント
値を、マイクロコンピュータ11が目的の停止位置に与
えられた所定のカウント値と比較演算し、一致すると同
時に小型モータ駆動回路12の信号を切って小型モータ
13を停止させ、アクチュエータを停止2位置決めする
。In such a conventional system, the microcomputer 11
transmits a signal to the small motor drive circuit 12 to drive the motor 13
An actuator (not shown) is moved by rotating the . When the actuator is stopped at a target position, a pulse signal output from a pulse encoder 14 directly connected to the motor 13 is integrated by a reversible counter 15 and converted into a count value corresponding to the rotation direction of the motor 13. The microcomputer 11 compares and calculates the accumulated count value with a predetermined count value given to the target stop position, and at the same time when they match, the signal to the small motor drive circuit 12 is cut off to stop the small motor 13, and the actuator Stop 2 and position.
このように、積算されたパルスエンコーダ14のカウン
ト値と、停止位置に与えられた所定のカウント値との比
較演算をマイクロコンピュータ11が行ない、小型モー
タ13の駆動を制御することによりアクチュエータを目
的の位置に位置決めするものである。In this way, the microcomputer 11 performs a comparison calculation between the integrated count value of the pulse encoder 14 and a predetermined count value given to the stop position, and controls the drive of the small motor 13 to move the actuator to the desired position. It is used for positioning.
(発明が解決しようとする問題点)
このような従来のものでは、アクチュエータの各停止位
置に必要な所定のカウント値を、計算によって求めて設
定するが、実際には機構部品のばらつきや、これら部品
の組み立てにおいて発生する累積誤差等により、計算に
よって求めた所定のカウント値と、実際の停止位置に必
要なカウント値とは同一にならず、数パルス変動する。(Problem to be Solved by the Invention) In such conventional systems, the predetermined count values required for each stop position of the actuator are determined and set by calculation, but in reality, variations in mechanical parts and Due to cumulative errors that occur during the assembly of parts, the predetermined count value obtained by calculation and the count value required for the actual stop position are not the same, and vary by several pulses.
そのため、実際の停止位置に位置決めするためには、各
停止位置におけるそれぞれの変動量を測定し、その測定
値に応じたカウント値を求め、計算によって得られた全
ての停止位置のカウント値を、測定によって求めた値に
変更しなければならず、その修正変更を迅速に行なえな
いという問題があった。Therefore, in order to position at the actual stop position, measure the amount of variation at each stop position, calculate the count value according to the measured value, and calculate the count value of all the stop positions obtained by calculation. There is a problem in that the value must be changed to the value determined by measurement, and the correction cannot be made quickly.
本発明は上記の点に鑑み、アクチュエータの機構部品の
寸法のばらつきや、これら部品の組み立てにおいて生ず
る累M誤差等による停止位置のばらつきに影響されるこ
となく、目的の停止位置に位置決めできるようにしたア
クチュエータの位置決め制御方式を提供するものである
。In view of the above points, the present invention has been developed to enable positioning at a desired stop position without being affected by variations in the dimensions of the actuator's mechanical parts or variations in the stop position due to cumulative M errors that occur when assembling these parts. The present invention provides a positioning control method for an actuator.
(問題点を解決するための手段)
そこで本発明は、マイクロコンピュータの指令信号によ
り回転、停止するモータの駆動力によって移動させるよ
うにしたアクチュエータに相対位置検出器を取り付け、
前記アクチュエータの所用の各停止位置に相対位置検出
マーカを設け、前記マイクロコンピュータは前記アクチ
ュエータが移動して前記相対位置検出器が所望の停止位
置にある相対位置検出マーカのエツジを検出したときよ
り前記モータ直結のパルスエンコーダのパルス信号のカ
ウントを始め、前記コンピュータが前記マーカの幅分の
パルス数と比較演算し合致と同時に前記モータを停止さ
せるようにしたものである。(Means for Solving the Problems) Therefore, the present invention provides a method in which a relative position detector is attached to an actuator that is moved by the driving force of a motor that rotates and stops in response to command signals from a microcomputer.
A relative position detection marker is provided at each desired stop position of the actuator, and the microcomputer detects the edge of the relative position detection marker when the actuator moves and the relative position detector detects the edge of the relative position detection marker at the desired stop position. The computer starts counting pulse signals from a pulse encoder directly connected to the motor, compares the number of pulses with the number of pulses corresponding to the width of the marker, and stops the motor at the same time when a match is found.
(作 用)
アクチュエータに取り付けた相対位置検出器が目的とす
る停止位置に設けたマーカのエツジを検出したとき、パ
ルスエンコーダのパルス信号のカウントを始め、コンピ
ュータがマーカの幅分のパルス数と比較演算して合致し
たときにモータを停止するようにするので、目的の位置
にアクチュエータを停止させることができ、アクチュエ
ータの機構部品の精度9組立による累積誤差があっても
、これら誤差に全く影響されず、アクチュエータを目的
とする位置に停止2位置決めすることができる。(Function) When the relative position detector attached to the actuator detects the edge of the marker set at the desired stop position, the pulse encoder starts counting the pulse signals, and the computer compares them with the number of pulses corresponding to the width of the marker. Since the motor is stopped when the calculation matches, the actuator can be stopped at the desired position, and even if there are cumulative errors due to assembly of the actuator's mechanical parts, these errors will not affect the actuator at all. First, the actuator can be positioned at the desired position.
(実施例)
第1図は本発明の実施例を示し、1はマイクロコンピュ
ータであり、小型モータ駆動回路2.正逆パルス弁別回
路6および相対位置検出器プを制御、監視する。3はア
クチュエータ9を移動させる小型のモータであって、パ
ルスエンコーダ4が直結されている。8はアクチュエー
タ9の所望の各停止位置に設けた相対位置検出マーカで
ある。(Embodiment) FIG. 1 shows an embodiment of the present invention, in which 1 is a microcomputer, a small motor drive circuit 2. Controls and monitors the forward/reverse pulse discrimination circuit 6 and the relative position detector 6. 3 is a small motor for moving the actuator 9, and a pulse encoder 4 is directly connected thereto. 8 is a relative position detection marker provided at each desired stop position of the actuator 9.
上記小型モータ3の回転、停止制御はマイクロコンピュ
ータ1が小型モータ駆動回路2に信号を伝達することに
より行なわれる。Rotation and stop control of the small motor 3 is performed by the microcomputer 1 transmitting signals to the small motor drive circuit 2.
そこで、アクチュエータ9を所望の位置に停止させる場
合、各停止位置に取り付けられた相対位置検出マーカ8
と、アクチュエータ9に取り付けられた相対位置検出器
を用いてマイクロコンピュータ1が監視し、目的として
いる停止位置の相対位置検出マーカ8かどうかを判断す
る。目的としている相対位置検出マーカ8を認識すると
、マイクロコンピュータ1は1次にマーカ8のエツジを
基準として正逆パルス弁別回路6より出力される小型モ
ータ3直結のパルスエンコーダ4のパルス信号をカウン
トし、マーカ8の幅分のパルス数と比較演算し合致と同
時に小型モータ3を停止させ、アクチュエータ9を目的
の停止位置に位置決めする。Therefore, when the actuator 9 is stopped at a desired position, the relative position detection marker 8 attached to each stop position is
The microcomputer 1 monitors this using a relative position detector attached to the actuator 9, and determines whether the relative position detection marker 8 is at the desired stop position. When the target relative position detection marker 8 is recognized, the microcomputer 1 firstly counts the pulse signal of the pulse encoder 4 directly connected to the small motor 3 which is output from the forward/reverse pulse discrimination circuit 6 using the edge of the marker 8 as a reference. , and the number of pulses corresponding to the width of the marker 8, and when they match, the small motor 3 is stopped and the actuator 9 is positioned at the desired stop position.
アクチュエータ9の停止位置を変更する場合には、相対
位置検出マーカ8の取付位置を変えればよい。 停止時
の最終位置決めは、モータ直結のパルスエンコーダのパ
ルス量の演算により行なうため、位置決め精度はパルス
エンコーダの分解能と同一の精度が得られる。また、相
対位置検出器をアクチュエータに取り付け、パルスエン
コーダをモータに直結しているので、モータと動作部と
の伝達系による位置決め誤差を減少させる。When changing the stop position of the actuator 9, the mounting position of the relative position detection marker 8 may be changed. The final positioning at the time of stopping is performed by calculating the amount of pulses of a pulse encoder directly connected to the motor, so that the same accuracy of positioning as the resolution of the pulse encoder can be obtained. Furthermore, since the relative position detector is attached to the actuator and the pulse encoder is directly connected to the motor, positioning errors due to the transmission system between the motor and the operating section are reduced.
(発明の効果)
以上のように本発明によれば、相対位置検出マーカを基
準としてアクチュエータの停止位置決めするようにした
ものであるから、アクチュエータの機構部品の寸法のば
らつきや0組み立てで生ずる累積誤差があっても、これ
に全く影響されず目的の停止位置に位置決めすることが
できる。(Effects of the Invention) As described above, according to the present invention, since the stop position of the actuator is determined based on the relative position detection marker, the cumulative error caused by variations in the dimensions of the actuator's mechanical parts and zero assembly is eliminated. Even if there is a problem, the vehicle can be positioned at the desired stopping position without being affected by this.
第1図は本発明の実施例を示す図、第2図は従来のモー
タ駆動アクチュエータの位置決め制御方式の概略ブロッ
ク図である。
1・・・マイクロコンピュータ、 3・・・モータ、4
・・・パルスエンコーダ、 7・・・相対位11検出器
、 8・・・相対位置検出マーカ、 9・・・アクチュ
エータ。FIG. 1 is a diagram showing an embodiment of the present invention, and FIG. 2 is a schematic block diagram of a conventional positioning control system for a motor-driven actuator. 1...Microcomputer, 3...Motor, 4
...Pulse encoder, 7. Relative position 11 detector, 8. Relative position detection marker, 9. Actuator.
Claims (1)
モータの駆動力によって移動させるようにしたアクチュ
エータに相対位置検出器を取り付け、前記アクチュエー
タの所用の各停止位置に相対位置検出マーカを設け、前
記マイクロコンピュータは前記アクチュエータが移動し
て前記相対位置検出器が所望の停止位置にある相対位置
検出マーカのエッジを検出したときより前記モータ直結
のパルスエンコーダのパルス信号のカウントを始め、前
記コンピュータは前記マーカの幅分のパルス数と比較演
算して合致と同時に前記モータを停止させるようにした
ことを特徴とするアクチュエータの位置決め制御方式。A relative position detector is attached to an actuator that is moved by the driving force of a motor that rotates and stops in response to a command signal from a microcomputer, and a relative position detection marker is provided at each desired stop position of the actuator. When the actuator moves and the relative position detector detects the edge of the relative position detection marker at the desired stop position, the pulse encoder directly connected to the motor starts counting pulse signals, and the computer starts counting pulse signals for the width of the marker. A positioning control method for an actuator, characterized in that the motor is stopped at the same time when the number of pulses matches the number of pulses.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2243587A JPS63191210A (en) | 1987-02-04 | 1987-02-04 | Positioning control system for actuator |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2243587A JPS63191210A (en) | 1987-02-04 | 1987-02-04 | Positioning control system for actuator |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS63191210A true JPS63191210A (en) | 1988-08-08 |
Family
ID=12082614
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2243587A Pending JPS63191210A (en) | 1987-02-04 | 1987-02-04 | Positioning control system for actuator |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS63191210A (en) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61173318A (en) * | 1985-01-29 | 1986-08-05 | Fujitsu Ltd | Position controlling system |
-
1987
- 1987-02-04 JP JP2243587A patent/JPS63191210A/en active Pending
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61173318A (en) * | 1985-01-29 | 1986-08-05 | Fujitsu Ltd | Position controlling system |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0092378A1 (en) | Position control apparatus and method | |
US5371460A (en) | Speed and direction sensor for a rotating shaft having a rotor with teeth of alternating widths | |
CA1175892A (en) | Apparatus for stepper motor position control | |
CA2442242C (en) | Method and apparatus for calibrating an incremental count of movement | |
CN111982050B (en) | Automatic detection system, detection method and compensation method for mechanical clearance of holder controller | |
JPS63191210A (en) | Positioning control system for actuator | |
CA1295363C (en) | Process for determining the rotational speed of a machine | |
US5164896A (en) | Positioning system | |
JPH0737995B2 (en) | Failure detection device for rotation sensor | |
JP2560042Y2 (en) | Elevator speed detector | |
EP0263685B1 (en) | Extra magnetic field positioning apparatus | |
JPS63243703A (en) | Count-check type detector for angle of rotation | |
JPH0561880B2 (en) | ||
JPH102715A (en) | Position detector | |
JP2602065B2 (en) | Travel position control device for self-propelled vehicles | |
US5191271A (en) | Process and device for adjusting an axis | |
JPH05164541A (en) | Moving position calibrator | |
US20040017189A1 (en) | Method and apparatus for soft absolute position sensing of an electromechanical system output | |
JPS61260103A (en) | System for moving and measuring object to be controlled | |
JPS61221802A (en) | Searching system for original point of robot arm | |
KR0161044B1 (en) | Control system and method of mobile robot | |
JPH083733B2 (en) | Return to origin method of numerical controller | |
KR20020078896A (en) | Monitoring camera and controlling method thereof | |
JPS6262363B2 (en) | ||
JPH03164812A (en) | Linear actuator controller |