Next Article in Journal
Multi-Repeated Projection Lithography for High-Precision Linear Scale Based on Average Homogenization Effect
Previous Article in Journal
Acute Sleep Deprivation Induces a Local Brain Transfer Information Increase in the Frontal Cortex in a Widespread Decrease Context
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Spacecraft Angular Rates Estimation with Gyrowheel Based on Extended High Gain Observer

School of Astronautics, Harbin Institute of Technology, No.2 Yikuang Street, Nangang District, Harbin 150080, China
*
Author to whom correspondence should be addressed.
These authors contributed equally to this work.
Sensors 2016, 16(4), 537; https://doi.org/10.3390/s16040537
Submission received: 6 March 2016 / Revised: 5 April 2016 / Accepted: 7 April 2016 / Published: 14 April 2016
(This article belongs to the Section Physical Sensors)

Abstract

:
A gyrowheel (GW) is a kind of electronic electric-mechanical servo system, which can be applied to a spacecraft attitude control system (ACS) as both an actuator and a sensor simultaneously. In order to solve the problem of two-dimensional spacecraft angular rate sensing as a GW outputting three-dimensional control torque, this paper proposed a method of an extended high gain observer (EHGO) with the derived GW mathematical model to implement the spacecraft angular rate estimation when the GW rotor is working at large angles. For this purpose, the GW dynamic equation is firstly derived with the second kind Lagrange method, and the relationship between the measurable and unmeasurable variables is built. Then, the EHGO is designed to estimate and calculate spacecraft angular rates with the GW, and the stability of the designed EHGO is proven by the Lyapunov function. Moreover, considering the engineering application, the effect of measurement noise in the tilt angle sensors on the estimation accuracy of the EHGO is analyzed. Finally, the numerical simulation is performed to illustrate the validity of the method proposed in this paper.

Graphical Abstract

1. Introduction

The micro-spacecraft is a major trend in the development of space technology, since it has many advantages, such as being light weight, having low power, low cost and high integration [1]. However, when designing the micro-spacecraft, the researchers meet some issues, such as stringent mass, power and volume constraints, which significantly impact cost [2]. The attitude control system (ACS) in a micro-spacecraft, which mainly includes sensors, actuators and some control logics, accounts for a major proportion of the above-mentioned constraints [3]. In order to improve the functional integration destiny in a unit of space and the redundancy of the ACS for the micro-spacecraft, researchers attempt to exploit the fullest potential to integrate the attitude-sensing and attitude-control functions into a single device, which can significantly alleviate the constraints of the cost factors, such as mass, power and volume [4].
Previous research has demonstrated that according to the difference of the gyro rotor support, the integrated devices combining both attitude-sensing and the attitude-control can be roughly divided into two categories: the magnetically-suspended double-gimbal control moment gyroscope (CMG) (MSDGCMG) [4,5,6] and the integrated device-based gimbal support structure represented by a gyrowheel (GW) [7,8]. The former MSDGCMG supports the rotor by active magnetic bearings (AMBs) [9,10]. The latter GW is developed based on the principle of a dynamically-tuned gyroscope (DTG) by Bristol Aerospace Company for the Canadian Space Agency’s SCISAT-1 Scientific in 2003, and the GW rotor is supported by crossed torsion springs and a gimbal. The MSDGCMG implements the functions of the two degrees of freedom (DOF) torque output and two-axis angular rate sensing in two different operation modes [3,11], so that it can only implement a type of function at some point. However, unlike MSDGCMG, the GW not only has the ability for 3-DOF torque output and two-axis angular rate sensing, but also can implement both functions at the same time because of its simple structure.
This paper focuses on the problem of the two-axis angular rate sensing of a GW. Actually, this problem has been partly studied by Canadian academics at Carleton University. For example, in order to implement the two-axis angular rate sensing of the carrier by a GW, Dr. Own in Canada achieved this work by linearizing the motion equations of the GW at the zero tilt angle position and ignoring the effects of the angular acceleration of the carrier and the tilt angle acceleration of the GW rotor [12]. Combining with the static calibration experiments [13], the two-axis angular rates can be measured accurately by this method when the GW rotor works in a smaller rotor tilt angle region (<0.1°). However, it is hard to meet the requirement of the radial torque output for the smaller working tilt angle of the GW rotor. Therefore, in order to implement the radial torque output, the GW rotor frequently works in a larger tilt angle region, which can be up to 7 , and the tilt angles are time-varying, which makes the operation of linearization and the omission of tilt angle acceleration unreasonable. Moreover, the GW is applied to a strapdown inertial navigation system (SINS), which means the GW base is directly fixed on the spacecraft, and according to the gyroscope principle, the complicated angular motion of the spacecraft inevitably affects the dynamic characteristics of GW because of the large moment of inertia and spinning speed of the GW rotor. Therefore, the effect of spacecraft motion on the GW needs to be comprehensively considered. All of the above-mentioned factors result in a larger accuracy loss of angular rate sensing using the above linearized algebra measurement equations.
In this paper, the angular rate sensing problem of the GW is presented when the rotor works in larger tilt angle states. In order to deal with this problem, a novel dynamic estimation approach of spacecraft angular rates based on GW is proposed. This approach provides most of the derived nonlinear mathematical model of the GW built by Lagrange’s method and develops a nonlinear estimation algorithm to implement the angular rate sensing of spacecraft when the GW works in large tilt angles. To this end, the remainder of this paper is divided into four sections: In Section 2, the description of the GW physical structure is firstly presented, then the GW dynamic equations are derived, and the relationships between the measurable variables and unmeasurable variables are built for the subsequent angular rate measurement. In Section 3, the extended high gain observer (EHGO) is designed to implement the estimation of the related terms of the angular rates of the spacecraft, and the error convergence of the designed EHGO is proven in the time domain. In Section 4, the effects on the observer accuracy of the EHGO from measurement noise are further analyzed. In Section 5, for validating the performance of the proposed approach, the numerical simulation is performed. Finally, the conclusions are drawn in Section 6.

2. Descriptions of Gyrowheel

Gyrowheel Physical Structure

The GW system schematic diagram and simplified structure as shown in Figure 1 are similar to a dynamically-tuned gyroscope (DTG). As in the computer-aided design diagram shown in Figure 1a, the GW system mainly consists of the following subassemblies: case, motor, flexibility suspension structure, flywheel rotor, torquer consisting of the current coil and a permanent magnet and the tilt sensor. Among them, the case is fixed on the carrier, such as a spacecraft. The flexibility suspension structure is made up of a gimbal and inner and outer torsion springs, as shown in Figure 1b; the gimbal is connected to the motor shaft by a pair of inner torsion springs, and the rotor is connected to the gimbal by a pair of outer torsion springs. The rotor driven by the brushless DC motor rotates with a high time-varying speed. Thus, the torque along the spin direction of the rotor can be generated by adjusting the motor speed. Two pairs of torquers perpendicular to each other can provide two-dimensional tilt control torque to make the spin axis of the rotor tilt along the transverse directions. Additionally, the tilt sensors are designed to measure the tilt angles of the rotor with respect to the case. The special physical structure of the GW determines that the device not only can measure the two-dimensional angular rates of the spacecraft, like the DTG, but also can implement the three-dimensional torque output, like the variable speed double gimbal control moment gyroscope (VS-DGCMG).

3. Gyrowheel Mathematical Modeling

3.1. Gyrowheel Coordinates and Frames

