Powered Safe Abort for Autonomous Rendezvous of Spacecraft Louis Breger

advertisement
Powered Safe Abort for
Autonomous Rendezvous of Spacecraft
Louis Breger∗ and Jonathan P. How†
MIT Department of Aeronautics and Astronautics
Several recent on-orbit autonomous docking missions have experienced serious
failures requiring immediate safing action. The future of autonomous spacecraft
rendezvous will depend on the ability of docking algorithms to effectively handle off-nominal situations resulting from anomalous system behaviors. This paper
presents a method for online generation of actively safe fuel-optimized rendezvous
trajectories. These trajectories guarantee the existence of known powered abort
trajectories providing collision-free escape, even in the presence of single thruster
failures. Numerous examples are presented to demonstrate the overall benefits of
incorporating these active safety constraints when compared to nominal trajectory
design techniques. A stochastic analysis is used to demonstrate that imposing active
safety as a constraint decreases the overall likelihood of collisions occurring.
I.
Introduction
On-orbit spacecraft rendezvous is a well-established technology that has been in use since the
Apollo program [2]. Autonomous docking of spacecraft is almost as old [12], first dating back to
1967 and used regularly with the Mir space station. However, the degree of autonomy required
for future missions is expected to increase [1]. Recently, anomalies in robotic rendezvous missions
have occurred on ETS-VII [3] and DART [4, 5]. Multiple anomalies on the ETS-VII mission caused
entries into a safe operating mode, at least one of which resulted in a preprogrammed maneuver to
move the spacecraft 2.5 km from its target. A navigation failure in the DART mission is thought
to have resulted in excess fuel expenditures and appears to have caused an on-orbit collision [5–7].
These recent experiences suggest that autonomous rendezvous and docking would greatly benefit
from the inclusion of additional safeguards to protect the vehicles in the event of failures. Designing
approach trajectories that guarantee collision avoidance for some common failures could simultaneously decrease the likelihood of catastrophic failures in which one, or both, of the spacecraft
are damaged and increase the likelihood that future attempts at docking succeed. Previous work
introduced an approach for finding efficient, passively safe rendezvous trajectories [32]. This paper
builds on that work to develop a method for generating fuel-optimized rendezvous trajectories online that guarantee the existence of known active safe abort trajectories for a large class of possible
spacecraft anomalies.
∗
†
Research Assistant, MIT Department of Aeronautics and Astronautics, lbreger@mit.edu
Associate Professor, MIT Department of Aeronautics and Astronautics, jhow@mit.edu
1 of 21
American Institute of Aeronautics and Astronautics
Numerous methods of generating and analyzing rendezvous trajectories exist in the literature
and encompass a wide range of rendezvous scenarios [8–13]. These papers consider rendezvous
from many perspectives, often taking into account complicated collision avoidance constraints,
nonlinear rotational dynamics, and fuel efficiency. Another perspective to be considered when
designing trajectories is safe behavior [12, 14–16]. Safety in the context of spacecraft rendezvous and
docking is typically with respect to collision avoidance following some type of failure. For example,
the approach in Ref. [16] creates trajectories which naturally tend to drift away from the target
spacecraft in the absence of thrusting, but which are not fuel-optimized. Alternately, Refs. [12]
and [14] develop the safety circle method, in which a nearby orbit with a relative invariant trajectory
is established that allows safe long-term observation before docking, however this approach is not
fuel optimized and does not propose a specific docking path. A method proposed in Ref. [15]
optimizes both safety and fuel using genetic algorithms. This approach treats safety as a goal rather
than a constraint and thus, cannot assure that the resulting trajectory would be safe. Ref. [11] plans
passively safe trajectories using potential functions, but the approach is computationally intensive
and limited to static obstacles. Various types of safety have been considered in the design of
UAV trajectories, but these focused on creating trajectories that are safe under nominal operating
conditions (e.g., safety from adversaries, uncertain terrain)[17, 18].
This paper defines a safe trajectory as an approach path that guarantees collision avoidance in
the presence of a class of anomalous system behaviors. Previous work [32] introduced a method
generating fuel optimized passive safe trajectories, which guarantee collision avoidance with no
thrusting required for safety. This paper extends the concept to include active safety, in which a
trajectory requires that inputs be applied to keep the system safe in the event of a failure. Note that
this definition of safety is more restrictive than guaranteeing nominal collision avoidance because it
guarantees that no collisions will occur for a range of faults. Active safety requires that the types
of any failures be identified in real-time and that some components of the control system remain
operational so that a sequence of control inputs can be applied.
The following sections review a method for generating fuel-optimized trajectories from linearized
relative dynamics and develop a novel approach for guaranteeing those trajectories will be actively
safe. Several examples of active safe trajectories generated for docking with and without invariance
constraints establish that adding safety constraints do not result in significantly increased fuel
use. Next, a stochastic analysis is conducted to verify that safe trajectories reduce the likelihood
of collision in the event of a failure. A method for adding guaranteed robustness to the safety
guarantees is also demonstrated.
II.
Online Trajectory Optimization for Autonomous Rendezvous and Docking
This section reviews and introduces notation for optimization-based trajectory generation using
the approaches presented in Refs [8, 19]. A trajectory generated through online optimization can be
designed by choosing the system inputs that produce that trajectory. For a linear system, methods
for incorporating and propagating the effects of inputs are well-known. The trajectory optimization
formulation in this section is presented in the context of linear time-invariant dynamics, but there is
2 of 21
American Institute of Aeronautics and Astronautics
no inherent restriction in the formulation preventing the use of time-varying dynamics [19]. Given
a chaser satellite whose state is xk at time k, the linearized dynamics of the system can be written
as
xk+1 = Ad xk + Bd uk
(1)
where Ad is the state transition matrix for a single time step, Bd is the discrete input matrix
for a single time step, and uk is the input vector at step k. Typically, in a rendezvous situation,
spacecraft would be in sufficiently close proximity to enable the use of the Hill-Clohessy-Wiltshire
(HCW) equations [20, 30], but GVE-based approaches [21] can be used for more widely separated
situations. Examples in this paper will use the HCW equations and hence the state x is defined as
x=
h
x y z vx vy vz
iT
(2)
where x, y, z, vx , vy , and vz are the positions and velocities of a chaser satellite in the radial,
in-track, and cross-track axes, respectively, of an LVLH frame positioned on the center of gravity
of a passive target vehicle. The input is defined as
u=
h
ux uy uz
iT
(3)
where ux , uy , and uz are the inputs of the chaser vehicle in the axes indicated by the subscripts in
the LVLH frame.
Given an initial state x0 , the state at any future step k is [22]

