Next Article in Journal
Study of Resonance between Bogie Hunting and Carbody Mode via Field Measurements and Dynamic Simulation
Previous Article in Journal
A Multilayer Architecture towards the Development and Distribution of Multimodal Interface Applications on the Edge
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Adaptive Control for a Two-Axis Semi-Strapdown Stabilized Platform Based on Disturbance Transformation and LWOA-PID

1
School of Electrical Engineering and Automation, Xiamen University of Technology, Xiamen 361024, China
2
Xiamen Key Laboratory of Frontier Electric Power Equipment and Intelligent Control, Xiamen 361024, China
3
Shanghai Institute of Satellite Engineering, Shanghai 201109, China
4
School of Aerospace Engineering, Tsinghua University, Beijing 100085, China
5
School of Computer and Information Engineering, Xiamen University of Technology, Xiamen 361024, China
*
Author to whom correspondence should be addressed.
Sensors 2024, 24(16), 5198; https://doi.org/10.3390/s24165198
Submission received: 25 June 2024 / Revised: 25 July 2024 / Accepted: 10 August 2024 / Published: 11 August 2024
(This article belongs to the Section Navigation and Positioning)

Abstract

:
A two-axis semi-strapdown stabilized platform is a device designed to eliminate aircraft disturbances and ensure the stability of the sensor’s orientation. A traditional two-axis semi-strapdown stabilization platform for aircraft can effectively control disturbance in pitch and yaw channel, but it cannot achieve ideal disturbance control in the roll channel. In order to solve this problem, an adaptive control method based on disturbance transformation and LWOA-PID is proposed. Disturbance transformation is the process of integrating the angular position disturbance of the roll from the previous moment into the combined disturbance of the pitch and yaw at the current moment. This is followed by decoupling the combined disturbance of the pitch and yaw at the current moment, thereby eliminating the disturbance caused by the roll from the previous moment. This process is repeated to achieve the goal of eliminating roll channel disturbances. To ensure the line of sight (LOS) pointing accuracy stability in the two-axis semi-strapdown stabilized platform system for aircraft, a whale optimization adaptive proportional–integral–derivative (LWOA-PID) controller based on Latin hypercube sampling is designed. It is then compared with the classical PID controller in Matlab/Simulink. The simulation results indicate that the disturbance conversion module proposed in this paper can eliminate the impact of roll axis disturbances on the LOS pointing accuracy of the two-axis semi-strapdown stabilized platform for aircraft. Compared to the classical PID controller, the LWOA-PID controller reduces tracking errors for step and sinusoidal signals by 50% and 75%, respectively. It also shortens optimization time by 37.5% compared to the WOA-PID while maintaining the same level of accuracy. Furthermore, when combined with the conversion module, the tracking error is reduced by an additional order of magnitude.

1. Introduction

Aerial remote sensing stabilization platforms are devices designed to enhance the quality of images and the accuracy of data acquired by sensors [1]. The two-axis semi-strapdown stabilized platform, due to its small size, light weight, and low cost, holds significant application value in aerial remote sensing stabilization platforms [2]. However, the key to achieving the function of a two-axis semi-strapdown stabilized platform for aircraft lies in whether it can quickly isolate disturbances and ensure the pointing stability of the sensors.
The attitude disturbance of the carrier is the primary factor that affects the tracking performance of the sensors during operation [3]. The aircraft’s attitude inevitably changes during flight, potentially generating corresponding disturbances in angular velocity. If the angular velocity disturbance cannot be compensated for or controlled in a timely manner, it will be transmitted within the stabilized platform, impacting the accurate alignment of the sensor’s LOS axis, thereby ultimately affecting tracking performance. The mechanical structure of the two-axis semi-strapdown stabilization platform for aircraft allows for ideal control only over the roll and pitch channels, making it a coupled underactuated nonlinear system. This type of nonlinear system inherently exhibits chaotic behavior [4]. In [5], it was demonstrated that controllers can effectively manage nonlinear chaotic systems, while in [6], adaptive control for these systems was further explored. Based on controller principles, many academics have conducted significant research on the control strategy of the stabilized platform for aircraft to ensure the pointing stability of the LOS axis of the two-axis semi-strapdown stabilized platform sensor.
A method that combines active disturbance suppression with adaptive fuzzy sliding mode control, which can improve the target tracking capability of stabilized platforms, was proposed by [7]. A multivariable binary adaptive model based on output feedback for a two-axis stabilized platform was proposed by [8] and applied as an actuator on the stabilized platform. A composite control strategy that combines active disturbance compensation and variable gain function techniques to address constraints and disturbances in the output of a visual tracking system for an inertial stabilized platform was proposed by [9]. A sliding mode variable structure control strategy based on the disturbances experienced by the optoelectronic stabilized platform during motion was proposed by [10], significantly reducing the stabilization error of the platform’s velocity loop. The above studies did not analyze the disturbances in stabilization platforms; they merely used controllers to eliminate or compensate for these disturbances to achieve platform stability. To address this issue, this paper conducts an in-depth study of the composition of disturbances in stabilization platforms, categorizing them into aircraft body disturbances and platform-specific disturbances. For aircraft body disturbances, a disturbance conversion module is designed for elimination, while platform-specific disturbances are stabilized using a controller.
Classical PID controllers offer the following advantages: a simple structure, not relying solely on mathematical models, and ease of implementation in engineering. Therefore, classical PID controllers hold a dominant position in various engineering applications, including aerospace, power electronics, and machining. However, when the internal parameters of the system are perturbed and the external environment changes, the previously adjusted controller often exhibits poor adaptability [11].
To enhance the adaptability of classical PID controllers, a fuzzy gain scheduling PID controller for the stabilization of a UAV position and altitude was presented by [12], and its adaptability was validated in MATLAB. A composite control scheme that combines PID and adaptive control was proposed in [13]. The adaptive control provides an adaptive feedforward control signal, while the PID offers feedback control to counteract parametric and nonparametric modeling errors. To improve the line-of-sight stabilization accuracy of the stabilized platform, an adaptive fuzzy controller was designed in [14]. This controller uses a threshold switching method: the adaptive fuzzy controller is applied when the error exceeds the threshold, and PID control is used when the error is below the threshold. Researchers have also conducted studies on PID parameter tuning, including intelligent PID parameter tuning [15,16], PID parameter tuning in multivariable systems [17], nonlinear PID parameter tuning [18,19], and so on. The above studies can be summarized as enhancing the adaptability of PID controllers through real-time adjustment of PID control parameters. It was demonstrated by [20] that the control performance of PID systems with adjustable parameters exceeds that of fixed-parameter PID systems. Based on the concept of adjustable PID parameters, this paper proposes an LWOA-PID controller with the objective of real-time adjustment of PID parameters to enhance the controller’s adaptability.
In this paper, a disturbance transformation method based on delay compensation and an adaptive control approach using LWOA-PID are proposed to ensure the stability and pointing accuracy of the LOS axis for a two-axis semi-strapdown stabilized platform for aircraft. The remainder of this paper is organized as follows: Section 2 deduces the transmission mechanism of angular velocity disturbance in the platform and the principle of LOS axis stability. Section 3 presents the disturbance transformation method and LWOA-PID, and Section 4 conducts simulation verification. Finally, the study is summarized in Section 5.
This paper is dedicated to achieving stable tracking capability for the LOS axis of a two-axis semi-strapdown stabilized platform system used in aircraft, and its main contribution lies in the following:
(1) A disturbance transformation method based on delay compensation is proposed to convert roll channel disturbances into yaw and pitch channel disturbances, thereby achieving effective control of roll channel disturbances in LOS axis of traditional aircraft two-axis semi-strapdown stabilization platforms.
(2) An adaptive control method using LWOA-PID is proposed to ensure the stability of target tracking in the LOS axis of a two-axis semi-strapdown stabilized platform system for aircraft. Compared to the classical PID controller, LWOA-PID offers better tracking ability. Additionally, compared to the traditional WOA-PID, LWOA-PID demonstrates faster optimization speed.

