Preprint) AAS 12-115 INVERSE PROBLEM FORMULATION COUPLED WITH UNSCENTED KALMAN FILTERING FOR STATE...
Transcript of Preprint) AAS 12-115 INVERSE PROBLEM FORMULATION COUPLED WITH UNSCENTED KALMAN FILTERING FOR STATE...
(Preprint) AAS 12-115
INVERSE PROBLEM FORMULATION COUPLED WITHUNSCENTED KALMAN FILTERING FOR STATE AND SHAPE
ESTIMATION OF SPACE OBJECTS
Laura S. Henderson∗, Pulkit Goyal† and Kamesh Subbarao‡
This work addresses issues related to resolving space objects i.e. Space SituationalAwareness (SSA). The motivation behind this paper is to further current techniquesused to estimate states associated with non-resolved space objects. Furthermore,this work deals with an inverse problem for a system of nonlinear stochastic dif-ferential equations. This system of equations corresponds to the two body orbitequations along with models accounting for effects of atmospheric drag, solar ra-diation pressure, and Earth’s aspherical shape. The present work implements anUnscented Kalman filter (UKF) in conjunction with a batch estimation loop. TheUKF estimates the states and parameters of the resident space object (RSO) untila pre-determined measurement batch size criterion is met. The estimates are thenpassed to the batch loop where a cost function is minimized to improve the esti-mates of the RSO’s parameters further. The batch loop is implemented using twomethods; the first uses the Levenberg-Marquardt technique while the second usesa Gauss-Newton algorithm. Moreover, two experiments are conducted. The firstexperiment uses the traditional UKF implementation and is treated as the bench-mark for the implementation of the batch loop. The second experiment uses theUKF along with the batch loop. The implementation of the batch loop shows aslight improvement over the traditional UKF implementation.
INTRODUCTION
For the past five decades we have been accumulating objects in space. Many of these objects
are satellites that no longer work, pieces of used rocket stages, and remnants from collisions. Over
the last decade the number of these objects has increased dramatically. This has become a critical
problem that must be addressed with urgency as it could have a detrimental effect on functioning
space assets. Objects that are placed in space such as satellites are of great importance to our
communications, national security, and economy. Much of the global connectivity technology relies
heavily on these satellites. In addition to satellites the International Space Station (ISS) is at an even
higher risk due to its large size. It is of great importance to address the issue of identifying these
objects and have the ability to predict where these objects will be at any given time and if they
pose a risk to other space objects. The motivation for this paper is the belief that it is necessary
to develop means to detect, track, identify, and predict the future intentions, actions, and positions
of space objects with adequate precision and accuracy. In addition to this, means to determine the
origin of these objects along with any change in their orbital state must be generated.
∗Graduate Student, Mechanical and Aerospace Engineering Department, University of Texas at Arlington, 500 West First
Street, Woolf Hall 106.†Visiting Student, Mechanical and Aerospace Engineering Department, University of Texas at Arlington‡Associate Professor, Mechanical and Aerospace Engineering, University of Texas at Arlington, 500 West First Street,
Woolf Hall 315G
1
This paper focuses in the area of low observables. More specifically, it deals with an inverse
problem for a system of nonlinear differential equations. Often inverse problems are studied in
linear differential equations. It is the objective of this paper to investigate inverse problem in the
context of nonlinear differential equations more specifically the inverse problem presented in Ref-
erence 1. Similar to the previously mentioned reference the short-term and long-term evolution of
space objects are studied. A system of stochastic nonlinear differential equations provide a detailed
time evolution model. The system of equations include effects from atmospheric drag, solar radia-
tion pressure, and Earth’s gravitation (including J2). Other unmodeled effects are lumped together
and represented as stochastic disturbing forces and torques. The atmospheric drag effects are mod-
eled to account for the projected frontal area of the object, which changes with time as the objects
tumble arbitrarily. The inverse problem to be addressed consists of determining the parameters that
appear in the system of stochastic nonlinear equations so that an accurate description of the position,
velocity, attitude, angular velocity and other properties of the object can be obtained. (Reference 1).
The parameters that appear in the system of differential equations characterize the object which
is assumed to be a cuboid. In other words the parameters are the length, width, and height of the
object. To estimate these parameters, the system of equations include the translational dynamics
and rigid body rotational dynamics with varying mass of moment of inertia terms so that a complete
description of the position and orientation of the object is obtained. The simulated measurements
will emulate information from the Space Surveillance Network (SSN). Lightcurve measurements
are used to determine attitude and orientation, while elevation and azimuth information are used for
position.
This paper also studies the implementation of a batch estimation methodology in conjunction with
the Unscented Kalman filter (UKF). The goal of this implementation is to improve the estimates of
the parameters that appear in the system of differential equations. This is done by estimating the
states by means of the UKF and ‘storing’ these values until a fixed batch size criterion is met. Then
these estimated state values are passed to the batch estimation algorithm which produces a new
updated value for the parameters by reducing a cost function. This is done until all the measurements
are used. Although batch estimation cannot be used in real time it has the advantage of providing
state or parameter estimates that have a lower error-covariance than sequential methods (Reference
2).
PROBLEM FORMULATION
Given time series astrometric and photometric measurements from the Space Surveillance Net-
work (SSN) as explicit and implicit functions of position, attitude, and resident space object’s (RSO)
shape and size, in addition to governing equations for the system dynamics and appropriate mea-
surement models the following problem will be solved.
• Combined Direct + Inverse Problem (References 1, 3–7) This problem aims to determine
the position, velocity, angular velocity, attitude and the Resident Space Object’s shape and
size.
2
The governing equations of motion for combined translation and rotation for the space object are
given by a system of nonlinear ordinary differential equations as shown in Equation (1).
r = v
v = −µ
|r|3r + aJ2 − α(p)|vrel|vrel + a(p)SRP + Γ
g = A(g)ω
I(p)ω = −[ω]I(p)ω + τSRP + τgg (1)
The deterministic acceleration due to Earth’s gravitation is given by − µ|r|3
r. aJ2 is the second
order gravity effect, α(p) represents the atmospheric drag parameter which is dependent upon the
projected area of the RSO, the atmospheric density, and the drag coefficient. The term vrel =v − ωE × r is the relative velocity, where ωE is the angular velocity of the Earth. Moreover
aSRP is the acceleration due to solar radiation pressure, and Γ is the (stochastic) acceleration due
to composite unmodeled forces. The corresponding inverse problem as mentioned above will be to
determine the system parameters (p), based on measurements from the SSN. This work will consider
all disturbances as shown on Equation (1).
For the rotational governing equations of motion g and ω denote the orientation and the angular
velocity vectors of the object, respectively. Here A(g) is a matrix consisting of functions that
depend nonlinearly on the orientation g. I(p) denotes the moment of inertia of the space object and
is a function of the dimensions of the object. The density of the object is assumed constant. τSRP is
the external torque due to solar radiation pressure and τgg is the external torque due to the gravity
gradient. It is assumed that the object does not have any control torques acting on it. Finally [ω] is
the skew-symmetric vector cross product operator of the angular velocity.
Inverse Problem for Orbit State and Parameter Determination
The dynamical system can be represented as a vector x with its entries as positions, velocities,
angular displacements, and angular velocities. The specific inverse problem for the RSO will deal
with the estimation of the object state, attitude, angular velocity, and shape parameters based mea-
surements from optical sensors and radars. The problem is posed as
min∑
j ‖ym(j) − y(j)‖2
subject to ˙x(t) = F (x, p, t)˙p(t) = g(p) (2)
ym(j) is the vector of measurements or the available data and y(j) is the predicted output at
the jth sample instant. An analogous dynamical system will be developed to estimate the system
states, orbit states, and parameters. Similar to Reference 1, the approach of this paper to solve the
inverse problem will be to first obtain the expected value of the orbit as a function of time, second
analyze the time dependence of the covariance of the orbit, and third estimate the system parameters
and corresponding error values. Unlike the work shown in the previously mentioned reference, the
Unscented Kalman Filter will now be coupled with a batch update framework for the object size
parameters.
3
PERTURBATION EFFECTS ON THE RSO DYNAMICS
Translational and rotational acceleration perturbations are considered to model the true dynamics.
The estimator utilizes a process noise term to model these effects.
Drag Acceleration Model
Equation (3) was used to describe the drag experienced by the RSO as it orbits the Earth. The
ballistic coefficient (BC) was set up as a function of the area projected on a plane perpendicular
to the RSO’s velocity vector. As the object tumbles this area will change and so will the ballistic
coefficient. Furthermore an exponential atmospheric model was used (Reference 1 and 8 ).
aEdrag = −1
2ρatm‖vE
rel‖BCvErel (3)
J2 Acceleration Model
For most applications the assumption that Earth is a sphere is sufficient. For a more comprehen-
sive model it is necessary to model the accelerations due to the non-spherical nature of Earth as
well. An aspherical-potential function must be derived in order determine the gravitational attrac-
tion on the SRO. In this case we will use a simplification of the accelerations along each of the axis.
Given the disturbing function R2, where J2 indicates that this approximation is using the second
order zonal harmonics (J2 = 0.0010826269). Furthermore µ is Earth’s gravitational parameter
(3.896 × 105km3/s2), RE is Earth’s mean equatorial radius (RE = 6, 378km), r is the position
vector of the RSO measured from the center of the Earth, and φgc is the latitude of the object.
R2 = −3J2µ
2r
(
RE
r
)(
sin2(φgc)−1
3
)
(4)
Using sin(φgc) = rk/r where rk is the component of r along the z-axis, the following expression
can be obtained.
R2 = −3J2µR
2E
2r3
(
r2Kr2
)
+J2µR
2E
2r3(5)
Now Equation (5) can be differentiated with respect to each of the components of r to obtain the
corresponding accelerations. As an example (Equation (6))
∂R2
∂rI
= −3J2µR
2e rI
2r5
(
−5r2K + 1
r2
)
(6)
Following the same procedure Equations (8) and (9) can be obtained. This yields all three accel-
erations for this model (Reference 8).
aI = −3J2µR
2erI
2r5
(
1−5r2Kr2
)
(7)
aJ = −3J2µR
2erJ
2r5
(
1−5r2Kr2
)
(8)
aK = −3J2µR
2erK
2r5
(
3−5r2Kr2
)
(9)
4
Solar Radiation Pressure Acceleration
Solar radiation pressure is a nonconservative disturbance, much like drag. This model will arrive
at an expression for the specific acceleration due to this disturbance. The force exerted on the object
is a function of the object’s visible area from the Sun. Furthermore, the pressure felt by the object
is the force divided by the incident area exposed to the Sun. The first factor to be considered is the
intensity of the energy of the Sun’s incoming radiation. The following expression gives the solar
flux (W/m2) which varies over a year (Reference 8).
SF =1358
1.004 + 0.0334 cos(Daphelion)(10)
where Daphelion is 2π times the days from when the Earth is at aphelion denoted as a fraction of the
whole year. The change in momentum or the solar pressure per unit area is
pSR =SF
c(11)
where c is the speed of light.
Most surfaces reflect some portion of the incoming radiation and absorb the other portion. Rabs
is used to determine the percentage of absorption, Rdiff is used to denote the percentage of diffused
light and finally Rspecular is the percentage of specular light. For a surface Af which has incident
solar radiation. The normal to the surface makes an angle with the Sun-object line of φinc as shown
on Figure 1. The reflective angle φref is equal to the incident angle. Assuming a Lambertian
diffusion the following expressions can be used to describe the diffuse and specular radiation forces
(Reference 8).
Fa = −pSRRabsA cos(φinc) s (12)
Frs = −2 pSRRspecA cos2(φinc) n (13)
Frd = −pSRRdiffA cos(φinc)
(
2
3n+ s
)
(14)
The total acceleration contribution from all the facets of the object is given by Equation (15). If
φinc for a particular facet does not lie between [π/2,−π/2], then contribution of that facet to the
net acceleration produced is assumed to be zero.
aSRP = −6
∑
i=1
pSRAi cos(φinc)
m
[
2
(
Rdiff
3+Rspec cos(φinc)
)
n+ (1−Rspec) s
]
(15)
Solar Radiation Pressure Torque
The force due to the solar radiation pressure acting on each face of the RSO can be calculated by
taking the vector sum of forces defined in Equations (12), (13), and (14). The net force is assumed
to be acting on the center of the facet and so the torque produced is calculated using rc × F, where
rc is the vector from the center of the space object to the center of the facet. Equation (16) shows
the expression used to calculate the net torque due to solar radiation pressure.
τSRP =
6∑
i=1
rc,i × Fi (16)
τESRP can be obtained by using the direction cosine matrix from from the body fixed frame to the
Earth fixed frame.
5
Gravity Gradient Torque
The RSO will not experience the same gravitational attraction on all points of its body. In order to
account for this phenomena a gravity gradient torque model has been introduced. Portions that are
closer to Earth will feel a stronger attraction compared to the portions of the RSO that are further
away. To calculate the net gravity gradient torque the following equation is used (Reference 9). The
size of the object considered for this study is quite small for this to be significant. Nevertheless these
models are included for modeling the true data and for possible applications wherein these torques
are not negligible.
τgg =
∫
Br × dFg (17)
r is the position vector of the infinitesimal body element with respect to the center of mass of the
SRO. dFg is the gravitational force and can be calculated using Equation (18). Me is the mass of
the Earth, dm is the body element mass, and R is the inertial relative position vector from the center
of the Earth to the RSO’s center of mass.
dFg = −GMe
|R|3Rdm (18)
Substituting Equation (18) into (17) the following expression can be obtained.
τgg = GMe Rc ×
∫
B
r
|R3|dm (19)
This equation can be generalized as shown in Equation (20). This formulation uses the truncation
of the binomial series as an approximation. Where Rc is the inertial position vector relative to the
center of the Earth. [I] is the inertia matrix.
τEgg =
3 G Me Rc
R5c
× [I]Rc (20)
MEASUREMENT MODELS
Astrometric Observation Model
The radar measurements that the observer can obtain are range ρ, azimuth Θ and elevation Φ. The
following expressions will be used to obtain the measurements. The slant range ρ is the fundamental
observation. The subscripts u, e, and n correspond to the Up-East-North components of this vector.
The full model can be found in Reference 2.
Θ = tan−1
(
ρeρn
)
(21)
Φ = sin−1
(
ρu||ρ||
)
(22)
For the problem being addressed only one optical sensor is used and we only consider the azimuth
and elevation measurements.
6
Light Curve Model
The apparent magnitude for each facet can be calculated using the model developed in Refer-
ence 10. The apparent magnitude of the RSO is taken to be the summation of the apparent magni-
tudes of all the facets.
mapp = −mapp,sun − 2.5 log10
∣
∣
∣
∣
∣
6∑
i
Fobs,i
Csun,vis
∣
∣
∣
∣
∣
(23)
Fobs is the amount of light that is impinging on the facet that then reflects to the observer. Csun,vis
is the power per square meter affecting the object caused by visible light striking the facets.
INVERSE PROBLEM SOLUTION USING UNSCENTED KALMAN FILTER WITH BATCH
ESTIMATION
In general batch estimation has the advantage of providing state estimates with a lower error
covariance than a strictly sequential method. Unfortunately batch estimation cannot always be per-
formed when the estimate is needed in real time. The process involves using multiple measurements
to estimate the states/parameters (Reference 2). The dynamics of the system can be expressed in
discrete form as
xk+1 = F(xk,wk,uk, k) (24)
yk = h(xk,uk,vk, k) (25)
with wk as Gaussian white noise process term with zero mean and Qk as the covariance. y is the
measurement vector and vk is the measurement error vector which represents zero-mean Gaussian
noise process with covariance Rk. Where x contains the states as follows
xT =[
rT vT ωB/ET gT pT
]
(26)
where, p = [length width height]T , the dimensions of the RSO.
The estimation of the attitude will require a special derivation of the UKF. Implementing the
quaternions directly would not be desired as the updated quaternions may not have a unit norm. To
avoid this a modified implementation can be used where the norm of the quaternions is forced have
a value of one. The first step is to calculate the error quaternion. This error quaternion is derived
based on the MRP sigma points. Next the attitude perturbation due to each error quaternion can
be calculated by means of quaternion composition. The addition of the perturbation and the error
form the global quaternion. Furthermore, the error quaternion related to each propagated quaternion
sigma point can be obtained by means of the quaternion composition. Finally the MRP error can be
obtained from the propagated error quaternion. This is implemented as shown in Reference 11 and
has not been shown here for the sake of brevity.
Batch Implementation with The UKF
For the batch estimation of the object parameters the maximum likelihood estimation approach is
used. This method minimizes the following cost function by means of the Gauss-Newton algorithm
J(p) =1
2
N∑
k=1
(yk − yk)T (yk − yk) (27)
7
where yk is the estimated value of y at the time tk and N is the total number of measurements in
a particular batch. For an iteration number i the estimate of p at i + 1 is p obtained from the ith
estimate by
pi+1 = pi −[
∇2pJ(p)
]−1 [∇pJ(p)
]
(28)
where the gradients are obtained using the following expressions.
[
∇pJ(p)]
= −N∑
k=1
[
∇pyk
]T(yk − yk) (29)
[
∇2pJ(p)
]
≈
N∑
k=1
[
∇pyk
]T [
∇pyk
]
(30)
As shown in Figure 2 the UKF begins with an initial guess for the states and parameters. The
UKF continues to estimate both states and parameters until the number of measurements equals
a predetermined batch size. Next the estimated values of the states along with the last update of
the parameters only from the UKF is passed to the Batch Estimation loop and the parameters are
iterated until either the cost function meets a specified tolerance or if a fixed number of iterations
is exceeded. The obtained value of the parameters is then passed back to the UKF to continue the
estimation process. For this study, this is done until all measurements are used.
Two approaches were adopted for the update phase in the Batch Estimation loop. The first uses
the Levenberg-Marquardt update as shown in Equation (31). The parameter η is heuristically chosen
(trial and error). η is taken to be large for the initial iteration and is reduced by a specified factor
(f ) on each iteration. Z is a diagonal matrix with entries equal to the diagonal elements of ∇2pJ(p)
and α is a scaling factor (Reference 2).
pi+1 = pi − α[
∇2pJ(p) + ηZ
]−1 [∇pJ(p)
]
(31)
ηk+1 =ηkf
(32)
The second approach also uses a scaling factor α. The Levenberg-Marquardt Method is not used in
this case, rather a modified Gauss-Newton algorithm is implemented.
pi+1 = pi − α[
∇2pJ(p)
]−1 [∇pJ(p)
]
(33)
SIMULATION RESULTS
To better show the results of the batch estimation two experiments were performed. The first of
those experiments is the baseline referred to as Joint Estimation. This experiment uses the UKF
as implemented in Reference (1, 2) including the all measurement models and perturbation effects.
This first experiment does not include the batch estimation loop. Furthermore the Joint Estimation
will be treated as the baseline to compare the performance of the new batch loop. The second
experiment implements batch loop with the UKF and is referred to as Batch Estimation. This second
experiment uses the same measurement and perturbation models as the first experiment. The second
experiment is presented with two cases the first uses a Levenberg-Marquardt algorithm to estimate
the parameters. The second case uses a Gauss-Newton algorithm for the same purpose.
8
The set of synthetic measurements for both experiments was created with the same initial con-
ditions and object parameters. The object size for both experiment was as p = [2 3 4]T m for
length, width, and height respectively. For a Low Earth Orbit (LEO) at an inclination of 15◦ and
period of approximately 90 minutes the following initial conditions were used:
• Position and velocity initial conditions:
r(0) = [6738 0 0]T km
v(0) = [0 7.4292 1.9906]T km/s
• Angular velocity and MRP initial conditions:
ωB/E(0) =[
1.357 × 10−4 4.296 × 10−3 − 1.104 × 10−3]T
rad/s
g(0) =[
0 0 4.14213 × 10−1]T
The synthetic measurements were created using zero-mean white noise error processes with stan-
dard deviation of 2 arc-seconds for azimuth and elevation. For the light curve the error process
has a standard deviation of 0.1 magnitude. The measurements were sampled every 30 seconds. The
lightcurve model was set up using Phong specularity parameters nu and nv with a value of 10 for all
facets. The values of specular and diffusive reflection were chosen as Rspec = 0.7 and Rdiff = 0.2for three facets and Rspec = 0.6 and Rdiff = 0.2 for the remaining three. These values yield a
visible magnitude that allows the estimation of the attitude and object parameters.
Baseline - Joint Estimation (JE)
The results presented in the Appendix have been produced using the synthetic measurements as
previously described. The estimator initial conditions errors were set as: 10 Km for position error,
0.1 Km/s for velocity error, 1400 deg/hr for rotational rate error, 20 deg for attitude error, and
0.05 m for the dimension error. Furthermore, the initial conditions for the error covariance are
102 Km2 for position, 0.12 (Km/s)2 for velocity, 14002 (deg/hr)2 for rotational rate error, 202 deg2
for attitude, and 0.052 m2 for dimensions.
Figure 3 shows the projected area time history as the object travels through its orbit. As it can
be seen the area changes over time as the object tumbles. Figures 4 through 8 show the results
obtained for the Joint Estimation by averaging over 100 runs. Figure 4 shows the estimation of the
length, width, and height of the RSO. As it can be seen the filter estimates these parameters within
centimeters of the actual size of the object. These parameters are very weakly observable and in
some cases arent observable at all. Future work will investigate this in more detail. The ±3σ bounds
are shown as dotted lines in this figure and all state and parameter error figures. Moreover, Figure
5 and 6 show the estimation of the position and velocity respectively as the space object translates
through its orbit. Values for position and velocity have been estimated by the filter fairly quickly
and accurately. Figures 7 and 8 show the attitude and angular velocity estimation respectively. The
attitude has been estimated approximately with in 3 degrees of the true value. The initial condition
for the attitude estimator was about 20 degrees from the true values. The angular velocity has been
estimated with in less than a tenth of a degree per second. The corresponding initial condition
was 1400 deg/hr away from the true values. The 3σ bounds for the attitude estimation increase
and decrease as the object tumbles and the information provided by the lightcurve changes. The 3σbounds for the angular velocity remain constant through the estimation. Clearly there are times when
the 3σ bounds on the attitude errors change with the available information in the measurements.
9
Batch Estimation (BE)
Two methods were used for the Batch Estimation process. The first uses the Levenberg-Marquardt
method while the second uses the Gauss-Newton method to arrive at the estimation of the object’s
dimensions. The results presented on both of the following sections have been obtained by aver-
aging the results from 10 runs. The chosen batch size of measurements has been selected as 60
measurements per batch. A total of 181 measurements were used to obtain a total of three batches.
The batch size was chosen by investigating the observability of the states and parameters given a
batch of measurements. The observability of the ‘stacked’ batch observability matrix yields a rank
of 15. As shown on Table 1 the observability matrix has full rank (= 15) for batches greater than
10. For batches of less than 10 measurements the rank of the ‘stacked’ observability matrix was
found to be less than 15. That said, depending upon the initial conditions, the full rank condition
was always met when the batch size was 60 or more. Therefore, it was determined that a batch of
60 measurements would yield adequate results. The number of iterations per batch was set as 20
for both cases. The estimator initial conditions errors and initial conditions for the error covariance
were set to be the same as the Joint Estimation case. Similarly, the synthetic measurements were
created with the same initial conditions.
Table 1. Bach Size and Observability Matrix Rank Correlation
Batch Size Less than 10 Greater than 10
Rank of Observability Matrix Less than 15 15
Levenberg-Marquardt Method (BE-LM). The results for the Levenberg-Marquardt Bach Esti-
mation have been presented in the Appendix. These results were obtained with values of η = 100and f = 5. A scaling factor was introduced in this case as the cost function was modifying the
values for the parameters to a point where they became negative. In order to correct this α was set
as 0.1 as seen in Equation (31). This allowed the cost function to be decreased while maintaining a
non-negative value for the parameters. Figures 9 though 14 show the results obtained by averaging
the values from 10 independent runs. The first of these figures shows the estimation of the dimen-
sions of the object. No 3σ have been shown for any of the parameter estimations as these were done
by the batch estimation rather than the UKF. It can be seen the values change as the batch estimation
loop progresses. The values were estimated with in centimeters of the true value. In addition, Figure
10 shows the value of the cost function for each batch. It can be seen that the Levenberg-Marquardt
method is effective in reducing the value of the cost function with each iteration. Figure 11 shows
the estimation of the position. The 3σ bounds for this estimation are larger than those of the JE but
they quickly reduce. The final estimation value for the velocity is within 0.1 Km/s of the true value.
Figure 13 contains the results for the attitude estimation of the RSO. The 3σ bounds for the attitude
estimation vary more in this case than for the JE case, nevertheless the estimation of the attitude is
within 3 degrees of the true value. Finally the angular velocity estimation is shown in Figure 19.
The 3σ bounds for this plot increase and later oscillate as the estimation progresses.
Gauss-Newton Method (BE-NR). This method was implemented with a scaling factor α = 0.001.
The results for this method are shown in Figures 15 through 20. Figure 15 clearly shows the evo-
lution of the values for the length, width, and height through each of the three batches. The batch
yields estimates within centimeters of the true value of the dimensions of the object. The cost
function for one of the runs has been shown in Figure 16. It can be seen that for each batch of
10
measurements the cost function decreases with each iteration. Moreover, Figures 17 and 18 show
the estimation of the position and velocity. The 3σ bounds for the position begin at larger values
than those for the JE, nevertheless the error for the batch estimation quickly reaches an error close
to zero. The velocity estimation is similar to that of the JE with 3σ bounds closing in slightly faster.
Figure 19 shows the attitude estimation for this case. When compared to the results obtained by the
JE it can be seen that the error is slightly larger and the 3σ vary more as well. Nevertheless, the
attitude is estimated within four degrees of the true value. Finally the angular velocity estimation
error can be seen in Figure 20. Similarly to the attitude estimation, the error in the angular velocity
is slightly higher in this case when compared to that of the JE. The 3σ bounds also increase towards
the end of the estimation.
SUMMARY AND CONCLUSIONS
The focus of this paper was to further advance the work done in Reference 1. The motivation
behind this work is to continue improving methods that can be used to identify space objects that
could pose a danger to critical space assets. A new implementation of the UKF with a batch esti-
mation loop was proposed and implemented. The UKF estimates the states and parameters for a
predetermined batch size. When the batch size is reached the estimates are passed to the batch loop.
The batch loop was implemented using two methodologies. The first of those methodologies is the
Levenberg-Marquardt. The second methodology uses a Gauss-Newton algorithm. Once the batch
estimation iterates, a new estimate of the object’s parameters is obtained. This process is followed
until all available measurements are used.
It was determined that an adequate batch size was 60 measurements. A total of 181 measure-
ments were used for a total of three batches. Two experiments were executed. The first of those
experiments was deemed Joint Estimation and was treated as the baseline. This experiment did
not use the batch loop, rather it implemented all the measurement and perturbation models to ob-
tain a benchmark behavior of the UKF. The results obtained showed the UKF converges extremely
well for the position and velocity. The attitude and angular velocity estimations are good but the
3σ bound behavior could be improved. The estimation of the parameters also behaves well. The
second experiment was the implementation of the batch loop and the UKF. The second experiment
namely the Batch Estimation had two cases. The first case dealt with the implementation of the the
Levenberg-Marquardt method. The results for this case showed an improvement on the estimation
of the RSO’s parameters. It was shown that the value for the cost function decreases for each batch.
Moreover, the estimation of the position and velocity was similar to that of the Joint Estimation. The
attitude and angular velocity estimation was slightly different than that of the baseline, specially in
the behavior of the 3σ bounds. Finally the second case for the batch estimation used the Gauss-
Newton algorithm. The estimation of the parameters was improved when compared to that of the
baseline and the first case. Nevertheless, the minimization of the cost function is not as pronounced
as in the first case. The estimation of the velocity and the position are very similar to that of the first
batch case. Similarly, the attitude and angular velocity 3σ behavior could be improved.
Although batch estimation techniques can not be used in real-time, we developed this coupled
approach to exploit their advantage in obtaining estimates with lower error-covariance than with
sequential methods. It was seen that both the Levenberg-Marquardt methodology and the Gauss-
Newton yielded a better parameter estimate than the baseline UKF. This is not conclusively proven
and more work is to be conducted to show this. It was also seen that the Gauss-Newton algorithm
yielded a slightly better results than the Levenberg-Marquardt method. This too needs to be proven
11
with additional studies. Although further work needs to be done in the estimation of the attitude
and angular velocity this is an important step towards the estimation of RSO parameters. This work
has advanced the current knowledge in the area of low observables and the investigation of inverse
problems in nonlinear stochastic differential equations. Future work will involve improving upon
the current methods presented here.
The lightcurve measurement model has not been verified/calibrated against any real data. It was
found that the model utilized by us together with the initial conditions (orbit characteristics) yielded
very little information for accurate attitude estimation. Future work will involve improving this
measurment model with appropriate calibration to improve the estimation accuracy.
REFERENCES
[1] K. Subbarao and L. Henderson, “Inverse Problems in Unresolved Space Object Identification,” SpaceFlight Mechanics Meering, No. 10-149, 2010.
[2] J. L. Crassidis and J. L. Junkins, Optimal Estimation of Dynamic Systems. New York, New York:Chapman and Hall \CRC, 2004.
[3] D. A. Vallado and S. S. Carter, “Accurate orbit determination from short-arc dense observational data,”Advances in Astronautical Sciences, Vol. 97, 1997, pp. 1587–1602.
[4] J. Matusewicz, K. Subbarao, and J. Frisbee, “Uncertainty characterization of orbital debris using sim-ulated space surveillance network measurements,” AAS/AIAA Astrodynamics Specialist Conference,Mackinac Island, Michigan, August 19-23 2007.
[5] J. Matusewicz, K. Subbarao, and J. Frisbee, “Uncertainty characterization of orbital debris using theextended Kalman filter,” AAS/AIAA Astrodynamics Specialist Conference, Mackinac Island, Michigan,August 19-23 2007.
[6] M. Kaasalainen, L. Lamberg, K. Lumme, and E. Bowell, “Interpretation of lightcurves of atmosphere-less bodies: I. General theory and new inversion schemes,” Astronomy and Astrophysics, Vol. 259, 1992,pp. 318–332.
[7] J. Durech, “Shape determination of the asteroid (6053) 1993 BW3,” Icarus, Vol. 159, 2002, pp. 192–196.
[8] D. A. Vallado, Fundamentals of Astrodynamics and Applications. El Segundo, California and Boston,Massachusetts: Microcosm Press and Kluwer Academic Publishers, 2001.
[9] H. Schaub and J. Junkins, Analytical Mechanics of Aerospace Systems. AIAA, 2009.
[10] R. Linares, J. L. Crassidis, M. K. Jah, and H. Kim, “Astrometric and Photometric Data Fusion for Resi-dent Space Object Orbit, Attitude, and Shape Determination Via Multiple-Model Adaptive Estimation,”AAS/AIAA Astrodynamics Specialists Conference, Vol. AIAA-8341, 2010.
[11] M. F. Crassidis, J. L., “Unscented Filtering for Spacecraft Attitude Estimation,” Journal of Guidance,Control and Dynamics, Vol. 26, No. 4, 2003, pp. 536–542.
12
APPENDIX: FIGURES
Figure 1. Incident solar radiation on a particular face of the space object with ab-
sorbed (Fa) and reflective (Fr) forces (Reference 8)
Figure 2. Batch Estimation Sequence for Unscented Kalman Filter
13
Joint Estimation Figures
0 10 20 30 40 50 60 70 80 90 1002.3
2.35
2.4
2.45
2.5
2.55
2.6
2.65
2.7
2.75
2.8x 10
−5 Projected Frontal Area
Time (s)
Are
a (m
2 )
Figure 3. Projected Area (m2) JE
0 20 40 60 80 100−0.2
0
0.2
Leng
th
Error in Dimensions - m
0 20 40 60 80 100−0.2
0
0.2
Wid
th
0 20 40 60 80 100−0.2
0
0.2
Time (s)
Hei
ght
Figure 4. Error Dimensions (m) JE
0 20 40 60 80 100−5
0
5 Position Errors - Km
Rx
0 20 40 60 80 100−5
0
5
Ry
0 20 40 60 80 100−5
0
5
Time (s)
Rz
Figure 5. Position Error (Km) JE
0 20 40 60 80 100−5
0
5x 10
−3 Velocity Errors - Km/s
Vx
0 20 40 60 80 100−5
0
5x 10
−3
Vy
0 20 40 60 80 100−5
0
5x 10
−3
Time (s)
Vz
Figure 6. Velocity Error (Km/s) JE
0 20 40 60 80 100−5
0
5 Atttiude Errors - (deg)
φ
0 20 40 60 80 100−5
0
5
Time
θ
0 20 40 60 80 100−5
0
5
Time (s)
ψ
Figure 7. Attitude Error (MRP) JE
0 20 40 60 80 100−5
0
5x 10
−4 Angular Velocity Errors (rad/s)
ωx
0 20 40 60 80 100−5
0
5x 10
−4
ωy
0 20 40 60 80 100−5
0
5x 10
−4
Time (s)
ωz
Figure 8. Angular Velocity Error (rad/s) JE
14
Batch Estimation with Levenberg-Marquardt Method Figures
0 50 100 150 200−0.5
0
0.5
Leng
th
Error in Dimensions - m
0 50 100 150 200−0.5
0
0.5
Wid
th
0 50 100 150 2000
1
2
Time (s)
Hei
ght
Figure 9. Error Dimensions (m) BE-LM
0 5 10 15 20 25 300
50
100
Bat
ch 1
Cost Function for Batch
0 5 10 15 20 25 300
50
Bat
ch 2
0 5 10 15 20 25 3025
30
35
Iteration
Bat
ch 3
Figure 10. Batch Cost Function BE-LM
0 50 100 150 200−500
0
500 Position Errors - Km
Rx
0 50 100 150 200−500
0
500
Ry
0 50 100 150 200−500
0
500
Time (s)
Rz
Figure 11. Position Error (Km) BE-LM
0 50 100 150 200−0.5
0
0.5 Velocity Errors - Km/s
Vx
0 50 100 150 200−0.5
0
0.5
Vy
0 50 100 150 200−0.5
0
0.5
Time (s)
Vz
Figure 12. Velocity Error (Km/s) BE-LM
0 50 100 150 200−20
0
20 Atttiude Errors - MRPs
q 1
0 50 100 150 200−20
0
20
q 2
0 50 100 150 200−20
0
20
Time (s)
q 3
Figure 13. Attitude Error (MRP) BE-LM
0 50 100 150 200−0.1
0
0.1 Angular Velocity Errors (rad/s)
ωx
0 50 100 150 200−0.2
0
0.2
ωy
0 50 100 150 200−0.1
0
0.1
Time (s)
ωz
Figure 14. Angular Velocity Error (rad/s) BE-LM
15
Batch Estimation with Gauss-Newton Method Figures
0 50 100 150 2000.02
0.04
0.06
Leng
th
Error in Dimensions - m
0 50 100 150 200−0.05
0
0.05
Wid
th
0 50 100 150 2000
0.05
0.1
Time (s)
Hei
ght
Figure 15. Error Dimensions (m) BE-NR
0 5 10 15 20 25 3056.6
56.8
57
Bat
ch 1
Cost Function for Batch
0 5 10 15 20 25 3038
38.5
39
Bat
ch 2
0 5 10 15 20 25 3034
35
36
Iteration
Bat
ch 3
Figure 16. Batch Cost Function BE-NR
0 50 100 150 200−500
0
500 Position Errors - Km
Rx
0 50 100 150 200−500
0
500
Ry
0 50 100 150 200−500
0
500
Time (s)
Rz
Figure 17. Position Error (Km) BE-NR
0 50 100 150 200−0.5
0
0.5 Velocity Errors - Km/s
Vx
0 50 100 150 200−0.5
0
0.5
Vy
0 50 100 150 200−0.5
0
0.5
Time (s)
Vz
Figure 18. Velocity Error (Km/s) BE-NR
0 50 100 150 200−20
0
20 Atttiude Errors - MRPs
q 1
0 50 100 150 200−20
0
20
q 2
0 50 100 150 200−10
0
10
Time (s)
q 3
Figure 19. Attitude Error (MRP) BE-NR
0 50 100 150 200−0.2
0
0.2 Angular Velocity Errors (rad/s)
ωx
0 50 100 150 200−0.2
0
0.2
ωy
0 50 100 150 200−0.2
0
0.2
Time (s)
ωz
Figure 20. Angular Velocity Error (rad/s) BE-NR
16