선형 모터 스테이지의 주파수 영역 모델기반 모션 제어 설계

Hee Won Jeon; Hyeong-Joon Ahn

doi:10.7736/JKSPE.023.107

Articles

Page Path

REGULAR

선형 모터 스테이지의 주파수 영역 모델기반 모션 제어 설계

전희원¹, 안형준^2,#

Model-based Motion Control Design of a Linear Motor Stage in Frequency Domain

Hee Won Jeon¹, Hyeong-Joon Ahn^2,#

Journal of the Korean Society for Precision Engineering 2024;41(1):55-60.
Published online: January 1, 2024

DOI: https://doi.org/10.7736/JKSPE.023.107

¹숭실대학교 대학원 기계공학과

²숭실대학교 기계공학부

¹Department of Mechanical Engineering, Graduate School, Soongsil University

²School of Mechanical Engineering, Soongsil University

#E-mail: ahj123@ssu.ac.kr

• Received: August 31, 2023 • Revised: November 16, 2023 • Accepted: November 21, 2023

This is an Open-Access article distributed under the terms of the Creative Commons Attribution Non-Commercial License (http://creativecommons.org/licenses/by-nc/3.0) which permits unrestricted non-commercial use, distribution, and reproduction in any medium, provided the original work is properly cited.

109 Views
3 Download
3 Crossref
2 Scopus

prev next

Full Article

Download PDF

ABSTRACT
NOMENCLATURE
1. 서론
2. 선형 모터 모션 스테이지 제어
3. 주파수 영역 제어기 설계
4. 실험
5. 결론
ACKNOWLEDGMENTS
REFERENCES
Biography

ABSTRACT

The fourth industrial revolution led to advanced servo systems, enhancing productivity across industries. However, designing these systems remains challenging due to the performance-stability trade-off. This paper presents a model-based motion control of a linear motor motion stage in frequency domain. A user-code for the PowerPMAC commercial controller was developed to excite motion control system so that we could get a frequency response. The theoretical frequency response of the servo algorithm was compared with the experimental frequency response. Based on this, a tuning graphical user interface (GUI) was developed to predict performance when the servo loop gain is changed. Especially, to compensate for residual vibrations caused by high acceleration and deceleration and to improve tracking error, DOB (Disturbance Observer) and ILC (Iterative Learning Control) control techniques were applied in the frequency domain. Through the design of the frequency domain motion controller, the control performance of the linear motor motion stage could be predicted with over 96% accuracy, resulting in a 54.32% improvement in tracking error and a 93.56% improvement in settling time, 85.29% in RMS error.
KEYWORDS: Linear motor stage, Frequency domain, Motion controller, Tuning GUI, Disturbance observer, Iterative learning control
KEYWORDS: 선형 모터 스테이지, 주파수 영역, 모션 제어기, 튜닝 그래픽 인터페이스, 외란 관측기, 반복 학습 제어

NOMENCLATURE

Controller

C_d

Damping of Magnet Track

Disturbance

d ^{^}

Estimated Disturbance

Position Error

g_d

Cutoff Frequency of DOB

J_n

Nominal Inertia

K_i

Servo Integral Gain

K_s

Spring Coefficient

K_m

torque Coefficient

K_p

Servo Proportional Gain

K_T

Stiffness of Magnet Track

K_vfb

Servo Velocity Feedback Gain

K_vff

Servo Velocity Feedforward Gain

Learning Filter

M_n

Mass of Mover

Filter Order of DOB

Q Filter

Reference Input

t_d

Time Delay

u_c

Control Effort

u_s

Servo Out

Actual Position

1. 서론

4차 산업혁명과 함께 고성능의 서보 시스템이 개발되고 넓은 산업분야에 적용되어 생산성이 크게 향상되었다[1]. 반도체 노광 장비의 경우, 긴 스트로크를 빠른 속도로 움직여야 하고 1 nm의 정확도로 시간당 230개의 웨이퍼를 처리해야 하는 극한의 성능을 요구받는다[2]. 이때 제어 시스템의 성능과 안정성이 반비례 관계에 있기 때문에 서보 시스템을 잘 설계하는 것은 여전히 큰 과제이다[3,4]. Ohnish에 의해 고안된 외란관측기(DOB)는 제어 시스템 내부로 들어온 외란을 추정하여 보상해주는 제어기법으로[5], 간단한 구조로 인해 모션 제어 시스템에서 자주 사용된다. 특별히 고가감속 시 발생하는 잔류진동을 효과적으로 보상해줄 수 있기 때문에, 반발력 보상(RFC) 선형모터에 적용되었을 때 추종오차 및 정착시간을 크게 향상시킨다[6]. 반복학습제어(ILC)는 동일한 작업을 여러 번 수행하는 시스템에 적합한 제어기법으로, 추종오차를 반복 학습하여 제어 입력을 지속적으로 업데이트한다[7,8].

조율형(Integral) 구조의 모션 스테이지는 높은 성능으로 인해 산업 전반에 걸쳐 사용되지만 가격이 비싸고 목적에 적합한 별도의 제어전략을 적용하기가 어렵기 때문에, 조합형(Modular) 구조로 가격을 낮춤과 동시에 조율형 구조에서는 불가능했던 제어전략을 적용하여 성능을 높이고자 하는 연구들이 활발히 이루어지고 있다[6].

이 논문에서는 조합형으로 구성된 선형모터 모션 스테이지의 안정성 및 성능 향상을 위해 주파수 영역에서의 모델 기반 모션 제어 설계를 연구하였다. PowerPMAC 상용 제어기의 유저코드를 기반으로 모션 제어 시스템을 가진하여 주파수 응답을 측정하였고, PMAC Servo 알고리즘의 이론값과 실제값을 비교 검증하여 서보 게인 변화에 따른 개루프와 폐루프의 변화를 예측하였다. 이를 바탕으로 튜닝 그래픽 인터페이스(GUI)를 설계하여 새로운 게인값과 필터가 적용된 스테이지의 안정성 및 동적성능을 평가하였고, 고가감속으로 인해 발생되는 잔류진동과 추종오차를 보상해주기 위하여 모델을 기반한 외란관측기와 반복학습제어 기법을 주파수 영역에서 설계하여 적용하였다. 이후 제어기 성능을 평가하기 위하여 모션 프로파일을 구동하며 추종오차와 정착시간을 비교하였다.

2. 선형 모터 모션 스테이지 제어

2.1 선형 모터 모션 스테이지

선형 모터 모션 스테이지를 위한 제어 시스템을 Fig. 1과 같이 구성하였다. 공심형 리니어 모터(Justek, JTKL3638), 서보 드라이버(Servotronix, CDHD-006), 상용 모션 제어기(PowerPMAC)가 사용되었고 구성된 모션 스테이지는 580 mm의 스트로크, 208N의 연속 추력, 1 μm의 분해능, 5 m/s의 최대 속도, 50 m/s²의 최대 가속도의 성능을 지닌다.

Fig. 1

Control system of the linear motor motion stage

2.2 외란관측기(DOB)

선형 모터 모션 스테이지의 고가감속으로 인해 발생되는 잔류진동을 제어하기 위하여 Fig. 2와 같은 DOB를 적용하였고 공칭관성(M_n), 추력계수(K_m), 절점주파수(g_d)로 구성된다. 변수 r, y, e, u_c, u_s, d, d^{^}은 각각 위치입력, 위치출력, 추종오차, 제어노력, 서보출력, 외란, 추정외란을 의미한다. 모션 제어 시스템 내부로 들어온 잔류진동은 외란(d)으로 간주되고, 식(1)과 같이 모터의 속도(y˙)와 서보출력 값을 입력으로 받는 DOB를 거쳐서 최종적으로 식(2)와 같이 N차 저역필터를 거친 추정외란(d^{^})으로 출력된 후 제어입력으로 다시 들어가 외란의 영향이 상쇄된다. 특별히 이렇게 구조화된 DOB를 PMAC 서보 알고리즘과 함께 적용하면, 제어기의 전달함수를 도출할 수 있고 이론 주파수 응답을 통한 성능 예측이 가능하다.

Fig. 2

Disturbance observer schematic

(1)

d^=Kmus+Mngdy˙-Mngdy˙s+gdgdgds+gdN=Kmus-Mny˙sgds+gdN

(2)

=Kmus-Mny¨gds+gdN=d(s)gds+gdN

2.3 반복학습제어(ILC)

특정 모션 프로파일로 선형 모터 모션 스테이지를 반복 구동할 때, 오차가 발생하는 구간과 양상은 모두 동일하다. 이러한 점을 이용하는 ILC는 반복되는 오차를 학습하여 보상해주는 역할을 한다. 최초 모션 실행 시 발생한 오차(e_i)에 대한 제어 노력(u_ff,i)을 메모리에 저장해 두었다가 다음 모션 수행 시, 해당 값을 전향제어 입력하여 오차를 보상한다. 이후 동일한 구간에서 발생한 오차 값을 보상하기 위하여 이전 제어 노력(u_ff,i)과 현재 오차를 반영한 새로운 제어 노력(u_ff,i+1)을 학습하여 저장한다. 여기서 오차 크기에 대한 제어노력을 적응적으로 조절하기 위하여, 학습률을 상수가 아닌 가우시안 함수를 사용하여 정의하였다. 추종 오차로부터 전향제어 입력까지의 관계는 식(3)과 같이 표현되고 오차를 0으로 만들기 위해 설계되는 학습필터(L)의 수식은 식(4)와 같이 표현된다. 이때 P는 식별된 모델의 이론 값이고 식(5)의 Q는 저역 필터로, 필터 L의 차수를 맞춰주고 고주파로 인한 불확실성을 차단해주는 역할을 한다.

Fig. 3

Iterative learning control schematic

(3)

ei=-uff,i+CeiP

(4)

ei/uff,i=-P/(1+PC)=L

(5)

uff,i/ei=-Q(1+PC)/P=QL-1

3. 주파수 영역 제어기 설계

3.1 주파수 응답 측정

모션 제어 시스템을 구성하고 있는 서보 제어 및 전류 제어 그리고 플랜트의 영향을 통합적으로 고려하기 위하여 Fig. 4와 같이 PMAC 서보 알고리즘을 거치고 출력된 제어노력 값에 1-1,000 Hz의 다중 정현파 신호를 주입하여 모션 제어 시스템을 가진하였다. 가진신호를 주입하기 전의 제어노력 값을 입력, 가진신호를 주입한 후인 서보출력 값을 출력 값으로 하여 개루프의 주파수 응답을 측정하였다.

Fig. 4

Frequency response measurement

3.2 주파수 응답 기반 제어기 설계

주파수 영역 모델 기반 제어기를 설계하고 안정성 및 성능을 예측하기 위하여 Fig. 5와 같은 주파수 응답 기반의 튜닝 GUI를 설계하였다. DOB가 적용된 PMAC 서보 제어기의 이론 모델이 식(8)로 표현되고, Table 1의 튜닝 이전(Before) 제어이득을 가지는 제어기의 이론 주파수 응답(C_Th₁(jω))을 실제 주파수응답(C_Ex(jω))과 비교한 결과 Fig. 6와 같이 일치하기 때문에 식(6)이 성립하여 새로운 제어기의 이론 주파수 응답(C_Th₂(jω))을 식(7)과 같이 적용할 수 있다. 또한 주파수 응답 기반 ILC 적용을 위해 식(9)와 같은 선형 모터 모델과 Q 필터를 함께 적용하여 식(5)와 같은 학습필터를 설계한다. 이때 튜닝 GUI를 통하여 Fig. 7과 같이 모델의 이론 주파수 응답과 실제 주파수 응답을 비교하며 모델을 식별한다.

Fig. 5

Frequency response based tuning GUI

Table 1

PMAC servo tuning

Table 1
Variable	Before	After	Variable	Before	After
K_p	15	27	K_vfb	300	500
K_i	0.006	0.006	g_d	10	30
K_vifb	300	500	K_aff	0	25,000

Fig. 6

FRF of PMAC servo algorithm with DOB

Fig. 7

FRF of the plant (P(jω))

(6)

CEx(jω)≈CTh1(jω)

(7)

PCExjω×CTh2(jω)CTh1(jω)=PCTh2jω

(8)

Cs=-Kp+Kvifbs1+Kis+Kvfbs1-gds+gdN+Mns2Kmgds+gdN1-gds+gdN

(9)

Ps=1Ms2+Cds+Ks×12πdt⋅tds+1

(10)

Q = 1(τs+1)N

4. 실험

4.1 주파수 영역 설계 결과

튜닝 GUI를 통하여 얻어진 이론 기반 주파수 응답이 실제 주파수 응답을 잘 예측했는지 비교하기 위하여 개루프 주파수 응답을 각각 Fig. 8에 나타냈다. 그 결과 Table 2에서 보여주듯이 절점주파수는 99.62% 위상여유는 99.32% 이득여유는 96.07%의 정확성을 가졌다.

Fig. 8

Open-Loop FRF of the tuned controller

Table 2

Accuracy of the tuning GUI

Table 2
Performance	Prediction	Real	Accuracy
Bandwidth	52.8 Hz	53 Hz	99.62%
Phase margin	29.1^o	29.3^o	99.32%
Gain margin	9.54 dB	9.93 dB	96.07%

튜닝 전후로 적용된 제어 이득은 Table 1과 같고, 최종 53 Hz대역폭, 29.3^o 위상여유 그리고 9.93 dB 이득여유의 제어 시스템을 구성하였다. 모델이 가지는 100 Hz 이상 불확실성을 고려하여 Q 필터 차단주파수를 100 Hz로 선정하였다 ILC 필터 설계에 사용된 변수와 수식을 Table 3에 나타냈고, 주파수에 응답은 Fig. 9에 나타냈다.

Table 3

ILC design parameter

Table 3
Linear motor plant (P)
Variable	Value	Transfer function
M_n [kg]	6	10.005s3+6.02s2+4.7+3000
C_d [Ns/m]	2
K_s [N/m]	3,000
t_d [s]	1.1
ILC filter design (Q*P^-1)
Variable	Value	Transfer function
τ [s]	0.001	0.7s3+797.1s2+632.8s+8.2×108s3+1885s2+1.2×106s+2.4×108
N	2	0.7s3+797.1s2+632.8s+8.2×108s3+1885s2+1.2×106s+2.4×108

Fig. 9

Bode diagram of the ILC filter

4.2 모션 스테이지 성능 평가

설계된 모션 스테이지는 Fig. 10과 같이 모델 기반 DOB와 ILC가 함께 적용되었다. 성능 실험을 위해 Fig. 11과 같이 200 mm 스트로크, 250 mm/s 속도, 2,500 mm/s² 가속도의 모션 프로파일을 실행하였고 발생한 추종오차와 평균오차를 각각 Figs. 12와 13에 나타냈다. PIV만 적용하였을 때 보다 DOB와 ILC를 함께 적용하였을 때 추종오차가 54.32%, 정착시간이 93.56%, 평균오차가 85.29% 향상되었다.

Fig. 10

Motion control schematic

Fig. 11

Motion profile

Fig. 12

Following error comparison

Fig. 13

RMS error comparison

Fig. 14와 같이 모션을 반복할수록 제곱평균오차가 감소하였다. 모션을 30회 반복 수행하는 동안 Fig. 15와 같이 RMS 오차가 지속적으로 감소하지만 특정 구간(18, 21, 24, 25, 27, 30번째)에서는 오차가 증가하는 경우가 있다. ILC에 의해 저주파 오차는 제거되나 저역 통과 Q 필터 영향으로 고주파 오차는 잘 제거되지 않기 때문이다. 실제 모션을 반복하며 발생되는 추종오차 성분을 분석한 결과 Fig. 16과 같이 저주파수 성분은 줄어들지만 고주파 성분은 증가한다.

Fig. 14

ILC effort

Fig. 15

RMS error by iterations

Fig. 16

Acceleration FFT of following error

5. 결론

이 연구에서는 조합형으로 구성된 선형 모터 모션 스테이지의 모델기반 주파수 영역 모션 제어기 설계를 위하여, DOB가 적용된 PMAC 서보 알고리즘의 이론 주파수 응답과 실제 주파수 응답을 비교하고 검증하여 튜닝 GUI를 설계하였다. 추가적인 성능 향상을 위하여, 주파수 응답을 통해 식별된 모델을 바탕으로 ILC를 적용하였다. 설계된 GUI는 절점주파수를 99.62%, 위상여유는 99.32%, 이득여유는 96.07%의 정확도로 성능 및 안정성을 예측하였고, 주파수 영역 모델 기반으로 제어기를 설계하여 시행착오를 크게 줄일 수 있었다. 모션 프로파일을 통하여 설계된 제어기의 성능을 비교한 결과 모델 기반의 DOB와 ILC를 함께 적용하였을 때, 추종오차가 54.32%, 정착시간이 93.56%, 평균오차가 85.29% 향상되었다.

ACKNOWLEDGMENTS

이 연구는 산업통상자원부(한국산업기술평가관리원) 산업기술혁신사업(2021년도 소재부품기술개발사업)의 지원으로 수행되었음(20017202).

REFERENCES

1.
Chen, Z., Yao, B., Wang, Q., (2014), μ-Synthesis-based adaptive robust control of linear motor driven stages with high-frequency dynamics: A case study, IEEE/ASME Transactions on Mechatronics, 20(3), 1482-1490.
10.1109/TMECH.2014.2369454
Article
2.
Nguyen, D. C., Ahn, H. J., (2014), Dynamic analysis and iterative design of a passive reaction force compensation device for a linear motor motion stage, International Journal of Precision Engineering and Manufacturing, 15, 2367-2373.
10.1007/s12541-014-0602-8
Article
3.
Zhang, M.-G., Wang, X.-G., Liu, M.-Q., (2005), Adaptive PID control based on RBF neural network identification, Proceedings of the 17th IEEE International Conference on Tools with Artificial Intelligence (ICTAI'05), 3-683.
4.
Chen, Y., Yang, M., Long, J., Qu, W., Xu, D., Blaabjerg, F., (2019), A moderate online servo controller parameter self-tuning method via variable-period inertia identification, IEEE Transactions on Power Electronics, 34(12), 12165-12180.
10.1109/TPEL.2019.2909439
Article
5.
Murakami, T., Ohnishi, K., (1988), An advanced approach of servo control in industrial robot, Proceedings of the IEEE International Conference on Intelligent Robots and Systems, 1988, 379-384.
6.
Yoo, S. J., Ahn, H.-J., (2020), Software-based integral product architecture for modular motion control system of a RFC linear motor motion stage: Model-based DOB for residual vibration suppression, International Journal of Precision Engineering and Manufacturing, 21, 203-209.
10.1007/s12541-019-00212-y
Article
7.
Longman, R. W., (2000), Iterative learning control and repetitive control for engineering practice, International Journal of Control, 73(10), 930-954.
10.1080/002071700405905
Article
8.
Kim, D. H., Han, C. S., Kim, G. S., (1995), A force control of robot manipulator based on the iterative learning control, Proceedings of the Korean Society for Precision Engineering, 577-583.

Hee Won Jeon
Hyeong-Joon Ahn

Figure & Data

References

Citations

Citations to this article as recorded by

Disturbance Rejection and Robust Tracking Using a Compound Control Approach for RFC Linear Motor Motion Stage
Kyung Ho Yang, Hyeong-Joon Ahn
International Journal of Precision Engineering and Manufacturing.2026;[Epub] CrossRef
Fuzzy Neural Network Control for a Reaction Force Compensation Linear Motor Motion Stage
Kyung Ho Yang, Hyeong-Joon Ahn
International Journal of Precision Engineering and Manufacturing-Smart Technology.2024; 2(2): 109. CrossRef
Customized Current Control of a Linear Motor Motion Stage
Kyung Ho Yang, Hyeong-Joon Ahn
Journal of the Korean Society for Precision Engineering.2024; 41(11): 875. CrossRef

Cite

CITE

export

Copy Download

Format
XML Download

Download Citation

Download a citation file in RIS format that can be imported by all major citation management software, including EndNote, ProCite, RefWorks, and Reference Manager.

Format:

RIS — For EndNote, ProCite, RefWorks, and most other reference management software
BibTeX — For JabRef, BibDesk, and other BibTeX-specific software

Include:

Citation for the content below
Citation and abstract for the content below

Model-based Motion Control Design of a Linear Motor Stage in Frequency Domain

J. Korean Soc. Precis. Eng.. 2024;41(1):55-60. Published online January 1, 2024

DOI: https://doi.org/10.7736/JKSPE.023.107

Download Citation

Download a citation file in RIS format that can be imported by all major citation management software, including EndNote, ProCite, RefWorks, and Reference Manager.

Format:

RIS — For EndNote, ProCite, RefWorks, and most other reference management software
bib — For JabRef, BibDesk, and other BibTeX-specific software

Include:

Citation for the content below
Citation and abstract for the content below

Model-based Motion Control Design of a Linear Motor Stage in Frequency Domain

J. Korean Soc. Precis. Eng.. 2024;41(1):55-60. Published online January 1, 2024

DOI: https://doi.org/10.7736/JKSPE.023.107

Figure

Model-based Motion Control Design of a Linear Motor Stage in Frequency Domain

Fig. 1 Control system of the linear motor motion stage

Fig. 2 Disturbance observer schematic

Fig. 3 Iterative learning control schematic

Fig. 4 Frequency response measurement

Fig. 5 Frequency response based tuning GUI

Fig. 6 FRF of PMAC servo algorithm with DOB

Fig. 7 FRF of the plant (P(jω))

Fig. 8 Open-Loop FRF of the tuned controller

Fig. 9 Bode diagram of the ILC filter

Fig. 10 Motion control schematic

Fig. 11 Motion profile

Fig. 12 Following error comparison

Fig. 13 RMS error comparison

Fig. 14 ILC effort

Fig. 15 RMS error by iterations

Fig. 16 Acceleration FFT of following error

Fig. 1

Fig. 2

Fig. 3

Fig. 4

Fig. 5

Fig. 6

Fig. 7

Fig. 8

Fig. 9

Fig. 10

Fig. 11

Fig. 12

Fig. 13

Fig. 14

Fig. 15

Fig. 16

Model-based Motion Control Design of a Linear Motor Stage in Frequency Domain

Variable	Before	After	Variable	Before	After
K_p	15	27	K_vfb	300	500
K_i	0.006	0.006	g_d	10	30
K_vifb	300	500	K_aff	0	25,000

Performance	Prediction	Real	Accuracy
Bandwidth	52.8 Hz	53 Hz	99.62%
Phase margin	29.1^o	29.3^o	99.32%
Gain margin	9.54 dB	9.93 dB	96.07%

Linear motor plant (P)
Variable	Value	Transfer function
M_n [kg]	6	$\frac{1}{0.005 s^{3} + 6.02 s^{2} + 4.7 + 3000}$
C_d [Ns/m]	2
K_s [N/m]	3,000
t_d [s]	1.1
ILC filter design (Q*P^-1)
Variable	Value	Transfer function
τ [s]	0.001	$\frac{0.7 s^{3} + 797.1 s^{2} + 632.8 s + 8.2 \times 10^{8}}{s^{3} + 1885 s^{2} + 1.2 \times 10^{6} s + 2.4 \times 10^{8}}$
N	2

Table 1 PMAC servo tuning

Table 2 Accuracy of the tuning GUI

Table 3 ILC design parameter

Articles

Page Path

선형 모터 스테이지의 주파수 영역 모델기반 모션 제어 설계

Model-based Motion Control Design of a Linear Motor Stage in Frequency Domain

Full Article

ABSTRACT

NOMENCLATURE

1. 서론

2. 선형 모터 모션 스테이지 제어

Control system of the linear motor motion stage

Disturbance observer schematic

(1)

(2)

Iterative learning control schematic

(3)

(4)

(5)

3. 주파수 영역 제어기 설계

Frequency response measurement

Frequency response based tuning GUI

PMAC servo tuning

FRF of PMAC servo algorithm with DOB

FRF of the plant (P(jω))

(6)

(7)

(8)

(9)

(10)

4. 실험

Open-Loop FRF of the tuned controller

Accuracy of the tuning GUI

ILC design parameter

Bode diagram of the ILC filter

Motion control schematic

Motion profile

Following error comparison

RMS error comparison

ILC effort

RMS error by iterations

Acceleration FFT of following error

5. 결론

ACKNOWLEDGMENTS

REFERENCES

Biography

Figure & Data

References

Citations

CITE

Download Citation

Format:

Include:

Figure

Related articles

Fig. 1

Fig. 2

Fig. 3

Fig. 4

Fig. 5

Fig. 6

Fig. 7

Fig. 8

Fig. 9

Fig. 10

Fig. 11

Fig. 12

Fig. 13

Fig. 14

Fig. 15

Fig. 16

Table 1

Table 2

Table 3

ABOUT

BROWSE ARTICLES

EDITORIAL POLICIES

FOR CONTRIBUTORS