2. Coordinate System Definition and Model Analysis

Consider a two-axis semi-strapdown stabilized platform system as depicted in Figure 1. The figure denotes the yaw and pitch platforms. Three reference frames are introduced: an aircraft body-fixed frame (b), a frame (o) fixed to the yaw platform, and a frame (i) fixed to the pitch platform. The center of rotation is in the frame origin, which is assumed to be the same point for the three frames.
o x b y b z b represents the body coordinate system, where o x b is directional in the direction of the aircraft’s head.
o x o y o z o denotes the yaw platform coordinate system, with the angle of rotation around the z-axis as α .
o x i y i z i is the pitch platform coordinate system, with the rotation angle around the x-axis as β .
The sensors LOS axis coordinate system is denoted by o x g y g z g . Since the o x g y g z g is mechanically fixed to o x i y i z i , the sensor’s LOS axis coordinate system is equivalent to the pitch platform coordinate system.
These abovementioned coordinate systems have the following transformations:
C b o = cos α sin α 0 sin α cos α 0 0 0 1
C o i = 1 0 0 0 cos β sin β 0 sin β cos β
C b o is the transformation from (b) to (o), i.e., if a vector is expressed by its coordinates in frame (b), then C b o v b gives the coordinates of the same vector in frame (o). Similarly, C o i is the transformation from (o) to (i).
For the angular velocities of frames (b), (o), and (i), the following notations are introduced, respectively:
ω b = p q r T ω o = ω o x ω o y ω o z T ω i = ω i x ω i y ω i z T
where ω b x , ω b y , and ω b z are the components of the inertial angular velocity of the frame (b) itself, and similarly for the other vectors. We use the notations ω b x , ω b y , and ω b z to represent the pitch, roll, and yaw components, respectively.
According to the definition of Euler angles applied in flight dynamics, Equation (4) is obtained by utilizing Equations (1) and (3).
ω o = ω o x ω o y ω o z = ω b x cos α + ω b y sin α ω b y cos α ω b x sin α ω b z + 0 0 α ˙
The vectors are expressed in system (o). 0 0 α ˙ T represents inertial velocity of the yaw platform. Similarly, between the yaw platform (o) and the pitch platform (i), there exist flight dynamics Euler angles relationships. The following results can be obtained by using Equation (2).
ω i = ω i x ω i y ω i z = ω b x cos α + ω b y sin α + β ˙ cos β ω b y cos α ω b x sin α + sin β ω b z + α ˙ sin β ω b y cos α ω b x sin α + cos β ω b z + α ˙
β ˙ 0 0 T represents inertial velocity of the pitch platform.
Further, we introduce Equation (5):
ω r i = ω r i x ω r i y ω r i z = ω b x cos α + ω b y sin α cos β ω b y cos α ω b x sin α + ω b z sin β sin β ω b y cos α ω b x sin α + ω b z cos β
ω d i = ω d i x ω d i y ω d i z = β ˙ α ˙ sin β α ˙ cos β
It is apparent that ω i = ω r i + ω d i . The pitch platform angular velocity ω i , consists of two components: ω r i , which represents the projection of the aircraft’s angular velocity on the (i) coordinate system, and ω d i , which denotes the angular velocity caused by the motion of the stabilizing platform itself. In order to stabilize the LOS axis, ω i should satisfy ω i = 0 . However, the aircraft’s two-axis semi-strapdown stabilized platform system lacks a roll axis control motor to directly mitigate roll disturbance, which impacts the stabilization of the sensor’s LOS axis.
The semi-strapdown stabilized platform commonly uses a DC torque motor as the control motor. The equivalent circuit diagram of the DC torque motor and platform load is shown in Figure 2:
U = I R + L d I d I d t d t + E E = C e ω M = J ω ˙ + f m ω M = C m I
where U is the input modulation voltage, I is the current between motor windings, L is the inductance of the motor windings, E is the back electromotive force of the motor, ω is the motor speed, R is the motor armature resistance, J is the load inertia, C m is the torque constant, and f m is the friction coefficient of the shaft. Typically, the motor current time constant ( L L R R ) is very small, resulting in minimal impact on system dynamics. Therefore, the motor model can be simplified to
U = I R + C e ω C m I = J ω ˙ + f m ω
Applying the Laplace transform to Equation (9), the transfer function between the motor and the platform is obtained as shown in Equation (10).
G s = ω s U s = C m J + f m R s + C m C e