The simplified structure and the respective body frames of GW are shown in Figure 1b. The four body frames are case frame( F 0 :O- x c y c z c ), motor body frame ( F 1 :O- x m y m z m ), gimbal body frame ( F 2 :O- x g y g z g ) and rotor body frame ( F 3 :O- x r y r z r ), respectively. And Figure 2 shows the angular position relationship of these four body frames. The rotation angles θ x , θ y , θ z in Figure 1a and Figure 2 are defined as chosen generalized coordinates for GW and can represent the motion about the three degrees of freedom of the GW system. They will be applied to derive the dynamical model of GW using Lagrange’s equations and can be termed as spinning coordinates [2].
According to Figure 2, the direction cosine matrix of rotor with respect to the case can be given by:
A = θ y y θ x x θ z z = C θ y C θ z S θ x S θ y S θ z C θ y S θ z + S θ x S θ y C θ z C θ x S θ y C θ x S θ z C θ x C θ z S θ x S θ y C θ z + S θ x C θ y S θ z S θ y S θ z S θ x C θ y C θ z C θ x C θ y
where ( θ i ) i , i = x , y , z represent the rotation matrix of θ i about the z m -axis, x g -axis and y g -axis, respectively, and S θ i = sin θ i , C θ i = cos θ i , i = x , y , z .
Since the two-dimensional tilt sensors of the GW system in Figure 1a can measure the tilt angles of rotor with respect to the case, another set of case-referenced frames F 0 , F 1 , F 2 , F 3 denoted by the orthogonal triads x , y , z , x , y , z , x , y , z , x , y , z and case-reference coordinates ϕ x , ϕ y , ϕ z , respectively, need to be defined as shown in Figure 3. The frames F 0 , F 3 are consistent with the frames F 0 , F 3 , and ϕ x , ϕ y can be measured directly by the tilt sensors in Figure 3. According to the rotation order of the case-referenced frames, the direction cosine matrix of rotor with respect to the case can be given by:
A = ϕ z z ϕ y y ϕ x x = C ϕ y C ϕ z S ϕ x S ϕ y C ϕ z + C ϕ x S ϕ z C ϕ x S ϕ y C ϕ z + S ϕ x S ϕ z C ϕ y S ϕ z S ϕ x S ϕ y S ϕ z + C ϕ x C ϕ z C ϕ x S ϕ y S ϕ z + S ϕ x C ϕ z S ϕ y S ϕ x C ϕ y C ϕ x C ϕ y
where ( ϕ i ) i , i = x , y , z represent the rotation matrix of ϕ i about the x-axis, y -axis and z -axis, respectively, and S ϕ i = sin ϕ i , C ϕ i = cos ϕ i , i = x , y , z .

3.2. Gyrowheel Kinematic Equations

Supposing the angular velocity of the GW case fixed on the spacecraft, with respect to inertial space in the case frame F 0 , is ω b = ω b x ω b y ω b z T
According to the frames conversion relationship shown in Figure 3, the angular velocity of the motor shaft ω m in the motor body frame F 1 is presented as the Equation (3).
ω m = ω m x ω m y ω m z = 0 0 θ ˙ z + θ z z · ω b = ω b x C θ z + ω b y S θ z ω b x S θ z + ω b y C θ z θ ˙ z + ω b z
The gimbal angular velocity ω g in its body frame F 2 is a function of the base and motor shaft angular velocities where:
ω g = ω g x ω g y ω g z = θ ˙ x 0 0 + θ x x · ω m = θ ˙ x + ω b x C θ z + ω b y S θ z ω b x C θ x S θ z + ω b y C θ x C θ z + ( θ ˙ z + ω b z ) S θ x ω b x S θ x S θ z ω b y S θ x C θ z + ( θ ˙ z + ω b z ) C θ x
Finally, the rotor angular velocity ω r in its body frame F 3 is calculated by the gimbal angular velocity and the rotation of the rotor about the outer torsion shaft where:
ω r = ω r x ω r y ω r z = 0 θ ˙ y 0 + θ y y · ω g = θ ˙ x C θ y θ ˙ z C θ x S θ y ω b z C θ x S θ y + C θ y C θ z S θ x S θ y S θ z ω b x + C θ y S θ z + S θ x S θ y C θ z ω b y θ ˙ z S θ x + θ ˙ y C θ x S θ z ω b x + C θ x C θ z ω b y + ω b z S θ x θ ˙ x S θ y + θ ˙ z C θ x C θ y + ω b z C θ x C θ y + S θ y C θ z + S θ x C θ y S θ z ω b x + S θ y S θ z S θ x C θ y C θ z ω b y
Ignoring the GW case angular velocity ω b , the Equation (5) can be simplified to:
ω r = θ ˙ x C θ y θ ˙ z C θ x S θ y θ ˙ z S θ x + θ ˙ y θ ˙ x S θ y + θ ˙ z C θ x C θ y
Similarly, without considering the case angular velocity ω b , the rotor angular velocity expressed by case-referenced coordinates ϕ x , ϕ y , ϕ z in its body frame F 3 can be given by:
ω r = C ϕ y C ϕ z · ϕ ˙ x + S ϕ z · ϕ ˙ y C ϕ y S ϕ z · ϕ ˙ x + C ϕ z · ϕ ˙ y ϕ ˙ z + S ϕ z · ϕ ˙ x

3.3. Gyrowheel Dynamic Equations

