Minimum-Time Trajectory Optimization With
Data-Based Models: A Linear Programming Approach
Abstract
In this paper, we develop a computationally-efficient approach to minimum-time trajectory optimization using input-output data-based models, to produce an end-to-end data-to-control solution to time-optimal planning/control of dynamic systems and hence facilitate their autonomous operation. The approach integrates a non-parametric data-based model for trajectory prediction and a continuous optimization formulation based on an exponential weighting scheme for minimum-time trajectory planning. The optimization problem in its final form is a linear program and is easy to solve. We validate the approach and illustrate its application with a spacecraft relative motion planning problem.
keywords:
Trajectory Optimization, Time-Optimal Control, Data-Driven Control, Linear Programming, , ,
1 Introduction
Minimum-time trajectory optimization (also known as “time-optimal control”) is frequently involved in robot path planning and tracking (Lepetič et al., 2003; Verscheure et al., 2009), space mission design and operation (Shirazi et al., 2018), and other disciplines wherever a task is desired to be accomplished in a least amount of time, typically subject to limited resources. Due to its significant relevance, the investigation into this topic has been extensive over decades (Kalman and Bertram, 1959; LaSalle, 1959; O’Reilly, 1981).
The formulation of a minimum-time trajectory optimization problem can be either in continuous time or in discrete time. In continuous time, solution techniques are usually based on indirect methods (also known as “variational methods”): One first applies Pontryagin’s maximum principle to reduce the trajectory optimization problem to a two-point boundary value problem (TPBVP), and then solves the TPBVP using a shooting method (Trélat, 2012; Taheri et al., 2017). In discrete time, in contrast, direct methods are more often considered. Various direct methods for minimum-time trajectory optimization in discrete time have been proposed in the literature: In the approach of Carvallo et al. (1990), a minimum-time problem is reformulated into a mixed-integer program, where a set of Boolean variables are used to indicate if a given target condition is reached at each time step over the planning horizon. In the approaches of Van den Broeck et al. (2011) and Zhang et al. (2014), a minimum-time problem is solved using a bi-level algorithm, where the lower level solves a fixed-horizon trajectory planning problem treating the target condition as a terminal constraint and the upper level adjusts the planning horizon of the lower-level problem to find the minimum horizon length such that the lower-level problem admits a feasible solution. In the approaches of Rösmann et al. (2015) and Wang et al. (2017), the time is scaled and the scaling factor is treated as an optimization variable. This way, minimizing the final time of the original free-final-time problem is achieved through minimizing the scaling factor in a related fixed-final-time problem. However, in such an approach based on time scaling, the optimization problem is necessarily nonlinear and nonconvex, even for linear systems. In the approach of Verschueren et al. (2017), the deviation from the target condition is penalized with a weight that increases exponentially with time. It is shown that a minimum-time trajectory solution can be obtained if the weight parameter is chosen to be sufficiently high. The approaches reviewed above typically use a state-space model of the considered dynamic system to predict the trajectories. A common approach to obtaining a state-space model, to be used for trajectory optimization, is to first derive the model from first principles and then calibrate its parameters according to prior knowledge and/or data of the system.
Recently, a non-parametric modeling approach based on behavioral systems theory is gaining attention due to its unique applicability to emerging data-driven paradigms (Markovsky and Dörfler, 2021). This approach uses input-output time-series data of a given system to build up a (non-parametric) predictive model, which is referred to as a data-based model in this paper, rather than using the data to identify/calibrate a (parametric) state-space model. The integration of such data-based models into predictive control algorithms has been investigated by various researchers, e.g., Coulson et al. (2019, 2021); Berberich et al. (2020); Baros et al. (2022); Huang et al. (2023), and has demonstrated superior performance than conventional control methods in a number of applications (Elokda et al., 2021; Huang et al., 2021; Chinde et al., 2022). Along with bypassing the step of state-space model identification/calibration, such a predictive control algorithm using an input-output data-based model determines control input values directly based on output measurements and does not require state estimation using an observer. Therefore, it provides an “end-to-end” data-to-control solution, which may be simpler to implement from the point of view of practitioners and may facilitate fully autonomous operation of future intelligent systems.
In the above context, the goal of this paper is to develop an approach to minimum-time trajectory optimization based on input-output data-based models, to produce an end-to-end data-to-control solution to many time-optimal planning and control problems in robotics, aerospace, and other disciplines. To the best of our knowledge, there has been no previous work addressing this topic. We focus on linear time-invariant systems, for which we adopt the approach based on behavioral systems theory to build up a non-parametric data-based model for trajectory prediction. We then exploit an exponential weighting scheme extended from the one of Verschueren et al. (2017) to solve for minimum-time trajectories. We show that the optimization problem in its final form is a linear program and hence is easy to solve. Main contributions of this paper are as follows:
-
•
We develop an approach to minimum-time trajectory optimization based on input-output data-based models, which is the first such approach in the literature.
-
•
We extend the trajectory prediction method in previous predictive control algorithms using data-based models (e.g., the ones in Coulson et al. (2019, 2021); Berberich et al. (2020); Baros et al. (2022); Huang et al. (2023)) to enable predicting trajectories over an extended planning horizon without relying on a high-dimensional model. This extension is especially relevant to trajectory optimization because a long planning horizon is not rare in a trajectory optimization setting. Our method is inspired by the multiple shooting method (Trélat, 2012).
-
•
Using an exponential weighting scheme extended from that of Verschueren et al. (2017), we formulate the minimum-time trajectory optimization problem into a linear program, which is easy to solve. We prove that minimum-time trajectories can be obtained with the linear program if a weight parameter is chosen to be sufficiently high. In particular, we make the following extensions to the exponential weighting scheme: 1) The scheme was used in Verschueren et al. (2017) for minimum-time trajectory planning based on a state-space model; we extend the scheme to apply it to minimum-time trajectory planning based on an input-output data-based model. 2) The scheme was used in Verschueren et al. (2017) for point-to-point trajectory planning; we extend the scheme to more general point-to-set trajectory planning. To enable these extensions, different assumptions are made, and, correspondingly, new proofs are developed to show the ability of this exponential weighting scheme to produce minimum-time trajectory solutions.
-
•
We validate the developed approach to minimum-time trajectory optimization and illustrate its application with an aerospace example.
Organization: The minimum-time trajectory optimization problem addressed in this paper is described in Section 2. We introduce the method using a non-parametric input-output data-based model to predict trajectories over an extended planning horizon in Section 3. We reformulate the minimum-time trajectory optimization problem into a linear program based on an exponential weighting scheme and prove its theoretical properties in Section 4. A spacecraft relative motion planning problem is considered in Section 5 to illustrate the approach. The paper is concluded in Section 6.
Notations: The symbol denotes the set of real numbers and the set of integers; denotes the set of -dimensional real vectors, the set of -by- real matrices, and the set of integers that are greater than or equal to ; denotes the -dimensional identity matrix, the -by- zero matrix, and the -dimensional column vector of ones. Given multiple vectors or matrices with the same number of columns , , the operator stack them on top of one another, i.e., and . For a discrete-time signal , we use , with and , to denote . We call both the sequence and the column vector a trajectory (of length ).
2 Problem Statement
We study trajectory optimization problems associated with finite-dimensional linear time-invariant systems which can be represented in state-space form as
(1a) | ||||
(1b) |
where denotes the discrete time step, represents the system state at time , is the control input, is the output, and , , and are matrices of appropriate dimensions. We make the following assumption about the system:
Assumption 1: The system is controllable and observable.
Given a state-space model (1) of the system, we can write the following equation that relates an input trajectory of length , , to its corresponding output trajectory:
(2) |
where is the system state at the initial time of the trajectory, and and are matrices defined as follows:
(3) |
The smallest integer such that the matrix defined above has full rank is called the lag of the system and denoted as . Under Assumption 1, exists and satisfies .
Given an arbitrary pair of input trajectory and output trajectory , both of length , if (2) holds for some , then the pair is called admissible by the system. In particular, an admissible pair of input-output trajectories of length , , with , corresponds to a unique initial state , which can be determined according to (2) as follows:
(4) |
where denotes the Moore-Penrose pseudoinverse.
In this paper, we focus on minimum-time trajectory optimization problems given in the following form:
(5a) | ||||
s.t. | (5b) | |||
(5c) | ||||
(5d) |
where ; and represent given initial conditions for the input and output trajectories; ; represents a target set for the output trajectory; and represents prescribed path constraints for the trajectory to satisfy. The goal represented by the cost function in (5a) and the constraint in (5c) is to drive the output trajectory to reach the target set in the minimum time, starting with the initial condition in (5b), while satisfying the path constraints in (5d). We first make the following assumption about the initial condition :
Assumption 2: The pair represents an admissible pair of input-output trajectories (of length ) that satisfies the path constraints at all times.
Assumption 2 is reasonable because and , according to (5b), represent the input and output trajectories of the system over the past time steps, and hence, the pair is supposed to be admissible and satisfies any path constraints. Under Assumption 2, given a state-space model (1) of the system, (5b) corresponds to the following initial condition for the state:
(6) |
where and are the matrices defined in (3) with .
We consider polyhedral target set and linear-inequality path constraints , i.e., they can be written as:
(7a) | |||
(7b) |
where and are matrices and vectors of compatible dimensions. Furthermore, we make the following “controlled invariance” assumption about :
Assumption 3: Let . For any admissible pair of input-output trajectories of length , , that satisfies the path constraints for and the target condition , there exist an input and its corresponding output such that they satisfy and .
In Assumption 3, because , an admissible pair of input-output trajectories corresponds to a unique initial state and a unique state trajectory . Hence, for an input , the corresponding output is also unique. Assumption 3 means that for any pair of input-state trajectories the output trajectory of which enters the target set while satisfying the path constraints, there exists a control to maintain the output trajectory in while satisfying the path constraints. Hence, it specifies a “controlled invariance” property of with respect to the system dynamics and the path constraints.
Remark 1: While in many conventional trajectory optimization problem formulations the initial condition is a given value for the state at the initial time , a given value for the output or a given pair of input-output at a single time is not sufficient for uniquely determining the trajectory. Therefore, we consider a pair of input-output trajectories of length that satisfies as the initial condition which uniquely determines the initial state according to (6) and hence the trajectory. For the terminal condition, we consider a target set instead of a single point to represent a larger class of problems which includes a single target point as a special case.
Lastly, we assume that a state-space model of the considered system (i.e., the matrices in (1)) is not given and only input-output trajectory data of the system are available. For instance, we may deal with a real system that has uncertain parameters while can generate input-output data (see the example in Section 5). The goal of this paper is to develop a computationally-efficient approach to the minimum-time trajectory optimization problem (5) for such a setting. We note that although it is possible to first identify the matrices using input-output data and system identification techniques and then solve the problem (5) based on the identified state-space model, this two-step approach may be cumbersome from the point of view of practitioners and that is compatible with given data is in general not unique. Therefore, we pursue an end-to-end solution – directly from input-output data to a solution to (5).
3 Data-based Model for Long-term Trajectory Prediction
Assume that we have input-output trajectory data of length :
(8) |
where the superscript indicates “data.” Note that these input-output pairs , , should be sampled from a single trajectory111If the data are from multiple trajectories, then the inputs shall satisfy a collectively persistently exciting condition (van Waarde et al., 2020).. Construct the following Hankel data matrices:
(9a) | |||
(9b) |
where indicates the number of stacks of the signal or in each column. The control input trajectory is said to be persistently exciting of order if has full rank.
Our approach uses a result known as the fundamental lemma of Willems et al. (2005). The following lemma is an equivalent statement of Willems’ fundamental lemma in a state-space context (van Waarde et al., 2020):
Lemma 1: If the system (1) is controllable and the control input trajectory is persistently exciting of order , then a pair of input-output trajectories of length , , is admissible by the system (1) if and only if
(10) |
for some vector .
Assume and let . Then, (10) can be written as
(11) |
Given , (11) is a linear equation of variables . In Coulson et al. (2019), (11) is used as a model for predicting the outputs over the entire planning horizon . This requires . When the planning horizon is large, which is not rare in a trajectory optimization setting, such a strategy requires high-dimensional data matrices and requires the control input trajectory to be persistently exciting of an order of . Inspired by the multiple shooting method for trajectory optimization over an extended planning horizon (Trélat, 2012), we consider partitioning the entire trajectory of length into segments:
(12a) | |||
(12b) |
For each segment , , we stack its previous points on top to get the following vectors:
(13a) | ||||
(13b) |
According to Lemma 1, for each , the pair is an admissible pair of input-output trajectories if and only if
(14) |
for some . We refer to (14) for as equality dynamic constraints with as auxiliary variables. Then, we impose the following equality matching conditions for to piece together the segments and form a long admissible trajectory:
(15a) | ||||
(15b) |
i.e., we enforce the first points of (resp. ) to be equal to the last points of (resp. ). Note that because , an admissible pair of input-output trajectories of length corresponds to a unique state trajectory of length . Specifically, given a state-space model (1) of the system, for an admissible pair of input-output trajectories of length , with , the unique corresponding initial state can be determined by (4) with , and then the states over the next steps are uniquely determined by this initial state and the given input trajectory. Therefore, matching the first points of to the last points of creates a continuous state trajectory .
(18a) | ||||
(18b) |
The initial condition for the input-output trajectories in (5b) can be imposed through the following equality constraints on :
(16a) | ||||
(16b) |
Also, the path constraints in (5d) can be imposed through the following inequality constraints for and :
(17) |
The input-output trajectories over the entire planning horizon can be constructed from the vectors and , , through the equations in (18). And we arrive at the following result:
Lemma 2: Suppose the system (1) is controllable and the control input trajectory is persistently exciting of order . Then, a pair of input-output trajectories , where can be written as for some , is admissible by the system (1) and satisfies the initial condition in (5b) and the path constraints in (5d) if and only if there exist vectors , , that satisfy the constraints in (14), (15), (16) and (17) and relate to the vectors , , according to (18).
4 Linear Program for Minimum-time Trajectory Optimization
Now we deal with the target condition . Recall that the goal is to minimize the time at which the output trajectory reaches the target set .
Assume that the minimum time is in the range of . For a given problem, such a range may be estimated based on prior knowledge or set to be sufficiently large (e.g., and being a large number). It will become clear soon that a smaller range (i.e., a closer estimate of ) makes the formulated problem simpler in terms of having less decision variables and constraints. For each , define a slack variable , where is the dimension of and is that of . Impose the following constraints for :
(19a) | |||
(19b) |
where denotes the first rows of and denotes the remaining rows of . Then, if and only if is a feasible value for .
Consider the following function:
(20) |
where is a sufficiently large constant and denotes the -norm. The analysis in what follows shows that minimizing (20) can lead to a minimum-time trajectory solution:
Assume is known and consider the following problem parameterized by :
(21a) | ||||
s.t. | (21b) | |||
(21c) | ||||
(21d) | ||||
(21e) | ||||
(21f) |
where represents a planning horizon that satisfies , and , , are parameters with the nominal value . The following result clarifies the relation between the minimum-time problem of interest, (5), and the above problem (21):
Theorem 1: (i) Suppose Assumptions 2 and 3 hold. Let be an optimal solution to the minimum-time problem (5) with . Then, (21) with has a feasible solution that satisfies and for .
(ii) Suppose (5) is feasible and has a minimum time . Let be an arbitrary feasible solution to (21) with . Then, the triple is an optimal solution to (5).
Proof: For (i), let be an optimal solution to (5). Because and , must satisfy . Then, under Assumption 2, is an admissible pair of input-output trajectories of length that satisfies for and . In this case, under Assumption 3, there exist inputs and the corresponding outputs such that for and for . Now let and , and let be defined according to and for and for . Then, the triple is a feasible solution to (21) with . This proves part (i).
For part (ii), let be a feasible solution to (21) with . Due to the constraints in (21d)–(21f), this solution satisfies . Therefore, the triple is an optimal solution to the minimum-time problem (5).
Remark 2: From the proof of Theorem 1 the necessity of both Assumptions 2 and 3 for guaranteeing the result of part (i) should be clear. For instance, suppose the second half of Assumption 2 does not hold, i.e., the pair does not satisfy the path constraints at all times, and suppose and . Then, the pair may not satisfy for all . Consequently, for such a pair of input-output trajectories of length , there may not exist an input that is able to maintain the output trajectory in while satisfying the path constraints even if Assumption 3 holds. In contrast, the result of part (ii) does not rely on Assumptions 2 and 3.
Theorem 1 indicates that minimum-time trajectory solutions (i.e., optimal solutions to (5)) can be obtained through (21). However, the formulation of (21) relies on the exact knowledge of the minimum time , which is typically not known a priori (otherwise the problem reduces to a fixed-time trajectory planning problem). In what follows we show that an optimal solution to (21) can be obtained through another related problem the formulation of which does not rely on exact knowledge of . The technique originates from exact penalty methods for handling constraints in constrained optimization.
Now let be an optimal solution to (21) with and a certain value of . Let be the Lagrange multiplier associated with the constraint , . Its value satisfies
(22) |
where denotes the perturbed value of due to a perturbation to the th entry of the parameter , i.e., the Lagrange multiplier represents the sensitivity of the cost to perturbations to the constraint (Büskens and Maurer, 2001). We make the following assumption about the optimal solution to (21):
Assumption 4: For sufficiently large and , the sensitivity of to perturbations to the constraints , , is bounded by a constant , i.e.,
(23) |
where denotes the -norm.
Under Assumption 4, we can derive the following bound on :
(24) |
Hence, if , we have
(25) |
for , where denotes the sup-norm. We arrive at the following result:
Theorem 2: Suppose (5) is feasible and has a minimum time . Let be an optimal solution to (21) with and . Suppose Assumption 4 holds and is sufficiently large. Then, is an optimal solution to the following problem, the formulation of which does not rely on :
(26a) | ||||
s.t. | (26b) | |||
(26c) | ||||
(26d) | ||||
(26e) |
Proof: The cost function of (26) can be written as , where is the cost function of (21). If Assumption 4 holds and , then according to (25), for , the Lagrange multiplier associated with the constraint of (21) satisfies . This implies that the term in the cost function of (26) is an exact penalty for the constraint . Therefore, (26) is a reformulation of (21) by replacing all constraints in (21f) with exact penalties and hence the result follows (Han and Mangasarian, 1979).
Theorem 2 indicates that optimal solutions to (21), which, according to Theorem 1, are optimal solutions to (5) (i.e., minimum-time trajectories), can be obtained through (26). The cost function of (26), which is non-smooth due to the -norms, can be readily converted into a smooth function using a linear programming reformulation. We combine the results of the previous section on data-based trajectory prediction and of this section on minimum-time trajectory planning and arrive at the following problem formulation:
s.t. | (27) | |||
initial condition: (16) | ||||
terminal condition: | ||||
in which the dimensions of the decision variables are , , , , and the number should be chosen as , where means rounding up to the nearest integer. As discussed in the second paragraph of this section, the range may be estimated based on prior knowledge about the problem or set as with sufficiently large. It can be seen that the cost function of (4) is a linear equation of decision variables and all constraints of (4) are either linear equalities or linear inequalities of decision variables. Hence, (4) is a linear program (LP) and can be easily solved using off-the-shelf LP solvers.
Remark 3: In (4), the auxiliary variables only appear in the dynamic constraints (14). Using the following approach we can drop these variables from the problem: Let and . Then, (14) can be written as . Assume . We partition the rows of into two groups: collects linearly independent rows and collects the remaining rows. Since , the rows of are linear combinations of the rows of , i.e., can be written as , where is uniquely determined by . Then, (14) can be written as
(28) |
where (resp. ) collects the entries of corresponding to the rows of (resp. ), and the last equality is obtained by substituting in the first row into the second row. Recall that, according to Lemma 1, represents an admissible pair of input-output trajectories if and only if there exists such that (14) (equivalently, (28)) holds. Since and has a rank of , for any there exists such that the equation in the first row of (28) is satisfied. In this case, there exists such that (28) holds if and only if and satisfy the equation in the second row of (28). Therefore, we can replace the dynamic constraints (14) in (4) with the linear-equality constraints for , after which we obtain a linear program that is equivalent to (4) while does not involve auxiliary variables . Note that the partition of into and and the calculation of can be done offline and they are independent of .
5 Example: Spacecraft Relative Motion Planning
To illustrate the approach, we consider a motion planning problem for a low-thrust spacecraft relative to a target body on a nominal circular orbit. The continuous-time dynamics are represented by the Clohessy-Wiltshire-Hill (CWH) equations:
(29) |
with
(30) |
where is the orbital rate of the target (in radians/s), km3/s2 is the gravitational parameter, km is the radius of the target’s circular orbit, kg is the mass of the ego spacecraft, and kN represents the ego spacecraft’s maximum thrust. The first three entries of the state vector represent the relative positions of the ego spacecraft with respect to the target body along the -, -, and -axes of the CWH frame (in km), and the last three entries represent the relative velocity components (in km/s). The entries of the control input vector represent the thrust level components of the ego spacecraft along the -, -, and -axes. For simplicity, we discretize the continuous-time model (29) using the forward Euler method with a sampling period of s and obtain the discrete-time model:
(31) |
We treat the discrete-time model (31) as the actual system and use it for both data generation and simulation. Also for simplicity, we assume a sup-norm bound on the control input vector: , which can be equivalently expressed as individual bounds on each thrust level component:
(32) |
We remark that higher-fidelity modeling is possible: For piecewise-constant or piecewise-linear control inputs, exact discrete-time models can be obtained through the zero- or first-order hold method. For a 2-norm bound on the thrust level vector, , one can use a polygonal approximation (Blackmore et al., 2012). The considered task is for the ego spacecraft to travel from the initial condition to the target condition in the minimum time.
Assume we do not have the model (31). This may be due to uncertainty about the target’s orbital rate or uncertainty about the ego spacecraft’s precise mass , the maximum thrust its propulsion system produces, or thruster alignment. And assume we are only able to measure relative positions, i.e.,
(33) |
We apply the approach developed in this paper to solve the minimum-time trajectory planning problem for the ego spacecraft in such a setting.
First, we build up a data-based model with using a pair of input-output trajectories of length . It is checked that the persistent excitation of order condition is satisfied by this trajectory. The lag of this system is . Therefore, we choose and and consider the following initial condition for and terminal condition for :
(34a) | |||
(34b) |
These conditions equivalently express the initial and terminal conditions and for the state vector . We estimate that the minimum time is in the range of , and hence we choose . In the LP formulation (4), we use , which is shown to be sufficiently large to yield a minimum-time trajectory solution.
To validate the result obtained by our approach, we also implement a (state-space) model-based mixed-integer programming (MIP) approach for minimum-time trajectory optimization, which is modified from the approach of Carvallo et al. (1990). The MIP formulation for the considered spacecraft relative motion planning problem is given as:
(35a) | ||||
s.t. | dynamic constraints: | (35b) | ||
(35c) | ||||
path constraints: | ||||
(35d) | ||||
terminal condition: | ||||
(35e) | ||||
(35f) |
where , , , , are indicator variables, is a large constant, the constraints in (35e) mean that the state reaches the target condition at time if , the constraint in (35f) makes sure that a feasible trajectory must reach at some , and the goal represented by the cost function in (35a) is to minimize the time to reach .
Figs. 2–4 illustrate the trajectory solutions from our LP approach based on data-based model (black solid curves) and the MIP approach based on state-space model (red dotted curves). Fig. 2 shows the ego spacecraft relative position trajectories, and Fig. 3 shows the thrust level vector time histories. It can be seen that the trajectories from the two approaches are different, especially for the z-direction. However, the two trajectories have the same time-of-flight, (s), where is the minimum (discrete) time obtained by both approaches and (s) is the sampling period, i.e., the two trajectories are both minimum-time trajectories. It is well-known that in a discrete-time setting minimum-time trajectories are typically not unique. While the MIP approach (35) returns an arbitrary minimum-time solution, our LP approach (4) returns a minimum-time solution that also minimizes the secondary objective function (roughly, the cumulative distance from the target condition). Correspondingly, it can be seen from Fig. 3 that the thrust vector profile obtained by our LP approach is smoother than that from the MIP approach222To avoid obtaining a non-smooth control profile due to the non-uniqueness of minimum-time trajectories, one can add a small regularization term to the cost function (Carvallo et al., 1990). In our LP approach, the secondary objective function plays the role of such a regularization term.. Fig. 4 shows the values of the slack variables: in our LP approach (4) and in the MIP approach (35). At (corresponding to continuous time (s)), converges to zero (according to the criterion ) and equals one, indicating that both approaches capture the minimum time .
In terms of the computations, the difference between the two approaches is significant: We solve the problems in the MATLAB environment running on a Windows 10 Enterprise OS desktop with Intel Xeon Gold 2.30 GHz processor and GB of RAM. It takes the LP approach milliseconds (averaged over experiments) to find a minimum-time solution (after elimination of the auxiliary variables using the approach in Remark 3 and solved with MATLAB linprog function and default settings); while it takes the MIP approach seconds to find one (solved with MATLAB intlinprog function and default settings) – our LP approach based on data-based model is approximately times faster than the MIP approach based on state-space model.
6 Conclusions
In this paper, we developed an LP-based approach to minimum-time trajectory optimization using input-output data-based models. The approach was based on an effective integration of non-parametric data-based models for trajectory prediction and a continuous optimization formulation using an exponential weighting scheme for minimum-time trajectory planning. We proved that minimum-time trajectories could be obtained with the approach if the weight parameter was chosen to be sufficiently high. We validated the approach and illustrated its application with an aerospace example. Future work includes integrating the approach into a model predictive control framework to achieve repeated replanning and closed-loop control, where real-time data may be used to update the model, and extending the approach to handle noisy data and nonlinear systems.
References
- Baros et al. (2022) Baros, S., Chang, C.-Y., Colon-Reyes, G. E., Bernstein, A., 2022. Online data-enabled predictive control. Automatica 138, 109926.
- Berberich et al. (2020) Berberich, J., Köhler, J., Müller, M. A., Allgöwer, F., 2020. Data-driven model predictive control with stability and robustness guarantees. IEEE Transactions on Automatic Control 66 (4), 1702–1717.
- Blackmore et al. (2012) Blackmore, L., Açıkmeşe, B., Carson III, J. M., 2012. Lossless convexification of control constraints for a class of nonlinear optimal control problems. Systems & Control Letters 61 (8), 863–870.
- Büskens and Maurer (2001) Büskens, C., Maurer, H., 2001. Sensitivity analysis and real-time optimization of parametric nonlinear programming problems. Online Optimization of Large Scale Systems, 3–16.
- Carvallo et al. (1990) Carvallo, F. D., Westerberg, A. W., Morari, M., 1990. MILP formulation for solving minimum time optimal control problems. International Journal of Control 51 (4), 943–947.
- Chinde et al. (2022) Chinde, V., Lin, Y., Ellis, M. J., 2022. Data-enabled predictive control for building HVAC systems. Journal of Dynamic Systems, Measurement, and Control 144 (8), 081001.
- Coulson et al. (2019) Coulson, J., Lygeros, J., Dörfler, F., 2019. Data-enabled predictive control: In the shallows of the DeePC. In: 18th European Control Conference (ECC). IEEE, pp. 307–312.
- Coulson et al. (2021) Coulson, J., Lygeros, J., Dörfler, F., 2021. Distributionally robust chance constrained data-enabled predictive control. IEEE Transactions on Automatic Control 67 (7), 3289–3304.
- Elokda et al. (2021) Elokda, E., Coulson, J., Beuchat, P. N., Lygeros, J., Dörfler, F., 2021. Data-enabled predictive control for quadcopters. International Journal of Robust and Nonlinear Control 31 (18), 8916–8936.
- Han and Mangasarian (1979) Han, S. P., Mangasarian, O. L., 1979. Exact penalty functions in nonlinear programming. Mathematical Programming 17, 251–269.
- Huang et al. (2021) Huang, L., Coulson, J., Lygeros, J., Dörfler, F., 2021. Decentralized data-enabled predictive control for power system oscillation damping. IEEE Transactions on Control Systems Technology 30 (3), 1065–1077.
- Huang et al. (2023) Huang, L., Zhen, J., Lygeros, J., Dörfler, F., 2023. Robust data-enabled predictive control: Tractable formulations and performance guarantees. IEEE Transactions on Automatic Control 68 (5), 3163–3170.
- Kalman and Bertram (1959) Kalman, R. E., Bertram, J., 1959. General synthesis procedure for computer control of single-loop and multiloop linear systems (an optimal sampling system). Transactions of the American Institute of Electrical Engineers, Part II: Applications and Industry 77 (6), 602–609.
- LaSalle (1959) LaSalle, J., 1959. Time optimal control systems. Proceedings of the National Academy of Sciences 45 (4), 573–577.
- Lepetič et al. (2003) Lepetič, M., Klančar, G., Škrjanc, I., Matko, D., Potočnik, B., 2003. Time optimal path planning considering acceleration limits. Robotics and Autonomous Systems 45 (3-4), 199–210.
- Markovsky and Dörfler (2021) Markovsky, I., Dörfler, F., 2021. Behavioral systems theory in data-driven analysis, signal processing, and control. Annual Reviews in Control 52, 42–64.
- O’Reilly (1981) O’Reilly, J., 1981. The discrete linear time invariant time-optimal control problem–an overview. Automatica 17 (2), 363–370.
- Rösmann et al. (2015) Rösmann, C., Hoffmann, F., Bertram, T., 2015. Timed-elastic-bands for time-optimal point-to-point nonlinear model predictive control. In: European Control Conference. IEEE, pp. 3352–3357.
- Shirazi et al. (2018) Shirazi, A., Ceberio, J., Lozano, J. A., 2018. Spacecraft trajectory optimization: A review of models, objectives, approaches and solutions. Progress in Aerospace Sciences 102, 76–98.
- Taheri et al. (2017) Taheri, E., Li, N. I., Kolmanovsky, I., 2017. Co-state initialization for the minimum-time low-thrust trajectory optimization. Advances in Space Research 59 (9), 2360–2373.
- Trélat (2012) Trélat, E., 2012. Optimal control and applications to aerospace: Some results and challenges. Journal of Optimization Theory and Applications 154, 713–758.
- Van den Broeck et al. (2011) Van den Broeck, L., Diehl, M., Swevers, J., 2011. A model predictive control approach for time optimal point-to-point motion control. Mechatronics 21 (7), 1203–1212.
- van Waarde et al. (2020) van Waarde, H. J., De Persis, C., Camlibel, M. K., Tesi, P., 2020. Willems’ fundamental lemma for state-space systems and its extension to multiple datasets. IEEE Control Systems Letters 4 (3), 602–607.
- Verscheure et al. (2009) Verscheure, D., Demeulenaere, B., Swevers, J., De Schutter, J., Diehl, M., 2009. Time-optimal path tracking for robots: A convex optimization approach. IEEE Transactions on Automatic Control 54 (10), 2318–2327.
- Verschueren et al. (2017) Verschueren, R., Ferreau, H. J., Zanarini, A., Mercangöz, M., Diehl, M., 2017. A stabilizing nonlinear model predictive control scheme for time-optimal point-to-point motions. In: 56th Conference on Decision and Control (CDC). IEEE, pp. 2525–2530.
- Wang et al. (2017) Wang, Z., Liu, L., Long, T., 2017. Minimum-time trajectory planning for multi-unmanned-aerial-vehicle cooperation using sequential convex programming. Journal of Guidance, Control, and Dynamics 40 (11), 2976–2982.
- Willems et al. (2005) Willems, J. C., Rapisarda, P., Markovsky, I., De Moor, B. L., 2005. A note on persistency of excitation. Systems & Control Letters 54 (4), 325–329.
- Zhang et al. (2014) Zhang, X., Fang, Y., Sun, N., 2014. Minimum-time trajectory planning for underactuated overhead crane systems with state and control constraints. IEEE Transactions on Industrial Electronics 61 (12), 6915–6925.