3. Conversion Module and LWOA-PID Design

From Equation (7), it is evident that when α is a constant, both α ˙ and ω d i y are equal to zero. In this case, if ω r i y meets the requirement of ω r i y = 0 , then roll axis disturbances can be eliminated. Based on this idea, a conversion module is designed.

3.1. Conversion Module

For the convenience of discussion, ω r i x , ω r i y , and ω r i z are denoted by ω x , ω y , and ω z . Figure 3a demonstrates the relationship of inertial angular velocity vector components within the (i) coordinate system at time t0. Here, the three-axis disturbances ω x 0 , ω y 0 , and ω z 0 align with the x0, y0, and z0 axes in the figure, corresponding to pitch, roll, and yaw disturbances, respectively. Additionally, the coordinate system at time t0 is defined as the stable coordinate system.
At the xoz plane, the combined disturbance of ω x 0 and ω z 0 is represented as ω x z 0 , with an angle denoted as φ x z 0 . At time t0, the disturbance represented by ω x 0 and ω z 0 is eliminated by their respective motors. However, the absence of a control motor to eliminate ω y 0 results in a roll angle φ y 0 at time t1. As a result, the LOS axis coordinate system will rotate around the y-axis by the angle φ y 0 , leading to instability in the LOS axis.
At time t1, the combined disturbance of ω x 1 and ω z 1 in the xoz plane is denoted as ω x z 1 . However, the disturbance of ω y 0 at time t0, ω x z 1 , will next continue to be deflected by an angle φ y 0 . The deflected ω x z 1 by angle φ y 0 is denoted as ω x z 1 . It comprises the pitch and yaw disturbance at moment t1, as well as the roll disturbance at moment t0. ω x z 1 is decoupled in the stable coordinate system, after which the system is stabilized using pitch and yaw control motors. The disturbance transformation relationship is shown in Figure 3b.
At time t1, compensation for the roll axis disturbance from time t0, followed by compensation at time t2 for the roll axis disturbance from time t1, and subsequently at time t3 for the roll axis disturbance from time t2, continue in this manner. This continuous process achieves eliminating roll channel disturbances. Using this disturbance transformation method, three-axis LOS angular velocity disturbances are converted into two-axis ones. This module is referred to as the conversion module. However, if the deflection angle of the roll axis at time t0 is large, it results in inaccurate feedback, thus impeding the normal work of the conversion module.
The combined disturbance in the oxz plane at time t1 is shown in Equation (11).
ω x z t 1 = ω z t 1 2 + ω x t 1 2
The angle between the x-axis disturbance and the z-axis disturbance at time t1 is shown in Equation (12).
φ x z t 1 = arctan ω z t 1 ω x t 1
The equivalent deflection angle in the y-axis direction at time t1 is shown in Equation (13).
φ y t 1 = t 0 t 1 ω y t 0 d t
The actual deflection angle of the combined disturbance at time t1 is shown in Equation (14).
φ x y z t 1 = φ x z t 1 φ y t 1
The decoupled calculation of the deflection angular velocity at time t1 is shown in Equation (15).
ω x t 1 = ω x z t 1 sin φ x y z t 1 ω z t 1 = ω x z t 1 cos φ x y z t 1
The algorithm process of the conversion module is shown in Table 1.

3.2. LWOA-PID Controller