Supposing the principal axes of the body frames F 1 , F 2 , F 3 are consistent with the inertial principal axis of the motor, gimbal and rotor, respectively. Therefore, we can represent the moments of inertia of the motor, gimbal and rotor as follows.
I m = d i a g I m x , I m y , I m z I g = d i a g I g x , I g y , I g z I r = d i a g I r x , I r y , I r z
The GW kinetic energy T consists of the kinetic energy of motor shaft, gimbal and rotor, which can be expressed by generalized rotation speed quadratic forms:
T = 1 2 ( i = x , y , z I m i ω m i 2 + i = x , y , z I g i ω g i 2 + i = x , y , z I r i ω r i 2 )
The GW potential energy V is the sum of the potential energy of the inner and outer torsion deformation, which can be given by:
V = ( k x θ x 2 + k y θ y 2 )
where k x , k y are stiffness coefficients of the inner and outer torsion springs, respectively.
Above all, the Lagrange energy function L can be defined by:
L = T V = 1 2 ( i = x , y , z I m i ω m i 2 + i = x , y , z I g i ω g i 2 + i = x , y , z I r i ω r i 2 ) ( k x θ x 2 + k y θ y 2 )
For the GW, Lagrange’s equations are given by:
d d t L θ ˙ x L θ x = T g x 2 c x θ ˙ x
d d t L θ ˙ y L θ y = T g y 2 c y θ ˙ y
d d t L θ ˙ z L θ z = T g z
where T g x , T g y , T g z are generalized control torques corresponding to the generalized coordinates θ x , θ y , θ z . c x , c y are damping coefficients of the inner and outer torsion shaft, respectively.
We assume that the angular motion of the rotor along its spin axis is decoupled from the transverse axes motion, and the effect of the z-axis carrier angular rate ω b z on the transverse axes motion is ignorable. Thus considering these factors and calculating the first two equations of the Equation (14), we obtain
I 1 · θ ¨ x = c x θ ˙ x k x θ x 1 2 I 2 S 2 θ x · θ ˙ z 2 I 3 S 2 θ y · θ ˙ x θ ˙ y ( I 3 C 2 θ y I r y ) C θ x · θ ˙ y θ ˙ z + T g x + B 1 θ ω b x + B 2 θ ω b y + B 3 θ ω ˙ b x + B 4 θ ω ˙ b y + B 5 θ ω b x 2 + B 6 θ ω b y 2 + B 7 θ ω b y 2 I r y · θ ¨ y = c y θ ˙ y k y θ y 1 2 I 3 C θ x 2 S 2 θ y · θ ˙ z 2 + 1 2 I 3 S 2 θ y · θ ˙ x 2 + ( I 3 C 2 θ y I r y ) C θ x · θ ˙ x θ ˙ z + T g y + D 1 θ ω b x + D 2 θ ω b y + D 3 θ ω ˙ b x + D 4 θ ω ˙ b y + D 5 θ ω b x 2 + D 6 θ ω b y 2 + D 7 θ ω b y 2
where I 1 = I g x + I r x C θ y 2 + I r z S θ y 2 , I 2 = I g z I g y I r y + I r x S θ y 2 + I r z C θ y 2 , I 3 = I r z I r x and B i θ , D i θ i = 1 , 2 7 in Equations (16) and (17) are nonlinear coefficient terms of the spacecraft angular rates( ω b x , ω b y ), respectively.
B 1 ( θ ) = I 3 S θ x S 2 θ y C θ z + I 1 S θ z + I 2 cos 2 x 1 S θ z θ ˙ z I 3 S 2 θ y C θ z + S θ x C 2 θ y S θ z I r y S θ x S θ z x 4 B 2 ( θ ) = I 3 S θ x S 2 θ y S θ z + I 1 C θ z + I 2 C 2 θ y C θ z θ ˙ z I 3 S 2 θ y S θ z S θ x C 2 θ y C θ z + I r y S θ x C θ z x 4 B 3 ( θ ) = I 1 C θ z 1 2 I 3 S θ x S 2 θ y S θ z B 4 ( θ ) = I 1 S θ z + 1 2 I 3 S θ x S 2 θ y C θ z B 5 ( θ ) = 1 2 I 2 S θ z 2 S 2 θ x + 1 4 I 3 C θ x S 2 θ y S 2 θ z B 6 ( θ ) = 1 2 I 2 C θ z 2 S 2 θ x 1 4 I 3 C θ x S 2 θ y S 2 θ z B 7 ( θ ) = 1 2 I 2 S 2 θ z S 2 θ x 1 2 I 3 C θ x S 2 θ y C 2 θ z
D 1 ( θ ) = I 3 S 2 θ y C θ z + S θ x C 2 θ y S θ z I r y S θ x S θ z θ ˙ x + I 3 C θ x C 2 θ y C θ z 1 2 S 2 θ x S 2 θ y S θ z + I r y C θ x C θ z θ ˙ z D 2 ( θ ) = I 3 S 2 θ y S θ z S θ x C 2 θ y C θ z + I r y S θ x C θ z θ ˙ x + I 3 1 2 S 2 θ x S 2 θ y C θ z + C θ x C 2 θ y S θ z + I r y C θ x S θ z θ ˙ z D 3 ( θ ) = I r y C θ x S θ z D 4 ( θ ) = I r y C θ x C θ z D 5 ( θ ) = + 1 2 I 3 S θ x C 2 θ y S 2 θ z + S 2 θ y C θ z 2 S θ x 2 S θ z 2 D 6 ( θ ) = 1 2 I 3 S θ x C 2 θ y S 2 θ z S 2 θ y S θ z 2 S θ x 2 C θ z 2 D 7 ( θ ) = + 1 2 I 3 S θ x 2 S 2 θ y S 2 θ z 2 S θ x C 2 θ y C 2 θ z + S 2 θ y S 2 θ z

3.4. Relationship between the Unmeasurable Variables and the Measurable Variables

According to the GW description in Section 2.1, the two-dimensional tilt angles( ϕ x , ϕ y ) can be measured by tilt sensors, the control torques ( T c x , T c y ) can be obtained by measuring the torquer coils currents, the motor speed ( θ ˙ z ) and rotation angles ( θ z ) can be measured by the Hall sensors or rotary transformers, respectively. However, the variables T g x , T g y , θ x , θ y and its derivatives θ ˙ x , θ ˙ y , θ ¨ x , θ ¨ y in Equation (15) are not measurable, so the relationship between the unmeasurable variables and the measurable variables should be built, which means the generalized coordinates ( θ x , θ y and its derivatives) in the GW Equation (15) should be expressed by the case-reference coordinates ϕ x , ϕ y , and the torque terms ( T g x , T g y ) in Equation (15) should be expressed by the measurable control torques T c x , T c x . For this purpose, according to the rotation motion characteristics of motor shaft, gimbal and rotor, the relationship between T c x , T c y and T g x , T g y can be given by:
T g x = C θ z · T c x + S θ z · T c y T g y = S θ z C θ x · T c x + C θ z C θ x · T c y
Considering that both A in Equation (1) and A in Equation (2) can be used to describe the rotation direction of the rotor with respect to the case, thus the Equation (19) is established as follows:
A = A
Let A 21 A 22 = A 21 A 22 ,the relationship between ϕ z and the measurable variables ϕ x , ϕ y , θ z can be shown as:
tan ϕ z = C ϕ x S θ z C ϕ y C θ z + S ϕ x S ϕ y S θ z
To build the relationship between ( θ x , θ y ) and ( ϕ x , ϕ y ), we take the equation:
C θ z A 31 + S θ z A 32 = C θ z A 31 + S θ z A 32
and it gives:
S θ x = C ϕ x S ϕ y S ϕ z + S ϕ x C ϕ z S θ y = S ϕ y C θ z S ϕ x C ϕ y S θ z
In addition, since both ω r in Equation (6) and ω r in Equation (7) represent the rotor angular velocity in the rotor body frame F 3 with different coordinates, the following Equation (22) is given by:
ω r = ω r
Rearranging the Equations (6), (7) and (22), ( θ ˙ x , θ ˙ y ) and ( ϕ ˙ x , ϕ ˙ y , ϕ ˙ z ) can be expressed by the following forms:
θ ˙ x = 1 C θ y C ϕ y C ϕ z ϕ ˙ x + S ϕ z ϕ ˙ y + C θ x S θ y θ ˙ z θ ˙ y = C ϕ z ϕ ˙ y C ϕ y S ϕ z ϕ ˙ x S θ x θ ˙ z
ϕ ˙ x = 1 C ϕ y C ϕ z C θ y θ ˙ x S ϕ z θ ˙ y C θ x S θ y C ϕ z + S θ x S ϕ z θ ˙ z ϕ ˙ y = C θ y S ϕ z θ ˙ x + C ϕ z θ ˙ y C θ x S θ y S ϕ z S θ x C ϕ z θ ˙ z
ϕ ˙ z = S θ y θ ˙ x + C θ x C θ y θ ˙ z S ϕ y ϕ ˙ x
Taking the derivatives of the two equations in Equation (24), it yields the following Equation (26):
ϕ ¨ x = ϕ ˙ y S ϕ y C ϕ y 2 C ϕ z C θ y θ ˙ x S ϕ z θ ˙ y C θ x S θ y C ϕ z + S θ x S ϕ z θ ˙ z + 1 C ϕ y ϕ ˙ z S ϕ z C θ y θ ˙ y C ϕ z S θ y θ ˙ x ϕ ˙ z C ϕ z θ ˙ y + C ϕ z C θ y θ ¨ x S ϕ z θ ¨ y C θ x S θ y C ϕ z + S θ x S ϕ z θ ¨ z + ϕ ˙ z C θ x S θ y S ϕ z C ϕ z θ ˙ y C θ x C θ y θ ˙ x S θ x S θ y ϕ ˙ z S θ x C ϕ z C θ x S ϕ z θ ˙ x θ ˙ z ϕ ¨ y = ϕ ˙ z C θ y C ϕ z θ ˙ y S θ y S ϕ z θ ˙ x + C θ y S ϕ z θ ¨ x + C ϕ z θ ¨ y S ϕ z ϕ ˙ z θ ˙ y C θ x S θ y S ϕ z S θ x C ϕ z θ ¨ z ϕ ˙ z C θ x S θ y C ϕ z + S ϕ z θ ˙ y C θ x C θ y θ ˙ x S θ x S θ y θ ˙ x C θ x C ϕ z ϕ ˙ z S θ x S ϕ z θ ˙ z
Now the relationship between the unmeasurable variables ( θ x , θ y , θ ˙ x , θ ˙ y , θ ¨ x , θ ¨ y , T g x , T g y ) and the measurable variables (tilt angles ϕ x , ϕ y ,motor speed θ ˙ z and motor rotation angle θ z ) can be expressed by Equations (15), (18), (20), (21), (23) and (25).