xk = Akd x0 +
h
k−2
Ak−1
d Bd Ad Bd . . . Ad Bd
u0
i
..
Bd 
 .




(4)
uk−1


= Akd x0 + Γk 


u0
..
.



(5)
uk−1
where Γk is the discrete convolution matrix. Since the effects of the control on the states are readily
expressed as linear combinations of the inputs, a linear optimization can be formed that optimizes
the constrained control commands and constrains the states of the system. The cost function for
this optimization will exclusively penalize fuel use. In an actual maneuver implementation, it may
be preferable to optimize both the fuel use and the maneuver duration (see Ref. [23]), however in
this paper only fuel use will be considered to simplify presentation and cost comparisons. The cost
of the optimization J is given by
J=
N
−1
X
kui k1
(6)
i=0
where N is the total number of possible input steps and the 1-norm cost is used to capture the
expenditure of fuel used, which is proportional to acceleration and ∆V , from axial thrusters. The
3 of 21
American Institute of Aeronautics and Astronautics
optimal cost is then given by [33]
J∗ =
min
N
−1
X
u0 ,...,uN −1
kui k1
(7)
i=0
At each step k, it is possible to constrain the state at that time to lie inside a convex region
Ak xk ≤ bk
(8)
where Ak is a matrix and bk is a vector that together capture a set of linear constraints on the state.
Note that the costs and constraints in Eqs. 6 and 8 show an example linear implementation of a
trajectory optimization, but in general the same concepts that will be presented hold for nonlinear
costs and constraints as well. Alternately, the state xk could be constrained to lie outside a region
through the use of binary variables [8]
Ak xk ≤ bk + M yk
kyk k1 ≤ m − 1
(9)
(10)
where yk is a vector whose elements are constrained to be 0 or 1, and M is a large number on
the scale of values taken by elements of x. This “Big M” method of collision avoidance works by
allowing, at most, all but one of the collision avoidance constraints to be relaxed. A constraint is
relaxed when the binary variable associated with it is set to 1, thereby making the right-hand side
of the inequality very large and guaranteeing constraint satisfaction. Since at least one constraint
is always guaranteed to not be relaxed, collision avoidance is assured (e.g., knowing that one is
outside of one side of a box is sufficient information to guarantee that one is not in the box).
The inputs at each time step can also be directly constrained using
umink ≤ uk ≤ umaxk
(11)
where umink and umaxk are vector bounds on the values of uk . Typically, the minimum thrust at
all times would be −umaxk . A detailed description of the full matrix forms used in linear trajectory
optimizations for space vehicles can be found in Refs. [19] and [8].
This section has reviewed an approach for creating fuel-minimizing trajectories that satisfy
time-varying position, velocity, and thrusting constraints. Applications of these constraint types
can insure that a spacecraft remains inside a line-of-site cone, and arrives at a docking port position
at a particular time with a particular speed range. In addition, the control authority available over
the course of the trajectory can be varied according to desired pattern.
III.
Active Safety
The trajectories generated by the constraints in Section II will satisfy docking requirements and
use minimal fuel to arrive at a rendezvous location. However, as is typical of optimal paths, the
4 of 21
American Institute of Aeronautics and Astronautics
trajectories will approach constraint boundaries and generally be sensitive to uncertain behavior.
Refs. [24] and [23] describe computationally feasible methods of generating trajectories online that
are robust to process and sensing noise expected under nominal operating conditions, a consideration revisited in Section A. That type of robustness to uncertainty is distinct from the definition
of safety for off-nominal conditions considered herein. This section presents an approach for generating trajectories that are actively safe with respect to a class of system failures. While it would
be desirable to avoid collisions and successfully complete docking in the presence of any system
failure, it is unlikely that such a scenario is possible.
Reference [32] considers passive abort safety, in which thrusters are turned off in the event of an
anomaly. Passive abort provides safe guarantees for a large subset of all possible failures is used,
including guidance system shutdowns, which encompasses thruster failures, computer anomalies,
and loss of sensing. However, because passive abort requires that all safe characteristics arise from
the nominal abort trajectory, it is generally necessary for the safe trajectory to be different from
the optimal trajectory, resulting in increased fuel use.
An alternative to passive safety is active safety, in which a set of thruster inputs is applied
to ensure rendezvous safety. The active response is a set of input sequences that is used instead
of passive safety. The safe input sequence can be designed a priori (e.g., thrust in-track, thrust
radially) and chosen in real-time or optimized at the time the nominal rendezvous maneuver is
optimized. In either case, the safe inputs are known at all times during the maneuver and no
additional optimization is required in the event of a failure. The advantages of active safety over
passive safety are significant: by allowing thrusting in the event of a failure, a significantly larger
portion of the nominal trajectory can be guaranteed safe and the fuel costs of guaranteeing the
safety of the nominal trajectory are reduced. Passively safe trajectories can be considered a subset of
active safe trajectories in which the active input sequence has no thrusting. The primary limitation
of active safety is that it provides safety guarantees for a smaller set of possible system malfunctions
than passive safety. In the case of passive safety, any anomaly in which the thrusters can be disabled
can be made safe. Safety guarantees resulting from an active safety trajectory require that some
thrusters continue to work properly and in the correct directions in the event of a failure. An
extension at the end of this section will show how active safety can be modified to provide safety
guarantees for single thruster failures.
The discrete convolution approach used in Eq. 4 can be used to predict the state of the chaser
at step k in the planning horizon in the event of a failure at time T with a predetermined safe input
5 of 21
American Institute of Aeronautics and Astronautics
sequence v yields

