Low-Cost Sensors State Estimation Algorithm for a Small Hand-Launched Solar-Powered UAV

In order to reduce the cost of the flight controller and improve the control accuracy of solar-powered unmanned aerial vehicle (UAV), three state estimation algorithms based on the extended Kalman filter (EKF) with different structures are proposed: Three-stage series, full-state direct and indirect state estimation algorithms. A small hand-launched solar-powered UAV without ailerons is used as the object with which to compare the algorithm structure, estimation accuracy, and platform requirements and application. The three-stage estimation algorithm has a position accuracy of 6 m and is suitable for low-cost small, low control precision UAVs. The precision of full-state direct algorithm is 3.4 m, which is suitable for platforms with low-cost and high-trajectory tracking accuracy. The precision of the full-state indirect method is similar to the direct, but it is more stable for state switching, overall parameters estimation, and can be applied to large platforms. A full-scaled electric hand-launched UAV loaded with the three-stage series algorithm was used for the field test. Results verified the feasibility of the estimation algorithm and it obtained a position estimation accuracy of 23 m.


Introduction
Solar-electrically powered fixed-wing unmanned aerial vehicles (UAVs) promise significantly increased flight endurance over pure electrically or even gas-powered aerial vehicles. Large-scale disaster relief, meteorological surveys in remote areas, and continuous border or wildlife protection benefit in particular from the multi-hour continuous flight capability provided by these robotic systems [1]. Traditional solar-powered UAVs require runways or complicated catapults for take-off and landing which are not commonly available in most field areas. The large size makes it inconvenient to apply and carry. The size of the UAV can be reduced to a wingspan of 2 to 5 m. With its excellent aerodynamic shape and lightweight structure, the hand-launched solar-powered UAV has great advantages in convenient application, long-endurance, and various mission execution [2][3][4].
Smaller-scale solar-powered UAVs are mostly designed for low-altitude long-endurance (LALE) applications [5]. Though faced with the more challenging meteorological phenomena of the lower atmosphere, low-altitude UAVs provide great potential of higher resolution imaging, reduced complexity and cost and simplified handling, for example, through hand-launched take-off. As a verification scheme, SoLong [3] has achieved a continuous 48-h flight using solar power and actively seeking out thermal updrafts, and Skysailor [4] has achieved a continuous 27-h solar-powered flight without the use of thermals, but both of these require a pilot to control them. AtlantikSolar [5] has  In this paper, three novel state estimation algorithms are proposed to improve the measurement accuracy of low-cost sensors, reduce the cost of flight controller, and realize the application of three-stage series method in hand-launched solar-powered UAV. Additionally, the UAV is special, as it is designed without ailerons and a landing gear to ensure that the full wing is covered with solar cells and is lightweight (Figure 1). Since only the rudder is used for lateral control, the trajectory tracking accuracy of such a UAV is poor, and the state estimation algorithms can combine the characteristics of the UAV to achieve reliable heading estimation, ensuring that it meets the mission requirements and realizes the reduction of platform cost.
Sensors 2019, 19, x FOR PEER REVIEW 3 of 23 designed without ailerons and a landing gear to ensure that the full wing is covered with solar cells and is lightweight (Figure 1). Since only the rudder is used for lateral control, the trajectory tracking accuracy of such a UAV is poor, and the state estimation algorithms can combine the characteristics of the UAV to achieve reliable heading estimation, ensuring that it meets the mission requirements and realizes the reduction of platform cost. The paper is organized as follows. Low-cost sensors measurement error model and error statistics are described in Section 2. Section 3 presents three state estimation algorithms based on EKF. Section 4 verifies the above algorithms according to the whole mission path simulation. The field experiment results and model calibration methods are presented in Section 5, and Section 6 concludes the paper. The paper is organized as follows. Low-cost sensors measurement error model and error statistics are described in Section 2. Section 3 presents three state estimation algorithms based on EKF. Section 4 verifies the above algorithms according to the whole mission path simulation. The field experiment results and model calibration methods are presented in Section 5, and Section 6 concludes the paper.

Sensors Measurement Error Model
The sensors combination in the low-cost flight controller is usually composed of MEMS IMU, magnetometer, pressure sensor and GPS [18], as shown in Figure 2. The SBG-Ellipse IMU module is chosen as an industrial-grade accuracy comparison.

