An Improved Dynamic Friction Rejection Attitude Stability Control Strategy

2019-11-05 00:59YonghaiWangGangMengJianlinLiYongtaoShuiandBaogangLu

Yonghai Wang, Gang Meng, Jianlin Li, Yongtao Shui and Baogang Lu

(Beijing Institute of Space Long March Vehicle, China Academy of Launch Vehicle Technology , Beijing 100076, China)

Abstract: The attitude stability control of under-actuated spacecraft that used two reaction wheels in the presence of dynamic friction disturbance is handled. A novel improved control approach with a combination of a singular control law based on quaternion and extended state observer (ESO) is employed to establish a stabilization control so as to restrain the effect of friction. The corresponding simulation results demonstrate the highly stable accuracy and performance compensated dynamic friction. Furthermore, if there is a non-zero initial condition in under-actuated axis, the attitude stability can be enhanced with a magnetic torquer. Simulations for a nano-spacecraft denote a potential application value in pointing accuracy using two reaction wheels and a magnetic torquer.

Keywords: nanospacecraft; dynamic friction; singular control; linear extended state observer; magnetic torquer

1 Introduction

With the development of spacecraft technique in the modern, more and more requirements are proposed, such as higher reliability, lower cost, smaller size and so on. The attitude control techniques need to add some advanced capabilities including higher precision and agility, the much better performance of rejecting the uncertainty and disturbance, the capacity of keeping stabilization when some parts of the actuators lose effectiveness[1-2]. Recently, the attitude control of the under-actuated spacecraft exerts a tremendous fascination on researchers. The traditional attitude control normally assumes the spacecraft is full-actuated which means the number of control inputs is the same as the number of state variables[3]. The traditional attitude control normally assumes the spacecraft is full-actuated which is the number of control inputs equals to the number of the states[3]. However, under-actuated attitude control faces the challenge that the ability of control is insufficient. For this problem, more and more research literatures focus on the stabilization of the spacecraft with under-actuated conditions, such as attitude control with thrusters[4-5], control momentum gyroscopes[6-7], or two reaction wheels (RWs)[8-9]. Moreover, lots of theory researches have got a multitude of significant achievements, for instance, Mirshams[10-11]presented a tube-based predictive control strategy and applied it into the 3-axis stabilization attitude control of an asymmetric spacecraft which lacked control in one axes. Aiming at the cases where there are two available thrusters, the control laws are established for angular velocity and three-axis attitude stabilization utilizing the standard parameters of spacecraft attitude. In addition, the stability of the control laws proposed was proved employing Lyapunov stability criteria and LaSalle invariant theory strictly[12].

The full-state feedback control law and the inverse optimal attitude control areutilized to deal with the 3-axis attitude stabilization of a satellite equipped with two reaction wheels[13]. Moreover, the full-state feedback control law was validated to accomplish 3-axis stabilization just employing two control torques in-orbit test. As an improvement, a novel switching control law with bounded wheel speeds combing the generalized feedback linearization and a new saturated function was proposed to realize the attitude orientation control of spacecraft[14]. The extended control law was added with a new term to the control law presented by Horri and Palmer[13]and obtained the faster time responses and a lower steady state error[15].

However, the three control laws of the aforementioned method have not discussed the influence of the dynamic friction of the RWs and the external disturbance. In the practical application, the two types of disturbances cannot be neglected and have a negative effect on the attitude stabilization of under-actuated spacecraft. The extended state observer (ESO) technique proposed by Han was able to realize precise approximation for external bounded disturbance[16-17]. The linear and nonlinear ESO had been proved that the approximation error of ESO can converge into a small bounded neighborhood near the origin for the unknown disturbance[18-20]. Therefore, the novel improvement proposed in this paper combines a quaternion feedback control with ESO to develop a robust stabilization control law, which could avoid any potential complications caused by chattering.

In this paper, a quaternion feedback control combined with ESO is proposed to realize stabilization control which could restrain the effect of friction and bounded external disturbance while requiring no prior knowledge of them. Moreover, the ESO is used to approximate the dynamic friction disturbance. The asymptotic stability of closed-loop system is guaranteed which means the actual angular velocity and quaternion can be stabilized in the presence of friction. In Section 2, the attitude kinematics and dynamics of the under-actuated spacecraft in the presence of zero-total momentum and friction are formulated. Then, an attitude stability control strategy based on ESO subject to the effects of dynamic frictions and disturbance is proposed in Section 3. It is given the singular control law based on quaternion by the research of Horri and Palmer[13]. And it is proved that the estimation error of the linear ESO is bounded. Then a suitable Lyapunov function is proposed to prove the asymptotically stable of the closed-loop system. In Section 4, simulations based on a nano-spacecraft are performed to verify the robustness for the friction and external disturbance. The control method is shown to accurately slew and stabilize to a stable state with greater efficiency and pointing accuracy than existing controllers with the friction. It is also illustrated that the proposed control can significantly improve the convergence of stabilization state accuracy of a spacecraft subject to bounded square waves disturbance.

