Abstract
The accuracy of feedforward control model including system time-delay significantly affects the position tracking performance in a precision motion system. In this paper, an iterative tuning method for feedforward control with precise time-delay compensation is proposed. First, considering system time-delay from actuator, sensor, calculation, and communication in real platform, a feedforward control model with time-delay compensation is established, and a nonlinear objective function with time-delay is designed based on the measured data of a finite time task, to minimize the position tracking error. Second, in order to deal with both the nonlinear objective function and also unknown disturbances and noise in the real system, an optimization strategy combining the Gauss–Newton iterative (GNI) scheme and instrumental variable (IV) is proposed to realize the unbiased estimation of the feedforward parameters and precise delay time. Finally, with the identified feedforward control parameters, the precise system time-delay which is a nonintegral multiple of the sampling period is compensated accurately for the feedforward control with accurate path planning time-shift in the implementation. The effectiveness of the proposed feedforward parameter tuning and precise time-delay compensation scheme is verified by the simulation and also experimental result on a precision motion platform with obvious position tracking performance improvement.
1. Introduction
In real control systems, the sensors, actuators, data communication, and signal processing can all generate some time-delay [1, 2]. Without compensation, the time-delay will lead to reduced system control bandwidth, will lead to slow response and even affects the system stability. On the one hand, the characteristics of time-delay can also be utilized in the active vibration absorber to obtain better vibration suppression performance [3, 4]. In precision motion systems, the feedforward control is introduced to compensate the time-delay by injecting the control signal in advance [5], which can significantly improve the tracking accuracy. This feedforward method is widely used in the high-speed and high-precision motion control systems such as photolithography equipment [6, 7], machine tool [8], and atomic force microscope system [9].
The parameter accuracy of the feedforward control significantly affects the control performance of the precision motion system [10]. In the feedback-feedforward control structure, when the feedforward model is equal to the inverse of the controlled plant, the position error can be effectively compensated. The model-based feedforward control is commonly used in the motion system, but it needs to determine the precise model of the plant in advance. When the system performs a finite time task, such as point-to-point motion, the measured data contains the knowledge of the plant. Based on this, the iterative feedforward tuning (IFT) [11, 12] method utilizes the measured data to optimize the feedforward parameters without the need for detailed knowledge of the plant. In the IFT method, the least square (LS) method based on instrumental variable (IV) is adopted to eliminate the effect of noise unrelated to the input signal, and the unbiased estimation of feedforward parameters is obtained. It can be seen that the IFT establishes a connection between the feedforward tuning and closed-loop system identification and clarifies the direction of feedforward parameter regulation. In terms of parameter estimation variance, an iterative refined instrumental variable is constructed to achieve optimal accuracy [13, 14], and the Kalman filtering (KF) approach is introduced into the IV-IFT framework, which enables unbiased parameter estimation with zero asymptotic variance [15]. Then, the IFT is extended to flexible motion systems. For the non-minimum phase system, the stability problem of model inversion is solved by the input shaping method [16, 17]. The unbiased parameter estimation with optimal accuracy in terms of variance is obtained for feedforward controllers with a rational basis [18], and the feedforward control with rational basis functions can enable higher performance and more enhanced extrapolation capabilities than polynomial basis functions [18, 19]. A high-order IFT algorithm is proposed by introducing the iterative domain into the IFT, and IV is also employed to tolerate the noise data [6].
The inherent time-delay in precision motion systems causes nonlinearity issue. In existing IFT methods, the linear feedforward model is adopted, which does not solve the coupling problem between the delay time and model parameters. Besides, the LS cannot be directly used in the nonlinear system with time-delay [20], so the tuning accuracy of feedforward parameters cannot be guaranteed. In addition to LS, the gradient-descent method (GD) is used to tune a feedforward controller with force ripple compensation [21]. The Newton iterative (NI) method is used to tune the feedforward controller iteratively for non-minimum phase systems [16] and design a feedforward controller for multi-input multioutput systems [7]. These two methods are suitable for the feedforward tuning of nonlinear systems, but they cannot deal with disturbances in real systems.
Many methods are proposed to identify the delay time. The Bode diagram of the plant can be used to fit the delay time [22, 23]. The time-delay term is linearly parameterized by Taylor expansion, and a new adaptive law is constructed to identify the delay time [20]. Then, an approximate nonlinear LS is proposed to simultaneously estimate the delay time and dynamic parameters in the continuous system [24]. Moreover, the Pade approximant is applied to replace the time-delay to realize parameter estimation [25]. In addition, the Newton iterative and separable methods are applied to identify the delay time of nonintegral multiple period for the discrete system [26]. Therefore, the approximate linear transformation is a key step to realize the identification of the time-delay.
As we can see, the existing IFT based on IV is not suitable for nonlinear systems with time-delay, and the feedforward adjustment method based on GD and NI cannot deal with disturbances in real systems. To solve these problems, this paper presents a precise parameter tuning method of feedforward control with time-delay compensation. The main contributions of this paper are as follows: (1) fully considering the comprehensive system time-delay from actuator, sensor, calculation, and communication in real platform, a nonlinear objective function is proposed based on the measured data of a finite time task for iterative tuning of the feedforward parameters, to minimize the position tracking error; (2) in order to handle the proposed nonlinear objective function and also tolerate unknown disturbances and noise in real system, a desired optimization strategy combining the Gauss–Newton iterative (GNI) scheme and instrumental variable (IV) is proposed in this paper to realize the unbiased estimation of the feedforward parameters and precise delay time, which is the key innovation of this paper; (3) the identified precise system time-delay which is a nonintegral multiple of the sampling period, is exactly compensated in the feedforward control with accurate path planning time-shift. The simulation illustration and experimental validation demonstrate the advantages of the proposed control strategy.
The paper is organized as follows: in Section 2, the mathematical model of the feedforward controller with time-delay compensation is established, and a feedforward parameter tuning method considering the time-delay is elaborated; in Section 3, a discrete realization method of feedforward control with time-delay compensation is proposed; in Sections 4 and 5, the effectiveness of the proposed method is verified in the simulation example and experiment on an air floating precision motion platform.
2. Iterative Tuning Method of Feedforward Parameters with Time-Delay
In order to achieve the position tracking control, a feedback-feedforward control system is established in this paper, as shown in Figure 1. The error signal between the reference position and the feedback position is processed by the feedback controller to generate the control signal, which is loaded on the motor to generate thrust and the controlled plant moves. The measured position is fed back to the loop to build the closed-loop control, which realizes the position tracking control on the premise of ensuring the stability of the system, and has the ability of restraining the disturbance. On this basis, the feedforward control improves the position tracking accuracy by adding an input signal in the forward channel.
In Figure 1, the unknown controlled plant is a single-input single-output (SISO) and continuous time-invariant system with time-delay, and is considered with unit numerator for motion systems with dominant rigid-body dynamics [6, 11, 13]. is the feedback controller, and is the feedforward controller. denotes the reference position and is a known third-order multisegment polynomial trajectory, is the feedback control signal, and is the feedforward control signal. The unknown disturbance is assumed to be given by , where is the normally distributed white noise with zero mean and variance , is the shaping filter that makes a colored noise; and hence, and are uncorrelated. In a finite time task [11], the planned path is input to the system and the system implements point-to-point motion, is the measured position error signal, and is the position signal.
From Figure 1, the position error is , where , where the Laplace transform symbol is omitted. It shows that when the feedforward controller is equal to the inversion of the plant , in the error is zero and this is the goal of the feedforward parameters tuning.
2.1. Feedforward Control Model
In order to realize the feedforward control and tune the feedforward parameters, the mathematical model of the feedforward controller is established. Considering the time-delay in the system, the time-advance term is introduced in the linear parametric model [11–17] and is parameterized as follows:where can be determined by means of a model order selection procedure [27]. are the feedforward parameters, and is the delay time. The feedforward parameters vector is .
2.2. Feedforward Parameter Tuning Method
In this method, the feedforward parameters are tuned iteratively by using the measurement data of the finite time task of the system to achieve the feedforward control goal. In a task, the system starts from the static state and executes point-to-point motion to obtain the complete motion data. The measured signal vector in each task is defined as , where is a measurement at time instant for , where is the sampling time and N is the number of sampling.
In the th task, the feedforward controller is ; from equation (1), we obtain
And is known but may not be equal to the plant parameters. The task is executed, and the measured signals and are given by
In , the error caused by the reference is and the error caused by the disturbance is . In , the position caused by the reference is and the position caused by the disturbance is .
Then, as shown in Figure 2, the feedforward parameters are tuned, and the iterative format iswhere is the feedforward correction vector, are the feedforward parameters corrections, and is the delay time correction, which constitute the feedforward correction model . In a linear system, is a linear superposition of and [11, 12]. Here, is nonlinearly parameterized and the feedforward parameters and delay time need to be superimposed separately.
Next, an objective function is established by the measurement data and to calculate the feedforward parameter correction vector .
2.2.1. Objective Function for Feedforward Parameter Identification
The objective function is established based on the measured data, and the correction vector can be obtained by minimizing . Then, is updated to to minimize the position error.
First, the residual vector is established based on the measured data. In order to associate the measured data with , is introduced into equation (4), which contains . Assuming the disturbance , equations (3) and (4) can be transformed into
The following formula can be obtained by subtracting equation (7) from equation (6):
Then, is introduced to filter the left polynomial of equation (8), which can avoid the calculation of the transfer function inversion, the differential term, and the advance term, and the residual vector is defined aswhere and the time-delay and can be approximated by first-order Pade polynomial [25].
Based on the residual vector, is established as follows:
The optimization problem is . When is minimized, the residual vector will be zero without considering the disturbance and modeling error. Since is derived from equation (8), can be obtained from the right side of equation (8) equal to 0; that is, the feedforward parameters after tuning can be equal to the true plant parameters. Then, in the next task, , the position error is minimized, and the feedforward control goal is achieved.
2.2.2. Iterative Identification of Parameters
After the definition of the objective function, the Gauss–Newton iteration method based on instrumental variable (IV-GNI) is proposed to realize the unbiased estimation of the feedforward correction vector .
According to GNI, is constructed by introducing the parameter variation into . Through the first-order Taylor expansion, becomes a linear function of :where is the derivative of with respect to :
To minimize , can be calculated by making the derivative of zero:which is in the form of LS [27, 28]. Then, can be identified iteratively based on . Let be the th estimate of , and the iterative form is given bywhere can be obtained by equation (13) based on the known :In the above formula,
In this method, the optimization of is transformed into the optimization of , which is an ingenious transformation.
From equations (3) and (4), and are constructed based on , which provides a persistence of excitation condition and ensures that is nonsingular, so exists. As the motion starts from the static state and the initial state is 0, it will not affect the identification of parameters. In the iteration, the initial value is selected as , which is located in the convex interval of the objective function containing the required extreme points, so that the algorithm can converge to the correct value. See Appendix for the proof process.
The influence of the disturbance in the measured data on is explained below. In Figure 1, contains the random disturbance in the system and the unmodeled factors when establishing the feedforward model. From equation (16), we can get and , where
According to equation (15), based on the measured data with disturbance, we can get , and the matrix inversion formula is used in the derivation [27, 28], wherein which is determined by the system parameters and is not affected by the disturbance, which is accurate. However, due to the presence of , cannot be obtained directly. The reasons are as follows: the mathematical expectation of is . It can be seen from equations (17) and (18) that contains and , where the reference is auto-correlated, and contains and , where is autocorrelated, so that there exists . Therefore, when the disturbance exists, obtained by the Gauss–Newton iterative method cannot be guaranteed to be the unbiased estimate of .
Since equation (15) has the least square calculation format, the instrumental variable method in linear system identification can be employed to eliminate the deviation caused by the disturbance . The instrumental variable is introduced, which is the same dimension as and satisfies the following limit characteristics: and , in which is nonsingular. That is, needs to be independent of and is strongly correlated to and in . Obviously, the ideal choice is , but cannot be obtained when . Since both and are correlated to , one choice of is , which can meet the limit characteristics.
From equation (15), we can get , and is introduced to obtain . Then, the IV estimate of is . According to the limit characteristics of , we can get
That is, the instrumental variable eliminates the deviation caused by the disturbance and is the consistent estimate of . When the number of measured data is large enough, has an unbiased estimation characteristic. Therefore, obtained by the iteration in equation (14) based on is also the unbiased estimation of the feedforward parameter correction vector , which can minimize . Since is calculated by a complete finite time task data, the whole tuning procedure is conducted offline.
Based on the above optimization for , the iterative tuning of feedforward controller can be executed. The flow chart of iterative tuning of feedforward parameters is shown in Figure 3, and the procedure is as follows:(1), the current feedforward controller is , measures and with applied to the system.(2)Iterative calculation of . As shown in Figure 3, when , set the initial correction vector . Construct and from equation (16) and introduce the instrumental variable ; solve , and then, in the next iteration, . If each element in converges to its stable value, the iterative calculation of ends and proceeds to the next step. Otherwise, , and repeat this step.(3)Construct the new feedforward controller , and this adjustment is completed. Then, set and proceed from step 1.
In this section, the iterative tuning method of the feedforward parameters in the motion system with time-delay is elaborated. A nonlinear objective function is established based on the measured data and of a single finite time task, and the IV-GNI method is proposed to identify unbiased feedforward parameters and delay time with the presence of disturbance. Then, the feedforward parameters are tuned iteratively to match the tuned feedforward controller with the inverse model of the plant, so as to minimize the position error and achieve the optimal feedforward control performance.
3. Realization Method of Feedforward Control with Precise Time-Delay Compensation
Discrete signals are utilized in the digital control system, and the control period is . The realization method of feedforward control is explained by taking as an example in equation (1). The feedforward control signal is , where , , and are the position, velocity, and acceleration inputs in the feedforward control, respectively, and is the delay time. The control block diagram is shown in Figure 4. At time , the system reference position is the planned signal , and , , and are , , and , respectively, which are ahead of time period . Then, they are introduced into the feedforward model to generate the feedforward force, which can make the plant reach the reference position, and thus realize the feedforward control with time-delay compensation, so as to improve the control performance.
The ahead planning of the position by accurate path planning time-shift is explained below. The delay time may be a nonintegral multiple of period, which satisfies and is a nonnegative integer. As shown in Figure 5(a), the continuous time position (the thick black line) is obtained by the position planning function [29] and it is shifted to the left by along the time axis to obtain (the thick blue line), which realizes . At the sampling time , (the fine black line) is , and (the fine blue line) is , which are the discrete position signals received by the system. In fact, the desired signal processed by the actual lead-time term is (the dotted red line), i.e., shifting to the left by , but each point of is not at the sampling time, which cannot be obtained. Here, there are errors in approximating with , but since the system runs periodically, the errors cannot be eliminated. In [30], the position signal with lead time of integer multiple of period is obtained first and then delayed by means of calculation to realize the lead-time of noninteger multiple of period. In comparison, the method by path planning time-shift does not need delay calculation, which is more convenient to implement in one step. The lead or lag is a relative relationship in time and can be converted into each other. Thus, can be realized by the delay planning of relative to ; that is, . As shown in Figure 5(b), at the sampling time , is planned as and is planned as . Thus, the lag of the reference position signal is realized, and the same effect can be achieved. The lead time of the feedforward signal and relative to the reference signal can also be implemented by this method to complete the feedforward control.
(a)
(b)
4. Simulation Analysis
In this section, the simulation is implemented to verify whether the feedforward model obtained by the proposed algorithm matches the inverse of the controlled plant. Three controlled plants with time-delay, a mass model, a mass damping model, and a mass stiffness damping model, are considered separately in the simulation, and the feedback-feedforward control system is shown in Figure 1. The feedforward model is established, and the initial parameters are given. Then, the Gauss–Newton iterative method based on instrumental variable is used to identify and tune the feedforward parameters with the measurement data of the finite time task. Finally, the feedforward control model with delay compensation is introduced into the system for control performance improvement. Meanwhile, the parameter accuracy of the proposed algorithm is compared with several existing tuning algorithms.
4.1. Simulation 1
In simulation 1, a mass model with time-delay is considered and the plant is given by
It is introduced into the control loop, and the control period is set as 1 ms. The feedback controller is a PID controller, and , where , , and , which enables the system with bandwidth of 129.6 Hz, phase margin of 35.6°, and amplitude margin of 6.3 dB.
4.1.1. Simulation Illustration of Feedforward Parameter Tuning Method
Firstly, according to the parameterization method in Section 2 and the model of plant, the feedforward controller is parameterized as . The initial feedforward controller is , and the initial parameters are and , which are given based on the rule that it should be smaller than the plant parameters according to Appendix.
In a finite time task, the system reference position is a third-order point-to-point motion path, as shown in Figure 6. Since contains , (the solid black line) is delayed by 0.6 ms relative to (the dashed blue line) by the method of path planning in Section 3, so the acceleration in feedforward control is advanced relative to . Then, the control system with acceleration and time-delay feedforward is implemented.
(a)
(b)
(c)
(d)
The task is executed, and the feedforward correction parameters are identified based on the measured data. Since the key step is the calculation of the feedforward correction parameters in the proposed tuning method and the existing IFT methods, is calculated by IV-GNI in the proposed method and by NI and IV-LS in the existing IFT, respectively. Then, the results are compared to elaborate the applicability of these methods.
In order to verify the ability of the proposed identification algorithm to tolerate the disturbance, the simulation analysis is carried out in two cases:(1)In the case of disturbance No disturbance is introduced into the system, and (the black line in Figure 7(a)) is obtained by IV-GNI. For comparison, the Gauss–Newton iteration method is adopted to calculate directly by the measurement data and (the blue line) is obtained by equation (14). Then, (the magenta line) and (the green line) are obtained by the Newton iterative method and the least square method based on instrumental variable in existing IFT. Since the linear model is established in IV-LS, the delay time cannot be calculated. The results are also shown in Table 1.(2)In the case of The disturbance is introduced into the system. Similar to the disturbance as present in [11, 12], is a normally distributed white noise with zero mean and variance , and . , , , and are calculated, and the results are shown in Figure 7(b) and Table 2.
(a)
(b)
From the above results, we can get the following: (1) when , each value in converges to the corresponding correct value, and , which are the difference values between the plant parameters and the initial feedforward parameters. It is shown that the optimization scheme in Section 2 is effective and the IV-GNI method is also applicable in the case without disturbance. As the path planning time-shift method is employed to realize in , its validity is indirectly proved. and are equal to the accurate values, indicating that GNI and NI can also be used in this case. The stable value of is 0.483, the deviation from its accurate value is 0.017, and the delay time cannot be calculated, which shows that IV-LS is not suitable for the identification of the nonlinear system with time-delay. (2) When , the stable values of , , and are 0.479, 0.485, and 0.484, and the deviations from the accurate value are 0.021, 0.015, and 0.016. The stable values of and are 0.00929 and 0.00584, and the deviations from the accurate value are 0.00819 and 0.00474. The stable values of are equal to the accurate values. It shows that GNI and NI cannot deal with the disturbance, which will lead to the identification deviation. The stable values of with and without disturbances are basically equal, which means that the instrumental variable eliminates the effect of disturbance, but IV-LS cannot calculate the delay time. The introduction of IV in GNI is feasible, which has the ability to tolerate the disturbance, and the unbiased estimation of can be obtained.
Finally, the feedforward parameters are tuned. The feedforward controller is updated to according to equation (5) with , which is equal to the inverse model of the plant in equation (20), so the feedforward tuning is completed and the effectiveness of the feedforward parameter tuning method is verified.
4.1.2. Feedforward Control Results in Simulation 1
Based on the realization method of the feedforward control in Section 3, the tuned feedforward controller is introduced into the system to obtain the position error without disturbance injection.
In Figure 8, the position error of the feedback control is shown by the black line, and the position error after introducing acceleration as well as velocity feedforward is shown by the dashed blue line; it can be seen that the position error decreases obviously after the feedforward control is introduced and the maximum error is reduced from to .
In Figure 9, the position error without the time-delay compensation in the feedforward control is shown by the black line, and the position error with the time-delay compensation is shown by the dashed blue line. It can be seen that the tracking accuracy is further improved by introducing the time-delay compensation. The error of nonzero jerk segment is greatly reduced, and the maximum error is reduced from m to m, which means the impact effect caused by jerk segment is mitigated and the time-delay feedforward compensation method in Section 3 is effective.
4.2. Simulation 2
In simulation 2, a mass damping model with time-delay is considered and the plant is given by
The control period is set as 1 ms. The feedback controller is a PID controller and , where , , and , which enables the system with a bandwidth of 67.6 Hz, phase margin of 34.6°, and amplitude margin of 7.2 dB.
4.2.1. Simulation Illustration of Feedforward Parameter Tuning Method
Firstly, the feedforward controller is parameterized as . The initial feedforward controller is . In a finite time task, the system reference position is a third-order point-to-point motion path, as shown in Figure 10. Since contains , (the solid black line) is delayed by 1.3 ms relative to (the dashed blue line) by the method of path planning in Section 3, so the acceleration and velocity in feedforward control are advanced relative to . Then, the control system with acceleration, velocity, and time-delay feedforward is implemented.
(a)
(b)
(c)
(d)
The task is executed, and the feedforward correction parameters are identified based on the measured data. Similar to simulation 1, are calculated by IV-GNI in the proposed method and by NI and IV-LS in the existing IFT, respectively. The simulation analysis is also carried out in two cases with and without disturbance.
No disturbance is introduced into the system, and the results of , , , and are shown in Figure 11(a) and Table 3. Then, the disturbance is introduced into the system and is a normally distributed white noise with zero mean and variance and . The results are shown in Figure 11(b) and Table 4.
(a)
(b)
From the above results, we can get the following: (1) when , each value in converges to the corresponding correct value: , , and . It is shown that the optimization scheme in Section 2 is effective and the IV-GNI method is also applicable in the case without disturbance. As the path planning time-shift method is employed to realize in , its validity is indirectly proved. and are basically equal to the accurate values, indicating that GNI and NI can also be used in this case. The stable values of and are 0.0107 and 0.0330, and the deviations from the accurate values are 0.0193 and 0.003; the delay time cannot be calculated, which shows that IV-LS is not suitable for the identification of the nonlinear system with time-delay. (2) When , the stable values of , , and are 0.0410, 0.0401, and 0.0109, and the deviations from the accurate values are 0.0110, 0.0101, and 0.0191. The stable values of , , and are 0.0259, 0.0265, and 0.0328, and the deviations from the accurate values are 0.0041, 0.0035, and 0.0028. The stable values of and are 0.00761 and 0.00624, and the deviations from the accurate values are 0.00601 and 0.00464. The stable values of are basically equal to the accurate values. It shows that GNI and NI cannot deal with the disturbance, which will lead to the identification deviation. The stable values of with and without disturbance are basically equal, which means that the instrumental variable eliminates the effect of disturbance, but IV-LS cannot calculate the delay time. The introduction of IV in GNI is feasible, which has the ability to tolerate the disturbance, and the unbiased estimation of can be obtained.
Finally, the feedforward parameters are tuned. The feedforward controller is updated to according to equation (6) with , which is basically equal to the inverse model of the plant in equation (21), so the feedforward tuning is completed and the effectiveness of the feedforward parameter tuning method is verified.
4.2.2. Feedforward Control Results in Simulation 2
Based on the realization method of the feedforward control in Section 3, the tuned feedforward controller is introduced into the system to obtain the position error without disturbance injection.
In Figure 12, the position error of the feedback control decreases obviously after the acceleration and velocity feedforward control is introduced, and the maximum error is reduced from to .
In Figure 13, the tracking accuracy is further improved by introducing the time-delay compensation. The error of nonzero jerk segment is greatly reduced, and the maximum error is reduced from to , which means the impact effect caused by jerk segment is mitigated and the time-delay feedforward compensation method in Section 3 is effective.
4.3. Simulation 3
In simulation 3, a mass stiffness damping model with time-delay is considered and the plant is given by
The control period is set as 1 ms. The feedback controller is a PID controller and , where , , and , which enables the system with a bandwidth of 151.5 Hz, phase margin of 36.2°, and amplitude margin of 6.28 dB.
4.3.1. Simulation Illustration of Feedforward Parameter Tuning Method
Firstly, the feedforward controller is parameterized as . The initial feedforward controller is . In a finite time task, the system reference position is a third-order point-to-point motion path, as shown in Figure 14. Since contains , (the solid black line) is delayed by 0.7 ms relative to (the dashed blue line) by the method of path planning in Section 3, so the acceleration , velocity , and position in feedforward control are advanced relative to . Then, the control system with acceleration, velocity, position, and time-delay feedforward is implemented.
(a)
(b)
(c)
(d)
The task is executed, and the feedforward correction parameters are identified based on the measured data. Similar to simulation 1, no disturbance is introduced into the system, and the results of , , , and are shown in Figure 15(a) and Table 5. Then, the disturbance is introduced into the system and is a normally distributed white noise with zero mean and variance , and . The results are shown in Figure 15(b) and Table 6.
(a)
(b)
From the above results, we can get the following: (1) when , , , and are basically equal to the correct values,, , , and , indicating that IV-GNI, GNI, and NI can be used in the case without disturbance. As the path planning time-shift method is employed to realize in , its validity is indirectly proved. The stable values of , , and are 2.64, 2.56, and 1.25, and the deviations from the accurate values are 0.64, 0.44, and 0.05; the delay time cannot be calculated, which shows that IV-LS is not suitable for the identification of the nonlinear system with time-delay. (2) When , the stable values of , , and are 1.88, 1.89, and 2.79, and the deviations from the accurate values are 0.12, 0.11, and 0.79. The stable values of , , and are 3.07, 3.07, and 2.46, and the deviations from the accurate values are 0.07, 0.07, and 0.54. The stable values of , , and are 1.18, 1.18, and 1.26, and the deviations from the accurate values are 0.02, 0.02, and 0.06. The stable values of and are 0.0014 and 0.00128, and the deviations from the accurate values are 0.0008 and 0.00068. , , and of method GNI and NI are close to the real values, but is quite different from the real value. The deviation between and the accurate value is large. The stable values of are basically equal to the accurate values. It shows that GNI and NI cannot deal with the disturbance, which will lead to the identification deviation. The introduction of IV in GNI is feasible, which has the ability to tolerate the disturbance, and the unbiased estimation of can be obtained.
Finally, the feedforward parameters are tuned. The feedforward controller is updated to according to equation (6) with , which is basically equal to the inverse model of the plant in equation (22), so the feedforward tuning is completed and the effectiveness of the feedforward parameter tuning method is verified.
4.3.2. Feedforward Control Results in Simulation 3
Based on the realization method of the feedforward control in Section 3, the tuned feedforward controller is introduced into the system to obtain the position error without disturbance injection.
In Figure 16, the position error of the feedback control decreases obviously after the acceleration, velocity, and position feedforward control is introduced and the maximum error is reduced from to .
In Figure 17, the tracking accuracy is further improved by introducing the time-delay compensation. The error of nonzero jerk segment is greatly reduced, and the maximum error is reduced from to , which means the impact effect caused by jerk segment is mitigated and the time-delay feedforward compensation method in Section 3 is effective.
5. Experimental Verification
In this section, we verify whether the feedforward model obtained by the proposed algorithm matches the inverse of the plant on a precise air floating motion control experiment platform, and the parameter accuracy of the proposed optimization scheme is compared with several existing tuning algorithms.
5.1. Experimental Setup
The experimental setup is shown in Figure 18, which is a H-type precision air floating platform and has two degrees of freedom in the XY direction. In this work, the method is only tested in the Y direction. In the Y direction, the platform is driven directly by a single permanent magnet linear synchronous motor (PMLSM). The controller communicates with the motor driver through EtherCAT bus, and the position signal is measured by a grating ruler and fed back to the controller to realize the closed-loop control. The system software includes a monitoring software (Twincat 3.0 Scope View) and a real-time control software (Twincat 3.0 eXtended Automation Engineering). The control algorithm is implemented by using C/C++ code-based modules, and the sampling period is 1 ms.
The frequency response curve of the controlled plant is shown by the fine black line in Figure 19. In the frequency range below 100 Hz, the amplitude-frequency characteristic indicates that the controlled plant can be identified as a second-order rigid-body model approximately. The phase-frequency characteristic does not remain −180° but decreases linearly with the increase in the frequency and the slope is constant, which is considered to be caused by the time-delay [23].
(a)
(b)
The feedback controller is a PID controller, and , where , , and , which enables the system with a bandwidth of 64.7 Hz, phase margin of 29.6°, and amplitude margin of 5.6 dB.
5.2. Experimental Verification of Feedforward Parameter Tuning Method
Firstly, the feedforward control model is established. The air floating guide in the platform eliminates the influence of friction, and the plant is a second-order rigid-body motion model with time-delay, so the feedforward controller is parameterized as .
In the finite time task, the system reference position is a third-order point-to-point motion path, as shown in Figure 20, and the maximum values for position, velocity, acceleration, and jerk are 0.1 m, 0.1 m/s, 1 m/s2, and 10.0 m/s3.
(a)
(b)
(c)
(d)
Then, the feedforward correction parameters are calculated. The initial feedforward controller is set to , so the initial task is executed without the feedforward control. and are measured, and the objective function is established. The same as the simulation, , , , and are calculated by four algorithms, respectively. The results are shown in Figure 21 and Table 7. In , converges to 0.080 and converges to 0.0029.
(a)
(b)
Finally, the feedforward parameters are tuned. With the contribution of , the new feedforward controller is obtained as . The inverse model of is , and the frequency response curve is shown as the thick blue line in Figure 19, which is consistent with the plant. So the tuning of the feedforward parameters is completed, and the stable values of are correct. The stable values of , , and are 0.074, 0.075, and 0.084, and the stable values of and are 0.00717 and 0.00637, which means that the results of , , and are biased. The cable forces and other unknown disturbances during the experiment are not dealt within GNI and NI, which leads to the bias of and . The results of indicate that IV-LS is not applicable to nonlinear systems, and the identification accuracy of dynamic parameters is affected. The GNI based on IV can achieve unbiased estimation under disturbance and can be applied to feedforward parameter tuning with time-delay.
5.3. Experimental Results
According to the realization method of feedforward control with precise time-delay compensation, the new feedforward controller is introduced into the control system, and the following experiments are carried out to obtain the position error.
In Figure 22, the position error under the feedback control is the black line and the position error under the feedback and acceleration feedforward control is the dashed blue line, we can see that the tracking performance of nonuniform velocity section is improved obviously under the acceleration feedforward control, and the maximum error is reduced from to . In Figure 23, the feedback control signal under the feedback control is shown as the black line. In Figure 24, the feedback control signal and the feedforward control signal under the feedback and acceleration feedforward control are shown as the black line and blue line, respectively. After the introduction of the feedforward control, the thrust required for system motion is provided by the sum of and . As shown in Figure 24, provides most of the thrust required in the acceleration section, so is greatly reduced in this region correspondingly. Since the position error is processed by the controller to get , the position error is also greatly reduced.
Based on the acceleration feedforward, the position errors with and without the time-delay feedforward are shown as the black line and dashed blue line in Figure 25, respectively, and the feedback control signal is shown in Figure 26. Since the time-delay feedforward is realized by the delay planning of the reference position, the feedforward control signal under the two feedforward control are the same and shown by in Figure 24. It can be seen that the position error caused by the impact of jerk segment is further reduced under the time-delay feedforward and the maximum error is reduced from to , and the fluctuation of decreases in this region, which shows that the time-delay compensation method in Section 3 is effective. We can see that still exists after the introduction of acceleration and time-delay feedforward, which should be the compensation signal generated by the control loop for the cable force and other disturbances in the system.
The experimental results show that the proposed method can be applied in the precision motion control system with unknown time-delay. The feedforward parameters and delay time can be identified by IV-GNI based on the measurement data of a single finite time task without detailed knowledge of the plant, and the time-delay can be compensated with path planning time-shift, which can obviously improve the control performance of the system.
6. Conclusions
This paper proposes an iterative tuning method of feedforward parameters considering the time-delay. The key essentials of the proposed method lie in the following: (1) a nonlinear objective function with time-delay suitable for iterative feedforward tuning is established; (2) the Gauss–Newton iterative method and instrumental variables are combined to optimize the nonlinear objective function, and the unbiased estimation of the feedforward parameters and delay time are obtained in the presence of disturbance; and (3) the precise time-delay compensation can be realized in feedforward control with accurate path planning time-shift. The Newton iterative method and the least square method based on instrumental variable in existing IFT and the conventional GNI are compared with the proposed IV-GNI scheme. The identification results of the feedforward parameters in the simulation and experiment on an air floating precision motion platform show that the proposed method can be applied to the nonlinear system with time-delay and realize the unbiased parameter estimation with disturbance and noise. The results of feedforward control in simulation and experiment prove that the control performance of the precision system can be obviously improved with the proposed method.
This method can be extended to precision motion control MIMO systems, the decoupling method is needed to make the coupling MIMO become decoupled multiple SISO systems, and the corresponding controlled plant should have a mathematical model without zero.
Appendix
Proof of convexity of the objective function
The controlled plant is assumed to be and , and are the true values. In the tuning procedure, the feedforward parameters should satisfy . A new objective function is established by the polynomial on the right side of equation (8):which is equivalent to the original objective function . In the interval , is differentiable. When choosing and , we can obtain
The derivative of to is multiplied by to get
In equations (A.2) and (A.3), we can obtain
Using the first-order Taylor expansion with Lagrange remainder, , , so ; we can get
Then, can be obtained, so and are the convex functions in the interval . contains the extreme point that makes the derivative zero. In the iterative calculation, the initial value is , which can converge to the extreme point.
Data Availability
The data used to support the findings of this study are included within the article.
Conflicts of Interest
The authors declare that there are no conflicts of interest regarding the publication of this paper.
Acknowledgments
The authors deeply acknowledge the financial support from the National Science and Technology Major Project of China (no. 2017ZX02101007-002) and the National Natural Science Foundation of China (nos. 51675195, 51705163, 51721092, and 51975234). The authors also thank Yan Zhu in Micro and Nano Fabrication and Measurement Laboratory for the support in experimental verification.