Sensors Measurement Error Model
The sensors combination in the low-cost flight controller is usually composed of MEMS IMU, magnetometer, pressure sensor and GPS [18], as shown in Figure 2. The SBG-Ellipse IMU module is chosen as an industrial-grade accuracy comparison. The IMU consists of a triaxial gyroscope, a triaxial accelerometer, the hardware is MPU6050. The accelerometer with a capacitive transducer to convert the mass displacement into a voltage output. The measurements are subject to signal bias and random uncertainty, and the simulation model is constructed as follows: y accel,x =u +qw-rv+gsin θ+β accel,x +η accel,x y accel,y =v +ru-pw+gcosθsinϕ+β accel,y +η accel,y y accel,z =w +pv-qv+gcosθsinϕ+β accel,z +η accel,z (1) where accel  is a bias term, which is dependent on temperature and should be calibrated prior to each flight. The accel  is zero-mean Gaussian noise with the variance 2 accel  . The output of a gyroscope can be modeled as The IMU consists of a triaxial gyroscope, a triaxial accelerometer, the hardware is MPU6050. The accelerometer with a capacitive transducer to convert the mass displacement into a voltage output. The measurements are subject to signal bias and random uncertainty, and the simulation model is constructed as follows: u + qw − rv + gsinθ + β accel,x +η accel,x y accel,y = . v + ru − pw + gcosθsinϕ+β accel,y +η accel,y y accel,z = . w + pv − qv + gcosθsinϕ+β accel,z +η accel,z where β accel is a bias term, which is dependent on temperature and should be calibrated prior to each flight. The η accel is zero-mean Gaussian noise with the variance σ 2 accel . The output of a gyroscope can be modeled as γ gyro = k gyro Ω + β gyro + η gyro (2) where γ gyro corresponds to the measured angular rate in volts; k gyro is a gain converting the rate in radians per second to volts and Ω is the angular rate (these two items can be replaced by the real angular rate in the simulation); β gyro is a bias term, mainly dependent on temperature, and the drift is obviously greater than β accel ; η gyro is zero-mean Gaussian noise with covariance σ 2 gyro . The measurement model of the triaxial magnetometer is as follows: where β and η are similar to the above, and R is a direction cosine matrix. The pressure sensor is divided into absolute pressure sensor to measure altitude and differential pressure sensor to measure airspeed. The measurement models are In the GPS measurement process, not only does the size of the positioning error need to be considered, but also the dynamic characteristics of the error are required. To model the transient behavior of the error, the Gauss-Markov process proved to be effective [19], and the expression is as follows: The GPS measurement information includes UAV space position, ground speed and heading angle can be modeled as y GPS,n/e/h [n] = p n/e/h [n] + v n/e/h [n] (7) where η V and η χ are zero-mean Gaussian processes with variance σ 2 V g and σ 2 χ , which can be obtained by using basic principles of uncertainty analysis: The statistical results of various low-cost sensor measurement errors are shown in Table 1, and the SBG-Ellipse is used for comparison.
According to the flight conditions of the UAV at low altitude, with an altitude of 600 m and an airspeed of 12.5 m/s during cruising conditions, combined with what from Table 1, the sensors are simulated as follows: No wind, an altitude of 600 m, an airspeed of 12.5 m/s, the controller temperature is 25 • C and remains unchanged, combined with the orthogonal error and bias of Table 1, the simulation results of various low-cost sensors are as follows. The solid line represents the true state and the dashed line represents the simulated measurement.
In Figure 3, (a,b), which is the IMU simulation, refers to Equations (1) and (2), where the accelerometer measurement is a high frequency signal; (c) is a magnetometer (refer to Equation (3)), and the measurement is a medium-low frequency signal. In order to consider the interference of the solar cell, the model error is appropriately increased, making the measurement slightly unstable; (d,e) is GPS (refer to Equations (6)- (8)); and (f) is pressure sensors simulation, as low frequency as GPS. The sensor modeling process mainly considers the influence of Gaussian white noise and bias, which is reflected in the range of variation range, frequency and steady-state deviation of the measured value. For the dynamic process, the measurement is consistent with the trend of the true signal. When entering the steady-state, the measurement noise is large and there is a significant deviation. temperature is 25 °C and remains unchanged, combined with the orthogonal error and bias of Table  1, the simulation results of various low-cost sensors are as follows. The solid line represents the true state and the dashed line represents the simulated measurement.
In Figure 3, (a) and (b), which is the IMU simulation, refers to Equations (1) and (2), where the accelerometer measurement is a high frequency signal; (c) is a magnetometer (refer to Equation (3)), and the measurement is a medium-low frequency signal. In order to consider the interference of the solar cell, the model error is appropriately increased, making the measurement slightly unstable; (d,e) is GPS (refer to Equations (6)- (8)); and (f) is pressure sensors simulation, as low frequency as GPS. The sensor modeling process mainly considers the influence of Gaussian white noise and bias, which is reflected in the range of variation range, frequency and steady-state deviation of the measured value. For the dynamic process, the measurement is consistent with the trend of the true signal. When entering the steady-state, the measurement noise is large and there is a significant deviation.

