1. Introduction
The three-axis inertially stabilized platform (ISP) is the middle mechanism between the remote sensing loads and the aircraft. To realize a high-performance attitude control for the load line of sight (LOS) in the flight process [
1], the ISP is used to isolate the non-ideal attitude perturbation of the airplane. Therefore, it has become a common key equipment in aerial remote sensing systems [
2].
However, the mechanism of the three-axis ISP is so complex that it is difficult to achieve high control performance in a real application. Due to the coupling between the aircraft and the ISP gimbal, the dynamic model has a strong coupling characteristic [
3]. At the same time, a nonlinear mapping relationship exists among the control signals and the measurement information of high-precision attitude measurement systems, gyroscopes, and encoders [
4]. Furthermore, the dynamic unbalance torque has a strong time-varying characteristic [
5]. Moreover, during the flight process, multiple disturbances for ISP exist, including the non-ideal angular motion and linear motion interferences generated by the strong random wind disturbance, the base angular motion disturbances caused by aircraft engine vibration, the coupling torques and friction interference torques caused by mechanical and electrical structure imperfections, and the measurement errors of gyros and accelerometers [
6]. The disturbances have asymmetry, non-Gaussian, norm-bounded, and other complex structural characteristics.
With its simple structure, PID control methods have been widely proposed for ISP. However, they have poor anti-interference abilities in a complex environment [
7]. Based on the imprecise model, robust control methods have shown high adaptability to parameter uncertainty. With the robust control and predictive control method, Rezaei D. Mahdy [
8] achieved a high control performance for ISP. However, it has corresponding conservative characteristics with the improvement of the system’s robustness. The back-stepping control method can deal with the system nonlinearity by using a step-by-step recursive process [
9]. Steoodeh [
10] developed the back-stepping control to stabilize the LOS of a boat-board camera. However, the parameters’ uncertainty and disturbances reduce the control performance [
11]. Sliding mode control (SMC) can deal with nonlinear systems with external disturbances and uncertainty effectively [
12,
13], and the high-order SMC method has been proposed for ISP [
14,
15]. However, the control performance will be deteriorated largely by the unknown cross coupling and external disturbance [
16]. Moreover, there is a certain chattering phenomenon in SMC [
17]. Due to its universal generalization ability, the neural network control method can suppress the influence of nonlinear disturbances after enough training [
18,
19]. However, it is difficult to obtain sufficient sample data in the ISP work environment. Without offline training, the adaptive neural network control method combined with the SMC is constructed [
20]. However, the upper bound of the residual approximation error can influence the control performance easily.
An extended state observer (ESO) can consider the system uncertainty and external disturbances as lumped disturbances, and extend them as the incremental state to be estimated and compensated directly [
21,
22]. Yao [
23] proposed a compound method based on the ESO and adaptive control for DC motors. Structural uncertainty can be dealt with effectively by adaptive control. Furthermore, the ESO is constructed to deal with unstructural uncertainty. A. H. M. Sayem [
24] proposed a compound control method for servo motor control that is composed by the linear ESO-based model repetitive control (MRC) method. In order to compensate for the friction of omnidirectional mobile robots (OMRs), Chao proposed a compound control method based on the SMC and a reduced-order ESO [
25]. However, if the system’s initial state does not match the estimated state of ESO, increasing the observation bandwidth will bring about the peaking phenomenon [
26]. At the same time, the system input delay will have a greater impact on the dynamic tracking error of the ESO [
27].
In this paper, to realize a high-performance control for the three-axis ISP, a compound control method is proposed, which consists of the adaptive ESO (AESO) and adaptive back-stepping integral SMC. The main contributions of this paper are listed as:
(1) For the three-axis ISP system, a nonlinear dynamic model based on geographic coordinates is constructed, which uses the attitudes of the LOS as the criteria of the ISP. It can avoid the degradation of measurement and control performance due to complex coordinate transformations.
(2) Based on the adaptive bandwidth, the AESO was developed to estimate the unknown disturbances of the ISP. With the information from the ISP system, the adaptive bandwidth of AESO can deal with the peaking phenomenon without introducing excessive noise.
(3) The adaptive back-stepping integral SMC is proposed to handle the ISP system’s nonlinearity, parameter variations, and disturbances. The adaptation laws based on the integral sliding mode for parameter uncertainty and disturbance estimation compensation have been developed, which can reduce the estimation burden and improve the disturbance estimation accuracy of AESO. With the introduction of the lumped disturbance estimation, the chattering problem of SMC has been effectively reduced to improve the control performance.
The outline of the paper is organized as follows: In
Section 2, the dynamic model of the three-axis ISP is constructed. In
Section 3, the compound control method based on the AESO and the adaptive back-stepping integral SMC is proposed to improve the control performance. The effectiveness of the proposed control method is validated by a series of simulations and experiments in
Section 4, followed by the conclusions in
Section 5.
2. The Dynamic Model of the Three-Axis ISP
The schematic diagram of the three-axis ISP is shown in
Figure 1, which is composed of the roll gimbal, pitch gimbal, and yaw gimbal. The roll gimbal is located at the outermost gimbal, fixed on the base by the shock absorbers. The pitch gimbal is adjacent to the roll gimbal, and the yaw gimbal is located in the innermost gimbal, carrying the remote sensing load. The frame structure of the ISP is symmetrically distributed from the inside to the outside, which ensures the stability of the LOS in the mechanical structure. The high-performance micro-guidance navigation control (MGNC) unit is installed on the top of the remote sensing load, which has the same base as the remote sensing load. Therefore, it can sample the pointing accuracy of the LOS of the remote sensing load in the geographic coordinate system and generate the corresponding control commands to isolate non-ideal disturbances. In order to achieve a high precision and a fast response control, the driving mechanisms of ISP are mainly composed of the brushless DC motors and wire gear drive systems. Based on the commands of the MGNC unit, the remote sensing load is adjusted correspondingly.
The coordinates used in the three-axis ISP system are shown in
Figure 2. The
,
,
,
,
,
,
,
,
and
,
,
are the base coordinates, roll coordinates, pitch coordinates, and yaw coordinates, respectively. Moreover, the attitude and angular velocity of the ISP are defined as
and
with respect to the base coordinate obtained by the roll-pitch-yaw sequence of rotations. Define
as the pitch coordinates, the roll coordinates, the yaw coordinates, and the base coordinates, respectively;
as the angular velocity of the
coordinate with respect to the inertial coordinate expressed in the
coordinate;
as the angular velocity of the
coordinate with respect to the geographic coordinate expressed in the
coordinate;
as the angular velocity of the geographic coordinate with respect to the inertial coordinate expressed in the geographic coordinate;
as the transformation matrix from the geographic coordinates to the
coordinates. Moreover,
,
, and
represent the transformation matrixes from base coordinates to roll coordinates, roll coordinates to pitch coordinates, and pitch coordinates to yaw coordinates, respectively. According to
Figure 2,
,
, and
can be expressed as.
Referring to the previous work [
20], the dynamic model of the ISP can be defined as follows:
where
,
,
,
,
, and
can be obtained by
,
and the transformation matrices
,
, and
.
,
and
are the moment of inertia of pitch, roll, and yaw gimbal in three directions, respectively, and they are all symmetric matrices.
is the moment of inertia of the motor.
is the torque sensitivity.
is the back EMF constant.
is the motor resistance. The
is the gear ratio of motor.
,
, and
are the voltage inputs applied on the pitch, roll, and yaw gimbal motor armatures, respectively.
,
, and
are the torque disturbances imposed on the pitch gimbal, roll gimbal, and yaw gimbal, respectively.
is the torque disturbance imposed on the motor of ISP.
The attitudes of the LOS are the criteria of the ISP system, which are defined in the geographic coordinates. However, it is obvious that the
and
of the ISP of [
20] are measured in the inertial coordinates. The process of converting from inertial coordinates to geographic coordinates is complicated, which will increase the computational burden of the MGNC unit and reduce the measurement and control performance. In order to solve the above problem, a nonlinear dynamic model based on the geographic coordinates is proposed. The
and
of the ISP with respect to geographic coordinates is expressed as
and
, and the corresponding values can be measured by the MGNC unit. The parameters coordinates can be unified:
Since
is relatively small.
To facilitate the application in practical engineering, based on (1)–(5), the nonlinear dynamic model of the three-axis ISP based on the geographic coordinates can be obtained as follows, and the detailed information on the dynamic model is shown in the
Appendix A.
where:
, , , , , , , , , , , , , denotes the unknown uncertainties of and , , , denotes the lumped disturbance, which contains nonlinearities and various unmodeled disturbances of the ISP system.
3. Control System of the ISP
Since , are nonlinear and time variant functions, it is difficult to express them accurately in the actual control system, which will affect the control performance of the ISP. Therefore, a compound control method based on the AESO and the adaptive back-stepping integral SMC is proposed. The adaptive back-stepping integral SMC method is proposed to handle the ISP system nonlinearity, parameter variations, and disturbances. Furthermore, the sign function is replaced by the lumped disturbance estimation of AESO, which can reduce the chattering problem and improve the control performance.
Since the pitch, roll, and yaw gimbals have the same control structure, take the roll gimbal as an example, and let
,
,
,
,
, the control flowchart is shown in
Figure 3.
3.1. The Traditional Linear ESO
For the ISP, let , where are the state variables.
Assumption 1. The and its first derivative are bounded, satisfying ,.
From (7), the expansion state equation of ISP can be obtained as:
For the (9), design the linear ESO (LESO).
where
,
and
are the estimation value of
,
and
,
is the error between
and
,
is the fixed bandwidth of LESO. At the same time,
is the estimation value of
.
Based on the (10), we can obtain:
According to (9), one has:
Combining (13) and (12), the lumped disturbance observation transfer function can be defined as follows:
The frequency response of
is shown in
Figure 4. It can be seen that as the frequency of the disturbance increases, the estimation of the disturbance by LESO exhibits obvious phase lag and amplitude attenuation. The decrease in the disturbance estimation accuracy will result in a decrease in the control performance. Although increasing the observation bandwidth
can improve the estimation ability of LESO, it will also introduce more high-frequency noise, which will weaken the system’s resistance to high-frequency noise.
By subtracting (10) from (9), the error model of the LESO is:
According to (16), one has:
when there are certain errors between the real states
and
of the system and the observation states
and
of LESO, the disturbance estimation error makes the corresponding increment due to the high observation bandwidth. Therefore, it will cause a great peaking phenomenon.
3.2. The AESO
To overcome the problem of LESO, we propose an AESO.
where
is the input gain value estimated by the
, and
is the parameter adaptation law to be synthesized later.
with
,
, is the bandwidth of AESO, which is composed by the observation errors of
and
, and the constant
needs to be designed.
Remark 1. The input gainand observation bandwidthof AESO are adaptive values, which are different from LESO. Adaptive variation of can reduce the estimation burden of AESO [
28]
. In addition, through the data input of the observation errors , the observation bandwidth can deal with the peaking phenomenon, improving the estimation accuracy of AESO without introducing excessive high-frequency noise. In order to further ensure the reliability of AESO, define: Convergence Proof. Let
, from (16) and (18), one has
where
,
and
. □
Theorem 1. For (18), if() and, there exist a constant and a finite time , satisfying Proof. The autonomous system of (19) is:
For (21), define the Lyapunov function
with
, where
and
. Then, the
is.
If
and
are achievable, then
,
, and
of (21) are locally exponentially stable (Theorem 1 of [
29]).
Based on the Assumption 1 and the exponential stability of (21), for (19), there exists an invariant set:
for any
and
, we can obtain.
then, for all
, considering
and (24), one has
□
3.3. The Compound Control Method Based on the AESO and the Adaptive Back-Stepping Integral SMC
To facilitate the design of adaptation laws, for (9), we can obtain:
where
,
.
Assumption 2. Define the unknown parameter , and the is the estimation value of . Moreover, define the lumped disturbance estimation error ,and the lumped disturbance estimation compensation is the estimation value of .
Let the estimation error
,
. Combining Assumption 2, the adaptation law
and
, with
and
, can be defined as [
28].
where
and
are the adaptation functions to be synthesized later; for any adaption function, the projection mapping used in (27) and (28) guarantees
,
.
Define the desired attitude angle
, the virtual control law
and the state error as:
and the derivative of
is obtained by:
For the virtual control law
, define:
where the constant
is the virtual control law coefficient.
Define the first Lyapunov function
, then the
is.
It is obvious that if converges to zero, is asymptotically stable, and can asymptotically track .
Based on (26) and (29), the differentiation of
is.
Define the integral sliding surface
as.
where
is a positive constant. Then, the control law
, the adaptation functions
and
can be designed as.
where
is a positive constant,
and
are the learning rates.
Stability analysis: Define the second Lyapunov function
, then the
is.
Taking (35)–(37) into (38).
Then, based on the and , the sliding surface is reachable. Meanwhile, the can track the effectively.
Remark 2. It is obvious that the control law does not contain symbolic function , which can reduce the chattering problem for the switching action of and decrease the loss of actuators in the control system. Moreover, the estimation compensation in can improve the estimation accuracy of AESO.
Remark 3. The projection mapping adaptation law (27) and (28) can guarantee and , thus guaranteeing . Since ,, when ,is bounded, and it can be shown that is bounded. However, due to , when ,, and is not decreasing, which does not guarantee . However, can still reduce the error between the estimation value and the real input gain .
4. Simulations, Experiments and Discussion
The three-axis ISP is shown in
Figure 5. Its length, width, and height are 0.33 m, 0.255 m, and 0.115 m, respectively. With the camera, the total weight reaches 13 Kg. Based on the MGNC unit, ISP can get attitude errors and make corresponding control commands.
4.1. Simulations
Table 1 shows the parameters of ISP. The battery voltage of the ISP system is 24 V, and the relationship between the input voltage
of the ISP and the output value
of the controller is
.
With the analysis of disturbances in the ISP system [
30], the corresponding asymmetrical disturbances have been added in simulations.
For the ISP system, the maximum mass imbalance distance is 5 mm, the maximum weight of the loads is 30 kg, and the amplitude of the wind disturbance is 1.5. Therefore, the torque disturbance
can be obtained as:
The sliding friction coefficient of the ISP system is
. The weight and the radius of the motor gear in the ISP system are 0.5 Kg and 0.1 m, respectively, and the amplitude of the residual periodic vibration disturbances is 0.9. Therefore, the torque disturbance
can be defined as:
where
is the residual vibration frequency.
Moreover, the mean and standard deviation of the measurement noise are 0 and 0.01, so one has:
In the simulation section, take the roll gimbal as an example, and the simulation time as 10 s. Let , the initial ISP system state values and are and respectively, and the initial AESO state values .
In order to verify the control performance of the proposed method, the following three control algorithms are selected in the simulation part:
(1) The proposed method: the control law in (35) with , , , , , , , , , , , . We test the disturbance estimation performance of LESO with , .
(2) The back-stepping control (BSC): with , , .
(3) The back-stepping integral sliding mode control (BSSMC): with , , , , .
Figure 6 shows the comparison of the attitude angles generated by the three control methods. When the simulation time reaches 0.3 s, the attitude angles of the three control methods can all track the desired attitude angles, and there exists a peaking value in the initial stage of the BSSMC, which reaches 5.1609°. Compared with the other two control methods, the proposed control method has the best performance both in terms of response speed and robustness to disturbances, and the angle velocity of the proposed control method can reach
. In order to intuitively reflect the control performance of the three control methods, the root mean square error (RMSE), the integral of time-multiplied absolute-value of error (ITAE), and the maximum deviation of error (MAXE) are used as the performance indicators of the tracking error.
Table 2 shows the comparison of the control performances of the three control methods. It can be seen that the proposed control method has the best control performance under multiple disturbance environments. Compared with the BS and the BSSMC, the RMSE value, ITAE value, and MAXE value of the proposed method are improved by at least 48.1%, 51.0%, and 34.6%, respectively.
Figure 7 shows the comparison of the control voltages generated by the three control methods. Compared with the other two control methods, BSSMC has an obvious chattering problem, which is very disadvantageous to the actuator of the ISP system. The proposed control solves the chattering problem, and the peak voltage is only 1/4 of that of the BSSMC, which will keep the ISP system running longer.
Figure 8,
Figure 9 and
Figure 10 show the simulation results for LESO and AESO. When the simulation time reaches 0.15 s, the disturbance estimations can track the real disturbance. Compared with LESO, there is no peaking phenomenon in AESO, and the disturbance estimation curve is more convergent. The maximum peak of estimation of AESO is only 8.09% of that of the LESO. In addition, the maximum disturbance estimation error of AESO is only 40% of that of the LESO. It can be seen from
Figure 10 that the bandwidth variation of AESO guarantees the accuracy of AESO disturbance estimation.
According to
Figure 11, the estimation of input gain
gradually approached the real input gain
with the parameter adaptation law
, and finally
. Compared with the
, the parameter uncertainty of
reduced by 98.2%, which greatly reduced the estimation burden of AESO.
4.2. Experiments
4.2.1. Case 1: Vehicle Experiment
To validate the control performance of the ISP system under the real disturbance environment, a vehicle experiment was carried out. The roll gimbal was chosen as an example, and let
. In order to verify the control performance of the proposed method, the adaptive neural network and sliding mode control (ANNSMC) method in [
20] is also used in this part under the same experimental conditions. The parameters of the proposed method were set to the same as those used in the simulation.
Figure 12 shows the experimental devices of the vehicle experiment. The ISP system was connected to the vehicle by the transitory bracket. The data logger was used to record the experimental data.
Figure 13,
Figure 14 and
Figure 15 show the experimental results in the vehicle experiment. As can be seen from
Figure 13,
Figure 14 and
Figure 15, both control methods can ensure the stable operation of the ISP system in the disturbance environment.
Table 3 shows the comparison of the control performances of the two control methods in the vehicle experiment. It can be seen that the proposed control method has the best control performance in the vehicle experiment. Compared with the ANNSMC, the RMSE value, ITAE value, and MAXE value of the proposed method are improved by 33.4%, 30.0%, and 51.4%, respectively.
4.2.2. Case 2: Unmanned Helicopter Flight Experiment
To test the control performance of the proposed method in actual flight, a series of airport pavement inspections have been conducted in Tianjin city from August 2020 to February 2021. The unmanned helicopter inspection system is shown in
Figure 16. Due to the consideration of counterweight, the ISP system was hung by four carbon fiber columns at the front abdomen of the unmanned helicopter.
With the consideration of camera index and the task requirement, the flight speed and flight height of the unmanned helicopter inspection system were set as 8 m/s and 20 m, respectively. Based on the MGNC system, the ISP adjusted the gimbals to keep the sight axis of load perpendicular to the ground, and the desired attitude angle
was set to
. Under the same flight experiment conditions, the same controllers were chosen as in Case 1. The roll, pitch, and yaw angles of the ISP system generated by the proposed control method and ANNSMC are shown in
Figure 17. Since the wind speed was 11.2 m/s, there were large wind disturbances in the flight test. The ISP could isolate non-ideal disturbances effectively to get high performance ground defect photos, and
Table 4 shows the comparison of the control performances of the two control methods in the flight experiment.
As can be seen from
Table 4, compared with the ANNSMC, the RMSE values and ITAE values of the proposed method are improved by at least 32.3% and 32.9%, respectively. However, the MAXE value of the roll gimbal of the proposed method is increased by 14.0%. Additionally, the MAXE values of the pitch gimbal and yaw gimbal of the proposed method are improved by 0.36% and 36.3%, respectively. Therefore, the proposed method has strong robustness against disturbances, which can achieve better control performance than ANNSMC.
The inspection photos of the proposed method and ANNSMC are shown in
Figure 18 and
Figure 19. Compared with the ANNSMC, the 1 mm crack and 1.5 mm hexagon tool could be located in the photo of the proposed method clearly. The ISP system based on the proposed method could isolate different disturbances effectively to locate airport pavement diseases.