The two-axis semi-strapdown stabilized platform system for aircraft comprises two loops: the yaw-axis control loop and the pitch-axis control loop. The system control diagram is shown in Figure 4. To guarantee the stability of the two-axis semi-strapdown stabilized platform LOS axis pointing accuracy, an LWOA-PID controller is designed for the yaw/pitch controller module. The LWOA-PID controller enhances the controller’s adaptability by adjusting the PID control parameters in real time.
The whale optimization algorithm simulates the methods that humpback whales use to search for and encircle their prey [21]. This includes three important stages: encircling prey, bubble-net feeding, and searching for prey. Each whale’s position represents a solution, which is continuously updated to eventually obtain the global optimal solution.
Assuming that the current best individual’s position is the optimal foraging location, the other individuals encircle the prey’s position based on this optimal foraging location. The calculation for this process is shown in Equation (16).
D = C × X * k X k C = 2 × r 2 X k + 1 = X * k A × D A = 2 × a × r 1 a
In (16), D is the distance between the individual and the optimal foraging location; k is the current iteration number; X * k is the currently obtained optimal foraging location; X k is the current individual position; A and C are control coefficients; r 1 and r 2 are random numbers in the range [0,1]; a is a decay variable that decreases from 2 to 0. The calculation formula is shown in Equation (17).
a = 2 k × 2 k s u m
k s u m represents the maximum number of iterations. The whale optimization algorithm updates positions by creating a spiral equation to calculate the distance between an individual and the optimal position. The position update calculation formula is shown in Equation (18).
X k + 1 = X * k + D * × e b l × cos 2 π l D * = X * k X k
D * is the distance between the current individual and the current optimal foraging location; b is a constant that changes the spiral shape; l is a random number in the range [−1, 1]. Contraction encircling and advancing along the spiral path occur simultaneously with equal probability. The calculation formula is shown in Equation (19).
X k + 1 = X * k A × D , p < 0.5 X * k + D * × e b l × cos 2 π l , p > 0.5
In (19), p is a random number in the range [0, 1], which controls the selection of the foraging method.
When |A|>1, peripheral individuals move away from the prey. Unlike the bubble-net feeding stage, which updates positions based on the optimal foraging location, a random individual’s position is chosen as the reference for the next position update. The calculation formula is given as follows:
X k + 1 = X r a n d A × D D = C × X r a n d X
In (20), X r a n d is the position of a random individual. The integral of time-weighted absolute error (ITAE) [22] function is chosen as the fitness function.
J = 0 t e t d t
Compared to other intelligent optimization algorithms, the WOA is simpler because it only requires setting the population size, number of iterations, and search space range. Depending on the application needs, the population size, number of iterations, and search space range can be modified to customize or adjust the algorithm.
The general form of a PID controller is as follows:
u t = K p e t + K i 0 t e τ d τ + K d d e t d t
where u t represents the controller output signal, e t denotes the system error, and K p , K i , and K d are the weighted values of the system error signal and its integral and derivative components, respectively. The classical WOA-PID control diagram is depicted in Figure 5.
The WOA-PID controller achieves system stability by continuously searching for the optimal control parameters using the whale optimization algorithm. The traditional whale optimization algorithm typically uses a uniform random sampling function to initialize the position distribution. However, uniform random sampling can result in an uneven distribution of points in some areas. To address this issue, we propose using a Latin hypercube sampling function to initialize the position distribution in the whale optimization algorithm, aimed at achieving more uniform coverage of the search space.
The Latin hypercube sampling method was proposed by McKay et al. as a multidimensional stratified sampling technique [23]. It efficiently samples within the variable distribution interval by dividing the interval [0, 1] into N equally spaced, nonoverlapping subintervals and performing independent, equally probable sampling within each subinterval to ensure that sampling points are evenly distributed across the entire distribution interval. Random sampling follows a uniform distribution within the interval [0, 1]. The proposed method, which uses Latin hypercube sampling to initialize the whale optimization positions, is called LWOA-PID. The Latin hypercube sampling algorithm is shown in Table 2. The algorithm procedure and application of the LWOA-PID are shown in Figure 6.
From Figure 6a, the red box highlights the use of Latin hypercube sampling to initialize the whale distribution, as proposed in this paper. The application of the proposed LWOA-PID in aerial remote sensing missions is shown in Figure 6b. The LWOA algorithm primarily consists of three parts: (1) initialization of parameter configurations, (2) initialization of position distribution using Latin hypercube sampling, and (3) global search for the optimal control parameters. The algorithmic process of the LWOA-PID module is shown in Table 3.
The mathematical formula for information entropy in information theory was proposed by Claude Shannon [24]. It is defined as the uncertainty or average amount of information of a probability distribution of a random variable. The formula for calculating entropy is as follows:
H x = i = 1 n P x i log b P x i
where H x represents the entropy of the random variable x, P x i is the probability that the random variable x takes on the i-th value, n is the number of different possible values that x can take, and log b denotes the logarithm to the base b.
A higher entropy value indicates a more uniform distribution of points, covering a larger parameter space, while a lower entropy value suggests that the points are more concentrated in certain areas. The larger the parameter space covered by the optimization algorithm, the better the optimization parameters that can be found. Comparing the entropy values can more intuitively demonstrate the advantages of Latin hypercube sampling.

4. Simulink Results and Analysis

In this section, the effectiveness of the proposed conversion module and LWOA-PID adaptive controller is validated using a two-axis semi-strapdown stabilized platform for aircraft as the research object. We assume that the gyroscope feedback is delay-free and error-free. The specifications of the simulation parameters are displayed in Table 4.

4.1. Conversion Module Validation

The conversion module is designed in Section 3.1. To gain an insight into the performance of the conversion module, simulation associated with the conversion module is conducted and the simulation results are presented in Figure 7.
From Figure 7a, it can be observed that the system itself reduces disturbance amplitudes, but the pitch and yaw angles of the sensor LOS exhibit oscillatory trends.
Figure 7b illustrates that the deflection angles of the pitch and yaw channel tend to stabilize within 2 s. Therefore, the results shown in Figure 7b provide excellent agreement with our statement associated with the conversion module, i.e., the conversion module utilizes lag compensation for roll axis disturbance in continuous time, achieving stabilization of the deflection angle. Nonetheless, the use of the conversion module alone may lead to extra problem like system excessive delay.

