Contour Tracking Control Based on Extended State Observer for Multiaxis Motion System

In the contouring process, the trajectory generated by the computer numerical control (CNC) machine tool is a result of the multiaxis coordinated motion. /e contour error has a direct impact on the accuracy of the machined product. To obtain higher contouring accuracy of the multiaxis motion control system, this paper presents a cross-coupled control approach based on the extended state observer sliding mode control. First, a single-axis sliding mode controller is designed, and an extended state observer is used to estimate system disturbances and improve the system robustness. /en, the cross-coupled control approach handles the coordinated motion of multiple axes to improve the contour control accuracy. Next, a simulation study is conducted on the three-axis motion platform. Its result shows that the control algorithm is effective in reducing tracking errors and contour errors.


Introduction
With the rapid development of the modern industry, there is an increasing demand on higher accuracy for the multiaxis manufacturing systems. To improve the contouring accuracy, many experts and scholars are devoted to researching various single-axis tracking control strategies, thereby improving the contour motion control accuracy indirectly [1][2][3]. However, this conventional contour controller based on the single-axis uncoupled control cannot fundamentally solve the problem of contour control. For example, when an axis has a large error under disturbances, the other axes do not take necessary measures to reduce the impact of the performance degradation of the axis on the overall performance because they still consider that the axis works normally. erefore, to solve the shortcomings of such a single-axis uncoupled controller, it is necessary to introduce a coupled mechanism among multiple axes, with the contour error as the control target, to directly reduce the contour error and improve the contouring accuracy.
Karen proposed the cross-coupled control (CCC) to solve the contour motion problem of the two-axis feed system. On this basis, variable gain CCC is further proposed [4,5]. Since then, more research studies on optimized CCC have been reported [6][7][8][9][10]. In CCC, the multiaxis control system is considered as organic whole where internal components are interconnected. e error compensation is calculated using the relations between the axes and fed back to each single axis for correction, thereby improving the matching and coordination between the axes. By changing the open-loop to the closed-loop contour control, CCC achieves the purpose of contour control and improves the control accuracy of the system. e development of the contour control technology results in increased complexity of the cross-coupled controller enhanced robust stability, and better coordination, but the anti-interference capacity is less improved. e multiaxis motion platform is susceptible to external disturbances in the machining process, which affects the position accuracy and contour accuracy of the CNC machining system. erefore, this paper introduces an extended state observer (ESO) to estimate the disturbances and combines it with the sliding mode controller (SMC) to improve the position tracking accuracy of the single axis. Moreover, the cross-coupled controller is used to deal with the coordinated motion among the axes to ensure the accuracy of the contour control. e simulation study on the three-axis motion platform demonstrates that the approach can effectively reduce the impact of external disturbances, improve the coordination among the axes, and ensure the tracking accuracy and contour accuracy.

Contour Error Model
Mismatch of dynamic characteristics of each axis motor is the main cause of contour error [11]. is paper applies CCC to coordinate the motion of each axis. e contour error is calculated by selecting the appropriate CCC gain. en, the contour error compensation is assigned to each axis, respectively. erefore, it is critical to build a more accurate contour error model. For the noncircular arbitrary contour, literature [12] proposes an effective two-axis contour error vector estimation approach and further introduces the multiaxis contour error estimation. e diagram of 3-axis motion contour error vectors is shown in Figure 1.
P and R are actual position and reference position, respectively, e represents the tracking error between the reference position and the actual position, ε is the contour error, for the deviation between the actual position and the desired contour, and t is the normalized tangential vector. Because it is difficult to calculate the precise value of contour error in practice, the estimation of contour error ε is adopted. Contour error estimation ε depends on tracking error e and normalize tangential vector t; when tracking error ‖e‖ is small enough, the contour error ε can be closely approximated by the contour error estimation vector ε.
Define the normalized estimated contouring error vector n: which satisfies the following condition: e relation between η 1 and η 2 can be derived from the above condition: Combining formulas (3) and (5), according to the properties of the vector inner product, the following are obtained: in which the signs of η 1 and η 2 determine the direction of the normalized estimation contour error vector. Because the angle between the normalized estimated contour error and the tracking error is within the range [− 90°, 90°] and satisfies 〈n, e〉 ≥ 0, η 1 and η 2 can be further determined as It can be seen from Figure 1 and equation (1) that the estimated contour error vector ε is the inner product of the normalized estimated contouring error vector n and the tracking error vector e, that is, ‖ε‖ � 〈n, e〉. (8) erefore, the estimated contour error vector is ε � ‖ε‖ · n � 〈n, e〉 · n. (9) e magnitude of the estimated contour error vector can be regulated by the cross-coupled controller and compensated for each axis along the direction of the estimated contour error vector, wherein how much compensation is made for each axis is determined by the cross-coupled gain. erefore, the cross-coupled gain can be obtained directly from the normalized estimated contour error vector.
Let n � [n x , n y , n z ] T , and CCC gain C � [C x , C y , C z ] T can be expressed directly as e contour error is ε � C x e x + C y e y + C z e z .
Since this approach is efficient for coupling calculation of nonlinear contours, it is used to estimate the contour error coupled gain in the cross-coupled controller in this paper.