3.5. Description of Angular Rates Estimation Problem Using Gyrowheel State Equation

Applying the Equations (15), (18), (20), (21), (23) and (25) to the Equation (26), and choosing the measurable tilt angles ( ϕ x , ϕ y ) and its derivatives as the state variables:
x = x 1 x 2 x 3 x 4 T = ϕ x ϕ ˙ x ϕ y ϕ ˙ y T
GW state equation can be constructed in terms of x as Equation (27):
x ˙ 1 = x 2 x ˙ 2 = f 1 x , t + w 1 ω b , x , t + g x 1 ( x , t ) u x + g y 1 x , t u y x ˙ 3 = x 4 x ˙ 4 = f 2 x , t + w 2 ω b , x , t + g x 2 x , t u x + g y 2 x , t u y
Considering that the tilt angles ( ϕ x , ϕ y ) can be measured by the tilt sensors, measurement equation of GW can be shown as:
y = Cx
Further more, GW dynamical equations can be rewritten by the following forms:
x ˙ = Ax + B f x , t + w ω b , x , t + g x , t u y = Cx
where
A = 0 1 0 0 0 0 0 0 0 0 0 1 0 0 0 0 B = 0 0 1 0 0 0 0 1 C = 1 0 0 0 0 0 1 0 u = u x u y = T c x T c y f x , t = f 1 ( x , t ) f 2 ( x , t ) w ω b , x , t = w 1 ( ω b , x , t ) w 2 ( ω b , x , t ) g x , t = g x 1 ( x , t ) g y 1 ( x , t ) g x 2 ( x , t ) g y 2 ( x , t )
f ( x , t ) is a vector irrelevant to the spacecraft angular rates ω b , and tilt control torque u , w ω b , x , t is a vector consisting of the related terms of spacecraft angular rates ω b , u is the tilt control torque vector. Specifically, f i x , t , w i x , t and g j i x , t , i = 1 , 2 , j = x , y can be obtained by combining the simultaneous Equations (15), (20), (21), (23), (25) and (26) with the physical significance of each term, and these concrete expressions are shown in Appendix A. u x = T c x = k t y i y , u y = T c y = k t x i x , k t x , k t y are scale factors of torquers along x-axis and y-axis, i x , i y are measurable currents of torquer coils, respectively. In the following of this paper, the moments of inertial of both rotor and gimbal along transverse axis and spin axis are supposed as:
I r x = I r y = I r t I r z = I r s I g x = I g y = I g t I g z = I g s
For the GW physical system carried on the spacecraft, since the GW torquers and motor power are limited and the spacecraft bandwidth is small, the tilt angles of the rotor, the rotation speed of the motor and the motion of the spacecraft are always continuous and bounded in Equation (29), so the following assumptions hold:
Assumption 1
both the control torques u ( x , t ) and spacecraft angular rates ω b are bounded input signals, and spacecraft angular rates ( ω b x , ω b y ) are derivable and their derivatives are bounded.
In addition, since the state x represents the tilt angles and tilt angular rates of the rotor along the transverse axis in the case frame F 0 , the tilt angle range is usually limited to 5 , + 5 by mechanical stoppages, then the Assumption 2 is given by:
Assumption 2
The state x is uniformly continuously bounded.
Another main objective of this paper is to design a high gain observer(HGO) featuring global asymptotic convergence to estimate the nonlinear related terms w ω b , x , t about the angular rates of the spacecraft, then the spacecraft angular rates ( ω b x , ω b y ) can be calculated by solving the differential equations containing the angular rates ( ω b x , ω b y ) with the direct estimates.
Through the following study of this paper, these four problems of spacecraft angular rates estimation with GW will be dealt with:
(1)
The errors caused by the linearization of nonlinear equations of GW in large tilt angles can be avoided.
(2)
The problem of dynamic drift error compensation existing both traditional mechanic gyroscopes [14] and GW can be solved by the above derivation and the following application of full dynamical model in angular rates estimation.
(3)
The initial iteration error accumulation of the calculated angular rates of the spacecraft, caused by the angular acceleration ( ω ˙ b x , ω ˙ b y ) in the term w ( ω b , x , t ) , is eliminated by the real-time estimation of the w ( ω b , x , t ) term.
(4)
The amplification of measurement noise by the multi-difference of measured tilt angles with measurement noise can be weakened by appropriately choosing the design parameters of HGO [15].
It is noted that the system parameters such as I r t , I g t , I r s , I g s , c x , c y , k x , k y , k t x , k t y in Equation (29) can be identified by the calibration experiments both on-orbit and on-ground.

4. Gyrowheel High Gain Observer for Angular Rates Estimation

4.1. Gyrowheel High Gain Observer Design

To implement the estimation of the state x and the spacecraft angular rates related term w ω b , x , t using the measurable states ( x 1 , x 3 ) by tilt angle sensors, we need to extend the existing states x and design the following extended high gain observer:
x ^ ˙ = A x ^ + B f x ^ , t + g x ^ , t u σ ^ + H ε y C x ^ σ ^ ˙ = F ε y C x ^
where x ^ , σ ^ = σ ^ x σ ^ y T are state variables and extended state variables, respectively.
H ε = h 1 0 h 2 0 0 h 3 0 h 4 = α 11 ε 0 α 21 ε 2 0 0 α 12 ε 0 α 22 ε 2 F ε = h 5 0 0 h 6 = α 31 ε 3 0 0 α 32 ε 3
where the role of the small design parameter ε > 0 is: (1) adjusting the dynamic response speed of the observer; (2) Weakening the effects of nonlinear disturbance terms on observation accuracy. The parameters α i j , i = 1 , 2 , 3 , j = 1 , 2 are real numbers and should be chosen to satisfy the Hurwitz polynomials shown below:
s 3 + α 1 j s 2 + α 2 j s + α 3 j j = 1 , 2

4.2. EHGO Error Convergence Proof