4.2. Comparison between LWOA-PID and Classical PID

The LWOA-PID controller is designed according to Section 3.2. The controller parameters of LWOA-PID for tracking step and sinusoidal signals are [99.357, 0, 7.5845] and [100, 100, 14.5286], respectively. According to [25], the parameters of the classical PID controller are [100, 100, 2]. The results of LWOA-PID and classical PID are shown in Figure 8 and Figure 9, and are further summarized in Table 5.
From Figure 8, it can be seen that both the LWOA-PID and the classical PID control methods can stabilize the system within 1 s. The steady-state error of the LWOA-PID controller is 0.01 rad, while the steady-state error of the traditional PID controller is 0.02 rad.
Comparing the PID control parameters of both methods, it is evident that the large initial steady-state error in the classical PID is due to the presence of the integral term in the control parameters. This is because, in the initial stage, there is a significant deviation between the actual value and the desired value. The integration during the phase of large deviation often leads to excessive overshoot in the system.
From Figure 9, it can be seen that the performance of the classical PID controller in tracking a sinusoidal signal is inferior to that of the LWOA-PID controller. The LWOA-PID controller has a maximum tracking error of 0.005 rad, whereas the classical PID controller has a tracking error of 0.02 rad.
Comparing the PID control parameters, it is evident that the classical PID has a larger steady-state error due to the insufficient derivative term. This term, which reflects the rate of change of the error signal, helps introduce an early correction before the error grows too large, thus accelerating system response and reducing adjustment time.
From Table 5, it can be clearly seen that the stable time of the classical PID controller for tracking a step signal is 1.5 times that of the LWOA-PID controller. Additionally, the maximum tracking error of the classical PID controller for a sinusoidal signal is four times that of the LWOA-PID controller. This demonstrates that the LWOA-PID has superior control performance.
The primary reason for this outcome is that the control parameters of the classical PID controller are fixed, whereas the PID controller based on the LWOA optimization algorithm can adjust the PID parameters according to different task requirements to achieve optimal control performance. In [26], genetic optimization algorithms were applied for the self-tuning of PI parameters in permanent magnet synchronous motors (PMSMs) and they demonstrated the feasibility of this optimization algorithm on a 2.3 kW PMSM AC servo platform.

4.3. Comparison between LWOA-PID and WOA-PID

Latin hypercube sampling can distribute particles more evenly within a specified region, thereby enhancing the global search capability of optimization algorithms and finding the optimal solution with fewer iterations. The comparison between Latin hypercube sampling and uniform random distribution sampling is shown in Figure 10.
From Figure 10, it can be observed that when using a uniform random distribution sampling function to initialize position distribution, there is a phenomenon where multiple points exist within a specific region, as shown in the red box area in Figure 10b. This decreases the ability to find the optimal solution. Although increasing the number of particles can address this issue, it leads to increased optimization time. In contrast, the Latin hypercube sampling function effectively avoids this problem.According to Equation (23), the entropy values for Latin hypercube sampling and uniform random distribution were calculated as 3.355 and 3.1527, respectively. This further demonstrates that Latin hypercube sampling is superior to uniform random distribution. The comparison between the LWOA-PID and the WOA-PID under the same number of iterations is shown in Figure 11.
From Figure 11, it can be seen that the LWOA-PID algorithm shows a faster optimization speed. By the fifth iteration, the fitness value can reach below 0.04, while the traditional WOA-PID requires eight iterations to achieve the same level. This demonstrates that the LWOA-PID possesses better optimization velocity.
Figure 11 further demonstrates that the more parameter space that is initially covered by the optimization algorithm, the better the results that can be achieved in a shorter time.

4.4. Combined Control

The analyses in Section 4.1 and Section 4.2 indicate that the standalone conversion module can eliminate the impact of roll channel disturbances on the LOS axis, but it has the issue of excessive system delay. Using the LWOA-PID controller alone allows the system to quickly reach a steady state, but it cannot eliminate the impact of roll channel disturbances on the LOS axis. In this section, the conversion module is combined with LWOA-PID and introduced into the system model. Their tracking results for step and sinusoidal signals are shown in Figure 12.
From Figure 12, it can be seen clear that the control method combining the conversion module and LWOA-PID inherits the advantages of both the LWOA-PID controller and the conversion module. Notably, for step signal tracking, the steady-state error was reduced to 0.002 rad, and a steady state was reached within 0.5 s. For sinusoidal signal tracking, the tracking error was reduced by an order of magnitude.
The results in Figure 12 align with the design concept of the conversion module in Section 3. The conversion module aims to achieve ω r i y = 0 , after the LWOA-PID controller, to stabilize the platform by adjusting its angle to counteract pitch and yaw disturbances. According to Equation (7), with no platform deflection, ω d i y = 0 , eliminating the impact of roll disturbances on the LOS. Although the lag compensation characteristic of the conversion module causes minor errors in the LOS, these are negligible.

4.5. Sensitivity Analysis of the Conversion Module