2 Attitude Kinematics and Dynamics for the Under-Actuated Spacecraft

In this section, we just consider the spacecraft as a rigid body with two reaction wheels under the influence of dynamic friction and ignore the external unknown disturbance torques. Therefore, the attitude dynamics with the Euler’s rotational equation is described by:

(1)

whereω=[ω1,ω2,ω3]Trepresents the angular velocity vector of the spacecraft in body fixed coordinate frame;Hdenotes the total angular momentum of the spacecraft including reaction wheels and is given by:

H=Jω+h

(2)

whereJdenotes inertia matrix of spacecraft, known positive definite and symmetric inertia tensor of spacecraft,hdenotes the composite angular momentum of two reaction wheels.

In practical application, the reaction wheel model unavoidably exits the dynamic friction. It will be a disturbance form for the control torque of the reaction wheels. Consequently, it will be unreasonable in the absence of the friction. In this section, the influence of dynamic friction for attitude stability of the under-actuated spacecraft will be discussed. The differential equation that describes the motion which considers the dynamic friction[21]for reaction wheels is:

(3)

(4)

It is well known that Euler angles may show singularity in use because the transformation from derivative of Euler angles to angular velocity is not defined globally. Considering the unit quaternions are globally defined in the attitude representation, they are popularly used for representing attitude of spacecraft in practice. Therefore, the kinematics of the spacecraft described in unit quaternion form as follows:

(5)

In this note, we mainly discuss the attitude stability of the under-actuated spacecraft with two reaction wheels. Hence, the zero-total angular momentum is applied in this case since it had been explained as emphasized in Ref.[13]. The zero-total angular momentum condition as:

Jω+h=0

(6)

In order to simplify the model concerned in this note, let us give some assumptions:J=diag(J1,J2,J3), two reaction wheels are setx-axis andy-axis of the body frame separately and the wheel onz-axis has lost effectiveness, leadingh3=0,ω3=0.

Moreover, the dynamics by Eq.(4) and the kinematics by Eq.(5) can besimplified as:

(7)

(8)

3 Dynamic Friction Rejection Attitude Stability Control Strategy

In this section,in order to handle the 3-axis attitude stability control just equipped with two reaction wheels, we take the system of spacecraft into two loops: 1) quaternion stability loop, called outer-loop. For this loop, a singular control law will be considered based on quaternion model to obtain the desired angular velocity which should achieve the attitude quaternion to be stable; 2) angular velocity tracking loop, called inner-loop. In this part, it should not only guarantee to track the desired angular velocity output from outer-loop, but also reject the dynamic friction. For the angular velocity tracking, feedback control law was proposed by Horri and Palmer[13], to address the problem. However, how to reject the friction of the wheels does not discuss in their research, indeed, there is rarely literature to concern this problem. In this note, the extended state observer (ESO) will be used to deal with the friction rejection.

3.1 Singular Control Law Based on Quaternion

For this problem, a singular controller was considered in Ref.[13] in the case of an under-actuated spacecraft with two reaction wheels based on quaternion modeling. Therefore, the same control law is adopted as follows:

(9)

wherek>0 andg>0 are constants,ωd1andωd2denote the desired angular velocity.

In Eq.(9), the fraction terms may become infinite whenq1→0 andq2→0. Hence, in practical application, we can utilize the saturated function to solve the problem. Indeed, the angular nonlinear control law translates to:

(10)

where sat(x,α) denotes the saturation function,α1>0,α2>0 are constant saturation limits.

3.2 Angular Velocity Tracking Control Based on ESO and Stability Proof

For the inner-loop control problem, it should not only guarantee to track the desired angular velocity output fromouter-loop, but also reject the dynamic friction. A simple feedback law combined with the linear ESO technique will address this problem.

(11)

In this paper,a linear ESO is employed to approximate dynamic friction and analyse the convergence of its estimation error in the case of the model of friction is unknown. Since the actual angular velocity of wheels should be required bounded, in other words,Ω≤Ωmax, the dynamic friction is bounded. Therefore,theχis also bounded and let ‖χ‖≤M1.

For Eq.(13), the corresponding linear ESO is given by:

(12)

(13)

In Ref.[22], the performance has been proved. If the tuning parameter is suitable, the estimation error will be limited to the tiny and bounded region. Therefore, it can range the influence of the friction by adding into the control law. The tracking control law based on the linear ESO for angular velocity tracking is given as:

(14)

Proof Choose a general Lyapunov function as:

(15)

The time derivative of this Lyapunov function is represented as:

(16)

(17)

Substituting the under-actuated attitude dynamics expressed by Eq.(11), the angular velocity tracking control law based the linear ESO indicated by Eq.(14) and the Eq.(17) into the Eq.(16), the time derivative of Lyapunov function develops into:

(18)

4 Simulation and Analysis

In this section, the feasibility of the control law will be now demonstrated by a numerical simulation using attitude dynamics and kinematics and proposed controller in Section 3. The simulation takes into two parts: the first and foremost, it demonstrates the controller derived with the model of spacecraft which only considers the friction. Secondly, it is shown that there is a sinusoidal disturbance as an external disturbance in the simulation to verify the proposed control to be the capability of rejecting the friction and external disturbance at the same time. It can illustrate effectively the robustness and practicability of the proposed control method. All of the simulations compare with a proportional feedback control law which is classical and distinguished.

The inertia matrix of the spacecraft in the simulations is given by

J=diag(0.152 1, 0.152 1, 0.037 5) kg·m2

and theinertia matrix of the reaction wheels is

IΩ=diag(0.001 5, 0.001 5, 0.001 5) kg·m2

Friction parameter

b=5.16×10-6N·ms,c=8.795×10-5N·m.

The initial conditions: the initial attitude quaternion

and angular velocityω=[0.1, 0.1]Trad/s.

The parameters of the linear ESO:β1=20,β2=40. The tuning parameters of the controller:k=0.16,g=0.32,κ=diag(1,1) and the maximum torqueumax=0.001 N·m. [Z1,Z2]Tdenotes the estimation of friction or external disturbance [d1,d2]T.

4.1 Simulations of Rejecting the Dynamic Friction

In this part, a simple proportional feedback control law is shown as a comparison:

(19)

The stability error for quaternion of the feedback control law based the linear ESO technique rejected the dynamic friction and the comparison control method with angular velocity feedback are demonstrated in Fig.1. It is obvious that the tracking error of quaternion utilizing comparison control is stabilized to 5×10-3. However, the stability error of the method presented is much smaller, which has been converged to 1×10-4order of magnitude. The compared result reflects that the proposed control has higher stabilization precision because of rejecting the friction by the linear ESO technique. The corresponding comparisons for angular velocity and control torque illustrate separately in Fig.2 and Fig.3. It demonstrates the estimation of the friction by the linear ESO in Fig.4 and Fig.5.

(a)Quaternion of the proposed control

(b)Quaternion of the compared control

Fig.1Quaternion error comparison with the friction

(a)Angular velocity tracking of the compared control

(b)Angular velocitytracking of the compared control

Fig.2Angular velocity comparison with the friction

(a)Control torque of the proposed control

(b)Control torque of the compared control

Fig.4 Estimation of the friction d1

4.2 Simulations of Rejecting the External Disturbance

In this part, we choose the square waves signal as the external disturbance. LetT=10 s is the switch period of the square waves. The model is described as:

(20)

The quaternion stability error of proposed control and the comparison method with the square wave disturbance are denoted in Fig.6.

Fig.5 Estimation of the friction d2

(a)Quaternion of the proposed control

(b)Quaternion of the compared control

The stabilization accuracy of the comparison control has been extremely bad, which is much bigger than the proposed control. However, the error of the proposed control maintains in a small region which is about 5×10-4at the switch points and much smaller during the stable-state. The comparison of the angular is shown in the Fig.7, it reflects that the angular velocity converges into zero except some switch points. It has been shown that the control torque of the proposed control is much smoother than the compared method in the Fig.8. It has demonstrated that the estimated value of the external unknown disturbance by linear ESO approached the actual value in the Fig.9 and Fig.10.

(a)Angular velocity tracking of the proposed control

(b)Angular velocity tracking of the compared control

Fig.7Angular velocity comparison with the friction

(a)Control torque of the proposed control

(b)Control torque of the compared control

Fig.8Control torque comparison with the friction

Fig.9 Estimation of the friction d1

Fig.10 Estimation of the friction d2

5 Conclusions

An improved dynamic friction rejection attitude stability control strategy,which including the singular control based on the quaternion and the angular velocity tracking control based on the linear ESO, is proposed in this paper. There is a significant improvement in convergence accuracy and control robustness with the effects of these uncertainties in comparison to a conventional control algorithm. Simulations have demonstrated that this control strategy can effectively stabilize a given state subject to external environmental disturbances and RWs friction. Furthermore, the control method proposed has the extremely excellent capacity to estimate the unknown disturbance with the linear ESO technique.