We first build the singularly perturbed equation for the above GW nonlinear observer. For this, the observation error vector η can be defined as follows:
η = η 1 η 2 η σ ^ x η 3 η 4 η σ ^ y T
where
η 1 = x 1 x ^ 1 ε 2 , η 2 = x 2 x ^ 2 ε , η 3 = x 3 x ^ 3 ε 2 , η 4 = x 4 x ^ 4 ε
η σ ^ = η σ ^ 1 η σ ^ 2 = σ ^ + f x , t f x ^ , t + g x , t g x ^ , t u + w x , t
Combining Equations (29) and (30) with Equations (33) and (34), the singularly perturbed equation can be given by:
ε η ˙ = A ¯ η + ε B ¯ Δ x + Δ d
where
A ¯ = α 11 1 0 0 0 0 α 21 0 1 0 0 0 α 31 0 0 0 0 0 0 0 0 α 12 1 0 0 0 0 α 22 0 1 0 0 0 α 32 0 0 B ¯ = 0 0 0 0 1 0 0 0 0 0 0 1 Δ x = f ˙ x , t f ˙ x ^ , t Δ d = w ˙ x , t + g ˙ x , t g ˙ x ^ , t u
Due to Assumption 1 and 2, there exists compact set Ω c such that,
x t Ω c f o r t [ 0 , )
Besides, considering that there is no singularity for the derivatives of f ( x , t ) , w ( ω b , x , t ) and g ( x , t ) in Equation (29) and f ( x , t ) satisfies the Lipschitz condition in the closed interval of the state x , there exist constants K x > 0 , K d > 0 , such that Δ x K x η , Δ d K d for t [ 0 , ) .
Defining Lyapunov function V η and Lyapunov equation for singular perturbed Equation (35), respectively, as follows:
V η = ε η T P η
A ¯ T P + P A ¯ = Q
where P in Equation (37) is the unique positive definite solution of Equation (38), Q is an arbitrary positive-definite matrix, in particular, Q is given as identity matrix I 6 × 6 . As previously mentioned, the parameters α i j , i = 1 , 2 , 3 , j = 1 , 2 in the matrix A ¯ are real and satisfy Hurwitz polynomial condition, so all the eigenvalues of the matrix A ¯ have negative real parts, which guarantees the existence of P . Taking the time derivative of V ( η ) along Equation (35), we have:
V ˙ ( η ) = η T P A ¯ + A ¯ T P η + 2 ε η T P B ¯ Δ x + 2 ε η T P B ¯ Δ d 1 2 ε K x P B ¯ η 2 + 2 ε K d P B ¯ · η
Obviously, there exists ε * > 0 , such that 1 2 ε K x PB > 0 for arbitrary ε 0 , ε * .
Defining the auxiliary function as follow:
l ε = 2 ε K d PB 1 2 ε K x PB
Whenever η is such that η > l ( ε ) , we have V ˙ ( η ) < 0 . Therefore, there exists T * ( ε ) 0 , , such that the observation error vector η ( t ) enters the following set: Ω η = η R 6 , η l ( ε ) and will remain in the set Ω η in finite time T * ( ε ) for ε 0 , ε * and initial value η ( 0 ) , which means:
η ( t ) Ω η , t [ T * ( ε ) , )
Therefore, the observation error converges to a small neighborhood of zero in finite time. Moreover, to meet the requirement of observation accuracy, it is supposed that the accuracy index is given by η δ η ; we can find that the auxiliary function l ( ε ) is O ε in the amplitude magnitude and is an increasing function of the design parameter ε. Hence, there exists ε η * ε * , such that, for every δ η > 0 and arbitrary ε 0 , ε η * , the relationship l ( ε ) δ η is always true. Thus, the requirement of the observation error performance index η δ η can be achieved in finite time.
According to the Equation (36), g x , t g x ^ , t and f x , t f x ^ , t in Equation (34) is Lipschitz and bounded, thus, the observation error index for the spacecraft angular rate related terms w x , t can be transformed into the requirement on the observation error η. Hence, the extended state σ ^ can be regarded as the estimation of w x , t . According to the above analysis, we can conclude that there exists ε w * ε * for any given δ w > 0 such that, the Equation (42) is always true for every ε 0 , ε w * .
σ ^ w ( x , t ) δ w , t T * ε ,
From the above design process, the designed extended high gain observer can estimate the tilt angle accelerations of the rotor x ˙ 2 , x ˙ 4 (that is, ( ϕ ¨ x , ϕ ¨ y ) ) when implementing the estimation of the original state x . The tilt angle accelerations of the rotor x ˙ 2 , x ˙ 4 mainly consist of two parts: the irrelevant part and the relevant part of the spacecraft angular rates ω b . The former can be regarded as the known model consisting of the GW inertia parameters, measurable variables and observable variables. Additionally, the latter is treated as an unknown factor due to the unknown spacecraft angular rates ω b . Thus, removing the known part, we can obtain the estimation of the other unknown related terms. Above all, the estimation of the spacecraft angular rates ω b can be implemented indirectly by the estimation of tilt angular accelerations of rotor x ˙ 2 , x ˙ 4 using the designed extended high gain observer with accuracy satisfied by adjusting the design parameter ε.

4.3. Influence Analysis of Measurement Noise

Theoretically, the observation accuracy can be obtained by decreasing the design parameter ε. However, in practice, the outputs of the tilt sensors of GW usually include measurement noise. Meanwhile, due to the differential characteristic of the above designed observer, a smaller design parameter ε will amplified the effects of measurement noise, which limits the range of the design parameter ε and affects the observation accuracy of the spacecraft angular rates ω b . The measurement equation with noise can be further given by:
y = Cx + n s
where n s R 2 is bounded measurement noise, which means that there exists positive number μ such that, the expression n s ( t ) μ holds. Then, the observation estimation error satisfies the following equation [16,17] given by:
x ( t ) x ^ ( t ) ε c 1 + μ ε 3 c 2 = d e f F ( ε , μ ) , t T
where c 1 , c 2 and T are positive constants.
For ε > 0 and μ 0 , taking the partial derivatives of the function F ( ε , μ ) with respect to ε, we can obtain:
F ( ε , μ ) ε = c 1 3 μ c 2 ε 4
From Equation (45) we can find that: (1) F ( ε , μ ) is strictly decreasing for ε < c a μ 1 / 4 , where c a = [ 3 c 2 / c 1 ] 1 / 4 , strictly increasing for ε > c a μ 1 / 4 , and has a global minimum F m i n ( ε o , μ ) = ( c 1 c a + c 2 / c a 3 ) μ 3 for ε > 0 at ε o = c a μ 1 / 4 ; (2) For any given observation accuracy requirement δ w , F m i n < δ w for μ < ( δ w / k a ) 4 , and the equation F ( ε , μ ) = δ w has two solutions at ε m ε o and ε M > ε o : For ε ε o , we have the following relationship:
F r ( ε m , μ ) = ε m c 1 + c 2 μ / ε m 3 = δ w ε m 4 c 1 + c 2 μ = δ w ϵ m 3 ε m = μ c 2 δ w ( 1 ε m c 1 δ w ) 1 3
Considering ε ε o = c a μ 1 / 4 and μ < ( δ w / k a ) 4 , we have ε < c a δ w / k a , so that
ε m = μ c 2 δ w ( 1 ε m c 1 δ w ) 1 3 μ c 2 δ w ( 1 c 1 c a k a ) 1 3
where the equality happens only at μ = 0 . In addition, for ε M > ε o , since lim μ 0 F ( ε M , μ ) = ε M c 1 , lim μ 0 ε M = δ w / c 1 . So we have F r ( ε , μ ) δ w for all ε ( ε m , ε M ] . According to the above analysis, the change sketch of the function F ( ε , μ ) as the parameter ε changing is shown in Figure 4.
From Equation (44) and Figure 4, we can find that due to the existence of measurement noise, the order of magnitude of the estimation error is O ( 1 / ε 3 ) , and too small or large ε will amplify the observation error; When ε = ε o = c a μ 1 / 4 , the minimum of the function F m i n ( ε o , μ ) = ( c 1 c a + c 2 / c a 3 ) μ 3 is achieved. Within a certain accuracy index δ w the range of the design parameter ε is limited to ε m , ε M . Considering the effect of the parameter ε on the observer performance recovery, a tradeoff should be considered between noise amplification and performance recovery including the state reconstruction speed [18].