EKF State Estimation Structure
The extended Kalman filter is similar to the linear Kalman filter, which uses an estimate of statistical variance to calculate the weight of sensor corrections to state estimates [20,21]. The state and observation equations of the nonlinear system are as follows: x =f x,u +w t z k =h x t k ,u +v k (10) where ( ) t w is used to account for disturbance and unmodeled part, k v represents the measurement noise. It is assumed that the ( ) t w and k v are zero-mean Gaussian noise, and covariance Q and R, respectively. The EKF is first-order linearization near the state, and the system time update equations are P =A x ,u P+PA x ,u T +Q For the update of state estimates when a measurement is received, the measurement update equations are

EKF State Estimation Structure
The extended Kalman filter is similar to the linear Kalman filter, which uses an estimate of statistical variance to calculate the weight of sensor corrections to state estimates [20,21]. The state and observation equations of the nonlinear system are as follows: .
where w(t) is used to account for disturbance and unmodeled part, v k represents the measurement noise. It is assumed that the w(t) and v k are zero-mean Gaussian noise, and covariance Q and R, respectively. The EKF is first-order linearization near the state, and the system time update equations are . x= f(x, u) A(x, u) = ∂f(x, u) ∂x | x=x (12) . P = A(x, u)P + PA(x, u) T +Q (13)  For the update of state estimates when a measurement is received, the measurement update equations are where A is the linearized state update matrix, C is the linearized model output matrix, P is the state covariance matrix, L is the Kalman gain matrix, Q is the process noise covariance matrix, and R is the sensor covariance matrix. Based on the EKF, this paper divides the state estimation algorithm into full-state estimation and three-state series estimation method according to whether the estimation structure is hierarchical. The full-state estimation consists of the direct and indirect method. The same hand-launched UAV simulation model was used, with an altitude of 600 m and an airspeed of 12.5 m/s, and the hovering condition of the windless conditions.

Three-Stage Series State Estimation
This algorithm divides the estimation process into three stages. Firstly, the measurement data are low-pass filtered, and gyroscope data are used for prediction and combined with the accelerometer for measurement update, which is the altitude estimation. The second stage is the heading estimation, especially when the UAV is flying in the wind field. The accurate heading angle is crucial for stable control. The final stage is the navigation estimation, based on the previous results and fused with GPS for measurement updates. The algorithm structure is shown in Figure 4.

Three-Stage Series State Estimation
This algorithm divides the estimation process into three stages. Firstly, the measurement data are low-pass filtered, and gyroscope data are used for prediction and combined with the accelerometer for measurement update, which is the altitude estimation. The second stage is the heading estimation, especially when the UAV is flying in the wind field. The accurate heading angle is crucial for stable control. The final stage is the navigation estimation, based on the previous results and fused with GPS for measurement updates. The algorithm structure is shown in Figure 4.

Attitude Estimation
For this stage, the states, inputs and outputs are The state variables to be estimated in this stage are pitch and roll. Angular rates, airspeed and altitude make up the input vector, u, and body frame accelerations composed the system outputs, z, for this stage. According to the relationship between body frame rotations and changes in roll and

Attitude Estimation
For this stage, the states, inputs and outputs are The state variables to be estimated in this stage are pitch and roll. Angular rates, airspeed and altitude make up the input vector, u, and body frame accelerations composed the system outputs, z, for this stage. According to the relationship between body frame rotations and changes in roll and pitch angle [22], the time update of the states is After evaluating the linearization about the current estimate states, the linearized state update matrix A is obtained: According to Equation (1), assuming that linear acceleration is zero, that is, w ≈ 0, the measurement update and linearized model output matrix C are shown as follows.
Using Equations (11) to (17), the state covariance and Kalman gain matrix are updated to achieve the altitude angle estimate. The simulation results of this stage are as follows.
As shown in Figure 5, the subscribe hat and true are the estimated and real state, respectively. Using the variable gain observer (VGO) as a comparison, the three-stage series algorithm has higher accuracy for altitude estimation. The noise of the gyroscope is reflected in the time update, while the accelerometer noise is applied to the measurement update, and the estimated altitude is used as the input of the heading estimation.
Using Equations (11) to (17), the state covariance and Kalman gain matrix are updated to achieve the altitude angle estimate. The simulation results of this stage are as follows.
As shown in Figure 5, the subscribe hat and true are the estimated and real state, respectively. Using the variable gain observer (VGO) as a comparison, the three-stage series algorithm has higher accuracy for altitude estimation. The noise of the gyroscope is reflected in the time update, while the accelerometer noise is applied to the measurement update, and the estimated altitude is used as the input of the heading estimation.