In this section, sensitivity analysis is conducted to explore whether our simulation results are sensitive to frequency and amplitude of input disturbance, respectively. Simulations under different input disturbance amplitude (2, 3, 4, 5, and 6) and under different frequencies (2 Hz, 3 Hz, 4 Hz, 5 Hz, and 6 Hz) are performed. Simulation results are depicted in Figure 13 and Figure 14.
From Figure 13, it is clear that under sinusoidal disturbances of different frequencies, both the pitch and yaw deflection angles of LOS stabilize within 2 s. The yaw deflection angle of LOS does not change with the disturbance frequency, but the stabilized value of the LOS pitch direction decreases with the disturbance.
This is because as the frequency of the disturbance increases, the resistance from the previous moment becomes the control force at the current moment, leading to a decrease in the stabilized deflection angle with higher frequencies.
From Figure 14, it is clear that under sinusoidal disturbances with amplitudes of 2, 3, 4, and 5, both the pitch and yaw deflection angles of LOS tend to stabilize. When the amplitude reaches 6, the steady-state value of LOS yaw remains unchanged, but there is a noticeable increase in the steady-state value of LOS pitch, indicating a decline in the performance of the conversion module.
This is because larger amplitude results in larger roll angles. The principle of the conversion module is similar to lag compensation, where larger disturbances weaken the stability of the feedback loop. This may cause oscillations or overshoot in the system, both of which contribute to an increase in the steady-state value.
Combining Figure 13 and Figure 14, it is clear that while the LOS yaw consistently stabilizes between 0.6 and 0.7 with different disturbances, the LOS pitch does not. This discrepancy is primarily due to the following two reasons:
(1) Reference [27] demonstrated that the pitch axis is more susceptible to disturbances than the yaw axis. This indicates that the pitch axis is more prone to changes when subjected to disturbances.
(2) Larger disturbance amplitudes result in correspondingly larger amplitudes of the disturbance angular velocity. According to Equations (12) to (14), the value of φ y increases for the roll channel, while φ x z remains unchanged, leading to a change in the range of φ x y z . The sine function has opposite signs on either side of zero, and the conversion module uses this function to calculate the pitch disturbance after conversion. This introduces errors in the delay compensation of the conversion module.
These two factors together result in a nonunique steady-state value for the LOS pitch. Although the steady-state value of the LOS pitch is nonunique, the conversion module still eliminates the impact of roll channel disturbances on the LOS axis compared to Figure 7a.

5. Conclusions

This paper proposed a disturbance transformation method that converts three-axis LOS angular velocity disturbances into two-axis ones, aiming to achieve effective control of roll channel disturbances in traditional two-axis semi-strapdown stabilized platforms for aircraft. We refer to this disturbance transformation method as the conversion module. To enhance the tracking stability of the aircraft’s two-axis semi-strapdown stabilized platform LOS axis, an adaptive control method using LWOA-PID was introduced.
The simulation results indicate that a single conversion modulecan stabilize the disturbance in the roll channel after 2 s. However, it results in excessive delay. Conversely, the LWOA-PID controller method quickly reaches a steady state but fails to stabilize disturbances in the roll channel. The combination of the conversion moduleand LWOA-PID adaptive control not only reduces disturbances in the roll channel on the sensor’s LOS axis but also decreases the time to reach a steady state. The steady-state error is 0.002 rad, with a stabilization time of 0.5 s.
The conversion moduleprovides robust results in the presence of different frequencies in the roll channel, but it performs poorly in controlling disturbance of larger magnitudes. This is an area that requires further study.

Author Contributions

Conceptualization, Q.H. and X.C.; methodology, Q.H.; validation, Q.H. and X.C.; formal analysis, Q.H. and J.Z.; investigation, X.C. and J.Z.; resources, Q.H.; data curation, X.C.; writing—original draft preparation, Q.H., J.Z. and Q.L.; writing—review and editing, J.Z., Q.L. and X.C.; visualization, Q.L. and R.C.; supervision, Q.H.; project administration, J.Z.; funding acquisition, J.Z. All authors have read and agreed to the published version of the manuscript.

Funding

This research was supported in part by Youth Fund of the National Natural Science Foundation of China, China (grant number 52305117); in part by Xiamen Municipal Bureau of Science and Technology under the Natural Science Foundation of Xiamen, China (grant number 3502Z20227072); in part by Fujian Provincial Department of Science and Technology under the Natural Science Foundation of Fujian Province, China (grant number 2022J05286 and grant number 2023J011431); in part by National Natural Science Foundation of China, China (grant number 52075446); in part by Fujian Provincial Department of Education under the Youth Foundation of Fujian Educational Committee, Fujian, China (grant number JAT210343); and in part by Xiamen University of Technology under the Startup Fund for Distinguished Scholars, Xiamen University of Technology of China (grant number YKJ22019R).

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Data are contained within the article.

Conflicts of Interest

The authors declare no conflicts of interest.