System Model
Of all permanent magnet synchronous motors (PMSM), the permanent magnet linear synchronous motor (PMLSM) is a special type of motor in which the stator is arranged in a straight line while the mover moves linearly along the stator direction. Driven by the electromagnetic force, the linear motor provides direct linear motion with the absence of a mechanical transmission mechanism, thus eliminating the additional mechanical losses. It features high efficiency and high motion control accuracy, which are ideal for the applications with linear motion control characteristics, such as precision machine tools and automated production lines.
PMLSMs which are perpendicular to each other are used to contour control the three-axis motion platform in this paper. e mechanical motion equation is where F e is the electromagnetic thrust, K f is the electromagnetic thrust coefficient, M is the total mass of the mover and the load carried by the mover, B is the viscous friction coefficient, v is the speed of the motor mover, _ v is the acceleration of the motor mover, and d is the external disturbance.
e motor position q and the motor speed v are selected as system state variables, and the state equation of PMLSM can be written as u � i q is the motor control input. e direct drive three-axis motion platform system model can be represented by three second-order differential equations:

Controller Design
In the actual machining process, the multiaxis motion control systems generally have uncertain nonlinearities, strong coupling, and external disturbances, which affect the position accuracy and contour accuracy of the CNC machining systems. erefore, to meet the machining accuracy requirement of the three-axis motion platform, this paper designs the controller from two aspects: single-axis position control and contour control. For the single-axis motion, an ESO-based sliding mode controller is used to improve single-axis position tracking accuracy and single-axis robustness is ensured. For the motion between axes, the CCC algorithm is used to improve contour control accuracy. e proposed contour error CCC scheme is shown in Figure 2. q x d ， q y d ， and q z d are the reference input position of x, y, and z axes, respectively, and q x ， q y ， and q z are actual output position of three axes. ε is the contour error. P x , P y , and P z represent the controlled object of three axes. e workflow is described as follows: (1) ree-axis tracking error e x , e y , and e z is obtained by the reference input and the actual output of each axis (2) ree-axis tracking errors are combined with the contour error gains C x , C y , and C z to obtain the contour error ε (3) ree-axis tracking errors are processed with the sliding mode controllers of x, y, and z axes, respectively, to obtain the control signals u x , u y , and u z (4) After processed by the cross-coupled controller, the contour error is combined with C x , C y , and C z to obtain the contour error compensation of each axis (5) By taking the sliding mode control amount and the actual output of each axis as the input signals of the ESO, the observations of the position signals, speed signals, and disturbance signals of the respective axis are generated and fed back to the SMC (6) u x , u y , and u z and the contour error compensation of each axis are superimposed as the total control amount which is applied on each axis actuator with perturbation; thus, the contour motion control is achieved.

Extended State Observer
Design. e single-axis motion control is susceptible to disturbance, thereby degrading the control performance. To solve this problem, an ESO-based disturbance compensation approach is proposed in this section. e basic idea for ESO is to take the disturbance quantity in the system as a state quantity and combine it with the original state variables to construct the extended state observations; then, we can use a few measurable data in the system model to estimate the external disturbances and system state information that cannot be measured. As a result, the impact of disturbances on the system can be traded off to improve the system's antidisturbance and robustness [13,14].
Assume the state variables x 1 � q and x 2 � v � _ q, and system (15) can be written as the following state equation: , and C � 1 0 .

Mathematical Problems in Engineering 3
e ESO is designed as follows: With this ESO, if t ⟶ ∞, obtain q ⟶ q, _ q ⟶ _ q, and d ⟶ d, where q, _ q, and d are observer states. σ > 0, and α 1 , α 2 , and α 3 are positive real numbers, and the polynomial s 3 + α 1 s 2 + α 2 s + α 3 satisfies the Hurwitz criterion. Define Characteristic equation of matrix A: en, By selecting α i (i � 1, 2, 3), make A satisfy the Hurwitz criterion.