Heading Estimation
An accurate heading is important to the lateral control of a UAV without ailerons. The rudder maneuvering produces a yaw moment, then the side slip occurs, and the UAV rolls depending on its own stability. Since the roll control is not direct, it will affect the trajectory tracking accuracy. Magnetometer update heading estimation is useful for cases where a wind induced crab needs to be accounted for when interpreting data from cameras or other sensors [23]. Due to the interference of

Heading Estimation
An accurate heading is important to the lateral control of a UAV without ailerons. The rudder maneuvering produces a yaw moment, then the side slip occurs, and the UAV rolls depending on its own stability. Since the roll control is not direct, it will affect the trajectory tracking accuracy. Magnetometer update heading estimation is useful for cases where a wind induced crab needs to be accounted for when interpreting data from cameras or other sensors [23]. Due to the interference of the solar cell, the magnetometer can be externally mounted and installed at the wing tip to obtain accurate measurement, which is suitable for large aspect ratio solar-powered UAV. The groundspeed will reduce under windy conditions and the heading approximated from GPS will become inaccurate, leading to the vehicle flying uncontrollably downwind [24]. In this stage, the heading estimation is a single-state EKF. The state, inputs and outputs are The time update of the estimation using gyroscope measurements by the expression As the single-state linearization yields a zero matrix, only model noise is considered in the covariance matrix update process. The sensor model is simply a rotational transformation of the earth-frame magnetic field to the body-frame sensor, given by Linearizing the current estimates, the linearized model output matrix is The heading estimation simulation is performed using the UAV hovering state, as shown in Figure 6. As the VGO does not have a separate heading estimate, the simulation results are compared with the real and estimated yaw angle.
os cos cos sin sinˆˆˆŝ in sin cos cos sin sin sin sin cos cos sin coŝˆĉ os sin cos sin sin cos sin sin sin cos cos coŝ Linearizing the current estimates, the linearized model output matrix is os sin cos cos ,ˆˆˆ, ( sin sin sin cos cos ) (sin sin sin cos sin )ˆˆ( sin sin sin cos cos ) (sin sin sin cos sin ) x y x y The heading estimation simulation is performed using the UAV hovering state, as shown in Figure 6. As the VGO does not have a separate heading estimate, the simulation results are compared with the real and estimated yaw angle.
Since the solar cell will affect the measurement of the magnetometer, the bias and noise are more obvious, as shown in Figure 3c. Accurate attitude estimation can ensure the accuracy of heading prediction. The measurement update of the magnetometer makes the trend of estimation consistent with the real state. The simulation result has a delay of 1 s and an error of 2 degrees.

Navigation Estimation
The final stage of this state estimation scheme keeps an estimate of vehicle location and path angle. With the altitude and heading obtained in first two stages and measured airspeed, the location, groundspeed and course angle of the airplane are predicted using a simple kinematic model and check against GPS measurements [25]. If the flight path angle =0  , then the evolution of the position is given by Since the solar cell will affect the measurement of the magnetometer, the bias and noise are more obvious, as shown in Figure 3c. Accurate attitude estimation can ensure the accuracy of heading prediction. The measurement update of the magnetometer makes the trend of estimation consistent with the real state. The simulation result has a delay of 1 s and an error of 2 degrees.

Navigation Estimation
The final stage of this state estimation scheme keeps an estimate of vehicle location and path angle. With the altitude and heading obtained in first two stages and measured airspeed, the location, groundspeed and course angle of the airplane are predicted using a simple kinematic model and check against GPS measurements [25]. If the flight path angle γ = 0, then the evolution of the position is given by By differentiating Equation (8), the evolution of the ground speed is given by According to the kinematic equation of the aircraft during the coordinated turning process, the evolution of χ is given by The state, inputs and output of this stage is The nonlinear propagation and linearized state update matrix are given by GPS measurement information includes position, ground speed and course angle. In order to estimate the wind field, a pseudo measurement of wind speed is constructed as follows: Therefore, the measurement update and the Jacobian matrix are given by The simulation results of the navigation estimation are shown in Figure 7. The estimation results of ground speed and wind field are better than the VGO algorithm; the groundspeed static bias is 0.5 m/s, which is improved to less than 0.2 m/s. The estimated GPS course is based on the results of the first two stages, so the position accuracy is higher. Algorithm 1 summary of the three-stage series estimation method.
Therefore, the measurement update and the Jacobian matrix are given by The simulation results of the navigation estimation are shown in Figure 7. The estimation results of ground speed and wind field are better than the VGO algorithm; the groundspeed static bias is 0.5 m/s, which is improved to less than 0.2 m/s. The estimated GPS course is based on the results of the first two stages, so the position accuracy is higher. Algorithm 1 summary of the three-stage series estimation method.  The same process as the stage 1, sensor measurement update is different, Equations (24)