5. Simulation

In order to demonstrate the effectiveness of the proposed method, a simulation platform as Figure 5 is built. Utilizing this simulation platform, we will verify the performance of the extended high gain observer for estimating the spacecraft angular rates terms w 1 ( ω b , x , t ) and w 2 ( ω b , x , t ) in Equation (27).
In Figure 5, the variables θ ˙ z * , ϕ x * , ϕ y * are the inputs of the motor control loop, the x-axis and the y-axis tilt control loop of the GW, respectively. The variables θ ˙ z , ϕ x , ϕ y are the corresponding measurable outputs of the above three control loops of the GW, respectively. The variables T c z , T c x , T c y are the control torque outputs of the above three control loops of the GW, respectively. The variables i x , i y are the measurable current outputs from the x-axis and the y-axis torquer, respectively. The relationship between T c x , T c y and i x , i y is given by T c x = k t y i y , T c y = k t x i x , respectively. The variables T z , T x , T y acting on the spacecraft are the three-axis control torque outputs of the GW. The estimates σ ^ x , σ ^ y are the extended observer states, which represent the estimates of the related terms of the spacecraft angular motion in the GW dynamics equations along the x-axis and y-axis, respectively. The variables ω b x , ω b y are the calculated values of spacecraft angular rates through the estimates σ ^ x , σ ^ y of the EHGO and the spacecraft attitude algorithm. According to the above description, the spacecraft attitude algorithm in Figure 5 can be expressed by:
σ ^ x = w 1 ( ω b , x , t ) σ ^ y = w 2 ( ω b , x , t )
where w 1 ( ω b , x , t ) and w 2 ( ω b , x , t ) are shown in Appendix A. Through solving the differential Equation (48), the spacecraft angular rates ω b x , ω b y can be obtained in real time.
The key parameters in the simulation are given in the Table 1.
The estimation performance of the spacecraft angular rates with the above designed EHGO when GW outputting control torque T x , T y , T z should be validated, so the inputs of the two-dimensional tilt angles ( ϕ x * , ϕ y * ) and the motor speed ( θ ˙ z * ) of GW can be given by:
ϕ x * = ϕ y * = 0.5 · t t 10 s 0.1 · sin 2 π · 0.04 · t t > 10 s θ ˙ z * = 157.04 + 22 · sin 2 π · 0.02 · t r a d / s
The initial values of spacecraft angular rates ω b x and ω b y are set as 0.001 rad/s. Here, the design parameters of EHGO α i j   ( i = 1 , 2 , 3 , j = 1 , 2 ) in Equation (31) can be given by:
α 1 j = 35.335 , α 2 j = 183.5681 , α 3 j = 705.5417 , j = 1 , 2
where the parameters α i j   ( i = 1 , 2 , 3 , j = 1 , 2 ) satisfy the Hurwitz polynomials as Equation (32), in addition, they are finally determined based on the design principle of control system to guarantee the dynamic response performance of EHGO.
To verify the effects of the design parameter ε of EHGO on the estimation accuracy of spacecraft angular rates ( ω b x , ω b y ) which is analyzed in Section 4.2, the design parameter ε is chosen as different positive real constants in simulation.
Without considering measurement noise in the two-dimensional tilt angle sensors, the estimates of the spacecraft angular rates ( ω b x , ω b y ) and estimation errors curves are shown in Figure 6.
From Figure 6a,b, we can see that when the design parameter ε is equal to both 0.01 and 0.001 , the spacecraft angular rates ( ω b x , ω b y ) estimates can converge rapidly to the real spacecraft angular rates. The spacecraft angular estimation accuracy increases with the decrease of the value of ε from Figure 6c,d. Simulations with other values of the design parameter ε also show the same phenomenon. These phenomenons are also consistent with the error convergence proof in Section 4.2. The results for other values of ε are omitted in Figure 6.
Strictly, peaking effect of HGO will occur with the parameter ε decreasing [20], which means that the transient response of the estimates will change dramatically when the parameter ε becomes smaller. However, From the partial magnification of Figure 6a,b, the peaking effect is overcame by the saturation of control loop and the boundedness of the nominal model. Actually, for GW, the amplitude of the torque output from the two-dimensional torquers subject to the power limitation is always limited, which is set as less than 100 mNm in this paper, so the tilt control torques( T c x , T c y ) acting on the rotor through tilt control loops are saturated and the peaking effect on the estimation performance of the extended state variables( σ ^ x , σ ^ y ) can be naturally avoided. Besides, in the partial magnification of the Figure 6b, we can find that in the process of transient response the peaking values as ε = 0.01 is larger than these values as ε = 0.001 , which is because the spacecraft angular rates ω b x , ω b y is obtained indirectly by the estimates σ ^ x , σ ^ y in Equation (48).
Further more, in the following simulation, measurement noise in the two dimensional tilt angle sensors is considered. The magnitudes of measurement noise in the tilt angle sensors are assumed to be uniformly distributed random variables taking values between 0.5 and + 0.5 , and the time interval of these random values variation is 0.0001 s. In addition, the other simulation conditions remain unchanged, and the estimation curves of the spacecraft angular are shown in Figure 7a,b when the design parameter ε is chosen as 0.01 and 0.001 , respectively.
From Figure 7, when the design parameter ε is equal to 0.01 , with the presence of measurement noise, the estimations of spacecraft angular rates can track the real angular rate instead of the deterioration of the estimation accuracy. However, differing from the previous simulation results without measurement noise, the design parameter ε is decreased to 0.001 ; the estimation noise is significantly amplified; and the estimation accuracy of the spacecraft angular rates becomes worse, as shown in Figure 8, because of the effect of measurement noise. Comparing Figure 7 and Figure 8, the phenomenon shows that the design parameter ε = 0.01 is a comparatively reasonable tradeoff, as analyzed in Section 4.3 for the designed EHGO. It should be noted that the magnitudes of the measurement noise decide the optimal tradeoff of the design parameter ε between estimation performance improvement and noise amplification. Moreover, the statistics of measurement noise are not necessary for the high-gain observer design, which is different from the filtering approach, for which the imprecise knowledge of the measurement noise statistics seriously deteriorates the estimation, even resulting in instability. Although the motion of the spacecraft is unobservable from the sensors in the GW, the estimation of the spacecraft angular rates with the EHGO is independent of it. While for the filtering approach, the estimation of spacecraft angular rates [21] is improved by observability, and the observability [22] depends on the information of the spacecraft dynamical model.

6. Conclusions

In this paper, the estimation of the spacecraft rates with GW based on extended high gain observer, which works in large tilt angles for the radial torque output, add, is first proposed and studied. For this purpose, three major contributions of this paper can be summarized as follows:
(1)
A complete dynamical model of GW is built with chosen generalized coordinates ( θ x , θ y , θ z ) by Lagrange’s Method, and since the generalized coordinates ( θ x , θ y ) and its derivatives in the GW dynamical model are unmeasurable, the relationships between the unmeasurable generalized coordinates and the measurable variables ( ϕ x , ϕ y , θ ˙ z , θ z ) by sensors are derived to construct the nonlinear state equation expressed by measurable variables for the spacecraft rate estimations with the GW.
(2)
The affine nonlinear state equation of GW and measurement equation are built based on the contribution (1). Combining the affine nonlinear state equation with measurement equation and extending the relevant terms of spacecraft angular rates as states, a high gain observer is designed to estimate the relevant terms of the spacecraft angular rates. Through solving the known differential equation, the spacecraft angular rates can be calculated.
(3)
The stability of the designed EHGO in contribution (2) is proved by Lyapunov’s stability theory, and the effects of the design parameter ε and measurement noise on the estimation accuracy are also analyzed.