References

  1. Laššák, M.; Draganova, K.; Blišťanová, M.; Kalapoš, G.; Mikloš, J. Small UAV Camera Gimbal Stabilization Using Digital Filters and Enhanced Control Algorithms for Aerial Survey and Monitoring. Acta Montan. Slovaca 2020, 25, 127. [Google Scholar]
  2. Liu, Z.Y. Research on Error Analysis and Structural Optimization of Semi-Strapdown Inertial Stabilized Platform for Aerial Remote Sensing; Changchun Institute of Optics, Fine Mechanics and Physics, Chinese Academy of Sciences: Changchun, China, 2017. [Google Scholar]
  3. Wang, Y.; Lei, H.; Ye, J.; Bu, X. Backstepping sliding mode control for radar seeker servo system considering guidance and control system. Sensors 2018, 18, 2927. [Google Scholar] [CrossRef] [PubMed]
  4. Zhang, C.Y. The Research of Nonlinear Hyperchaos System Synchronization; Northeast Petroleum University: Daqing, China, 2015. [Google Scholar]
  5. Bai, E.W.; Lonngren, K.E. Sequential synchronization of two Lorenz systems using active control. Chaos Solitons Fractals 2000, 11, 1041–1044. [Google Scholar] [CrossRef]
  6. Almatroud, O.A.; Shukur, A.A.; Pham, V.-T.; Grassi, G. Oscillator with Line of Equilibiria and Nonlinear Function Terms: Stability Analysis, Chaos, and Application for Secure Communications. Mathematics 2024, 12, 1874. [Google Scholar] [CrossRef]
  7. Sui, S.; Zhao, T. Active disturbance rejection control for optoelectronic stabilized platform based on adaptive fuzzy sliding mode control. ISA Trans. 2022, 125, 85–98. [Google Scholar] [CrossRef] [PubMed]
  8. Battistel, A.; Oliveira, T.R.; Rodrigues, V.H.P.; Fridman, L. Multivariable binary adaptive control using higher-order sliding modes applied to inertially stabilized platforms. Eur. J. Control 2022, 68, 28–39. [Google Scholar] [CrossRef]
  9. Liu, X.; Yang, J.; Qiao, P. Gain Function-Based Visual Tracking Control for Inertial Stabilized Platform with Output Con-straints and Disturbances. Electronics 2022, 11, 1137. [Google Scholar] [CrossRef]
  10. Guo, B.; Ke, F.; Yu, X.; Gao, X.; Sun, A. Control Strategy for Photoelectric Stabilized Platform Based on Sliding Mode Variable Structure Control. Acta Armamentarii 2022, 43, 1874. [Google Scholar]
  11. Ren, Y. Advanced Motion Control for Optoelectronic Tracking Systems; Beijing, Science Press: Beijing, China, 2017. [Google Scholar]
  12. Melo, A.G.; Andrade, F.A.A.; Guedes, I.P.; Carvalho, G.F.; Zachi, A.R.L.; Pinto, M.F. Fuzzy gain-scheduling PID for UAV position and altitude controllers. Sensors 2022, 22, 2173. [Google Scholar] [CrossRef]
  13. Tan, K.K.; Lee, T.H.; Khoh, C.J. PID-Augmented Adaptive Control of a Gyro Mirror Los System. Asian J. Control 2002, 4, 240–245. [Google Scholar] [CrossRef]
  14. Wei, J.; Qi, L. Application of adaptive fuzzy PID controller to tracker line of sight stabilized system. Control Theory Appl. 2008, 25, 278–282. [Google Scholar]
  15. Sabir, M.M.; Ali, T. Optimal PID controller design through swarm intelligence algorithms for sun tracking system. Appl. Math. Comput. 2016, 274, 690–699. [Google Scholar] [CrossRef]
  16. Wang, J.S.; Wang, J.C.; Wang, W. Self-tuning of PID parameters based on particle swarm optimization. Control Decis. 2005, 20, 5. [Google Scholar]
  17. Yamamoto, T.; Shah, S.L. Design and experimental evaluation of a multivariable self-tuning PID controller. IEEE Proc.-Control Theory Appl. 2004, 151, 645–652. [Google Scholar] [CrossRef]
  18. Kownacki, C.; Ambroziak, L. Asymmetrical artificial potential field as framework of nonlinear PID loop to control position tracking by nonholonomic UAVs. Sensors 2022, 22, 5474. [Google Scholar] [CrossRef] [PubMed]
  19. Jin, G.G.; Son, Y.D. Design of a nonlinear PID controller and tuning rules for first-order plus time delay models. Stud. Inform. Control 2019, 28, 157–166. [Google Scholar] [CrossRef]
  20. Şahin, M. Stabilization of Two Axis Gimbal System with Self Tuning PID Control. Politeknik Dergisi 2023. [Google Scholar] [CrossRef]
  21. Mirjalili, S.; Lewis, A. The whale optimization algorithm. Adv. Eng. Softw. 2016, 95, 51–67. [Google Scholar] [CrossRef]
  22. Feng, X.; Donghai, L.; Yali, X. Comparing and optimum seeking of PID tuning methods base on ITAE index. Proc.-Chin. Soc. Electr. Eng. 2003, 23, 206–210. [Google Scholar]
  23. McKay, M.D.; Beckman, R.J.; Conover, W.J. A comparison of three methods for selecting values of input variables in the analysis of output from a computer code. Technometrics 2000, 42, 55–61. [Google Scholar] [CrossRef]
  24. Wang, G.Y.; Yu, H.; Yang, D.C. Decision Table Reduction based on Conditional Information Entropy. Chin. J. Comput. 2002, 25, 759–766. [Google Scholar]
  25. Deng, F.Y.; Zou, Y. Simulation of stable tracking control for gimbal of phase array seeker. Syst. Eng. Electron. 2013, 35, 402–407. [Google Scholar]
  26. Peng, F. Research on Parameter Self Tuning of Permanent Magnet Synchronous Motor Control Systems; Guangdong University of Technology: Guangzhou, China, 2016. [Google Scholar]
  27. Ji, T.; Ji, M.; Xu, Q.Q.; Wu, Y.J.; Xue, F. Modeling and dynamic characteristics analysis of airborne photoelectric stabilization platform. Laser Infrared 2021, 51, 206–211. [Google Scholar]