Full-State Direct State Estimation
The hierarchical method is used to simplify the model, reduce the order of the matrix, ignore the mutual influence of the state parameters, and obtain a reliable heading estimation. This reduces the amount of calculation necessary but the accuracy is limited. The full-state method treats all parameters as a whole, the measurement error of IMU is used as a time update, and other sensors are used as measurement update to get the complete state.
When the mission is sensitive to airspeed and altitude, and the flight controller has feasible computing power, full-state direct state estimation is a suitable method to apply. The algorithm structure is shown in Figure 8. Due to the different sampling frequencies, the corresponding state of the fast sensor measurement update using the air pressure sensor includes altitude, airspeed and side slip angle pseudo measurement [26]. The states corresponding to the slow update using GPS include location, ground speed and course.    T  T  T  T  T  T  T  T  T  accel  gyro x = P , V ,θ , b , w y = y , y Using the gyro and accelerometer models, the equations of motion can be written as , b is the bias vector, η is the noise vector, w is the wind filed vector,   R θ is the direction cosine matrix, and   S θ is the transformation matrix of the angular velocity of body axes to inertial axes. Therefore, the state propagation equation is x =f x,y +G g x η gyro +G a x η accel +η The time update model of the state and the Jacobian matrices are as follows: Using the gyro and accelerometer models, the equations of motion can be written as where P = (p n , p e , p d ) T , V = (u, v, w) T , θ = (φ, θ, ψ) T , ω = (p, q, r) T , b is the bias vector, η is the noise vector, w is the wind filed vector, R(θ) is the direction cosine matrix, and S(θ) is the transformation matrix of the angular velocity of body axes to inertial axes. Therefore, the state propagation equation is . x = f(x, y)+G g (x)η gyro +G a (x)η accel +η (35) The time update model of the state and the Jacobian matrices are as follows: The fast sensor measurement update includes three parts, static and differential pressure sensor and pseudo side-slip angle. According to Equations (4) and (5), the measurement model and associated Jacobian matrices are given by With the given sensors, the side-slip angle or side-to-side velocity is unobservable and drift occurs, but it is important when the control system needs to obtain reliable lateral information to control the flight path [12]. To correct this parameter, a pseudo measurement is proposed on the side-slip angle by assuming that it is zero. Therefore, the model for the pseudo-sensor is given by The associate Jacobian matrix is given by The GPS measurement is updated at a low frequency, including north and east position, ground speed and heading. Similarly, the measurement model and the corresponding Jacobian matrices are as follows: The comparison between the real and the estimate state of all parameters is shown in Figure 9. Algorithm 2 is a summary of full-state direct state estimation method.
Compared with Figures 5 and 6, the accuracy of full-state method is obviously superior in position, speed, and heading. When entering the steady state, the altitude deviation is small, the error precision is less than 8%, the GPS-related state measurement accuracy is higher, and the position error precision is approximately 3 m, ensuring sufficient trajectory tracking accuracy. Due to the increase of accuracy of the estimated ground speed and course, this method is suitable for reliable trajectory tasks or fixed-area hovering, such as animal photography or precise takeoff and landing.

Full-State Indirect State Estimation
The direct state estimate method focuses on the observation of all measurement states, while for the indirect estimation method the idea is to filter the error states, which should satisfy the linear and Gaussian assumptions better than the direct implementation. The biggest difference of indirect method is that the error estimation vector is introduced, which is predicted by time update, and the estimation of states is achieved by observation and compensation of errors. Let x be the true state, x the estimated state, then x =x-x is the error state. Similar to the previous section, if x satisfies

Full-State Indirect State Estimation
The direct state estimate method focuses on the observation of all measurement states, while for the indirect estimation method the idea is to filter the error states, which should satisfy the linear and Gaussian assumptions better than the direct implementation. The biggest difference of indirect method is that the error estimation vector is introduced, which is predicted by time update, and the estimation of states is achieved by observation and compensation of errors. Let x be the true state,x the estimated state, then x = x −x is the error state. Similar to the previous section, ifx satisfies .

x= f(x, y)
The state error evolves according to Equation (35), .
x can be written as