Acknowledgments

This work was supported in part by the National Natural Science Foundation of China under Grant No. 61427809 and 61174001.

Author Contributions

Xiaokun Liu and Yao Yu studied the GW system, derived and verified the GW mathematical model and the relationship between the measurable and unmeasurable variables.Yao Yu outlined the structure of this paper and guides the simulation design. Kemao Ma, Xiaokun Liu and Hui Zhao designed the high gain observer and proved the stability of the observer for the GW. Xiaokun Liu performed the simulation, and together with Kemao Ma analyzed the simulation results. Xiaokun Liu wrote this paper. Fenghua He fixed some grammar errors.

Conflicts of Interest

The authors declare no conflict of interest.

Abbreviations

The following abbreviations are used in this manuscript:
GW7Gyrowheel
ACSAttitude control system
HGOHigh gain observer
EHGOExtended high gain observer
CMGControl moment gyroscope
MSDGCMGMagnetically suspended double-gimbal control moment gyroscope
AMBsActive magnetic bearings
DOFDegrees of freedom
SINSStrapdown inertial navigation system
DTGDynamically tuned gyroscope
VSDGCMGVariable speed control moment gyroscope

Appendix A

f 1 x , t = ϕ ˙ y S ϕ y C ϕ y 2 C ϕ z C θ y θ ˙ x S ϕ z θ ˙ y C θ x S θ y C ϕ z + S θ x S ϕ z θ ˙ z + 1 C ϕ y ϕ ˙ z S ϕ z C θ y θ ˙ y C ϕ z S θ y θ ˙ x ϕ ˙ z C ϕ z θ ˙ y C θ x S θ y C ϕ z + S θ x S ϕ z θ ¨ z + ϕ ˙ z C θ x S θ y S ϕ z C ϕ z θ ˙ y C θ x C θ y θ ˙ x S θ x S θ y ϕ ˙ z S θ x C ϕ z C θ x S ϕ z θ ˙ x θ ˙ z β 1 2 I 1 2 c x θ ˙ x + 2 k x θ x + I 2 S 2 θ x θ ˙ z 2 + 2 I 3 S 2 θ y θ ˙ x θ ˙ y + 2 I 3 C 2 θ y I r y C θ x θ ˙ y θ ˙ z η 2 I r y 2 c y θ ˙ y 2 k y θ y I 3 C θ x 2 S 2 θ y θ ˙ z 2 + I 3 S 2 θ y θ ˙ x 2 + 2 I 3 C 2 θ y I r y C θ x θ ˙ x θ ˙ z f 2 x , t = ϕ ˙ z C θ y C ϕ z θ ˙ y S θ y S ϕ z θ ˙ x S ϕ z ϕ ˙ z θ ˙ y C θ x S θ y S ϕ z S θ x C ϕ z θ ¨ z ϕ ˙ z C θ x S θ y C ϕ z + S ϕ z θ ˙ y C θ x C θ y θ ˙ x S θ x S θ y θ ˙ x C θ x C ϕ z ϕ ˙ z S θ x S ϕ z θ ˙ z + β 2 2 I 1 2 c x θ ˙ x 2 k x θ x I 2 S 2 θ x θ ˙ z 2 2 I 3 S 2 θ y θ ˙ x θ ˙ y 2 I 3 C 2 θ y I r y C θ x θ ˙ y θ ˙ z + C ϕ z 2 I r y 2 c y θ ˙ y 2 k y θ y I 3 C θ x 2 S 2 θ y θ ˙ z 2 + I 3 S 2 θ y θ ˙ x 2 + 2 I 3 C 2 θ y I r y C θ x θ ˙ x θ ˙ z
w 1 ω b , x , t = β 1 B 1 ( θ ) η D 1 ( θ ) ω b x + β 1 B 2 ( θ ) η D 2 ( θ ) ω b y + β 1 B 3 ( θ ) η D 3 ( θ ) ω ˙ b x + β 1 B 4 ( θ ) η D 4 ( θ ) ω ˙ b y + β 1 B 5 ( θ ) η D 5 ( θ ) ω b x 2 + β 1 B 6 ( θ ) η D 6 ( θ ) ω b y 2 + β 1 B 7 ( θ ) η D 7 ( θ ) ω b x ω b y w 2 ω b , x , t = β 2 B 1 ( θ ) C ϕ z D 1 ( θ ) ω b x + β 2 B 2 ( θ ) C ϕ z D 2 ( θ ) ω b y + β 2 B 3 ( θ ) C ϕ z D 3 ( θ ) ω ˙ b x + β 2 B 4 ( θ ) C ϕ z D 4 ( θ ) ω ˙ b y + β 2 B 5 ( θ ) C ϕ z D 5 ( θ ) ω b x 2 + β 2 B 6 ( θ ) C ϕ z D 6 ( θ ) ω b y 2 + β 2 B 7 ( θ ) C ϕ z D 7 ( θ ) ω b x ω b y g x 1 x , t = β 1 I 1 C θ z + η I r y S θ z C θ x g y 1 x , t = β 1 I 1 S θ z η I r y C θ z C θ x g x 2 x , t = β 2 I 1 C θ z C ϕ z I r y S θ z C θ x g y 2 x , t = β 2 I 1 S θ z + C ϕ z I r y C θ z C θ x
where, B i ( θ ) , D i ( θ ) , i = 1 , 2 , . . . , 7 has been shown in Equations (16) and (17), and the unmeasurable variables ( ϕ z , θ x , θ y , θ ˙ x , θ ˙ y ) in the above equations are substituted by following equations:
β 1 = C ϕ z C θ y I 1 C x 3 η = S ϕ z I r y C x 3 β 2 = C θ y S ϕ z I 1 θ x = a r c s i n C x 1 S x 3 S ϕ z + S x 1 C ϕ z θ y = a r c s i n S x 3 C θ z S x 1 C x 3 S θ z θ ˙ x = 1 C θ y C x 3 C ϕ z x 2 + S ϕ z x 4 + C θ x S θ y θ ˙ z θ ˙ y = C ϕ z x 4 C x 3 S ϕ z x 2 S θ x θ ˙ z
where ϕ z = a r c t a n C x 1 S θ z C x 3 C θ z + S x 1 S x 3 S θ z .