Design of the Sliding Mode Controller Based on the Extended State Observer.
e sliding mode function is chosen as in which c > 0 and e � q − q d . Sliding mode controller based on the extended state observer is designed as en, the sliding mode controller can be written as Take the Lyapunov function as en, Obviously, take the appropriate value k, and ensure _ V ≤ 0.

Cross-Coupled Controller.
To improve the contouring accuracy, address the matching between the axes, and achieve interaxis coordinated control; the cross-coupled controller is introduced. e cross-coupled controller uses a PID control algorithm. e PID controller has a simple control algorithm and small computation amount. Furthermore, it can ensure the system real-time performance, effectively reduce the system contour error, and improve the contouring accuracy.

Experiments
To verify the effectiveness of the multiaxis contour error control approach proposed in this paper, a simulation test is conducted, in which three PMLSMs are used as the control objects of the three-axis CNC system, and the 3D saddleshape curve and screw-shape curve are selected for validation. e multiaxis CNC system is susceptible to disturbances.
To reduce the impact of disturbance and improve the tracking accuracy, the sliding mode control algorithm is applied to each axis; the disturbance on each axis is observed by an ESO. Control system objects and controller parameters are shown in Table 1.
Simulation results are shown in Figure 3. Figure 3(a) shows the saddle-shape curve output in the three-dimensional space, and Figure 3(b) shows x, y, and z three-axis's position tracking, where the solid line is the single-axis desired trajectory, and the dotted line is the actual motion trajectory. Figure 3(c) is contour error, Figure 3(d) is the perturbation on three axes and its observation, and Figure 3(e) is the varying cross-coupled gains.
It can be seen from the simulation results Figures 3(b) and 3(d) that the uniaxial position is well tracked with the proposed single-axis sliding mode control algorithm, and the disturbances of each axis are effectively estimated with the extended state observer. Meanwhile, with the presence of the cross-coupled controller, the contour curve is well tracked. ere is only a small contour error in the initial stage. is can be easily seen by comparing the input and output of the 3D saddle curve.
For comparison, the extended state observation for the disturbances is cancelled, and tracking error and contour error simulation results are shown in Figure 4.
It can be seen that, after canceling the extended state disturbance observation, both the single-axis tracking error and the overall contour error are significantly increased, and Mathematical Problems in Engineering   the control performance is degraded obviously. e comparison of specific error values is shown in Table 2.
From the error comparison table, it can be intuitively found that, with the presence of the extended state disturbance observation, the single-axis tracking error is significantly smaller than that with the absence of the disturbance observation. e average tracking error of the x axis drops to 10.19% from 0.0206 to 0.0021; the average tracking error of the y axis drops to 42.42% from 0.0034 to 0.0014; and the average tracking error of the z axis drops to 56.4% from 0.0039 to 0.0022. e contour error is reduced significantly. e maximum contour error is reduced from 0.4650 to 0.1057, the average contour error is reduced from 0.2004 to 0.012, and the contour accuracy is improved by 16.7 times.
To further reflect the effectiveness of the control algorithm, we choose another 3D screw-shape curve for simulation analysis.
Case 2. Screw-shape curve is selected for simulation analysis. e desired curve is starting from (3,0,0).
x � 3 cos(πt)(mm), y � 3 sin(πt)(mm), Simulation results are shown in Figure 5. Figure 5(a) shows screw-shape curve contour tracking, and Figure 5(b) shows x, y, and z three-axis's position     Figure 5(c) is contour error, Figure 5(d) is the perturbation on three axes and its observation, and Figure 5(e) is the varying cross-coupled gains. e results from the screwshape curve simulation show that the proposed crosscoupled controller based on the ESO sliding mode control algorithm not only produces better single-axis tracking performance but also well tracks the contour curve. e simulation error of the screw-shape curve is shown in Table 3.
In short, the simulation results of the saddle curve and screw curve can effectively validate the effectiveness of the proposed control approach.

Conclusions
For the multiaxis linkage control system using the three-axis PMLSM servo drive, a contour error control algorithm based on the extended state disturbance observation is proposed to effectively reduce tracking error and contour error. e ESO can observe the disturbance signals to reduce the impact of the disturbances. Combine ESO with the sliding mode control algorithm to form the single-axis trajectory tracking controller with an aim of ensuring single-axis tracking accuracy and robustness. Moreover, the cross-coupled controller is applied to handle interaxis coordinated motion, make correction and compensation for the contour error of each axis, and improve dynamic performance and parameter matching of the system to ensure contour control accuracy. Next, the control algorithm is applied to the three-axis motion platform. e saddle curve contour and spiral curve contour are selected for simulation research. e results validate the effectiveness of the control algorithm.

Data Availability
e data used to support the findings of this study are included within the article.