x= A(x, y)+G(x)η s +η i (47)
The basic idea is to run the indirect filter on the state error, then to correct the state estimate at each step by adding in the error, and the state error is reset to zero after each correction. In the time update process, the state error propagate equation can be written as . x= A(x, y) x (48) In the measurement update process, it is also necessary to introduce a measurement of the state error, and Equation (17) can be rewritten as The state error is set to zero after each estimation, that is x=0. The algorithm is outlined in Figure 10. The basic idea is to run the indirect filter on the state error, then to correct the state estimate at each step by adding in the error, and the state error is reset to zero after each correction. In the time update process, the state error propagate equation can be written as In the measurement update process, it is also necessary to introduce a measurement of the state error, and Equation (17) can be rewritten as The state error is set to zero after each estimation, that is x = 0  . The algorithm is outlined in Figure 10.  Figure 10. Full-state indirect state estimation structure.
As the supplement to the direct filter, it is more computationally intensive and more complex, but the elimination of measurement bias is better than the first two methods. Due to the large size of the state matrix, the computation power of low-cost flight controller is a challenge. Figure 11 shows the simulation results of the indirect method, Table 2 compares the accuracy of the different algorithms, and Algorithm 3 is a summary of the method.
According to the above, it can be seen that the estimation accuracy of indirect method is better than that of direct method, and the estimation accuracy of wind field is higher. The indirect method has further improved the estimation accuracy of the altitude and position. Compared with Figure 9, the altitude deviation is small at the beginning, the deviation after steady state is reduced, and the result is more stable. Therefore, this method is suitable for large-scale solar-powered UAV or mission with high trajectory tracking accuracy. As the supplement to the direct filter, it is more computationally intensive and more complex, but the elimination of measurement bias is better than the first two methods. Due to the large size of the state matrix, the computation power of low-cost flight controller is a challenge. Figure 11 shows the simulation results of the indirect method, Table 2 compares the accuracy of the different algorithms, and Algorithm 3 is a summary of the method.
According to the above, it can be seen that the estimation accuracy of indirect method is better than that of direct method, and the estimation accuracy of wind field is higher. The indirect method has further improved the estimation accuracy of the altitude and position. Compared with Figure 9, the altitude deviation is small at the beginning, the deviation after steady state is reduced, and the result is more stable. Therefore, this method is suitable for large-scale solar-powered UAV or mission with high trajectory tracking accuracy.

Simulation
In order to verify the effectiveness of the proposed algorithm, the simulation of the complete mission path is carried out for the same UAV simulation model. A typical clime-cruise-hover-descend is used as the mission path, and the hovering process performs specific tasks, and the estimation