Figure 1. Two-axis semi-strapdown stabilized platform system.
Figure 1. Two-axis semi-strapdown stabilized platform system.
Sensors 24 05198 g001
Figure 2. Equivalent circuit diagram of the DC torque motor and platform load.
Figure 2. Equivalent circuit diagram of the DC torque motor and platform load.
Sensors 24 05198 g002
Figure 3. Disturbance relationship.
Figure 3. Disturbance relationship.
Sensors 24 05198 g003
Figure 4. System control diagram.
Figure 4. System control diagram.
Sensors 24 05198 g004
Figure 5. WOA-PID controller diagram.
Figure 5. WOA-PID controller diagram.
Sensors 24 05198 g005
Figure 6. Algorithm procedure and application of LWOA-PID.
Figure 6. Algorithm procedure and application of LWOA-PID.
Sensors 24 05198 g006
Figure 7. Performance of the conversion module.
Figure 7. Performance of the conversion module.
Sensors 24 05198 g007
Figure 8. Controller step tracking comparison chart.
Figure 8. Controller step tracking comparison chart.
Sensors 24 05198 g008
Figure 9. Controller sinusoidal tracking effect comparison.
Figure 9. Controller sinusoidal tracking effect comparison.
Sensors 24 05198 g009
Figure 10. Comparison of two distribution methods.
Figure 10. Comparison of two distribution methods.
Sensors 24 05198 g010
Figure 11. Comparison of LWOA-PID and WOA-PID.
Figure 11. Comparison of LWOA-PID and WOA-PID.
Sensors 24 05198 g011
Figure 12. Combined control tracking.
Figure 12. Combined control tracking.
Sensors 24 05198 g012
Figure 13. Different frequencies.
Figure 13. Different frequencies.
Sensors 24 05198 g013
Figure 14. Different amplitudes.
Figure 14. Different amplitudes.
Sensors 24 05198 g014
Table 1. Conversion module algorithm flow.
Table 1. Conversion module algorithm flow.
Conversion Algorithm Table
Input: ω x t 1 , ω z t 1 , and  φ y t 1
Output: ω x t 1 and ω z t 1
1. Begin
2. Initialize Conversion Module
3. While ( t > 0 ) do:
4. The combined disturbance at the current time is calculated using Equations (11) to (14).
5. Roll disturbances are compensated using Equation (15).
6. Return to Step 4.
7. End while
8. End
Table 2. Latin hypercube sampling algorithm.
Table 2. Latin hypercube sampling algorithm.
Latin Hypercube Sampling Algorithm
Input: Population size and dimensionality.
Out: Population randomly distributed in the dimension.
1. Determine the population size N and the population dimension D.
2. Set the interval for variable x as [xmin, xmax], where xmin and
    xmax are the lower and upper bounds of the quantity.
3. Divide the interval [xmin, xmax] into N equal subintervals.
4. Randomly select a point within each subinterval in every dimension.
5. Combine the points from each dimension to form the initial population.
Table 3. LWOA-PID Module algorithm flow.
Table 3. LWOA-PID Module algorithm flow.
LWOA-PID Calculation Process
Input: The number of whale, the values of Ksum and the range of kp, ki, kd
Output: The optimal control parameters
1.   Latin hypercube sampling to initialize the whales population
2.   Calculate the fitness of each search agent according to Equation (25),
      X* = the optimal control parameters
3.   while ( k < k s u m )
4.   for Update a, A, C, l, and p
5.   if1 (p < 0.5)
6.   If2 (|A| < 1)
7.   Update the position of the current search agent by the Equation (16)
8.   Else if2 (|A| >= 1)
9.   Update the position of the current search agent by the Equation (20).
10.   End if2
11.   else if1 (p >= 0.5)
12.   Update the position of the current search by the Equation (18).
13.   end if1
14.   End for
15.   Check if any search agent goes beyond the search space and amend it
16.   Calculate the fitness of each search agent. Update X* if there is a better solution
17.   K = k + 1
18.   End while
Table 4. The simulation parameter specifications.
Table 4. The simulation parameter specifications.
ParameterValue
Input sinusoidal disturbance1 rad/s, 1 Hz
Number of whales30
Number of iterate30
Optimization parameter range0–100
Initial LOS axis pitch0 rad
Initial LOS axis yaw0 rad
C m 0.85 Nm / A
C e 0.85 V / rad / s
J 0.0017 kg m 2
R 4.5 Ω
f m 0
Table 5. Comparison of LWOA-PID and classical PID.
Table 5. Comparison of LWOA-PID and classical PID.
Optical YawOptical Pitch
Stable TimeMax Optical ErrorStable TimeMax Optical Error
setp PID0.820.020750.02
setp NPSO-PID0.540.010.530.01
sinusoidal PID-0.02-0.002
sinusoidal NPSO-PID-0.005-0.0025
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Huang, Q.; Zhou, J.; Chen, X.; Li, Q.; Chen, R. Adaptive Control for a Two-Axis Semi-Strapdown Stabilized Platform Based on Disturbance Transformation and LWOA-PID. Sensors 2024, 24, 5198. https://doi.org/10.3390/s24165198

AMA Style

Huang Q, Zhou J, Chen X, Li Q, Chen R. Adaptive Control for a Two-Axis Semi-Strapdown Stabilized Platform Based on Disturbance Transformation and LWOA-PID. Sensors. 2024; 24(16):5198. https://doi.org/10.3390/s24165198

Chicago/Turabian Style

Huang, Qixuan, Jiaxing Zhou, Xiang Chen, Qing Li, and Runjing Chen. 2024. "Adaptive Control for a Two-Axis Semi-Strapdown Stabilized Platform Based on Disturbance Transformation and LWOA-PID" Sensors 24, no. 16: 5198. https://doi.org/10.3390/s24165198

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop