JP3698327B2 - Trajectory correction method for free curve - Google Patents
Trajectory correction method for free curve Download PDFInfo
- Publication number
- JP3698327B2 JP3698327B2 JP23442994A JP23442994A JP3698327B2 JP 3698327 B2 JP3698327 B2 JP 3698327B2 JP 23442994 A JP23442994 A JP 23442994A JP 23442994 A JP23442994 A JP 23442994A JP 3698327 B2 JP3698327 B2 JP 3698327B2
- Authority
- JP
- Japan
- Prior art keywords
- axis
- free curve
- scan
- position command
- correction
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Numerical Control (AREA)
Description
【0001】
【産業上の利用分野】
本発明は、電子カムを応用した研磨機やロボットなどにおける軌跡制御に係り、特に工具を電子カムが発生する自由曲線に沿って工具位置を制御する軌跡補正方法に関する。
【0002】
【従来の技術】
従来、電子カムを応用したサーボ系の軌跡制御方法として、図3に示す例が知られている。図3は電子カムにより自由曲線の指令位置Xref、Yrefを発生させ、その指令位置にサーボ軸X,Yを追従させることにより自由曲線の軌跡補正を行う例である。まず、図3の構成を説明する。
10は定周期スキャン実行方式のコントローラ(例えば一般にプログラマブルコントローラPLCと呼称されるもの)、11、11Aはサーボドライバ、12、12Aはサーボモータ、13、13Aはパルスゼネレータ、14、14Aは位置指令発生回路、15、15Aは位置指令から検出された位置を減算する減算部、16、16Aは位置制御ゲイン、17、17AはD/A変換器、18、18Aはパルスゼネレータのパルス信号を積算して、位置信号に変換するカウンタ、21は位相指令θ(θ=ωt、ωは角速度、tは時間)、22、22Aは位置指令、である。なお、各符号の末尾にAのないものはX軸、Aを付したものはY軸に対応している。
つぎに、その作用を説明する。コントローラ10内では、位相指令21(θ)の推移に応じて、X軸、Y軸の位置指令発生回路14、14Aがコントローラ10のスキャン毎に位置指令22、22Aを出力する。サーボ軸X、Yそれぞれの位置制御ループに各位置指令を与えることにより、軌跡制御を行うことが出来る。この方法によれば、研磨機のグラインダの位置をX、Y軸で位置制御する例を挙げると、グラインダ31は図2に示す自由曲線の軌跡41を描かせることが出来る。
【0003】
【発明が解決しようとする課題】
ところが、このような自由曲線で加工材を加工する場合、加工に使用される工具の径補正を行わなければならないが、図3に示した定周期スキャン実行方式のコントローラを用いた従来の電子カム応用サーボシステムでは、このような工具補正を行う方法がなかった。
また、NC装置では工具補正が行われているが、NCでは基準となる軌跡、すなわち教示軌跡は直線と円弧の組み合わせで出来ているので、ブロックデータの先読みで予め補正演算された補正軌跡に基づいて軌跡制御されている。
このため、もとの軌跡が図2のような自由曲線の場合は、このようなNCの工具補正は処理速度の関係から適用できなかった。
そこで、本発明は、定周期スキャン実行方式のコントローラによる電子カムを応用したサーボシステムの自由曲線に対して工具補正を可能とする方法を提供することを目的とする。
【0004】
【課題を解決するための手段】
上記問題を解決するため、本発明における軌跡制御方法は、定周期スキャン実行方式のコントローラのスキャン毎に、位相指令θの推移に応じてX軸およびY軸の位置指令を生成し、前記位置指令に基づいて位置の追従制御を行うサーボシステムを用いて工具を自由曲線に沿って制御する軌跡制御方法において、
前回スキャンの位置指令Pn-1(xn-1,yn-1)と今回スキャンの位置指令Pn(xn,yn)とから、XY平面内で∠ P n-1 P n Q n = 直角をなし 、 補正量が P n Q n = △ L となる位置を Q n (x n ',y n ') としたとき、 y n ≠ y n-1 の場合は、 x n '=x n + △ L・C0S α n 、 y n '=y n + △ L・sin α n 、とし(ただし、α n はX軸に対する P n Q n の傾きでα n =tan -1 (-(x n -x n-1 ) / (y n -y n-1 )) )、 y n =y n-1 の場合は、 x n '=x n +O 、 y n '=y n + △ L として前記 Q n (x n ',y n ') を求め、新たな前記工具の中心軌跡としたのである。
【0005】
【作用】
上記手段により、自由曲線に基づいて軌跡制御される工具軌跡の工具径補正や研磨量補正を任意に実施することができる。
【0006】
【実施例】
以下、本発明の実施例を図に基づいて説明する。
図1は本発明の実施例で、図3と異なる部分は、X、Y軸用補正演算部19、19Aと、加算部20、20Aで、他は図3と共通であるので説明は省略する。
図1でコントローラ10は定周期スキャン実行方式のコントローラとする。
補正が無い場合は、図3と同様に自由曲線41を描かせることができる。本実施例では、図3の従来技術に対して、以下に説明する原理を利用した軌跡補正機能を追加したものである。その補正の原理はつぎのとおりである。
X、Y軸位置指令発生回路14、14Aによりスキャン毎に位置指令22、22Aが発生される。このスキャン毎の位置指令について、前スキャンの指令の座標がPn-1(xn-1、yn-1)であったとし、今回スキャンがPn(xn、yn)であるとする。この時、図2のようにグラインダ31の中心軌跡のXY平面内における法線方向にΔ Lだけ補正をかけた軌跡の点をQn(xn’、yn’)とすると、つぎのような関係が成立する。
1)yn≠yn-1の場合:
X軸に対するPnQnの傾きαnは、
tanαn=-(xn-xn-1 ) / (yn-yn-1)より
αn=tan-1(-(xn-xn-1 ) / (yn-yn-1))
(但し研磨量が増す方向への補正の場合0°≦αn<180°)
となるので、補正をかけた時の新たな座標Qn(xn’、yn’)は、
xn'=xn+Δ L・cosαn
yn'=yn+Δ L・sinαn
(なお、-180°<αn≦0°でαnを選べば研磨量が減少する方向へも補正をかけることができる)
2)yn=yn-1の場合:
X軸に対するP n Q n の傾きαn=90°となるので、
xn'=xn
yn'=yn+Δ L
したがって、以上の位置関係を利用して、X、Y軸の位置指令を補正する。
すなわち、図1において、X軸位置指令発生回路14から生成されるX軸位置指令22に対しては、X軸補正演算部19と加算部20とにより、X軸位置指令23が次式を充たすようにする。
xn'=xn+Δ L・cosαn(yn≠yn-1)
xn'=xn+0 (yn=yn-1)
また、Y軸については、Y軸位置指令発生回路14Aから生成されるY軸位置指令22Aに対しては、Y軸補正演算部19Aと加算部20Aとにより、Y軸位置指令23Aが次式を充たすようにする。
yn'=yn+Δ L・sinαn(yn≠yn-1)
yn'=yn+Δ L (yn=yn-1)
このような処理をコントローラのスキャン毎に行うことにより、図2の自由曲線41をΔ Lだけ補正した自由曲線42を得ることができる。
【0007】
【発明の効果】
以上述べたように本発明によれば、定周期スキャン実行方式のコントローラを用いた電子カム応用のサーボシステムにおいて、推移する位相指令に対応して電子カムで発生させるあらゆる自由曲線に対して軌跡補正機能を実現することが可能となる。
【図面の簡単な説明】
【図1】本発明の実施例を示す図
【図2】自由曲線の軌跡補正を説明するための図
【図3】従来技術の例を示す図
【符号の説明】
10 コントローラ
11、11A サーボドライブ
12、12A サーボモータ
13、13A パルスゼネレータ
21 位相指令
141 、14A 位置指令発生回路
23、23A 位置指令
16、16A 位置制御ゲイン
17、17A D/A変換器
18、18A カウンタ
31 グラインダ
41 基準となる自由曲線の軌跡
42 基準となる自由曲線がΔlだけ補正された自由曲線の軌跡[0001]
[Industrial application fields]
The present invention relates to trajectory control in a polishing machine or robot using an electronic cam, and more particularly to a trajectory correction method for controlling a tool position along a free curve generated by the electronic cam.
[0002]
[Prior art]
Conventionally, an example shown in FIG. 3 is known as a locus control method of a servo system using an electronic cam. FIG. 3 shows an example in which free curve command positions Xref and Yref are generated by an electronic cam, and the locus of the free curve is corrected by causing the servo axes X and Y to follow the command positions. First, the configuration of FIG. 3 will be described.
10 is a controller of a periodic scan execution system (for example, what is generally called a programmable controller PLC), 11 and 11A are servo drivers, 12 and 12A are servo motors, 13 and 13A are pulse generators, and 14 and 14A are position commands. Circuit, 15 and 15A are subtractors for subtracting the detected position from the position command, 16 and 16A are position control gains, 17 and 17A are D / A converters, and 18 and 18A are integrated pulse signals of the pulse generator. , A counter for converting to a position signal, 21 is a phase command θ (θ = ωt, ω is an angular velocity, t is time), and 22 and 22A are position commands. In addition, the thing which does not have A at the end of each code | symbol respond | corresponds to the X-axis, and what attached | subjected A corresponds to the Y-axis.
Next, the operation will be described. The controller 10 inside, in accordance with the transition of the phase command 21 (theta), X-axis, the position command generating circuit 14,14A the Y-axis and outputs a position command 22,22A on each scan of the controller 10. Trajectory control can be performed by giving each position command to the position control loop of each of the servo axes X and Y. According to this method, when the position of the grinder of the polishing machine is controlled by the X and Y axes, the grinder 31 can draw the locus 41 of the free curve shown in FIG.
[0003]
[Problems to be solved by the invention]
However, when machining a workpiece with such a free curve, the diameter of the tool used for machining must be corrected, but the conventional electronic cam using the controller of the periodic scan execution method shown in FIG. In the applied servo system, there was no method for performing such tool correction.
Further, although the NC correction is performed in the NC device, the reference trajectory in the NC, that is, the teaching trajectory is made up of a combination of a straight line and an arc, so that it is based on a correction trajectory that is corrected in advance by prefetching block data. The trajectory is controlled.
For this reason, when the original locus is a free curve as shown in FIG. 2, such NC tool correction cannot be applied due to the processing speed.
Accordingly, an object of the present invention to provide a method that enables tool compensation to the free curve of the servo system which applies the electronic cam by the controller of the periodic scan execution mode.
[0004]
[Means for Solving the Problems]
In order to solve the above-described problem, the trajectory control method according to the present invention generates position commands for the X axis and the Y axis according to the transition of the phase command θ for each scan of the controller of the periodic scan execution method, and the position command In a trajectory control method for controlling a tool along a free curve using a servo system that performs position tracking control based on
From the previous scan position command P n-1 (x n-1 , y n-1 ) and current scan position command P n (x n , y n ) , ∠ P n-1 P n Q in the XY plane If n = right angle and the position where the correction amount is P n Q n = △ L is Q n (x n ', y n ') , then y n ≠ y n-1 , x n '= x n + △ L ・ C0S α n , y n '= y n + △ L ・ sin α n , where α n is the slope of P n Q n with respect to the X axis and α n = tan -1 (-( x n -x n-1 ) / (y n -y n-1 )) ), if y n = y n-1 , x n '= x n + O , y n ' = y n + △ L wherein Q n (x n ', y n') as seeking is to that the center locus of the new the tool.
[0005]
[Action]
By the above means, tool radius correction and polishing amount correction of a tool path whose path is controlled based on a free curve can be arbitrarily performed.
[0006]
【Example】
Embodiments of the present invention will be described below with reference to the drawings.
FIG. 1 shows an embodiment of the present invention. The differences from FIG. 3 are the X and Y axis
In FIG. 1, the controller 10 is a fixed-cycle scan execution type controller.
When there is no correction, the free curve 41 can be drawn as in FIG. In this embodiment, a trajectory correction function using the principle described below is added to the prior art of FIG. The principle of the correction is as follows.
Position commands 22 and 22A are generated for each scan by the X and Y axis position command generation circuits 14 and 14A. Regarding the position command for each scan, if the coordinates of the command of the previous scan are P n-1 (x n-1 , y n-1 ), and the current scan is P n (x n , y n ) To do. At this time, if the locus point corrected by Δ L in the normal direction in the XY plane of the central locus of the grinder 31 as shown in FIG. 2 is Q n (x n ′, y n ′), The relationship is established.
1) If y n ≠ y n-1 :
The slope α n of P n Q n with respect to the X axis is
From tanα n =-(x n -x n-1 ) / ( y n -y n-1 ), α n = tan -1 (-(x n -x n-1 ) / ( y n -y n-1 ))
(However, in the case of correction to increase the polishing amount, 0 ° ≦ α n <180 °)
Therefore, the new coordinates Q n (x n ', y n ') when correction is applied are
x n '= x n + Δ L・ cosα n
y n '= y n + Δ L・ sinα n
(Note that it is possible to apply -180 ° <α n ≦ 0 ° correction is also the direction in which the polishing amount decreases if you choose alpha n)
2) When y n = y n-1 :
Since the slope α n = 90 ° of P n Q n with respect to the X axis,
x n '= x n
y n '= y n + Δ L
Therefore, the X and Y axis position commands are corrected using the above positional relationship.
That is, in FIG. 1, the X-axis position command 22 generated from the X-axis position command generation circuit 14 is set by the X-axis
x n '= x n + Δ L・ cosα n (y n ≠ y n-1 )
x n '= x n +0 (y n = y n-1 )
As for the Y-axis, for Y-axis position command 22A generated from the Y-axis position command generating circuit 14A, by an
y n '= y n + Δ L · sinα n (y n ≠ y n-1)
y n '= y n + Δ L (y n = y n-1 )
By performing such processing for each scan of the controller, it is possible to obtain a free curve 42 obtained by correcting the free curve 41 in FIG. 2 only delta L.
[0007]
【The invention's effect】
As described above, according to the present invention, in a servo system using an electronic cam using a controller of a periodic scan execution method, trajectory correction is performed for any free curve generated by the electronic cam in response to a changing phase command. Functions can be realized.
[Brief description of the drawings]
FIG. 1 is a diagram showing an embodiment of the present invention. FIG. 2 is a diagram for explaining trajectory correction of a free curve. FIG. 3 is a diagram showing an example of a prior art.
10 controller 11, 11A servo drive 12, 12A servo motor 13, 13A pulse generator 21 phase command 141, 14A position command generation circuit 23, 23A position command 16, 16A position control gain 17, 17A D / A converter 18, 18A counter 31 Grinder 41 Reference free-curve locus 42 Free-form locus obtained by correcting the reference free curve by Δl
Claims (1)
前回スキャンの位置指令Pn-1(xn-1,yn-1)と今回スキャンの位置指令Pn(xn,yn)とから、XY平面内で∠ P n-1 P n Q n = 直角をなし 、 補正量が P n Q n = △ L となる位置を Q n (x n ',y n ') としたとき、 y n ≠ y n-1 の場合は、 x n '=x n + △ L・C0S α n 、 y n '=y n + △ L・sin α n 、とし(ただし、α n はX軸に対する P n Q n の傾きでα n =tan -1 (-(x n -x n-1 ) / (y n -y n-1 )) )、 y n =y n-1 の場合は、 x n '=x n +O 、 y n '=y n + △ L として前記 Q n (x n ',y n ') を求め、新たな前記工具の中心軌跡とすることを特徴とする自由曲線の軌跡補正方法。A tool using a servo system that generates X-axis and Y-axis position commands according to the transition of the position command θ and performs position tracking control based on the position commands for each scan of the controller of the periodic scan execution method In a trajectory control method for controlling the curve along a free curve,
From the previous scan position command P n-1 (x n-1 , y n-1 ) and current scan position command P n (x n , y n ) , ∠ P n-1 P n Q in the XY plane If n = right angle and the position where the correction amount is P n Q n = △ L is Q n (x n ', y n ') , then y n ≠ y n-1 , x n '= x n + △ L ・ C0S α n , y n '= y n + △ L ・ sin α n , where α n is the slope of P n Q n with respect to the X axis and α n = tan -1 (-( x n -x n-1 ) / (y n -y n-1 )) ), if y n = y n-1 , x n '= x n + O , y n ' = y n + △ L wherein Q n (x n ', y n') the determined locus correcting method for free curve, characterized in that the centroid of the new the tool as.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23442994A JP3698327B2 (en) | 1994-09-02 | 1994-09-02 | Trajectory correction method for free curve |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23442994A JP3698327B2 (en) | 1994-09-02 | 1994-09-02 | Trajectory correction method for free curve |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH0876825A JPH0876825A (en) | 1996-03-22 |
JP3698327B2 true JP3698327B2 (en) | 2005-09-21 |
Family
ID=16970884
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP23442994A Expired - Fee Related JP3698327B2 (en) | 1994-09-02 | 1994-09-02 | Trajectory correction method for free curve |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3698327B2 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103163822B (en) * | 2011-12-19 | 2015-09-16 | 苏州汇川技术有限公司 | electronic cam control device and method |
JP7095436B2 (en) * | 2018-06-27 | 2022-07-05 | オムロン株式会社 | Control devices, control methods, information processing programs, and recording media |
-
1994
- 1994-09-02 JP JP23442994A patent/JP3698327B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH0876825A (en) | 1996-03-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4980453B2 (en) | Servo control system for high-precision machining | |
US5303333A (en) | Method for controlling the acceleration and velocity of at least one controllable axis of a machine tool or robot | |
JPH11347983A (en) | Manipulator action limiting device | |
CN103454979B (en) | Quick variable-speed curve circular interpolation method packaged into PLCopen instruction | |
JP3698327B2 (en) | Trajectory correction method for free curve | |
JPH0378006A (en) | Acceleration and deceleration control method for numerical controller | |
JPH03281083A (en) | Attitude control system for cnc laser beam machine | |
CN107645979B (en) | Robot system for synchronizing the movement of a robot arm | |
JPH11231914A (en) | Numerical controller | |
JPH0962331A (en) | Movement command distribution method for servo control | |
CN111546329A (en) | Multi-joint robot servo gain consistency control method | |
JPH11194813A (en) | Operation command generating method for industrial machine | |
JPS6378206A (en) | Following delay removal method using digital servo system in full close feedback nc system | |
JP4515408B2 (en) | Positioning control device | |
JP3269541B2 (en) | Electronic cam phase control method | |
JP2650464B2 (en) | Industrial robot | |
JP2740691B2 (en) | Control method | |
JPS61136105A (en) | Shift controller of industrial robot | |
JP2001154719A (en) | Method for interpolating free curve | |
JPS58221673A (en) | Weaving teaching system of welding robot | |
JP2004185364A (en) | Numerical controller | |
JP2000222019A (en) | Mechanism controller | |
JPS59124561A (en) | Cam grinding method | |
JP2021086181A (en) | Orbit generator, automatic position control device and orbit generation method | |
JPS63146108A (en) | Servo-device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20050701 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080715 Year of fee payment: 3 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090715 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090715 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100715 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100715 Year of fee payment: 5 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110715 Year of fee payment: 6 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120715 Year of fee payment: 7 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130715 Year of fee payment: 8 |
|
LAPS | Cancellation because of no payment of annual fees |