Simulation
In order to verify the effectiveness of the proposed algorithm, the simulation of the complete mission path is carried out for the same UAV simulation model. A typical clime-cruise-hover-descend is used as the mission path, and the hovering process performs specific tasks, and the estimation accuracy in each flight phase and state switching is obtained. The flight trajectory and estimated parameters are shown in Figures 12 and 13.
All three algorithms can achieve autonomous flight in the mission process, and the altitude and trajectory accuracy are different. As the static pressure sensor and airspeed sensor are only processed by low-pass filtering, the static bias of three-stage series method will appear in the estimation of altitude and airspeed, which is 5.3 m and 0.9 m/s, respectively, and the error of flight trajectory will also appear in the heading estimation, which is approximately 10 degrees, resulting in a position error of 6 m in the hover phase.   All three algorithms can achieve autonomous flight in the mission process, and the altitude and trajectory accuracy are different. As the static pressure sensor and airspeed sensor are only processed by low-pass filtering, the static bias of three-stage series method will appear in the estimation of altitude and airspeed, which is 5.3 m and 0.9 m/s, respectively, and the error of flight trajectory will also appear in the heading estimation, which is approximately 10 degrees, resulting in a position error of 6 m in the hover phase.
Full-state estimation method fuses the measured data of pressure sensor and GPS, and has higher accuracy of position and velocity estimation, and there is only a small error in altitude, airspeed, and groundspeed. Full-state methods can consider the mutual influence between estimated states, and the parameter is not abruptly changed during the state switching, which is obvious in the three-stage series method. The altitude and position accuracy of the direct method are 1.2 degrees and 3.4 m, respectively. The indirect method achieves similar precision, but the estimated result is more stable. Since this method is based on the elimination of state error, the altitude estimation accuracy is high and the steady-state process estimation accuracy fluctuation is small. Table 3 compares the three algorithms from five aspects: Algorithm complexity, hardware requirements, number of estimable parameters, estimation accuracy and application. The indirect full-state algorithm has the highest accuracy, but the hardware requirements are also highest. The direct full-state algorithm is more compromised, and the three-stage series has the adequate heading   All three algorithms can achieve autonomous flight in the mission process, and the altitude and trajectory accuracy are different. As the static pressure sensor and airspeed sensor are only processed by low-pass filtering, the static bias of three-stage series method will appear in the estimation of altitude and airspeed, which is 5.3 m and 0.9 m/s, respectively, and the error of flight trajectory will also appear in the heading estimation, which is approximately 10 degrees, resulting in a position error of 6 m in the hover phase.
Full-state estimation method fuses the measured data of pressure sensor and GPS, and has higher accuracy of position and velocity estimation, and there is only a small error in altitude, airspeed, and groundspeed. Full-state methods can consider the mutual influence between estimated states, and the parameter is not abruptly changed during the state switching, which is obvious in the three-stage series method. The altitude and position accuracy of the direct method are 1.2 degrees and 3.4 m, respectively. The indirect method achieves similar precision, but the estimated result is more stable. Since this method is based on the elimination of state error, the altitude estimation accuracy is high and the steady-state process estimation accuracy fluctuation is small. Table 3 compares the three algorithms from five aspects: Algorithm complexity, hardware requirements, number of estimable parameters, estimation accuracy and application. The indirect full-state algorithm has the highest accuracy, but the hardware requirements are also highest. The direct full-state algorithm is more compromised, and the three-stage series has the adequate heading Full-state estimation method fuses the measured data of pressure sensor and GPS, and has higher accuracy of position and velocity estimation, and there is only a small error in altitude, airspeed, and groundspeed. Full-state methods can consider the mutual influence between estimated states, and the parameter is not abruptly changed during the state switching, which is obvious in the three-stage series method. The altitude and position accuracy of the direct method are 1.2 degrees and 3.4 m, respectively. The indirect method achieves similar precision, but the estimated result is more stable. Since this method is based on the elimination of state error, the altitude estimation accuracy is high and the steady-state process estimation accuracy fluctuation is small. Table 3 compares the three algorithms from five aspects: Algorithm complexity, hardware requirements, number of estimable parameters, estimation accuracy and application. The indirect full-state algorithm has the highest accuracy, but the hardware requirements are also highest. The direct full-state algorithm is more compromised, and the three-stage series has the adequate heading accuracy, with the lowest controller computation requirements and simplest complexity, but the estimated parameters are limited.

Field Experiment
A full-scale electronic UAV, with a wingspan of 3 m and a weight of 3 kg without solar cells, was equipped with a low-cost flight controller and the three-stage series estimation algorithm were loaded for the full mission flight verification ( Figure 14). The cost of the flight controller is less than $3000, and the whole system is less than $8000. The experimental site is located at (108 • 56 3.07 E, 34 • 58 58.85 N), with an altitude of 630 m, an average wind speed of 3.5 m/s, a ground temperature of 10 • C, and during autumn.

