Abstract

The lever-type electric erection system is a novel kind of erection system and the experimental platform in this paper operates with varying loads and low-resolution encoder. For high accuracy trajectory tracking, linear active disturbance rejection control (LADRC) is introduced. An approximate model, consisting of the servo system configured at velocity control mode and the lever-type erection mechanism, is built by means of system identification and curve fitting. Reduced-order LADRC based on the further simplified model is proposed to improve tracking accuracy and robustness. As comparisons, traditional LADRC and PID with high-gain tracking differentiator (HGTD) are designed. Simulation and experimental results indicate that reduced-order LADRC can realize higher trajectory tracking accuracy with low-resolution encoder and has better robustness to variation in erection loads, compared with traditional LADRC and PID with HGTD.

1. Introduction

The erection system is an important component of weaponry and engineering machinery, such as the rocket launcher and the dump truck. Typically, the erection system needs to track the planned trajectory. However, the trajectory tracking accuracy could be affected by variation in erection loads, resolution of sensors, and other disturbances. Uncertainties always exist in physical servo system and affect the tracking accuracy. Many nonlinear control methods are developed to achieve high accuracy trajectory tracking, such as the adaptive integral robust controller [1], the adaptive backstepping controller with modified LuGre model [2], and the adaptive repetitive controller [3].

Traditional erection systems are usually hydraulically driven by multistage hydraulic cylinder, which has long strokes and shock during the process of changing stage. Time-varying integral adaptive sliding mode control [4] and flow-pressure compound control [5] have been adopted to control the hydraulic erection system. With the improvement of servo motor and drive mechanism, the electric cylinder can be used as the actuator in the electric erection system [6]. The erection system in this paper combines the single-stage electric cylinder with the lever-type erection mechanism, which can shorten the strokes and avoid shock. Considering the modeling uncertainties, varying loads, and low-resolution encoder of the experimental platform in this paper, traditional linear controllers are difficult to satisfy the performance demands in terms of tracking accuracy and robustness. Therefore, linear active disturbance rejection control (LADRC) is introduced.

The concept of active disturbance rejection control (ADRC) was firstly proposed by Han [7], which inherits from classic PID and has better performance in rejecting the disturbances actively [8]. The core of ADRC is estimating the generalized disturbances, consisting of internal model uncertainties and external disturbances, and compensating for them, such that a relatively low precision model is necessary to design the control loop [9, 10]. The normal ADRC consists of tracking differentiator (TD), extended state observer (ESO), nonlinear state error feedback (NLSEF), and disturbance rejection (DR) [11]. Gao [12] developed LADRC, which is the simplification of ADRC by using linear extended state observer (LESO) and linear state error feedback (LSEF). LADRC has fewer parameters and is easily tuned in practice. The convergence and stability of LADRC have been proved in time domain [13, 14] and frequency domain [15] [16]. The validity has been verified in many applications [1721]. Consequently, LADRC has theoretical completeness and practicability.

First, this paper builds an approximate model of the electric erection system, which is composed of the servo system configured at velocity control mode and the lever-type erection mechanism. Second, reduced-order LADRC is proposed based on further simplified model. As comparisons, traditional LADRC and PID with high-gain tracking differentiator (HGTD) are designed for this system. Finally, simulations and experiments are carried out to validate the effectiveness and robustness of the proposed controllers.

The rest of this paper is organized as follows. Section 2 describes the composition of the electric erection system and the experimental platform. Section 3 builds the approximate model of the erection system. Section 4 designs reduced-order LADRC, traditional LADRC, and PID with HGTD for the erection system. Section 5 conducts the simulation and experimental verification. The conclusions are given in Section 6.

2. System Introduction

The electric erection system is a typical mechatronic servo system, which mainly consists of a controller, a servo driver, an electric cylinder, an erection mechanism, loads, and encoders, as shown in Figure 1.

The motion controller acquires the signals of encoders and calculates the control signal according to the control algorithm. The servo driver is configured at velocity control mode and controls the speed of servo motor in response to the analog voltage command of -10–+10 V. The electric cylinder can make rotation motion of the servo motor to linear motion of the pushrod via the reducer and ball screw and then thrust the erection mechanism and loads. The erection angle and the motor rotation angle are detected by encoders and transmitted to the controller.

Figure 2 shows the experimental platform of the electric erection system. The motion controller in IPC is GTS800, produced by Googoltech®, and the servo driver is MCDKT3520CA1, produced by Panasonic®. The encoder of erection angle, produced by Tamagawa®, outputs pulse signals with the resolution of 0.05°. The erection loads are adjustable from zero mass block (30 kg) to six mass blocks (180 kg).

3. Modeling of Electric Erection System

The electric erection system is a position servo system with the speed command of the servo driver as input and the erection angle as output. The control block diagram of the electric erection system is shown in Figure 3.

The servo driver and the servo motor can be considered as a whole and called the servo system. Therefore, the approximate model of the electric erection consists of two parts—the servo system and the erection mechanism.

3.1. Servo System Model

Figure 4 shows the control block diagram of the servo system.

The commercial servo driver, which is configured at velocity control mode, has inner velocity controller and current controller. Some parameters of the controllers and servo motor are not public. Also, there are some uncertainties, such as friction, parameter variation, and delay. So it is difficult to build a precise model of the servo system.

Typically, an approximate second-order model is devoted to describe the velocity loop of the servo system [19] and the transfer function can be described aswhere Θm(s) and U(s) are Laplace transform of the motor rotation angle θm and the speed command u, respectively, K is the transfer coefficient, and T is the time constant.

In order to identify the model parameters, the step response method is applied to the servo system on the experimental platform. According to the input gain of speed command, the unit of speed command can be converted from V to r/min. Step response tests of 100, 200, 300, and 400 r/min are, respectively, carried out on the experimental platform. The output of the servo system is the motor rotation angle, with the unit of rad. The experimental curves are shown in Figure 5.

The model parameters can be identified by means of the system identification toolbox in MATLAB. The identification model of the servo system can be described as

3.2. Erection Mechanism Model

The model of the erection mechanism takes the motor rotation angle θm as the input and the erection angle θe as the output, consisting of the transmission mechanism in the electric cylinder and the lever-type mechanism.

The rigid model of transmission mechanism can be expressed aswhere S is the extended length of the pushrod, L is the lead of the ball screw, and i is the reduction ratio of the reducer.

The lever-type mechanism is composed of the electric cylinder O2C, the triangular arm O1BC, and the connecting rod AB, as shown in Figure 6. To analyze the kinematics of the lever-type mechanism, a coordinate system is established in the vertical plane through the center of gravity, where the origin O is the rotation center of the erection loads, the X axis is horizontal, and the Y axis is vertical.

When the extended length of the electric cylinder is S, points A, B, and C move to points A’, B’, and C’, the triangular arm O1BC turns the angle of β, and the erection angle is θe. In the initial position, S is zero and θe is zero. The structure size and the coordinate of points A, B, and C are shown in Table 1.

Ignoring the deformation of the mechanism, the kinematics analysis can be expressed asSolving inverse trigonometric and quadratic equation, the expression of θe can be obtained as The relationship between θe and θm can be obtained based on (3) and (5). However, the analytical expression is complicated. It is not convenient for building the system model and designing the control algorithm. So an approximate polynomial expression [22] is used to express the relationship, which is obtained by means of curve fitting.

The maximum stroke of the electric cylinder is 0.3 m, the reduction ratio i is two, and the lead of ball screw L is 0.005 m. Changing S from 0 to 0.3, θm and θe can be calculated according to (3) and (5), respectively. Then, curve fitting is performed in MATLAB and the approximate polynomial expression is: where the units of θm and θe are both rad, the confidence bounds of the coefficients are 95%, the RMSE is 0.0049, and the SSE is 0.2419.

The calculated curve and fitted curve are shown in Figure 7.

3.3. System Model

Based on (1) and (6), the approximate model of the electric erection system can be expressed in the form of differential equation asFor the convenience of designing control algorithm, define the state variable and and transform the differential equation to the state-space form. The system model is expressed as where a is the model parameter and b is the control gain. Their expressions are

4. Design of Control Algorithm

The control target is to let the electric erection system track the planned trajectory within the error range of ±0.2°. However, there are several factors affecting the tracking accuracy as follows:

There are model uncertainties between the actual system and the approximate model in previous section.

There is variation in erection loads.

The low-resolution encoder of erection angle outputs signals with quantization noise.

There are other external disturbances during the process of erection.

In order to overcome above problems and realize the control target, LADRC is introduced to control the electric erection system, which has low requirements for the modeling precision and can estimate and compensate for the generalized disturbances.

4.1. Control System Structure

The normal LADRC consists of TD, LESO, LSEF, and DR. For the electric erection system, the suitable erection trajectory should be planned to improve the stability and rapidity of the erection process. The information of velocity and acceleration is easy to be obtained, so there is no need to use TD. LESO is used to estimate the state variables and the generalized disturbances, which is the core of LADRC. In order to improve tracking accuracy, LSEF is modified by combining state error feedback with velocity and acceleration feedforward. The structure of the control system is shown in Figure 8.

In this paper, half period cosine function is used to plan the erection trajectory, which is expressed aswhere , , and are, respectively, the reference position, velocity, and acceleration at the moment of t, θ is the target position, and tf is the duration of the erection process.

4.2. LADRC Design
4.2.1. Reduced-Order LADRC

For the servo system model (1), ignoring the dynamic characteristics of the velocity loop [23], the model can be further simplified asBesides, the extended state-space form of the simplified model can be expressed aswhere x2 is the generalized disturbances including model uncertainties and external disturbances, h is the differentiation of the generalized disturbances and br is the control gain.

The model uncertainties caused by the simplified model (12) can be estimated and compensated for by LADRC.

Structure the second-order LESO aswhere zy and zd estimate x1 and x2, respectively, and ωo is the observer gain.

With the estimation of the generalized disturbances, LADRC can compensate for them in real time asAlthough br varies with θm based on (13), the encoder of motor can accurately measure θm in real time and br can be calculated in real time.

The modified LSEF combines position error feedback with velocity and acceleration feedforward to improved tracking accuracy and stability, which is expressed aswhere kp, kv, and ka are the coefficient of position error feedback, velocity feedforward, and acceleration feedforward, respectively.

4.2.2. Traditional LADRC

Based on the second-order system model (8), the third-order extended state-space representation can be expressed aswhere x3 is the generalized disturbances and h’ is the differentiation of the generalized disturbances.

The third-order LESO can be structured as where z1, z2, and z3 estimate x1, x2, and x3, respectively, and ωo is the observer gain.

The expressions of DR and modified LSEF are designed in the same way as (15) and (16), which are shown aswhere k’p, k’v, and k’a are the coefficient of position error feedback, velocity feedforward, and acceleration feedforward, respectively.

For both second-order and third-order LESO, if the differentiation of the generalized disturbances is bounded, the estimation error of LESO is bounded and its upper bound decreases with the observer gain [13]. However, LESO will be more sensitive to noise with higher observer gain, which should be rationally selected according to control target and characteristics of the actual system.

4.3. PID Controller with HGTD Design

In contrast to LADRC, PID controller is applied to the electric erection system. In consideration of the quantization noise of the low-resolution encoder, HGTD [24] is introduced to filter the stair-step signals of the erection angle encoder and estimate its differential signals. The structure of PID controller with HGTD is shown in Figure 9.

The expression of HGTD iswhere y1 and y2 are, respectively, the filtered signals and the differential signals of the erection angle, and ωh is the gain of HGTD.

The control law is expressed aswhere kP, kI, and kD are the proportional, integral, and derivative coefficient, respectively.

5. Simulation and Experimental Verification

In order to verify the performance of the proposed controllers, simulations are conducted in MATLAB/Simulink and experiments are carried out on the experimental platform of the electric erection system, as shown in Figure 2. The control program of the experiments is written and compiled to codes in MATLAB/Simulink, which can be loaded to the GTS800 motion controller. The parameters of model and Simulink configuration are shown in Table 2.

5.1. Simulation Results and Analysis

Based on (1) and (6), the simulation model can be built in Simulink. Moreover, the stair-step signals of the low-resolution encoder caused by quantization noise can be simulated by the block—“Quantizer”—using the round-to-nearest method, according to the resolution of encoder. The tuned control parameters of LADRC and PID are shown in Table 3.

The trajectory tracking curves of reduced-order LADRC and traditional LADRC and PID with HGTD are shown in Figure 10. The tracking error is defined as the value of planned trajectory minus the simulation value without quantization noise at the same time.

From Figure 10, it can be seen that each of reduced-order LADRC, traditional LADRC, and PID with HGTD can track the planned trajectory within the required error range of ±0.2° and the terminal errors of them are almost zero. Besides, reduced-order LADRC has the highest tracking accuracy among three controllers.

Figure 11 shows the erection angle estimation error curves of second-order LESO, third-order LESO, and HGTD. The estimation error is defined as the simulation value without quantization noise minus the estimation value at the same time.