xF T k =
h
k−2
T −2
Ak−1
Bd 0 × ATd −1 Bd . . . 0 × Ad Bd
d Bd Ad Bd . . . Ad
u0
i
..
0 × Bd 
 .




uk−1

+ Akd x0 +
h
−1
Ak−T
Bd . . . Ad Bd
d
i
Bd 

v0
..
.




(12)
vk−T −1
where T < k < N , k − T < Ns , N is the number of steps in the nominal plan, and Ns is the number
of steps in the safe input sequence. If k ≤ T then xF T k = xk because no potential failure could
have occurred at that time. Equation 12 can be written more generally as
xF T k


Γk S(T, k)Uk + Akd x0 + Γk−T S(k − T, Ns )Vk ,
T < k ≤ N,




 Ak−N Γ S(T, N )U + Ak x + Γ
k > N,
N
N
k−T S(k − T, Ns )Vk ,
d 0
d
=
k−N

 Γk S(T, k)Uk + Akd x0 + Ad s ΓNs VNs ,
k ≤ N,



 k−N
k−Ns
k
ΓNs VNs ,
k > N,
Ad ΓN S(T, N )UN + Ad x0 + Ad
T < k − T ≤ Ns
k − T ≤ Ns
k − T > Ns
k − T > Ns
(13)
where k is the time step that the failure trajectory is propagated forward to, S(q, Nq ) = diag(I3(q) , 03(Nq −q) ),
In is an n × n identity matrix, 0n is an n × n matrix of zeros, the decision variables for the nominal input are the vector UTk = [ uT0
. . . uTk−1 ], and the predetermined safe input sequence
T
]. The possible ranges in Equation 13 correspond to the steps before the
VkT = [ v0T . . . vk−1
nominal plan has ended and before the end of the safe input sequence (k ≤ N, k ≤ k − T ), the
times after the nominal plan has ended and before the end of the safe input sequence (k > N, k ≤
k − T ), times before the nominal plan has ended and after the end of the safe input sequence
(k ≤ N, k > k − T ), and the times after the both the nominal plan and the safe input sequence
have ended (k > N, k > k − T ). All four cases must be considered in order to allow for safe input
sequences that are longer or shorter than the nominal plan length.
Active collision avoidance is achieved by adding constraints on the failure states of the spacecraft. Define the set of position states occupied by the target as Tk , which can describe any polytopic
region of position states, convex or otherwise. The safety horizon is the period of time after a failure
during which both spacecraft are guaranteed not to collide. The safety horizon lasts S steps after
the end of the nominal trajectory and is guaranteed by introducing the set of constraints
xF T k ∈
/ Tk ∀ k ∈ {T + 1, . . . , T + S}
(14)
The constraints in Eq. 14 are then imposed for T ∈ F where F is the set of every potential
failure time at which the system must guarantee collision avoidance for guidance shutdowns. The
parameters to be chosen in this safety formulation are F and S. This choice of parameters is highly
6 of 21
American Institute of Aeronautics and Astronautics
dependent on the requirements of a particular space mission. The advantage of choosing to be
safe for a large number of steps and for a long safety horizon is improved likelihood of preventing
a catastrophic failure scenario in which the chaser and target collide. However, imposing many
safety constraints greatly reduces the number of potential solution trajectories and as a result,
likely reduces fuel efficiency. The tradeoff between safety and fuel efficiency is discussed in the
scenarios in Sections IV.
An alternate approach to active safety where the safe input sequence is optimized online can
be implemented by moving the safe input sequence VNs into the decision vector of Eq. 13
xF T k




h
i U


k 

+ Akd x0 ,
T < k ≤ N,

Γk S(T, k) Γk−T S(k − T, Ns ) 



V
k







h
i U


N 

+ Akd x0 ,
k > N,

Adk−N ΓN S(T, N ) Γk−T S(k − T, Ns ) 


V Ns


=

i
h

UN 


+ Akd x0 ,
k ≤ N,

Γk S(T, k) Adk−Ns ΓNs 



V Ns







i U
h


N 

s
+ Akd x0 ,
k > N,

ΓNs 
Adk−N ΓN S(T, N ) Ak−N

d

VN
T < k − T ≤ Ns
k − T ≤ Ns
k − T > Ns
k − T > Ns
s
(15)
such that the safe input sequence VNs is optimized at the same time as the nominal rendezvous
trajectory.
The implementation of an active safe trajectory is similar to that of the safe trajectory approach
in Ref. [32]. Before entering the trajectory, the spacecraft is assumed to be in a nominal state
(i.e., all systems are functioning correctly). If a fault has not yet occurred, the spacecraft follows the
nominal trajectory, which is given by UN . If a fault occurs during a step that has been guaranteed
to be safe in the event of that fault, then the spacecraft begins using the safe input sequence. For
the duration of the safe input sequence, the chaser and target spacecraft are guaranteed to not
collide. Reference [32] introduced the invariance constraint
o
xF T k = AN
d xF T k
for k ≥ T
(16)
where No is the number of steps in an orbit. If S ≥ No and the open loop dynamics given by Ad
admit invariant solutions then Eq. 16 is sufficient to guarantee safety for any time horizon over
which the dynamics are valid.
IV.
Rendezvous Scenario
The rendezvous and docking scenario to be examined in this paper involves a target spacecraft
being docked with and a chaser spacecraft maneuvering to achieve that docking. Figure 1 shows
a target spacecraft that lies at the center of an local frame. A line-of-sight (LOS) cone protrudes
7 of 21
American Institute of Aeronautics and Astronautics
from the target spacecraft and it is required that rendezvous remain within this line-of-sight cone
for vision-based sensing. At the interface between the LOS cone and the target is a docking port
(rectangular platform). The LOS requirements are
ALOSk xk ≤ bLOSk ∀k = 1 . . . N
(17)
where ALOSk and bLOSk describe the states within the LOS cone at a step k in the planning horizon.
The terminal constraint is
ATermN xN ≤ bTermN
(18)
where ATermk and bTermk describe the states the spacecraft must occupy at the end of the planning horizon to achieve safe docking. These constraints can be both on position (e.g., enter a
region within reach of a grappling arm) and on velocity (e.g., dock within a velocity range that
produces acceptable stress on the docking port). In addition, time-varying bounds are introduced
on the maximum thrusting levels in order to ensure large thrusts are not planned for the period
immediately before docking. The safety constraints in Eq. 14 are imposed for the three quarters
of the planning horizon. In the examples, an orbit with frequency n = 0.001 rad/s is used and is
discretized into 20 steps and the set of inputs that can fail is T ∈ {4 . . . 19}. The planning horizon
is a full orbit. The chaser spacecraft, modeled after the mission in Ref. [27], has a mass of 45 kg
and a maximum acceleration of 10−3 m/s2 during the first 17 steps of the plan and 10−5 m/s2 for
the last 3 steps to prevent trajectory solutions with large terminal thrusts. In addition, the docking
constraint specifies that the velocity of the spacecraft at the time of docking be less than 1 mm/s
in each axial direction. In summary, the safety algorithm used in this section is
min
u0 ,...,uN −1
(19)
Eq. (6)
s.t. Eq. (11) ∀ k ∈ {0, . . . , N − 1},
Eq. (17),
Eq. (18),
Eq. (14) ∀ T ∈ F
In these examples, the safety horizon is a full orbit. Any of the design parameters in the safety
implementation can be easily adjusted and in practice one would likely conduct a simulation study
or analysis [28] to find the best combination for minimizing fuel use and guaranteeing feasible
solutions.
A.
Probability of Collision
To judge the effectiveness of the active safety algorithm introduced in Section III, define a probability of collision metric, Pcol , which is the probability of a failure at any time step during a maneuver
resulting in a collision between the target and chaser spacecraft. The probability of collision is
8 of 21
American Institute of Aeronautics and Astronautics
Docking
Port
Target
LOS
cone
Fig. 1: Target spacecraft and docking configuration
given by
Pcol =
N
X
P (failure at i | no failure before i) · P (collision occurs | failure at i)
(20)
i=1
where the probability P (collision occurs | failure at i) is either 1 or 0 and is evaluated by examining
the trajectory followed if thrusters are disabled at step i and checking for future collisions. Assuming
that the probability of a failure at any step in the trajectory is f , then
P (failure at i | no failure before i) = (1 − f )i−1 f
(21)
Using the metric Pcol , the effectiveness of the safety approach was investigated by creating a series
of safe trajectories starting from different initial conditions near the target. The initial condition
positions were chosen to create a range of nearby starting points. The velocity vector for each
position was chosen according to the conditions in Ref. [14] to create a safety circle. This creates
a situation where each rendezvous trajectory begins from a safe, invariant orbit within range of a
final approach rendezvous trajectory.
Figures 2 and 3 show the values of Pcol for full-orbit optimized final approach trajectories,
discretized into N = 20 steps. The trajectories are generated using F = ∅ (no safety constraints)
and F = {9, . . . , 19} (guaranteed safe for the last 10 steps of the trajectory), respectively, where
9 of 21
American Institute of Aeronautics and Astronautics
f = 0.001. These plots show that without safety, the probably of collision for a given rendezvous
trajectory tends to fall between 0.005 and 0.015. However, the addition of safety for half of the
trajectory brings the collision probability for most of the trajectories below 0.001. The same
optimizations were performed and analyzed for a range of other F ranges and the results are
summarized in Figure 4. The dashed line indicates an overbound, P̄col , for the maximum possible
probability of collision, which is the case where every failure during the course of the trajectory
when safety is not guaranteed (i.e., steps not in F) would result in a collision, which is given by
X
P (failure at i | no failure before i)
(22)
{0,...,N −1}\F
The line marked with shows the largest probability encountered in the optimized trajectories
for all initial conditions considered. This is equivalent to finding the maximum height (z value)
in a plot of the type in Figure 3 for each different set F used to create Figure 4. The minimum
(line marked by •) shows that in each case, there were some initial conditions that did not result
in collision, regardless of the steps in F. In those cases, the fuel-optimal rendezvous trajectory is
safe. The average Pcol (solid line), equivalent to averaging the probability heights over an area of
the type in Figure 3, followed a similar trend to the largest Pcol , but was significantly lower. This
indicates that although some initial conditions are particularly prone to collision, on average the
collision probabilities are significantly improved by safety and in no case has the addition of safety
made collisions more likely than in the fuel-optimal case (F = ∅). Furthermore, for this particular
case, the trends indicate that guaranteeing more than the last five steps safe does not significantly
decrease the probability of a collision. This conclusion would be valuable from a mission planning
perspective, because each additional plan step that is guaranteed safe represents a tradeoff in which
computation time and nominal fuel use potentially increase.
Eq. 22 indicates that the overbound P̄col decreases with increasing length of the safe region (i.e.,
fewer steps in F). For the purposes of worst-case safety guarantees, the overbound could be used
as an analytic rule-of-thumb for mission design studies.
B.
Examples
Figure 5 shows the fuel-minimizing rendezvous trajectory beginning from a safety circle holding
orbit. The nominal trajectory is marked by • and the trajectories followed in the event failures
occur in the last 3/4 of the nominal trajectory are marked by ×. Several of the failure trajectories
pass through the target spacecraft and would result in a collision, indicating that the nominal
rendezvous trajectory is not safe. Several active safety approaches to optimizing the same initial
conditions as in Fig. 5 are demonstrated in Figures 6-9. Figure 6 shows an active safe rendezvous
trajectory beginning from a safety circle holding orbit. In this case, the safe input sequence V has
been arbitrarily chosen to be an orbit of constant thrusting at 10−6 m/s2 in the −x direction of
an LVLH frame centered on target. The last three quarters of the rendezvous trajectory have been
guaranteed through constraints to be actively safe. In the figure, the nominal rendezvous trajectory
(line marked with •) shows the planned rendezvous maneuver which will be followed in no failures
10 of 21
American Institute of Aeronautics and Astronautics
Collision Probability Using Safety Circle ICs (No Safety)
P(collision)
0.015
0.01
0.005
0
100
20
10
50
0
−10
0
in−track (m)
−20
radial (m)
Fig. 2: Probability of a collision occurring for a range of initial conditions with F = ∅ (No safety
guarantees).
Collision Probability Using Safety Circle ICs
−3
x 10
2
P(collision)
1.5
1
0.5
0
100
20
10
50
0
−10
in−track (m)
0
−20
radial (m)
Fig. 3: Probability of a collision occurring for a range of initial conditions with F = {4, . . . , 19}
(latter 3/4 of trajectory guaranteed safe)
11 of 21
American Institute of Aeronautics and Astronautics
0.02
Analytic Overbound
Average P(collision)
Max P(collision)
Min P(collision)
Probability of Collision (overbound)
0.018
0.016
0.014
0.012
0.01
0.008
0.006
0.004
0.002
0
0
5
10
15
# of steps at plan end guaranteed safe
20
Fig. 4: Probability of collision occurring for various values of F
Table 1: Comparison of various types of safe rendezvous trajectories. Fuel costs in mm/s.
Nominal Cost
Safety Cost
P(collision)
No Safety,
Nominal
Passive
Safety
Passive
Safety,
invariant
Active
Safety,
a priori
13.67
0
0.012
14.21
0
0
19.32
0
0
13.84
6.28
0
Active
Safety,
a priori
invariant
18.17
6.28
0
Active
Safety,
optimized
13.67
0.76
0
Active
Safety,
optimized,
invariant
17.58
2.14
0
occur. Each portion of the trajectory marked with 4 shows a possible path followed by the chaser
in the event that the safe input sequence is used. Constraints guarantee safe collision avoidance for
the entire red portion of the trajectory, however, no safety guarantees exist for the trajectory after
the safe input sequence is enacted. The trajectories marked by × show the how the path drifts
after the end of each safe trajectory. In several cases, the drifting path would result in a collision
at some time in the future. To ensure collision avoidance, Figure 8 shows an active safe trajectory
optimized from the same initial conditions, but with the invariance constraint from Eq. 16 imposed.
In this case, a failure at any step in the last three quarters of the nominal trajectory would result
in the chaser spacecraft entering a safe, invariant trajectory near the target spacecraft. Figures 8
and 9 show the optimized active safe trajectories using the constraints in Eq. 15 without and with
invariance constraints, respectively.
Table 1 compares various approaches for creating rendezvous trajectories with and without
safety using the same initial conditions as the examples in Figures 6-9. The first row refers to
12 of 21
American Institute of Aeronautics and Astronautics
the fuel cost (mm/s) of implementing the nominal rendezvous trajectory. The second row gives
the cost of implementing a full safe input sequence (mm/s). The last row gives the probability of
collision for the trajectory using the method introduced in Section A. The columns compare the
fuel-optimal path with no safety to the passive safety path and paths using active safety. The active
safety columns labeled a priori use the predefined safe input sequence approach in Eq. 13 and the
columns labeled optimized use the approach in Eq. 15. The columns marked invariant also use the
invariance constraints in Eq. 16. It is notable that for the example in the table, the probability
of collision for the fuel-optimal trajectory (i.e., no safety) is 0.012, but the addition of passive or
active safety to the problem causes the probability to drop to zero. Note that this probability is
predicated on the assumption that a failure is identified within a time-step of its occurrence and
that the thrusters can be turned off (for passive safety) or used nominally (for active safety).
Passive safety requires more fuel for rendezvous than the case without safety, however, active
safety with an optimized safe input sequence has the same cost as the fuel-optimal case. In the
cases where invariance is imposed as a constraint, the fuel cost using active optimized safety is
lower than the passive invariance case, but not as low as the optimal trajectory. Thus, for these
initial conditions, both the nominal trajectory and the safe abort trajectory must be shaped to
achieve active invariance. The cost of safety for the nominal and passive safety trajectories is zero,
because those cases do not consider safety and do not require thrusting for failures, respectively.
In each active safety case, the safety cost is very small compared to the cost of the nominal
trajectory, indicating that it should be possible to implement active safety on a space mission
without significantly increasing the ∆V budget.
V.
Active Safety for Thruster Failures
The active safety approach in Eq. 15 can be modified to guarantee safety for cases of individual
thruster failure by optimizing multiple safe input sequences. Each safe input sequence is constrained
to only use a single thruster direction, or alternately, a single thruster assuming that thrusters act
through the center of gravity. This guarantees that if only one thruster fails, another safe trajectory
which does not use the failed thruster still exists. Thus, in a system with at least two thrusters,
any single thruster failure to the off state will be in the set of possible system failures covered by
active safety. If thrusters in the system can be used to cancel each other (e.g., a system with axial
thrusters) then this active safety extension can also be used in the presence of thruster-on failures.
In that case, the thruster opposite that which failed can be used to cancel erroneous thrusting while
a thruster in another direction can be used to enact a preplanned safe input sequence.
13 of 21
American Institute of Aeronautics and Astronautics
Fig. 5: Rendezvous trajectory optimized without safety. Nominal trajectory is marked by • and
trajectories followed in the event of failures in last 3/4 of nominal trajectory are marked by ×.
Modifying Eq. 15 to include multiple safe input sequences yields
xF T k =






























































Uk



0
 Γk S(T ) Γk S(T − k)Hx
  Vx  + Ak x0 ,
d
 k 
Γk S(T )
0
Γk S(T − k)Hy
y
Vk



 U
k
k−N


0
 Ad ΓN S(T ) Γk S(T − k)Hx
  V x  + Ak x0 ,
d
 k 
Ak−N
ΓN S(T )
0
Γk S(T − k)Hy
d
y
Vk



 U
k
k−N


0
 Γk S(T ) Ad ΓNs Hx
  Vx  + Ak x0 ,
d
 k 
Γk S(T )
0
Adk−N ΓNs Hy
y
Vk



 U
N
k−N
k−N


0
 Ad ΓN S(T ) Ad ΓNs Hx
  V x  + Ak x0 ,
d

N
s 
Ak−N
ΓN S(T )
0
Adk−N ΓNs Hy
d
y
V Ns
k ≤ N, k − T ≤ Ns
k > N, k − T ≤ Ns
k ≤ N, k − T > Ns
k > N, k − T > Ns
(23)
x is the safe input sequence of only x-direction inputs, Vy is the safe input sequence of
where VN
Ns
s
only y-direction inputs, and Hx and Hy are matrices that extract only elements of Γ pertaining
to ux inputs and uy inputs, respectively. The active safety algorithm remains the same, but the
failure trajectory used in formulating Eq. 14 must be propagated using Eq. 15 instead of Eqs. 13
or 15.
14 of 21
American Institute of Aeronautics and Astronautics
Nominal trajectory
in-track (m)
Active
trajectory
Drift
trajectory
radial (m)
cross-track (m)
Fig. 6: Rendezvous trajectories using active safety.
in-track (m)
inset
radial (m)
Fig. 7: Rendezvous trajectories using active safety with invariance constraints.
15 of 21
American Institute of Aeronautics and Astronautics
in-track (m)
radial (m)
in-track (m)
Fig. 8: Rendezvous trajectories using optimized active safety.
radial (m)
Fig. 9: Rendezvous trajectories using optimized active safety with invariance constraints.
16 of 21
American Institute of Aeronautics and Astronautics
X-fail Traj
in-track (m)
in-track (m)
Y-fail Traj
radial (m)
radial (m)
Fig. 10: Rendezvous trajectories for using active safety optimized for two possible thruster failure
directions.
Figure 10 shows an example trajectory using the multi-solution active safety form in Eq. 23 to
solve the safe rendezvous problem for the initial conditions used in Table 1. The left side of the
figure shows the nominal rendezvous trajectory and the safe trajectories that would be used in the
x ). The right side shows
event of a failure in the ±y direction thruster (resulting from using VN
s
y
. In this case, a
the same nominal trajectory, but the safe trajectories shown correspond to VN
s
single optimization has produced two sets of safe input sequences, either valid at any time step
with guaranteed safety. The safe input sequence solutions are

x
VN
s



=


−4.56 × 10−6


0









=


0
y
VN
s
3.06 × 10−6

0






0
0
(24)
0
The nominal trajectory in this case requires 13.67 mm/s of fuel, equivalent to the fuel-optimal,
x is 1.43 mm/s and for Vy is 0.96
“unsafe” trajectory. The cost of safety for implementing VN
Ns
s
mm/s, which follows the trend of low safety trajectory costs observed in Table 1.
The algorithm for using passive safety only requires that thrusters be disabled in the event of
a failure and active safety only requires that a predetermined safe input sequence be used. The
implementation algorithm for the modified active safety formulation in this section requires an
additional input from the spacecraft fault detection and isolation system which indicates the type
of fault. In the case of thruster failure, this would also need to include which thruster failed and
the nature of the failure. This additional information enables the active safety implementation to
choose the appropriate safe input sequence to use.
A.
Mitigating Effects of Process Noise and Navigation Error
The safety formulation in Equations 13 and 14 assumes that the state of the chaser spacecraft
relative to the target spacecraft is precisely known. In practice, this relative state is only known to
17 of 21
American Institute of Aeronautics and Astronautics
Robust Example using previous setup & ICs
– Nominal cost: 13.84 mm/s Safety cost: 2.1 mm/s
– Cost w/ no safety: 13.67 mm/s
Robustness method
– Optimize using
constraints for
multiple ICs
– Choose ICs
to represent
sensing
uncertainty
In this case:
– ±0.75 mm/s
radial vel
– ±0.002 mm/s
in-track vel
Fig. 11: Safe rendezvous trajectory with robustness to initial condition velocity uncertainty
within the accuracy provided by the navigation system. Likewise, the propagation used in Eq. 13
is only as accurate as the linear dynamics used to formulate that equation, since the actual vehicle
would be subject to nonlinear dynamics, and disturbances from effects such as drag, J2 , separation
distance, and eccentricity. Equation 13 can also be rewritten to enable time-varying dynamics
or an additional vector of modeled disturbances can be added to the problem without increasing
the complexity of the resulting optimization [19]. This permits a more sophisticated dynamics
model to be used, which could reduce some of the effects of modeling error [25]. To account for
navigation error, the constraints in Eq. 14 can be made robust by posing them multiple times
for a representative sampling of possible initial states that cover the space of likely navigation
errors. Reference [26] introduces such an approach and an algorithm for minimizing the effect of
robustness constraints on the size of the resulting optimization. Figure 11 shows a safe trajectory
optimized using the same initial conditions as those used to create Table 1. In the figure, active
safety with guaranteed collision avoidance for the last 3/4 of the trajectory is used with the addition
of robustness to initial condition uncertainty. In this case, the initial velocity of the chaser is only
known to within ±0.75 mm/s in the radial direction and ±0.0002 mm/s in the in-track direction.
The resulting trajectory requires 13.84 mm/s nominally and the safe input sequence requires 2.1
mm/s. The cost of robustness in this case is less then 2% of the cost of the nominal safe trajectory
without robustness. However, the problem is particularly sensitive to the amount of uncertainty
present in the in-track velocity and can quickly become infeasible for larger uncertainties.
18 of 21
American Institute of Aeronautics and Astronautics
VI.
Conclusion
Safety in autonomous spacecraft rendezvous trajectory design allows abort with guaranteed
collision avoidance for a class of anomalous system behaviors. This paper introduced several online
optimization formulations that guarantee active safety and demonstrated in numerous simulations
that the additional fuel costs are comparatively small, particularly relative to commonly considered
suboptimal trajectories. The active safety approach achieved the same fuel costs as trajectories
without safety while still guaranteeing collision-free escape trajectories for a large class of potential anomalies, including single thruster failures. The safety algorithms presented provide a
fuel-efficient, computationally feasible framework for designing safe mode procedures for multispacecraft missions.
Acknowledgments
This work was funded under Cooperative Agreement NCC5-729 through the NASA GSFC
Formation Flying NASA Research Announcement. Any opinions, findings, and conclusions or
recommendations expressed in this material are those of the authors and do not necessarily reflect
the views of the National Aeronautics and Space Administration.
References
1
D. J. Zimpfer, P. S. Spehar, F. Clark, C. D’ Souza, and M. Jackson, “Autonomous rendezvous
and capture guidance, navigation and control,” Flight Mechanics Symposium, (Goddard Space
Flight Center, Greenbelt, Maryland), Session 3, Paper 7, October 18–20, 2005.
2
M. E. Polites, “Technology of Automated Rendezvous and Capture in Space,” AIAA Journal of
Spacecraft and Rockets, vol. 36, no. 2, March-April 1999, p. 280-291.
3
I. Kawano, M. Mokuno, T. Kasai, T. Suzuki, “Result and evaluation of autonomous rendezvous
docking experiments of ETS-VII,” Proceedings of the AIAA Guidance, Navigation and Control
Conference, Aug 1999. AIAA-1999-4073.
4
T. E. Rumford, “Demonstration of Autonomous Rendezvous Technology (DART) Project Summary,” Proceedings of SPIE, Volume 5088, pp.10–19, 2003.
5
“Overview
of
the
DART
Mishap
Investigation
Results,”
NASA.gov,
online
at
http://www.nasa.gov/mission pages/dart/main/index.html, last accessed May 2006.
6
K. Young, “Autonomous rendezvous in space becomes hit and run,” New Scientist Space, online
at http://www.newscientistspace.com/article/dn7303, last accessed Jan. 2006.
7
B. Berger, “Fender Bender:
NASA’s DART Spacecraft Bumped Into Target Satellite,”
Space.com, online at http://www.space.com/missionlaunches/050422 dart update.html,
last accessed Jan. 2006.
19 of 21
American Institute of Aeronautics and Astronautics
8
A. G. Richards, T. Schouwenaars, J. P. How, E. Feron, “Spacecraft Trajectory Planning With
Collision and Plume Avoidance Using Mixed Integer Linear Programming,” AIAA Journal of
Guidance, Control and Dynamics, vol. 25, pp.755-764, Aug 2002.
9
I. Garcia and J. P. How, “Trajectory Optimization for Satellite Reconfiguration Maneuvers with
Position and Attitude Constraints” Proceedings of the IEEE American Control Conference, June
2005, pp.889-895
10
P. K. C. Wang, M. Mokuno, and F. Y. Hadaegh, “Formation Flying of Multiple Spacecraft with
Automatic Rendezvous and Docking Capability,” AIAA Guidance, Navigation, and Control
Confrence, Austin, TX, Aug 11-14, 2003.
11
A. B. Roger and C. R. McInnes, “Safety Constrained FreeFlyer Path Planning at the International Space Station,” Journal of Guidance, Control, and Dynamics, 23(6):971979, NovemberDecember 2000.
12
W. Fehse. Automated Rendezvous and Docking of Spacecraft. Cambridge University Press, 2003.
13
D. K. Geller, “Linear Covariance Techniques for Orbital Rendezvous Analysis and Autonomous
Onboard Mission Planning,” Journal of Guidance, Control, and Dynamics, 29(6):1404-1414,
NovemberDecember 2006.
14
B. Naasz, “Safety Ellipse Motion with Coarse Sun Angle Optimization,” 2nd International Symposium on Formation Flying Missions and Technologies, NASA/CP-2005-212781, Washington,
DC, United States, 14-16 Sept. 2004
15
S. Jacobsen, C. Lee, C. Zhu, and S. Dubowsky, “Planning of Safe Kinematic Trajectories for Free
Flying Robots Approaching an Uncontrolled Spinning Satellite.” Proceedings of the ASME 27th
Annual Biennial Mechanisms and Robotics Conference, Montreal, Canada, September 2002.
16
S. Matsumoto, S. Dubowsky, S. Jacobsen, Y. Ohkami, “Fly-by Approach and Guidance for
Uncontrolled Rotating Satellite Capture,” AIAA Guidance, Navigation, and Control Confrence,
Austin, TX, Aug 11-14, 2003.
17
T. Schouwenaars, J. P. How, and E. Feron, “Decentralized Cooperative Trajectory Planning of
Multiple Aircraft with Hard Safety Guarantees,” Proceedings of the AIAA Guidance, Navigation
and Control Conference, Aug 2004. AIAA-2004-5141.
18
C. Tomlin, I. Mitchell, R. Ghosh, “Safety Verification of Conflict Resolution Maneuvers,” IEEE
Transactions on Intelligent Transportation Systems, vol 2., no 2., June 2001, p.110.
19
M. Tillerson, G. Inalhan, and J. P. How, “Co-ordination and control of distributed spacecraft
systems using convex optimization techniques,” International Journal of Robust and Nonlinear
Control, Vol.12, John Wiley & Sons, 2002, p. 207-242.
20
G. W. Hill, “Researches in Lunar Theory,” American Journal of Mathematics, Vol. 1, 1878,
pp. 5–26,129–147,24–260.
20 of 21
American Institute of Aeronautics and Astronautics
21
L. S. Breger and J. P. How, “J2 -Modified GVE-Based MPC for Formation Flying Space,” AIAA
Guidance, Navigation, and Control Conference Conf., August 2005.
22
G. Franklin, J. Powell, and M. Workman, “Digital Control of Dynamic Systems,” Third
Edition,Addison-Wesley, 1998.
23
A. G. Richards, “Robust Constrained Model Predictive Control,” PhD Thesis, Massachusetts
Institute of Technology, November 2004.
24
M. Tillerson and J. P. How, “Analysis of the Impact of Sensor Noise on Formation Flying
Control,” Proceedings of the American Control Conference, Arlington, VA, June 25-27, 2001.
25
L. S. Breger and J.P. How, “Gauss’s Variational Equation-Based Dynamics and Control for
Formation Flying Spacecraft,” AIAA Journal of Guidance, Control and Dynamics, accepted for
publication April 18, 2006.
26
L. S. Breger, G. Inalhan, M. Tillerson, and J. P. How, “Cooperative Spacecraft Formation Flying:
Model Predictive Control With Open- And Closed-Loop Robustnes,” Modern Astrodynamics,
edited by P. Gurfil, Elsevier, Oxford, 2006.
27
J. P. How, R. Twiggs, D. Weidow, K. Hartman, F. Bauer, “Orion - A low-cost demonstration
of formation flying in space using GPS,” Proceedings of AIAA/AAS Astrodynamics Specialist
Conference and Exhibit, Boston, MA, Aug. 10-12, 1998, Collection of Technical Papers (A9837348 10-13), Reston, VA, American Institute of Aeronautics and Astronautics, 1998, p. 276-286.
28
A. G. Richards, L. S. Breger and J. P. How, “Analytical Performance Prediction for Robust
Constrained Model Predictive Control,” International Journal of Control, Vol. 79, No. 6, August
2006, pp. 877-894.
29
Y. Kuwata, Real-time Trajectory Design for Unmanned Aerial Vehicles using Receding Horizon
Control, S.M. Thesis, Dept. of Aeronautics and Astronautics, MIT, Jun. 2003.
30
M. Kaplan. Modern Spacecraft Dynamics and Control. Wiley, 1976.
31
L. S. Breger, J. P. How, and K. T. Alfriend, “Partial J2 -Invariance for Spacecraft Formations,”
AIAA Guidance, Navigation, and Control Conference Conf., August 2006.
32
L. S. Breger and J. P. How, “Safe Trajectories for Autonomous Rendezvous of Spacecraft,”
AIAA Guidance, Navigation, and Control Conference Conf., August 2006.
33
D. Bertsimas and J. N. Tsitsiklas, Introduction to Linear Optimization, Athena Scientific, Belmont, 1997.
21 of 21
American Institute of Aeronautics and Astronautics
Download