References

  1. Richie, D.J.; Lappas, V.J.; Palmer, P.L. Sizing/optimization of a small satellite energy storage and attitude control system. J. Spacecr. Rocket. 2007, 44, 940–952. [Google Scholar] [CrossRef]
  2. Richie, D.J.; Lappas, V.J.; Prassinos, G. A practical small satellite variable-speed control moment gyroscope for combined energy storage and attitude control. Acta Astronaut. 2009, 65, 1745–1764. [Google Scholar] [CrossRef]
  3. Chobotov, V.A. Spacecraft Attitude Dynamics and Control; Krieger Publishing Company: Tallahassee, FL, USA, 1991. [Google Scholar]
  4. Fang, J.; Zheng, S.; Han, B. Attitude sensing and dynamic decoupling based on active magnetic bearing of MSDGCMG. Instrum. Meas. IEEE Trans. 2012, 61, 338–348. [Google Scholar] [CrossRef]
  5. Cui, P.; Zhang, H.; Yan, N. Performance Testing of a Magnetically Suspended Double Gimbal Control Moment Gyro Based on the Single Axis Air Bearing Table. Sensors 2012, 12, 9129–9145. [Google Scholar] [CrossRef] [PubMed]
  6. Liu, B.; Fang, J.; Liu, G. Design of a magnetically suspended gyrowheel and analysis of key technologies. Acta Aeronaut. Astronaut. Sin. 2011, 32, 1478–1487. [Google Scholar]
  7. Senez, M.; Pokrupa, N.; Taylor, B. The GyroWheel testing and flight qualification program. Adv. Astronaut. Sci. 2002, 111, 283–295. [Google Scholar]
  8. Tyc, G.; Whitehead, W.; Pradhan, S. GyroWheelTM—An Innovative New Actuator∖Sensor for 3-axis Spacecraft Attitude Control. In Proceedings of the 13th Annual AIAA/USU Conference on Small Satellites, Logan, UT, USA, 23–26 August 1999.
  9. Xu, X.; Chen, S. Field balancing and harmonic vibration suppression in rigid AMB-rotor systems with rotor imbalances and sensor runout. Sensors 2015, 15, 21876–21897. [Google Scholar] [CrossRef] [PubMed]
  10. Fang, J.; Zheng, S.; Han, B. AMB vibration control for structural resonance of double-gimbal control moment gyro with high-speed magnetically suspended rotor. IEEE/ASME Trans. Mech. 2013, 18, 32–43. [Google Scholar] [CrossRef]
  11. Zheng, S.; Han, B. Investigations of an integrated angular velocity measurement and attitude control system for spacecraft using magnetically suspended double-gimbal CMGs. Adv. Space Res. 2013, 51, 2216–2228. [Google Scholar] [CrossRef]
  12. Ower, J.C. Analysis and Control System Design of an Innovative Tuned-Rotor Instrument; Carleton University: Ottawa, ON, Canada, 2000. [Google Scholar]
  13. Hall, J.M. Calibration of an Innovative Rate Sensing/momentum Management Instrument for De-tuned Operation and Temperature Effects; Carleton University: Ottawa, ON, Canada, 2008. [Google Scholar]
  14. Titterton, D.H.; Weston, J.L. Strapdown Inertial Navigation Technology, 2nd ed.; Peter Peregrinus Ltd. on behalf of the Institute of Electrical Engineers: London, UK, 2004. [Google Scholar]
  15. Oh, S.; Khalil, H.K. Nonlinear output-feedback tracking using high-gain observer and variable structure control. Automatica 1997, 33, 1845–1856. [Google Scholar] [CrossRef]
  16. Ahrens, J.H.; Khalil, H.K. High-gain observers in the presence of measurement noise: A switched-gain approach. Automatica 2009, 45, 936–943. [Google Scholar] [CrossRef]
  17. Khalil, H.K.; Praly, L. High-gain observers in nonlinear feedback control. Int. J. Robust Nonlinear Control 2014, 24, 993–1015. [Google Scholar] [CrossRef]
  18. Ma, K.; Khalil, H.K.; Yao, Y. Guidance law implementation with performance recovery using an extended high-gain observer. Aerosp. Sci. Technol. 2013, 24, 177–186. [Google Scholar] [CrossRef]
  19. Cain, J.S. Investigation of the Crossed Flexure Pivot and the Dynamics of the Momentum Management System Spacecraft Control Component and the Dynamically Tuned Gyroscope; Carleton University: Ottawa, ON, Canada, 1999. [Google Scholar]
  20. Dabroom, A.M.; Khalil, H.K. Output feedback sampled-data control of nonlinear systems using high-gain observers. IEEE Trans. Autom. Control 2001, 46, 1712–1725. [Google Scholar] [CrossRef]
  21. Lefferts, E.J.; Markley, F.L.; Shuster, M.D. Kalman filtering for spacecraft attitude estimation. J. Guid. Control Dyn. 1982, 5, 417–429. [Google Scholar] [CrossRef]
  22. Song, T.L. Observability of target tracking with bearings-only measurements. IEEE Trans. Aerosp. Electron. Syst. 1996, 32, 1468–1472. [Google Scholar] [CrossRef]
Figure 1. GW physical structure. (a) Schematic diagram of a gyrowheel system; (b) Simplified gyrowheel structure diagram.
Figure 1. GW physical structure. (a) Schematic diagram of a gyrowheel system; (b) Simplified gyrowheel structure diagram.
Sensors 16 00537 g001
Figure 2. Angular position relationship among the body frames.
Figure 2. Angular position relationship among the body frames.
Sensors 16 00537 g002
Figure 3. Case-Reference Coordinates and Reference Frames.
Figure 3. Case-Reference Coordinates and Reference Frames.
Sensors 16 00537 g003
Figure 4. The changes of the extremum of estimation error.
Figure 4. The changes of the extremum of estimation error.
Sensors 16 00537 g004
Figure 5. The changes of the extremum of estimation error.
Figure 5. The changes of the extremum of estimation error.
Sensors 16 00537 g005
Figure 6. Estimation of spacecraft angular rates without measurement noise. (a) x-axis angular rate ω b x ; (b) y-axis angular rate ω b y ; (c) ω b x estimation error; (d) ω b y estimation error.
Figure 6. Estimation of spacecraft angular rates without measurement noise. (a) x-axis angular rate ω b x ; (b) y-axis angular rate ω b y ; (c) ω b x estimation error; (d) ω b y estimation error.
Sensors 16 00537 g006
Figure 7. Estimation of spacecraft angular rates with measurement noise ( ε = 0.01 ). (a) x-axis angular rate ω b x ; (b) y-axis angular rate ω b y .
Figure 7. Estimation of spacecraft angular rates with measurement noise ( ε = 0.01 ). (a) x-axis angular rate ω b x ; (b) y-axis angular rate ω b y .
Sensors 16 00537 g007
Figure 8. Estimation of spacecraft angular rates with measurement noise ( ε = 0.001 ). (a) x-axis angular rate ω b x ; (b) y-axis angular rate ω b y .
Figure 8. Estimation of spacecraft angular rates with measurement noise ( ε = 0.001 ). (a) x-axis angular rate ω b x ; (b) y-axis angular rate ω b y .
Sensors 16 00537 g008
Table 1. Gyrowheel and Spacecraft Design Parameter in Simulation [19].
Table 1. Gyrowheel and Spacecraft Design Parameter in Simulation [19].
Parameter NameValue
Rotor transverse-axis inertia I r t 3.458 × 10 3 kg · m2
Rotor spin-axis inertia I r s 6.402 × 10 3 kg · m2
Gimbal transverse-axis inertia I g t 1.2758 × 10 5 kg · m2
Gimbal spin-axis inertia I g s 1.8047 × 10 5 kg · m2
Torsion Spring Stiffness k x , k y 0.092 Nm / rad
Torsion Spring damping c x , c y 0 Nm/(rad/s)
Spacecraft Inertia I sat d i a g 50 50 50 kg · m2

Share and Cite

MDPI and ACS Style

Liu, X.; Yao, Y.; Ma, K.; Zhao, H.; He, F. Spacecraft Angular Rates Estimation with Gyrowheel Based on Extended High Gain Observer. Sensors 2016, 16, 537. https://doi.org/10.3390/s16040537

AMA Style

Liu X, Yao Y, Ma K, Zhao H, He F. Spacecraft Angular Rates Estimation with Gyrowheel Based on Extended High Gain Observer. Sensors. 2016; 16(4):537. https://doi.org/10.3390/s16040537

Chicago/Turabian Style

Liu, Xiaokun, Yu Yao, Kemao Ma, Hui Zhao, and Fenghua He. 2016. "Spacecraft Angular Rates Estimation with Gyrowheel Based on Extended High Gain Observer" Sensors 16, no. 4: 537. https://doi.org/10.3390/s16040537

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