In Figure 11, the erection angle estimation error of second-order LESO can be controlled around 0°, which is the minimum among three controllers. Both third-order LESO and HGTD can control the estimation error within ±0.05°, which means that the maximum error is not exceeding the resolution of the encoder. Also, according to the planned trajectory in (10), the velocity is relatively low at the beginning and end. For three controllers, at low speed, the estimation error is larger than that at high speed. Therefore, both LESO and HGTD are more sensitive to the quantization noise at low speed.

Figure 12 shows the angular velocity estimation error curves of third-order LESO and HGTD. The simulation angular velocity is obtained by calculating the differential of the simulation erection angle without quantization noise. The estimation error is defined as the simulation value minus the estimation value at the same time.

In Figure 12, it is obvious that the angular velocity estimation error of third-order LESO is larger than that of HGTD. Also, at low speed, third-order LESO and HGTD both have larger angular velocity estimation error than that at high speed, which is similar to the erection angle estimation error.

Simulation results indicate that reduced-order LADRC, traditional LADRC, and PID with HGTD all can realize the control target for the electric erection system and reduced-order LADRC has the highest tracking accuracy. Moreover, both LESO and HGTD can filter the stair-step signals of low-resolution encoder and third-order LESO and HGTD also can estimate its differential signals, which is beneficial to improve the tracking accuracy.

5.2. Experimental Results and Analysis

The simulation results have proven that LADRC is effective and reduced-order LADRC has the highest tracking accuracy. Carrying out three controllers on the experimental platform, with the loads of 30 kg, 80 kg, 130 kg, and 180 kg, respectively, can verify their control performance in further. Besides, comparing the experimental results with the simulation results can verify the validity of the approximate model, using the same control parameters shown in Table 2

Figure 13 shows the experimental trajectory tracking curves of reduced-order LADRC, traditional LADRC and PID with HGTD, under the condition of 180 kg loads.

From Figure 13, it can be seen visually that three controllers all can keep the trajectory tracking error within the required error range of ±0.2°. Table 4 shows the Minimum, maximum, and terminal error of three controllers in the process of erection.

According to Figure 13 and Table 4, all tracking error curves of three controllers have different levels of fluctuation at the early stage of the erection process and then converge to zero, which is influenced by the low-speed performance of the servo system and the estimation performance of LESO and HGTD at low speed. Among three controllers, reduced-order LADRC has minimum fluctuation range.

Figure 14 shows trajectory tracking error curves of reduced-order LADRC, traditional LADRC and PID with HGTD, under the conditions of 30 kg, 80 kg, 130 kg, and 180 kg loads, respectively.

As presented in Figure 14(a), for reduced-order LADRC, the error range and fluctuation trend are not affected by the varying loads and the error curves are nearly the same with different loads. In Figures 14(b) and 14(c), the error curves have slight differences on the fluctuation trend, under the condition of 180 kg loads. In general, all of three controllers are robust to variation in erection loads and reduced-order LADRC has the best robustness.

Figure 15 compares the experimental trajectory tacking curves and tracking error curves of three controllers with the simulation curves, under the condition of 180 kg loads.

It can be seen from Figure 15 that, for three controllers, there is no significant difference between the experimental curves and the simulation curves. This result indicates that the approximate model of the electric erection system in Section 3 is valid to verify the control algorithm and tune control parameters.

Experimental results indicate that reduced-order LADRC can control the trajectory tracking error within the required error range with low-resolution encoder and has robustness to variation in erection loads. Compared with traditional LADRC and PID with HGTD, reduced-order LADRC has higher tracking accuracy and better robustness. In addition, the validity of the approximate system model proposed in this paper is verified by comparison of experimental curves with simulation curves.

6. Conclusions

The lever-type electric erection system in this paper is mainly composed of the servo system configured at velocity control mode and the lever-type erection mechanism. The approximate model is built by means of system identification and curve fitting. Considering the modeling uncertainties, varying loads, and the low-resolution encoder, reduced-order LADRC is proposed based on the further simplified system model. The following conclusions can be drawn based on the simulation and experimental results:

For the lever-type electric erection system, reduced-order LADRC has higher tracking accuracy with low-resolution encoder and better robustness to variation in erection loads, compared with traditional LADRC and PID with HGTD.

The approximate model is proved to be valid to verify the control algorithm and tune control parameters.

Future research will consider the trajectory planning of this system and the optimization of the dynamic performance of this controller.

Data Availability

The data used to support the findings of this study are available from the corresponding author upon request.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.

Acknowledgments

This research was supported by the National Natural Science Foundation of China [Grant no. 61703410].