Field Experiment
A full-scale electronic UAV, with a wingspan of 3 m and a weight of 3 kg without solar cells, was equipped with a low-cost flight controller and the three-stage series estimation algorithm were loaded for the full mission flight verification ( Figure 14). The cost of the flight controller is less than $3000, and the whole system is less than $8000. The experimental site is located at (108°56′3.07′' E, 34°58′58.85′' N), with an altitude of 630 m, an average wind speed of 3.5 m/s, a ground temperature of 10 °C, and during autumn. The UAV has no landing gear and it takes off through hand-launch from the car. The fuselage touches the ground when landing. The predicted state during the calculation is the altitude, position, and groundspeed. In the Figure15a,c are three-dimensional and two-dimensional flight trajectories, respectively, and (b) is parameters and commands recorded by flight controller. The directly measured states include altitude, airspeed, longitude and latitude; the IMU data are shown in the dotted line in Figure 16. Through the control of pitch and roll angle, altitude and airspeed control results, the three-stage series state estimation algorithm can provide a reliable state for flight controller. The calculation frequency is 50 Hz, and the IMU is also sampled based on the same frequency; the GPS measurement frequency is 10 Hz, which is the same as the data transmission frequency; and the data link frequency band is 915 MHz. The variation range is 8 m, the airspeed is 9-15 m/s, the groundspeed is 6-16 m/s, the roll angle accuracy is 6.5 degrees, the pitch angle is 3 degrees, the yaw angle is 9.3 degrees, and the trajectory tracking precision is nearly 23 m. The UAV has no landing gear and it takes off through hand-launch from the car. The fuselage touches the ground when landing. The predicted state during the calculation is the altitude, position, and groundspeed. In the Figure 15a,c are three-dimensional and two-dimensional flight trajectories, respectively, and (b) is parameters and commands recorded by flight controller. The directly measured states include altitude, airspeed, longitude and latitude; the IMU data are shown in the dotted line in Figure 16. Through the control of pitch and roll angle, altitude and airspeed control results, the three-stage series state estimation algorithm can provide a reliable state for flight controller. The calculation frequency is 50 Hz, and the IMU is also sampled based on the same frequency; the GPS measurement frequency is 10 Hz, which is the same as the data transmission frequency; and the data link frequency band is 915 MHz. The variation range is 8 m, the airspeed is 9-15 m/s, the groundspeed is 6-16 m/s, the roll angle accuracy is 6.5 degrees, the pitch angle is 3 degrees, the yaw angle is 9.3 degrees, and the trajectory tracking precision is nearly 23 m. The field flight test can not only verify the feasibility of the state estimation algorithm, but also calibrate some parameters in the modeling process, such as sensor measurement bias, noise and covariance matrix R. The Finite Impulse Response (FIR) filter is used to filter the flight data [27], as shown in Figure 16. The measurement result of the IMU is regarded as the raw data, and the filtered  The statistical data are of the measured noise and deviation of the IMU is shown in Table 4. For the noise of the accelerometer and the bias of the gyroscope, the value in the y direction is smaller The field flight test can not only verify the feasibility of the state estimation algorithm, but also calibrate some parameters in the modeling process, such as sensor measurement bias, noise and covariance matrix R. The Finite Impulse Response (FIR) filter is used to filter the flight data [27], as shown in Figure 16. The measurement result of the IMU is regarded as the raw data, and the filtered parameter is regarded as the real state. The bias and noise of the sensor model can be obtained by the following equations: where η correct is the corrected measurement noise and β correct is the corrected measurement bias.
The subscripts m and f represent measured and filtered data. The statistical data are of the measured noise and deviation of the IMU is shown in Table 4. For the noise of the accelerometer and the bias of the gyroscope, the value in the y direction is smaller than the x and z directions. The calibration of the covariance matrix R in the state estimation process is shown as follows: For the velocity vector, V = (u, v, w) T , both u and w are greater than v during the mission process. A penalty factor τ can be introduced in the matrix R accel to get a more general expression, rewritten as R accel = R x 0 τR y 0 R z 0 T (52)

Conclusions
This paper begins with the cost of the flight controller of a hand-launched solar-powered UAV without ailerons and landing gear, and proposes three novel state-estimation algorithms according to whether they are hierarchical, direct or indirect. The UAV trajectory tracking accuracy is improved by three algorithms and the platform cost is reduced.
Firstly, the measurement process of the low-cost sensors is modeled, and the simulation of the model is completed based on the statistical values of the measurement error and bias. The measurement of the accelerometer is high frequency, the gyroscope and the magnetometer are in middle frequency, and the GPS measurement is low frequency.
The three-stage series method reduces the longitudinal accuracy, and focuses on the estimation of heading angle to improve the trajectory precision, which is simple, with a clear hierarchy, limited estimation parameters, and is suitable for application on low-cost small UAV platforms. The full-state method can also obtain side-slip angle or side-to-side velocity estimation to improve the control precision of the aileron free UAV. For the solar-powered UAV, a method of fixing the magnetometer externally can be selected to ensure heading accuracy. The full-state direct method has a higher estimation accuracy and more estimation parameters, but the increase of the algorithm calculation requires a higher-level controller, suitable for high control precision and harsh takeoff and landing conditions. The indirect method has the highest accuracy estimation and the highest requirements for flight controllers, which can be applied to large solar-powered UAV platforms.
Simulations are presented to validate the proposed methods, and the results show the three-stage series method has a position accuracy of approximately 6 m, while the direct and indirect methods are both 3.4 m; however, the stability and state switching of the indirect method are better. Afterwards, the three-stage series algorithm is loaded on the full-scale low-cost electric UAV. The results illustrate that the three-stage series algorithm can provide a reliable state for the controller and achieve stable control, the yaw angle precision is 9.3 degrees, and the trajectory tracking precision is nearly 23 m. Finally, the sensor model and covariance matrix R corrected according to the recorded and filtered data of the IMU during flight.
As a next step, we will conduct research on a long-endurance, high-reliable flight control system, and adaptability to harsh environmental condition. With the long time reliability test of the hardware, the service life of the low-cost solar-powered UAV can be obtained. The completion of this series of experiments makes it closer to civilian applications.