学ぶための計画：将来の学習を保証するGPU上のリアルタイム頑健適応制御

\tl_set:Ne\linkpill

linkpill

Abstract

Robust adaptive control is vital for keeping robots safe while actively reducing uncertainty in unfamiliar settings. However, traditional methods are often conservative since they fail to account for guaranteed future parameter learning during planning and struggle to scale to high-dimensional systems. In this work, we present A-SLS, a learning-aware robust adaptive model predictive control (RAMPC) framework based on system-level synthesis. A-SLS forecasts future parameter uncertainty and preserves correlations between process disturbances, parameter error, and estimate updates to construct tight, guaranteed reachable sets that account for future information gain. We also develop a GPU-accelerated A-SLS solver to enable real-time performance. Across nonlinear robotic systems, A-SLS reduces reachable-tube conservativeness, maintains real-time performance, and scales to whole-body control for a quadruped with 61 states, 8 uncertain parameters, and 12 control inputs. We further demonstrate the approach on hardware, where a physical Crazyflie drone learns an uncertain dynamics parameter online to stabilize on the fly.

\linkpill

Website \linkpill Code \linkpill Video

I Introduction

Robots operating in unstructured environments must act safely despite uncertainty in their dynamics and surroundings. Robust control is one approach to achieve this, providing worst-case guarantees by treating uncertainty as persistently adversarial, propagating reachable tubes over admissible uncertainty, and tightening constraints accordingly. While this is appropriate for irreducible aleatoric uncertainty, it can be overly conservative for epistemic uncertainty arising from unknown but learnable physical parameters such as mass, friction, wind, or motor damage. Because this structured uncertainty can be reduced through interaction, robust adaptive control can become less conservative as parameter estimates improve online. As data is collected and parameter uncertainty shrinks, controllers can safely exploit the reduced uncertainty to improve performance. Moreover, because the rate of learning depends on how informative the chosen trajectory is, control actions can directly influence future parameter uncertainty, creating a tradeoff between performance, robustness, and information gathering.

However, designing robust adaptive controllers for robotics remains an open problem, with two central challenges. First, synthesizing adaptive controllers while jointly reasoning about estimation error, aleatoric uncertainty, and parametric uncertainty is computationally expensive for long-horizon, high-dimensional nonlinear systems, yet practical robotic systems require real-time learning, verification, and controller adaptation. Second, many existing methods update parameter estimates online but plan using the current parameter uncertainty set, incorporating newly learned information only reactively after measurements are collected. As a result, they cannot exploit guaranteed future uncertainty reduction during planning and may produce unnecessarily large reachable tubes even along informative trajectories. For example, a drone traversing an uncertain but learnable wind field should be able to plan knowing that it can measure, estimate, and compensate for the wind during execution. Ignoring this future learning can degrade performance or prevent task completion, while also leading to myopic planning that fails to seek informative trajectories that accelerate uncertainty reduction. Addressing these challenges requires jointly modeling the state and parameter-estimate dynamics while efficiently forecasting the worst-case learning guaranteed under all admissible uncertainties.

In this work, we close these gaps with A-SLS, a scalable robust adaptive policy optimization framework that explicitly accounts for future learning during planning. Building on system-level synthesis (SLS) [1], we augment the physical state with the online parameter estimate so that estimator evolution becomes part of the closed-loop dynamics. We propagate bounded parameter uncertainty and parameter-estimate shifts over the planning horizon, while adaptive SLS responses preserve correlations among process disturbances, parameter error, and estimate updates to construct tighter reachable tubes. Crucially, this enables assured future learning: for each candidate trajectory, we forecast the parameter uncertainty guaranteed to remain after future observations, allowing the optimizer to exploit worst-case future tube contraction without assuming favorable measurements. Because informativeness depends on the trajectory, the same formulation can also favor motions that accelerate uncertainty reduction. Finally, the structured SLS policy class admits efficient parallel reachability and robust constraint tightening, enabling GPU-parallel optimization for long-horizon, high-dimensional nonlinear systems. Our contributions are:

• We formulate learning-aware robust adaptive control as an SLS problem that augments the state with the online parameter estimate, returning policies that adapt to online data while remaining robust to residual uncertainty.
• We derive reachable sets that preserve correlations between disturbances, parameter error, and estimate shifts, enabling tightened robust tubes that account for and guarantee future learning. These information-sensitive tubes also enable planning that favors informative trajectories that reduce uncertainty and improve performance.
• We develop a GPU-parallel solver that enables real-time long-horizon control on high-DoF nonlinear systems.
• We evaluate safety, tube tightness, parameter learning, active information gathering, and scalability on high-dimensional nonlinear robotic systems and hardware.

II Related Work

Classic robust adaptive control [2, 3, 4, 5, 6] establishes stability guarantees under disturbances and parametric uncertainty. Recent work extends these ideas to nonlinear and unmatched uncertainty using contraction theory [7, 8, 9, 10] and \mathcal{L}_{1}-LPV control [11]. Other approaches develop SLS-based robust control under parametric uncertainty [12] and robust adaptive control for linear systems [13]. While these methods provide strong stability guarantees, they generally do not optimize long-horizon constrained trajectories or anticipate how planned actions reduce uncertainty; contraction-based approaches also require challenging metric synthesis and online geodesic computation. In contrast, our method uses SLS for robust adaptive nonlinear trajectory optimization, coupling closed-loop reachability with guaranteed future learning and real-time GPU-parallel synthesis.

Other methods incorporate adaptation into safety-critical control. Adaptive and robust-adaptive control barrier functions (CBFs) provide forward-invariance guarantees under parametric uncertainty [14, 15, 16], with later applications to robotics [17, 18]. Many reduce online control to small QPs or impose Lyapunov conditions within MPC. However, synthesizing adaptive CBFs/CLFs can be challenging, and these methods typically provide pointwise invariance or stability guarantees without explicitly planning trajectories to improve parameter learning. Our approach instead couples closed-loop reachability and planning through shared uncertainty sources affecting physical states and future parameter estimates, yielding tighter robust tubes while making information gathering part of the trajectory optimization.

Robust adaptive model predictive control (RAMPC) combines online model learning with constrained planning. Early work used conservative constraint tightenings or separate robust safety and learned performance models [19, 20]. Set-membership identification was later integrated with robust MPC for linear [21] and nonlinear systems [22, 23], with extensions addressing convergence [24], safety certification [25], \mathcal{L}_{1} adaptation [26], contraction [27], and distributed control [28]. However, most methods exploit learning only after uncertainty updates are observed rather than anticipating guaranteed future estimator evolution, and can be computationally demanding online. Our adaptive SLS formulation instead jointly propagates parameter-estimation and disturbance dynamics, preserves their correlations for tighter tubes, and enables real-time GPU-parallel synthesis.

Finally, dual and active-learning MPC recognize that control affects both task execution and future model quality [29]. Persistent-excitation constraints can promote parameter convergence in RAMPC [30], while [31] embeds predicted set-membership updates in linear MPC for informative exploration. These methods closely align with our planning-to-learn objective. However, persistent excitation is an indirect proxy for task-relevant uncertainty reduction, while exact future set-membership reasoning can be expensive and difficult to scale. Our method instead optimizes worst-case parameter-estimation dynamics within a scalable SLS framework, exploiting assured future tube contraction while retaining robust nonlinear constraints and GPU-parallel computation for long-horizon, high-dimensional systems.

III Preliminaries and Problem Statement

Notation: The symbols I_{n}\in\mathbb{R}^{n\times n}, 0_{n\times m}\in\mathbb{R}^{n\times m}, and 0_{n}:=0_{n\times 1} denote the identity matrix, zero matrix, and zero vector, respectively. The i-th standard coordinate row vector is denoted by \bar{e}_{i}^{(n)}\in\mathbb{R}^{1\times n}, whose i-th entry is 1 and all other entries are 0. The Frobenius norm of a matrix A\in\mathbb{R}^{m\times n} is given by \|A\|_{\mathcal{F}}:=\sqrt{\text{Trace}(A^{\top}A)}. For A\in\mathbb{R}^{n\times m}, [A]_{k,j} denotes the element in the k-th row and j-th column of A. Similarly, we use [\mathbf{\Phi}]_{k,j} to refer to the block at the k-th row and j-th column of a block matrix \mathbf{\Phi}. For integers M,N\in\mathbb{N}, index sets are defined as [N]:=\{0,\ldots,N-1\} and [M,N]:=\{M,\ldots,N\}. For a matrix product, indices increase from right to left, i.e., \prod_{m=\ell}^{j-1}A_{m}:=A_{j-1}\cdots A_{\ell}. For a matrix A\in\mathbb{R}^{n\times p}, its row-wise \ell_{1}-norm is the vector \|A\|_{1,\text{r}}\coloneqq[\|A_{1,:}\|_{1},\ldots,\|A_{n,:}\|_{1}]^{\top}\in\mathbb{R}^{n}. The diagonal matrix constructed from a\in\mathbb{R}^{n} is written as \text{diag}(a). The Minkowski sum of sets A and B is defined by A\oplus B:=\{a+b\mid a\in A,b\in B\} and \bigoplus denotes the iterated Minkowski sum. We define the unit \ell_{\infty}-ball as \mathcal{B}^{n}_{\infty}:=\{z\in\mathbb{R}^{n}\mid\|z\|_{\infty}\leq 1\}.

Definitions: We consider nonlinear dynamics with both parametric and exogenous worst-case uncertainty,

x_{k+1}=f(x_{k},u_{k};\theta)+F(x_{k})w_{k},

where x_{k}\in\mathcal{X}\subseteq\mathbb{R}^{n_{x}} is the system state, u_{k}\in\mathcal{U}\subseteq\mathbb{R}^{n_{u}} is the control input, and \theta\in\Theta_{0}\subseteq\mathbb{R}^{n_{\theta}} is an unknown parameter (e.g., mass) contained in an initial zonotopic uncertainty set \Theta_{0}. The map f:\mathbb{R}^{n_{x}}\times\mathbb{R}^{n_{u}}\times\mathbb{R}^{n_{\theta}}\to\mathbb{R}^{{n_{x}}} defines the nonlinear dynamics, while F:\mathbb{R}^{{n_{x}}}\to\mathbb{R}^{{n_{x}}\times{n_{x}}} scales the bounded disturbance w_{k}\in\mathcal{B}^{n_{x}}_{\infty}. Because \theta is unknown at planning time, the controller begins from an initial estimate \hat{\theta}_{0} and refines it online as measurements are collected, yielding \hat{\theta}_{k} at time k. We seek a robust-adaptive policy with (i) a feedback component that tracks the planned state trajectory and (ii) a feedforward component that exploits updated parameter estimates as uncertainty is reduced. The policy must robustly satisfy all state and input constraints despite residual parametric uncertainty and process noise. We therefore seek to solve the following robust-adaptive nonlinear optimal control problem (RANOCP):

\displaystyle\hskip-56.9055pt\min_{\pi(\cdot)}\ \\ \displaystyle J\left(x_{1},\dots,x_{N},\pi(\cdot)\right) \\ \displaystyle x_{k+1}=f(x_{k},u_{k};\hat{\theta}_{k})+E(x_{k},u_{k},\hat{\theta}_{k};\theta) \\ \displaystyle\qquad\qquad+F(x_{k})w_{k},\quad\forall k\in[N], \\ \displaystyle x_{0}=\bar{x}_{0},\quad\hat{\theta}_{0}=\hat{\theta}, \\ \displaystyle\hat{\theta}_{k}=m_{k}(\hat{\theta}_{0},r_{1},\dots,r_{k};\theta),\quad\forall k\in[N] \\ \displaystyle u_{k}=\pi_{k}(x_{0},\dots,x_{k},\hat{\theta}_{0},\dots,\hat{\theta}_{k}),\quad\forall k\in[N], \\ \displaystyle g_{k}(x_{k},u_{k})\leq 0,\,\,\forall w_{1},\dots,w_{k}\in\mathcal{B}^{n_{x}}_{\infty}, \\ \displaystyle\quad\qquad\qquad\qquad\forall\theta\in\Theta_{k},\,\forall k\in[N], \\ \displaystyle g_{N}(x_{N})\leq 0,\,\,\forall w_{1},\dots,w_{N}\in\mathcal{B}^{n_{x}}_{\infty},\,\,\forall\theta\in\Theta_{N},

where \pi:=\{\pi_{i}\}_{i=0}^{N-1} is a sequence of causal control policies, m_{k}:\mathbb{R}^{{n_{\theta}}}\times(\mathbb{R}^{{n_{x}}})^{k}\times\mathbb{R}^{{n_{\theta}}}\to\mathbb{R}^{{n_{\theta}}} is a measurement function based on the history of residual measurements r_{k}, \bar{x}_{0}\in\mathbb{R}^{{n_{x}}} is the initial state, and \hat{\theta},\theta\in\mathbb{R}^{{n_{\theta}}} are the initial parameter guess and true parameter, respectively. The set \Theta_{k} denotes the parameter uncertainty set at step k, with \hat{\theta}_{k}\in\Theta_{k} the parameter estimate. The functions g_{k}:\mathbb{R}^{n_{x}}\times\mathbb{R}^{n_{u}}\rightarrow\mathbb{R}^{n_{c}} denote stagewise state-input constraints, while g_{N}:\mathbb{R}^{n_{x}}\rightarrow\mathbb{R}^{n_{c}^{f}} denotes the terminal constraint. Lastly, E:\mathbb{R}^{{n_{x}}}\times\mathbb{R}^{{n_{u}}}\times\mathbb{R}^{{n_{\theta}}}\times\mathbb{R}^{{n_{\theta}}}\rightarrow\mathbb{R}^{n_{x}} represents the residual dynamics error from an incorrect parameter estimate.

Directly solving (2) is typically intractable [32]. Thus, we instead optimize a nominal state-control trajectory and robust tracking controller, perform closed-loop reachability around the trajectory, and enforce constraints over the resulting reachable set. We formulate this as an SLS problem [1], solved using GPUSLS [32] and GPUSLS-LEO [33].

System Level Synthesis (SLS): SLS is a robust controller synthesis framework. Specifically, SLS optimizes causal feedback gains to track a reference trajectory. For the following uncertain LTV system,

x_{k+1}=A_{k}x_{k}+B_{k}u_{k}+F_{k}w_{k},

the closed-loop control input is

u_{k}=v_{k}+\Delta u_{k}=v_{k}+\textstyle\sum_{j=0}^{k-1}\mathbf{\Phi}^{\mathrm{u}}_{k,j}F_{j}w_{j},

where v_{k}\in\mathbb{R}^{{n_{u}}} is the nominal control, \Delta u_{k} is the feedback correction, and \mathbf{\Phi}^{\mathrm{u}}_{k,j}\in\mathbb{R}^{{n_{u}}\times{n_{x}}} maps each past disturbance F_{j}w_{j} to the control input. Under this policy, the closed-loop state response is

x_{k}=z_{k}+\Delta x_{k}=z_{k}+\textstyle\sum_{j=0}^{k-1}\mathbf{\Phi}^{\mathrm{x}}_{k,j}F_{j}w_{j},\qquad z_{0}=\bar{x}_{0},

where z_{k}\in\mathbb{R}^{n_{x}} is the nominal state, \Delta x_{k} is the state deviation, and \mathbf{\Phi}^{\mathrm{x}}_{k,j}\in\mathbb{R}^{{n_{x}}\times{n_{x}}} maps disturbance F_{j}w_{j} to its effect on x_{k}. We set \mathbf{\Phi}^{\mathrm{x}}_{j+1,j}=I_{{n_{x}}} and propagate \mathbf{\Phi}^{\mathrm{x}}_{k+1,j}=A_{k}\mathbf{\Phi}^{\mathrm{x}}_{k,j}+B_{k}\mathbf{\Phi}^{\mathrm{u}}_{k,j}, for all j\in[N] and k\in[j+1,N-1]. For nonlinear systems with nominal dynamics z_{k+1}=f(z_{k},v_{k}), we construct the LTV system in (3) by linearizing about the nominal trajectory:

\textstyle A_{k}:=\frac{\partial f}{\partial x}\big|_{(z_{k},v_{k})},\ \ B_{k}:=\frac{\partial f}{\partial u}\big|_{(z_{k},v_{k})},\ \ F_{k}:=F(z_{k}).

Taylor models [32] provide linearization error bounds (LEBs) that can be efficiently computed on the GPU [34] and incorporated as an additional bounded disturbance by replacing F_{k}w_{k} with F_{k}w_{k}+F^{\textrm{nl}}_{k}w^{\textrm{nl}}_{k}, where F^{\textrm{nl}}_{k}w^{\textrm{nl}}_{k} captures the linearization error, with w^{\textrm{nl}}_{k}\in\mathcal{B}^{{n_{x}}}_{\infty} [33].

Problem Statement (Learning-Aware Robust Adaptive Control): Given the uncertain nonlinear system (1), initial state \bar{x}_{0}, parameter estimate \hat{\theta}_{0}, uncertainty set \Theta_{0}, bounded disturbance w\in\mathcal{B}^{{n_{x}}}_{\infty}, horizon N, and constraints g_{k} and g_{N}, our goal is to solve the RANOCP (2) by jointly planning a nominal state-control trajectory and synthesizing a causal adaptive policy \pi. Using observed transition residuals r_{k}, we update the parameter estimate \hat{\theta}_{k} online while bounding the future uncertainty sets \Theta_{k} a priori. The policy must minimize the control objective while robustly satisfying all constraints for every admissible parameter and disturbance realization. Notably, planning accounts for the worst-case future parameter uncertainty induced by measurements along the planned trajectory, allowing predicted reachable tubes to exploit guaranteed future learning rather than treating the current parameter uncertainty set as fixed over the horizon.

IV Methodology

In this section, we present the components of our adaptive SLS formulation (A-SLS) used to plan with guaranteed future learning. We first derive the parameter-estimation (Sec. IV-A) and uncertainty-update dynamics (Sec. IV-B), then embed them into SLS to construct correlation-preserving reachable sets (Sec. IV-C) and robust constraint tightenings (Sec. IV-D). We then extend to nonlinear dynamics and discuss the resulting robust-adaptive optimization problem (Sec. IV-E).

IV-A Parameter Estimation Dynamics

We begin with the parametric LTV dynamics

x_{t+1}=A_{t}x_{t}+B_{t}u_{t}+E_{t}\theta+F_{t}w_{t},

where E_{t}\in\mathbb{R}^{{n_{x}}\times{n_{\theta}}} is the parameter sensitivity matrix describing how \theta affects the dynamics. To adapt the controller, we estimate unknown parameters from observed state transitions. Given the applied control u_{t} and measured successor state x_{t+1}, the only unknown quantities in (7) are \theta and w_{t}. To mitigate the effects of noisy measurements on estimation accuracy, we introduce a binary diagonal measurement gate C_{t}\in\mathbb{R}^{{n_{x}}\times{n_{x}}} that selects the state measurement channels used for parameter estimation. We then define

H_{t}:=C_{t}E_{t}=U_{t}\Sigma_{t}V_{t}^{\top},\quad H_{t,\epsilon}^{\dagger}=V_{t}\Sigma_{t,\epsilon}^{\dagger}U_{t}^{\top},

where H_{t}\in\mathbb{R}^{{n_{x}}\times{n_{\theta}}} is the gated parameter sensitivity and U_{t}\Sigma_{t}V_{t}^{\top} is its singular value decomposition (SVD). The SVD identifies which directions in parameter space are observable through the selected measurements. However, inverting small singular values can amplify disturbance noise. To avoid this, we define the truncated pseudoinverse:

[\Sigma_{t,\epsilon}^{\dagger}]_{ii}=\begin{cases}\sigma_{t,i}^{-1},&\sigma_{t,i}\geq\epsilon_{t},\\
0,&\sigma_{t,i}<\epsilon_{t},\end{cases}\,\epsilon_{t}=\max\{\epsilon_{\mathrm{abs}},\epsilon_{\mathrm{rel}}\sigma_{t,1}\},

where \epsilon_{t}, \epsilon_{\mathrm{abs}}, and \epsilon_{\mathrm{rel}} determine which singular values are inverted [35, 36]. This allows parameter estimation even when some components of \theta are unobservable through H_{t}. We then define the gated measurement map \Pi_{t}\in\mathbb{R}^{{n_{\theta}}\times{n_{\theta}}} and measurement uncertainty map W_{t}\in\mathbb{R}^{{n_{\theta}}\times{n_{x}}}:

\Pi_{t}:=H_{t,\epsilon}^{\dagger}H_{t},\,\quad W_{t}:=H_{t,\epsilon}^{\dagger}C_{t}F_{t}.

Here, \Pi_{t} projects onto the retained observable parameter directions, while W_{t} captures how disturbances propagate into the parameter measurement. Thus, applying the truncated pseudoinverse to the gated transition residual r_{t} yields

\tilde{\theta}_{t+1}=H_{t,\epsilon}^{\dagger}\underbrace{C_{t}\left(x_{t+1}-A_{t}x_{t}-B_{t}u_{t}\right)}_{r_{t}}=\Pi_{t}\theta+W_{t}w_{t}.

Hence, \tilde{\theta}_{t+1} provides a noisy measurement of the observable component of \theta, which we use to update the parameter estimate and its uncertainty set.

IV-B Bounded Set Update

Using the parameter measurement model of Sec. IV-A, we now develop a set-valued estimation update that propagates bounded parameter uncertainty while accounting for newly observed information. Since the parameter-estimation error evolves affinely under bounded disturbances and zonotopes are closed under linear transformations and Minkowski sums, the initially zonotopic parameter uncertainty set \Theta_{0} admits a zonotopic outer approximation at every future timestep. Specifically, given the uncertainty set \Theta_{t}:=\hat{\theta}_{t}\oplus G_{t}\mathcal{B}^{p_{t}}_{\infty}, where \hat{\theta}_{t} is the current parameter estimate and G_{t} contains p_{t} generators, we update the zonotope center and generators as

\displaystyle\hat{\theta}_{t+1} \\ \displaystyle=\hat{\theta}_{t}+K_{t}\left(\tilde{\theta}_{t+1}-\Pi_{t}\hat{\theta}_{t}\right) \\ \displaystyle G_{t+1} \\ \displaystyle=\begin{bmatrix}(I_{{n_{\theta}}}-K_{t}\Pi_{t})G_{t}&K_{t}W_{t}\end{bmatrix},

where K_{t}\in\mathbb{R}^{{n_{\theta}}\times{n_{\theta}}} is the Kalman gain. The center update incorporates newly observed parameter information, while the generator update propagates residual parameter uncertainty and measurement disturbances and is efficient to compute online, ensuring that \Theta_{t+1} contains the true parameter, i.e., \theta\in\Theta_{t+1}, for all admissible disturbances [37]. Since G_{t+1} determines the parameter uncertainty in \Theta_{t+1}, we minimize the Frobenius norm of (13) as a surrogate for zonotope volume by choosing

K_{t}=G_{t}G_{t}^{\top}\Pi_{t}^{\top}\left(\Pi_{t}G_{t}G_{t}^{\top}\Pi_{t}^{\top}+W_{t}W_{t}^{\top}\right)^{\dagger}.

Since each update in (13) adds n_{x} additional disturbance generators, the number of generators grows by n_{x} at each stage. To maintain tractability, Girard reduction can replace the resulting zonotope with a lower-order outer approximation, limiting memory growth [38]. To prevent the uncertainty bound from increasing in any parameter dimension, we first compute K_{t} from (14) and compare the row-wise \ell_{1} norms \|G_{t+1}\|_{1,\mathrm{r}} and \|G_{t}\|_{1,\mathrm{r}}, which give the uncertainty radii for individual parameters. If an entry increases, we set the corresponding row of K_{t} to zero and recompute the update. This leaves that dimension’s uncertainty radius unchanged, guaranteeing nonincreasing coordinate-wise uncertainty while preserving containment of the true parameter. The resulting parameter uncertainty set is \Theta_{t+1}=\hat{\theta}_{t+1}\oplus G_{t+1}\mathcal{B}^{p_{t+1}}_{\infty}.

Although the future set center \hat{\theta}_{t+1} is unknown at planning time, W_{t} in (10) can be computed a priori along a candidate trajectory. This enables us to evaluate K_{t} using (14) and recursively propagate (13) to forecast G_{t} for all t\in[N]. Consequently, the parameter-estimation error satisfies

e_{t}:=\theta-\hat{\theta}_{t}\in G_{t}\mathcal{B}^{p_{t}}_{\infty},

where the bounding zonotope is known a priori, without requiring future measurements. This allows the controller to anticipate guaranteed future parameter uncertainty reduction during planning. Similarly, using (12)-(13), we can bound the parameter-estimate shift as follows:

\displaystyle\Delta\hat{\theta}_{t} \\ \displaystyle:=\hat{\theta}_{t+1}-\hat{\theta}_{t} \\ \displaystyle\in\begin{bmatrix}K_{t}\Pi_{t}G_{t}&K_{t}W_{t}\end{bmatrix}\mathcal{B}_{\infty}^{p_{t}+n_{x}},

whose bounding zonotope is also known during planning.

IV-C System Level Synthesis Formulation

To compute a robust adaptive controller responding to both state disturbances and updated parameter estimates, we augment the state with the parameter estimate. We rewrite (7) as

x_{t+1}=A_{t}x_{t}+B_{t}u_{t}+E_{t}\theta-E_{t}\hat{\theta}_{t}+E_{t}\hat{\theta}_{t}+F_{t}w_{t},

while (16a) gives the parameter-estimate dynamics

\hat{\theta}_{t+1}=I_{{n_{\theta}}}\hat{\theta}_{t}+I_{{n_{\theta}}}\Delta\hat{\theta}_{t}.

Defining

\displaystyle\bar{A}_{t} \\ \displaystyle:=\begin{bmatrix}A_{t}&E_{t}\\
0_{n_{\theta}\times n_{x}}&I_{n_{\theta}}\end{bmatrix},\quad\bar{B}_{t}:=\begin{bmatrix}B_{t}\\
0_{n_{\theta}\times n_{u}}\end{bmatrix}, \\ \displaystyle\bar{F}_{t} \\ \displaystyle:=\begin{bmatrix}F_{t}&E_{t}&0_{n_{x}\times n_{\theta}}\\
0_{n_{\theta}\times n_{x}}&0_{n_{\theta}\times n_{\theta}}&I_{n_{\theta}}\end{bmatrix},\quad s_{t}:=\begin{bmatrix}x_{t}\\
\hat{\theta}_{t}\end{bmatrix},

we construct augmented dynamics that include bounded but unknown changes in parameter estimates, resembling (3):

s_{t+1}=\bar{A}_{t}s_{t}+\bar{B}_{t}u_{t}+\bar{F}_{t}\begin{bmatrix}w_{t}^{\top}&e_{t}^{\top}&\Delta\hat{\theta}_{t}^{\top}\end{bmatrix}^{\top}.

During planning, (20) allows us to model parameter-estimation errors and estimate shifts as bounded disturbances. We define augmented SLS gains \mathbf{\Phi}^{\mathrm{s}}_{k,j}\in\mathbb{R}^{({n_{x}}+{n_{\theta}})\times({n_{x}}+{n_{\theta}})} and \mathbf{\Phi}^{\mathrm{u}}_{k,j}\in\mathbb{R}^{{n_{u}}\times({n_{x}}+{n_{\theta}})} for the state and control responses, yielding

\displaystyle\mathbf{\Phi}^{\mathrm{s}}_{j+1,j}=I_{{n_{x}}+{n_{\theta}}},\qquad\mathbf{\Phi}^{\mathrm{s}}_{k+1,j}=\bar{A}_{k}\mathbf{\Phi}^{\mathrm{s}}_{k,j}+\bar{B}_{k}\mathbf{\Phi}^{\mathrm{u}}_{k,j},

for k>j. Define the augmented state deviation \Delta s_{k}:=s_{k}-p_{k} from the nominal augmented state p_{k}, and the control deviation \Delta u_{k}:=u_{k}-v_{k}. Then

\begin{bmatrix}\Delta s_{k}\\
\Delta u_{k}\end{bmatrix}=\sum_{j=0}^{k-1}\mathbf{\Phi}_{k,j}\begin{bmatrix}F_{j}w_{j}+E_{j}e_{j}\\
\Delta\hat{\theta}_{j}\end{bmatrix},

where \mathbf{\Phi}_{k,j}=\begin{bmatrix}{\mathbf{\Phi}^{\mathrm{s}}_{k,j}}^{\top}&{\mathbf{\Phi}^{\mathrm{u}}_{k,j}}^{\top}\end{bmatrix}^{\top}. Treating w_{j}, e_{j}, and \Delta\hat{\theta}_{j} as independent disturbances and applying their respective bounds (15) and (16b) would yield a conservative bound on (22). Instead, we observe that e_{j} and \Delta\hat{\theta}_{j} are correlated with the disturbance history \{w_{\ell}\}_{\ell=0}^{j}. Formally,

Proposition 1

Let e_{0}=G_{0}\xi_{0}, where \xi_{0}\in\mathcal{B}^{p_{0}}_{\infty} represents the initial parameter-error realization, with p_{0} generators, and define the Kalman gain product

\Psi_{j,\ell}=\begin{cases}\textstyle\prod_{m=\ell}^{j-1}(I_{{n_{\theta}}}-K_{m}\Pi_{m}),&j>\ell,\\
I_{{n_{\theta}}},&j=\ell,\\
0_{{n_{\theta}}\times{n_{\theta}}},&\text{otherwise}.\end{cases}

Then the parameter error e_{j} and estimate shift \Delta\hat{\theta}_{j} (Eqs. (15)-(16a)) can be expressed in terms of the initial parameter error and disturbances w_{\ell} for \ell\leq j:

\displaystyle e_{j} \\ \displaystyle=\Psi_{j,0}G_{0}\xi_{0}-\textstyle\sum_{\ell=0}^{j-1}\Psi_{j,\ell+1}K_{\ell}W_{\ell}w_{\ell}, \\ \displaystyle\Delta\hat{\theta}_{j} \\ \displaystyle=K_{j}\Pi_{j}\Psi_{j,0}G_{0}\xi_{0}+K_{j}W_{j}w_{j} \\ \displaystyle\qquad-\textstyle\sum_{\ell=0}^{j-1}K_{j}\Pi_{j}\Psi_{j,\ell+1}K_{\ell}W_{\ell}w_{\ell}.

The proof of Prop. 1 is in App. -A. Substituting (24) and (25) into (22) expresses the augmented state and control deviations directly in terms of the process disturbances w_{j}. Formally,

Theorem 1

Define the adaptive disturbance gains

\displaystyle\hskip-7.0pt\bm{M}_{k,\xi} \\ \displaystyle=\textstyle\sum_{j=0}^{k-1}\left(\mathbf{\tilde{\Phi}}_{k,j}E_{j}+\mathbf{\bar{\Phi}}_{k,j}K_{j}\Pi_{j}\right)\mathbf{\Psi}_{j,0}G_{0}, \\ \displaystyle\hskip-7.0pt\bm{M}_{k,j} \\ \displaystyle=\mathbf{\tilde{\Phi}}_{k,j}F_{j}+\mathbf{\bar{\Phi}}_{k,j}K_{j}W_{j} \\ \displaystyle-\textstyle\sum_{t=j+1}^{k-1}\left(\mathbf{\tilde{\Phi}}_{k,t}E_{t}+\mathbf{\bar{\Phi}}_{k,t}K_{t}\Pi_{t}\right)\mathbf{\Psi}_{t,j+1}K_{j}W_{j},

where \mathbf{\Phi}_{k,j}:=\begin{bmatrix}\mathbf{\tilde{\Phi}}_{k,j}&\mathbf{\bar{\Phi}}_{k,j}\end{bmatrix}, with \mathbf{\tilde{\Phi}}_{k,j}\in\mathbb{R}^{({n_{x}}+{n_{\theta}}+{n_{u}})\times{n_{x}}} and \mathbf{\bar{\Phi}}_{k,j}\in\mathbb{R}^{({n_{x}}+{n_{\theta}}+{n_{u}})\times{n_{\theta}}}. Then the state and control deviations satisfy

\begin{bmatrix}\Delta s_{k}\\
\Delta u_{k}\end{bmatrix}=\bm{M}_{k,\xi}\xi_{0}+\textstyle\sum_{j=0}^{k-1}\bm{M}_{k,j}w_{j}.

The proof of Thm. 1 is in App. -B. Notably, Thm. 1 allows us to compute both robust reachable sets and an adaptive feedback controller from the SLS responses. Specifically, since \xi_{0}\in\mathcal{B}^{p_{0}}_{\infty} and w_{j}\in\mathcal{B}^{{n_{x}}}_{\infty}, (28) yields the following zonotopic reachable set for the augmented state and control:

\displaystyle\begin{bmatrix}s_{k}\\
u_{k}\end{bmatrix} \\ \displaystyle\in\mathcal{R}_{k}:=\left\{\begin{bmatrix}p_{k}\\
v_{k}\end{bmatrix}\right\}\oplus\bm{M}_{k,\xi}\mathcal{B}^{p_{0}}_{\infty}\oplus\bigoplus_{j=0}^{k-1}\bm{M}_{k,j}\mathcal{B}^{{n_{x}}}_{\infty}.\hskip-5.0pt

Crucially, the adaptive disturbance gains \bm{M}_{k,\xi} preserve correlations between parameter errors, estimate updates, and process disturbances, avoiding the conservatism of bounding them independently. To recover the adaptive controller, we assemble the optimized SLS responses into block lower-triangular matrices \mathbf{\Phi}^{\mathrm{s}} and \mathbf{\Phi}^{\mathrm{u}}, such that [\mathbf{\Phi}^{\mathrm{s}}]_{k,j}=\mathbf{\Phi}^{\mathrm{s}}_{k,j} and [\mathbf{\Phi}^{\mathrm{u}}]_{k,j}=\mathbf{\Phi}^{\mathrm{u}}_{k,j}. Since \mathbf{\Phi}^{\mathrm{s}}_{j+1,j}=I_{{n_{x}}+{n_{\theta}}}, \mathbf{\Phi}^{\mathrm{s}} has identity diagonal blocks and hence is causally invertible. Thus, following the standard SLS realization [1], the feedback gains are

\mathcal{K}=\mathbf{\Phi}^{\mathrm{u}}(\mathbf{\Phi}^{\mathrm{s}})^{-1}.

Denoting the (k,j) block of \mathcal{K} by \mathcal{K}_{k,j}=[\mathcal{K}]_{k,j}, with \mathcal{K}_{k,j}=0 for j>k, we write the associated causal adaptive policy as

u_{k}=v_{k}+\textstyle\sum_{j=1}^{k}\mathcal{K}_{k,j}(s_{j}-p_{j}),

where p_{j}=[z_{j}^{\top},\hat{\theta}_{0}^{\top}]^{\top} and s_{j}=[x_{j}^{\top},\hat{\theta}_{j}^{\top}]^{\top}. Thus, the controller responds to both physical-state deviations and online parameter-estimate updates, while the corresponding reachable sets enable robust constraint enforcement.

IV-D Robust Constraint Satisfaction

To ensure robust constraint satisfaction, we require g_{k}(x_{k},u_{k})\leq 0_{n_{c}} for all k\in[N] and g_{N}(x_{N})\leq 0_{n_{c}^{f}} for every admissible \xi_{0} and disturbance realization w_{j}. We achieve this by inflating the constraints of the nominal trajectory optimization to account for the adaptive closed-loop reachable set (29). First, we linearize the constraints along the nominal trajectory:

\displaystyle\hskip-4.0pt\textstyle\Gamma_{k} \\ \displaystyle\textstyle\displaystyle:=\frac{\partial g_{k}}{\partial x}\big|_{(z_{k},v_{k})},\,\Gamma_{N}\textstyle:=\frac{\partial g_{N}}{\partial x}\big|_{z_{N}},\,\ \Lambda_{k}\textstyle:=\frac{\partial g_{k}}{\partial u}\big|_{(z_{k},v_{k})}.\hskip-12.0pt

To construct constraint matrices that are dimensionally compatible with s_{k}, we augment the constraint Jacobians with zero blocks for the parameter estimate indices, as the physical state and input constraints do not directly depend on \hat{\theta}_{k}:

\displaystyle P_{k} \\ \displaystyle:=\begin{bmatrix}\Gamma_{k}&0_{n_{c}\times{n_{\theta}}}&\Lambda_{k}\end{bmatrix},\quad\forall k\in[N], \\ \displaystyle P_{N} \\ \displaystyle:=\begin{bmatrix}\Gamma_{N}&0_{n_{c}^{f}\times({n_{\theta}}+{n_{u}})}\end{bmatrix}.

Using (33) and the adaptive gains (28), robust constraint satisfaction follows if the following condition holds:

Corollary 1

Robust constraint satisfaction is ensured if, for all k\in[N],

g_{k}(z_{k},v_{k})+\beta_{k}\leq 0_{n_{c}},\quad g_{N}(z_{N})+\beta_{N}\leq 0_{n_{c}^{f}},

where, for all k\in[N+1],

\beta_{k}:=\|P_{k}\bm{M}_{k,\xi}\|_{1,r}+\textstyle\sum_{j=0}^{k-1}\|P_{k}\bm{M}_{k,j}\|_{1,r}+b^{\textrm{lin}}_{k},

and b_{k}^{\textrm{lin}} is the correction factor from [39, Eq. 22] accounting for nonlinear constraints.

The proof of Cor. 1 is available in App. -C.

IV-E Full Optimization Problem for Nonlinear Dynamics

To extend our method to nonlinear dynamics, we augment the LTV-based analysis of Secs. IV-C–IV-D with an additional exogenous disturbance channel that bounds the worst-case linearization error, and apply the gain propagation (21) to the error dynamics of the nonlinear system, enabling us to account for the affine offset introduced by linearization while robustly bounding the resulting state and input deviations. Using the initial parameter estimate \hat{\theta}_{0}, we linearize and obtain

\displaystyle\textstyle A_{k}:=\frac{\partial f}{\partial x}\big|_{(z_{k},v_{k},\hat{\theta}_{0})},\quad B_{k}:=\frac{\partial f}{\partial u}\big|_{(z_{k},v_{k},\hat{\theta}_{0})}, \\ \displaystyle\textstyle E_{k}:=\frac{\partial f}{\partial\theta}\big|_{(z_{k},v_{k},\hat{\theta}_{0})}.

Following [32], we construct a valid disturbance scaling matrix F_{k}\in\mathbb{R}^{{n_{x}}\times 2{n_{x}}} as a function of F(\cdot), the state and control deviations \Delta x_{k} and \Delta u_{k}, and the initial parameter set \Theta_{0}. The corresponding disturbance is denoted by w_{k}\in\mathbb{R}^{2{n_{x}}}. The LEB must remain valid over all admissible \theta\in\Theta_{0}, \Delta x_{k}, and \Delta u_{k}, with the deviations bounded using Cor. 1. Thus, F_{k} also depends on the adaptive gains \bm{M}_{k,\xi} and \bm{M}_{k,j} for j<k. We write this over-bound compactly as

F_{k}=\zeta\left(z_{k},v_{k},F(\cdot),\bm{M}_{k,\xi},\{\bm{M}_{k,j}\}_{j=0}^{k-1},\Theta_{0}\right),

where \zeta is described in [32, Eq. 23]. The corresponding disturbance is w_{k}\in\mathbb{R}^{2{n_{x}}}, allowing us to reconstruct (19)-(29) with guarantees for nonlinear systems. Using the adaptive gains from Thm. 1, the RANOCP becomes

\displaystyle\hskip-13.0pt\min_{\begin{subarray}{c}\mathbf{z},\,\mathbf{v},\mathbf{\Phi}\end{subarray}}\ \ \\ \displaystyle J(\mathbf{z},\mathbf{v})+\tilde{H}_{0}(\mathbf{\Phi}) \\ \displaystyle z_{k+1}=f(z_{k},v_{k};\hat{\theta}_{0}),\quad\forall k\in[N],\quad z_{0}=\bar{x}_{0}, \\ \displaystyle\mathbf{\Phi}^{\mathrm{s}}_{k+1,j}=\bar{A}_{k}\mathbf{\Phi}^{\mathrm{s}}_{k,j}+\bar{B}_{k}\mathbf{\Phi}^{\mathrm{u}}_{k,j},\ \ \mathbf{\Phi}^{\mathrm{s}}_{j+1,j}=I_{{n_{x}}+{n_{\theta}}}, \\ \displaystyle\quad\quad\forall j\in[N],\hskip 5.0pt\forall k\in[j+1,N-1], \\ \displaystyle g_{k}(z_{k},v_{k})+\beta_{k}\leq 0_{n_{c}},\qquad\forall k\in[N], \\ \displaystyle g_{N}(z_{N})+\beta_{N}\leq 0_{n_{c}^{f}},\vskip-2.0pt

where \mathbf{z}:=\{z_{k}\}_{k=0}^{N} and \mathbf{v}:=\{v_{k}\}_{k=0}^{N-1}. Equation (38b) enforces the nominal dynamics and initial condition, (38c) imposes the system-level constraints, and (38d)-(38e) enforce robust constraint satisfaction via (34)-(35). The objective (38a) combines the tracking cost J(\mathbf{z},\mathbf{v}) with the tube penalty \tilde{H}_{0}(\mathbf{\Phi}) from [40, Eqs. 49, 52-53]. Solving (38) over a fixed planning horizon yields a robust adaptive trajectory optimization policy, while repeatedly solving it in receding-horizon fashion yields a RAMPC controller.

Remark 1 (Recursive feasibility)

The resulting A-SLS controller is compatible with the recursive-feasibility construction of [41]. In particular, (38) can be augmented with a robust positively invariant terminal set and associated terminal controller, together with the shifted nominal and auxiliary trajectory construction in [41, Eqs. 27-29]. The adaptive disturbance representation in (28) and nonlinear linearization-error bound in (37) can then be treated as the bounded prediction uncertainty. Under the corresponding assumptions, initial feasibility implies recursive feasibility and robust constraint satisfaction.

V Results

We evaluate A-SLS as both a robust trajectory optimization method in Sec. V-A and a RAMPC policy in Sec. V-B. Our solver builds on [33]. All simulations use an NVIDIA RTX 4090 GPU (24 GB VRAM), while the hardware experiment uses an Apple M4 Pro CPU (12 cores, 24 GB RAM). We report a log-volume surrogate for the forecast parameter uncertainty sets,

\log V_{\theta,k}:=\textstyle\sum_{i=1}^{n_{\theta}}\log\|\bar{e}_{i}^{(n_{\theta})}G_{k}\|_{1},

and a log-volume surrogate for the positional tubes,

\log V_{p,k}:=\textstyle\sum_{i=1}^{n_{p}}\log(\|\bar{e}_{i}^{(n_{a})}\bm{M}_{k,\xi}\|_{1}+\sum_{j=0}^{k-1}\|\bar{e}_{i}^{(n_{a})}\bm{M}_{k,j}\|_{1}),

where n_{a}={n_{x}}+{n_{\theta}}+{n_{u}}, n_{p}=2 for Dubins car and the planar quadrotor, and n_{p}=3 otherwise.

V-A Robust Trajectory Optimization

Dubins Ablation: We evaluate two Dubins car models from [40, Eq. 39] (n_{x}=4, n_{u}=2): one with matched uncertainty and one with unmatched uncertainty, each with n_{\theta}=2 and \theta\in\Theta_{0}=0.0075\mathcal{B}^{2}_{\infty}. We denote uncertainty as matched if it enters the dynamics through the same channels as the control inputs (i.e., lies in the column space of B_{t}), and unmatched otherwise [23]. For the discretized dynamics with timestep dt, the matched and unmatched parameter sensitivities are E_{k}:=dt\begin{bmatrix}0_{2\times 2}&I_{2}\end{bmatrix}^{\top} and E_{k}:=dt\begin{bmatrix}I_{2}&0_{2\times 2}\end{bmatrix}^{\top}, respectively, with F_{k}=0.0003I_{4} in both cases. We compare A-SLS with and without LEBs against a non-adaptive SLS formulation. The car moves from p_{xy}:=(p_{x},p_{y})=(1.0,1.0)\,\textrm{m}, with \hat{\theta}_{0}=0_{2}, to (1.0,-1.0)\,\textrm{m} while avoiding an obstacle centered at c_{\textrm{obs}}=(0.95,0.0)\,\textrm{m} with radius r_{\textrm{obs}}=0.35\,\textrm{m}. We use horizon N=70 and timestep dt=0.05\,\textrm{s}. For each ablation, we run 10 adversarial-disturbance rollouts with a fixed worst-case disturbance primitive w_{k}=w\in\{1,-1\}^{4} for all k\in[N] and the true parameter selected from a corner of \Theta_{0}, together with 30 random rollouts where w_{k}\sim U[-1,1] and \theta is sampled uniformly from \Theta_{0}. For the matched and unmatched cases, A-SLS with LEBs reduces the log positional tube volume by 19\% and 11\%, shrinking the physical position-tube volume to 18\% and 53\% of the baseline SLS volume, respectively, as shown in Tab. I. Online parameter learning also reduces tracking error. Removing the LEBs further reduces tube volume but sacrifices robustness to linearization error, producing tube-containment rates below 100\% in the unmatched case. Overall, these results show that A-SLS reduces conservativeness and tracking error under matched and unmatched uncertainty, while LEBs ensure robust containment under nonlinear dynamics.

Dubins 2-Obstacle Baseline: We compare A-SLS with LEBs against an adaptive control contraction metric (CCM) method [22] and an adaptive disturbance-feedback (DF) method without system-level constraints [23] on the unmatched Dubins dynamics. The car moves from (0.0,1.0)\,\textrm{m} to (0.25,-1.0)\,\textrm{m} while avoiding obstacles centered at (-0.25,0.20)\,\textrm{m} and (0.25,-0.25)\,\textrm{m}, each with radius 0.23\,\textrm{m}. We use N=75, dt=0.05\,\textrm{s}, 10 adversarial rollouts, and 30 random rollouts. Across rollouts, A-SLS produces smaller positional tubes (Tab. I), enabling a shorter s-curve trajectory in Fig. 3(a). The DF approach omits linearization errors, causing adversarial rollouts to leave its tubes despite those tubes being larger than A-SLS (Fig. 3(b-c)). Overall, these results demonstrate that accounting for future parameter learning reduces conservativeness relative to CCM-based methods, while LEBs are essential for guaranteeing robust containment under nonlinear dynamics.

Quadrotor Active Information Gathering: We evaluate A-SLS on trajectory optimization for the 12-state, 4-input quadrotor model from [42, Eq. 2.19], with n_{\theta}=3 unknown unmatched wind-disturbance parameters entering through E_{k}=0.003\begin{bmatrix}0_{3\times 6}&I_{3}&0_{3\times 3}\end{bmatrix}^{\top}, with \theta\in\Theta_{0}=0.125\mathcal{B}^{3}_{\infty} and \hat{\theta}_{0}=0_{3}. We use the altitude-varying disturbance F(x_{k})=0.0009(1-\tanh(15(\bar{e}_{3}^{(12)}x_{k}-0.05)))I_{12}, where \bar{e}_{3}^{(12)} extracts the p_{z} coordinate. To encourage informative trajectories, we augment the nominal cost with

J_{\textrm{info}}(\mathbf{z})=\lambda\textstyle\sum_{k=1}^{N-1}\|W_{k}\|_{F},

using \lambda=600, where W_{k} from (10) depends implicitly on the nominal state z_{k} through state-dependent parameter sensitivities E_{k} and disturbances F_{k}.

The quadrotor moves from p_{xyz}:=(p_{x},p_{y},p_{z})=(-0.75,-0.75,0.40)\,\textrm{m} to (1.00,0.80,0.40)\,\textrm{m} while avoiding a cylindrical obstacle centered at c_{\textrm{obs}}=(0.10,0.10)\,\textrm{m} with radius r_{\textrm{obs}}=0.25\,\textrm{m}. We use N=110, dt=0.03\,\textrm{s}, and compare A-SLS+, which uses (41), against A-SLS without the information-gathering cost over 120 random and 80 adversarial rollouts. Without J_{\textrm{info}}, the nominal trajectory remains near the goal elevation (Fig. 4(b)), yielding larger positional tubes (Tab. I and Fig. 4(a-b)). By minimizing J_{\textrm{info}}, A-SLS+ seeks higher, lower-disturbance altitudes, reducing parameter uncertainty (Tab. I). The smaller p_{z} tube tightens the measurement-error bound W_{k} through reduced linearization error, which further shrinks parameter uncertainty and reinforces tube contraction (Fig. 4(c)). Overall, these results show that A-SLS enables active information gathering by planning trajectories that accelerate parameter learning.

V-B Robust Adaptive MPC

Planar Quadrotor Baseline: We compare A-SLS against the DF and CCM baselines in an MPC setting using the inverse-mass parameterized planar quadrotor from [27, Sec. 4] (n_{x}=6, n_{u}=2, n_{\theta}=1), with disturbance model F(x_{k})=0.005\begin{bmatrix}{0}_{1\times 3}\hskip-2.84526pt&\hskip-2.84526pt\cos(\bar{e}_{3}^{(6)}x_{k})\hskip-2.84526pt&\hskip-2.84526pt-\sin(\bar{e}_{3}^{(6)}x_{k})\hskip-2.84526pt&\hskip-2.84526pt0\end{bmatrix}^{\top}\bar{e}_{1}^{(6)}, where \bar{e}_{3}^{(6)}x_{k} is the quadrotor angle and \bar{e}_{1}^{(6)} ensures F(x_{k})\in\mathbb{R}^{{n_{x}}\times{n_{x}}}. We use \hat{\theta}_{0}=2.568 with \theta\in\Theta_{0}=[0.99\hat{\theta}_{0},1.01\hat{\theta}_{0}]. The quadrotor moves from p_{xy}=(0,0)\,\textrm{m} to (2,0)\,\textrm{m} while avoiding a circular obstacle centered at c_{\textrm{obs}}=(-0.1,1.0)\,\textrm{m} with radius r_{\textrm{obs}}=0.5\,\textrm{m}. All solvers use N=10, dt=0.05\,\textrm{s}, and up to H=40 MPC steps to reach the goal.

All approaches reach the goal within the allotted horizon, but A-SLS is the only method with solve times below the real-time budget (<dt) across all 40 runs (Tab. II). A-SLS also achieves the lowest control effort, measured by \|u-u_{\textrm{hover}}\|. Baselines using set-membership estimation (SME), which enforce \Theta_{t}\subseteq\Theta_{t-1} rather than bounded parameter updates, achieve smaller terminal parameter sets but larger positional tubes. Specifically, for DF [23], SME recursively refines the feasible parameter set using observed state transitions and bounded disturbances, with uncertainty quantified by its Chebyshev center and radius, whereas for CCM [27], SME refines a polytopic uncertainty set by intersecting it with measurement-consistent parameter constraints. Replacing A-SLS parameter measurements with SME yields parameter errors comparable to the baselines while retaining smaller tube volumes (Tab. II). Overall, these results show A-SLS achieves real-time robust adaptive MPC with much faster solve times and lower control effort than baselines, while maintaining tight reachable tubes.

Quadruped Scalability: To evaluate scalability, we consider the whole-body quadruped model from [33, App. E] with damped or damaged joints (n_{x}=61, n_{u}=12, n_{\theta}=8). For each uncertain joint,

\tau_{\textrm{eff}}^{j}=u^{j}-\theta^{j}\dot{q}^{j},

where \tau_{\textrm{eff}}^{j} is the effective torque for joint j, u^{j} is the commanded joint input, \theta^{j} is the damping, and \dot{q}^{j} is the joint’s velocity. We assume no initial joint damage, \hat{\theta}_{0}=0_{8}, for the four calf and four thigh joints, with \theta\in\Theta_{0}=[-1.6,1.6]^{8}. Disturbance bounds are 0.004 for base p_{x},p_{y}, 0.020 for thigh joints, and 0.025 for calf joints. To model real-world mismatch, the true plant additionally includes model error exceeding these assumed disturbance bounds. We use the measurement gate C_{t} (8) to admit joint-position information for a parameter only when the corresponding leg is in swing. The task requires stable motion for H=500 steps while tracking v_{x}=0.15 and avoiding an inflated circular obstacle centered at c_{\textrm{obs}}=(1.0,0.25)\,\textrm{m} with radius r_{\textrm{obs}}=0.42\,\textrm{m}. Both solvers use N=14 and dt=0.032\,\textrm{s}.

We compare A-SLS against SLS, the only baseline that scaled to this system. A-SLS succeeds in 38/40 runs while maintaining safe obstacle clearance, with an example shown in Fig. 2(a); SLS remains stable in only 24/40 runs. Despite violations of the assumed disturbance bounds, the parameter estimates and uncertainty sets remain near the true parameters (Fig. 2(b-c)) using (14). In contrast, SME requires hard set-containment guarantees, so violations of the assumed disturbance bounds can invalidate its parameter-set update. For non-adaptive SLS, the third-quartile solve time exceeds the real-time budget (Tab. II) because the large initial parameter uncertainty and larger tracking errors require more solver iterations. Nevertheless, A-SLS maintains stable legged motion with a median solve time of 16.1\,\textrm{ms}, remaining within the real-time budget of 32\,\textrm{ms}. Overall, these results show that A-SLS scales to high-dimensional whole-body control, achieving improved stability and tracking performance while meeting real-time computational constraints.

Hardware Validation: Lastly, we validate A-SLS on a Crazyflie with an unknown thrust-to-acceleration parameter (n_{\theta}=1), which captures the combined effects of mass, battery level, and motor health. We use the 12-state, 4-input quadrotor model (n_{x}=12, n_{u}=4), replacing the inverse mass 1/m with the uncertain parameter \theta. We set \hat{\theta}_{0}=13.5 and \Theta_{0}=[11.5,15.5]; prior to evaluation, we measured \theta=12.26 with a vehicle mass of 35\,\textrm{g}. Disturbance bounds are 0.004 for position, 0.008 for attitude, 0.16 for angular rates, and 0.04, 0.016, and 0.025 for the velocities v_{x}, v_{y}, and v_{z}, respectively. We use N=10 and dt=0.05\,\textrm{s}. The task is to move 2\,\textrm{m} in p_{y} while increasing altitude by 0.2\,\textrm{m} in p_{z}, subject to a normalized thrust limit of 0.95 (1 is the hardware limit). Because v_{z} is reliably measured, the gate in (8) uses only v_{z} residuals for parameter estimation.

Across 15 hardware runs, the Crazyflie learns the parameter and stabilizes to reach the goal (Fig. 1(b)). Since \hat{\theta}_{0}>\theta, the anticipated thrust was below the hover-required thrust and the vehicle initially loses altitude. However, A-SLS recovers the altitude as the parameter estimate converges around 0.55\,\textrm{s} (Fig. 1(a,c)). A-SLS also maintains real-time performance below the 50\,\textrm{ms} budget with a median solve time of 8.15\,\textrm{ms} while respecting the thrust limit (Fig. 1(d)). Overall, these results show that A-SLS enables real-time parameter learning and robust stabilization on physical hardware, recovering from inaccurate initial dynamics estimates while respecting actuator constraints.

VI Conclusion

We presented A-SLS, a robust adaptive control framework that accounts for guaranteed future parameter learning while preserving correlations between process disturbances, parameter error, and estimate updates to construct tighter reachable tubes. Across trajectory optimization and RAMPC experiments, A-SLS reduces conservatism and tracking error, supports active information gathering, and achieves real-time performance on nonlinear robotic systems, including whole-body quadruped control. Hardware experiments further demonstrate online parameter learning and stabilization on a Crazyflie with an incorrect initial parameter estimate. Future efforts will extend A-SLS to the output-feedback setting [43, 44] to enable adaptation to uncertain perception.

References

1. [1] J. Anderson, J. C. Doyle, S. H. Low, and N. Matni (2019) System level synthesis. Annual Reviews in Control 47, pp. 364–393.
2. [2] P. A. Ioannou and P. V. Kokotovic (1984) Robust redesign of adaptive control. TAC.
3. [3] P. A. Ioannou and J. Sun (1996) Robust adaptive control.
4. [4] M. M. Polycarpou and P. A. Ioannou (1996) A robust adaptive nonlinear control design. Automatica 32 (3), pp. 423–427. External Links: Document
5. [5] K. J. Åström and B. Wittenmark (1995) Adaptive control. 2 edition.
6. [6] C. Cao and N. Hovakimyan (2008) Design and analysis of a novel \mathcal{L}_{1} adaptive control architecture with guaranteed transient performance. TAC.
7. [7] B. T. Lopez and J. E. Slotine (2019) Contraction metrics in adaptive nonlinear control. External Links: 1912.13138
8. [8] B. T. Lopez and J. E. Slotine (2020) Universal adaptive control of nonlinear systems. External Links: 2012.15815
9. [9] H. Tsukamoto, S. Chung, and J. E. Slotine (2021) Learning-based adaptive control using contraction theory. In IEEE CDC,
10. [10] S. G. Gessow and B. T. Lopez (2023) Adaptive robust control contraction metrics: transient bounds in adaptive control with unmatched uncertainties. In IEEE CDC,
11. [11] P. Zhao, S. Snyder, N. Hovakimyan, and C. Cao (2024) Robust adaptive control of linear parameter-varying systems with unmatched uncertainties. JGCD.
12. [12] A. P. Leeman, J. Sieber, S. Bennani, and M. N. Zeilinger (2023) Robust optimal control for nonlinear systems with parametric uncertainties via system level synthesis. In IEEE CDC,
13. [13] D. Ho and J. C. Doyle (2019) Scalable robust adaptive control from the system level perspective. In ACC,
14. [14] A. J. Taylor and A. D. Ames (2020) Adaptive safety with control barrier functions. In ACC,
15. [15] B. T. Lopez, J. E. Slotine, and J. P. How (2021) Robust adaptive control barrier functions: an adaptive and data-driven approach to safety. IEEE Control Systems Letters 5 (3), pp. 1031–1036. External Links: Document, 2003.10028
16. [16] W. Xiao, C. Belta, and C. G. Cassandras (2022) Adaptive control barrier functions. IEEE Transactions on Automatic Control. External Links: Document
17. [17] M. V. Minniti, R. Grandia, F. Farshidian, and M. Hutter (2022) Adaptive CLF-MPC with application to quadrupedal robots. IEEE RA-L. External Links: Document, 2112.04536
18. [18] K. Sinaei and D. Ebeigbe (2026) Safe adaptive control with vanishing conservativeness for robotic systems with unknown dynamics via barrier functions. IEEE RA-L.
19. [19] V. Adetola and M. Guay (2011) Robust adaptive MPC for constrained uncertain nonlinear systems. International Journal of Adaptive Control and Signal Processing 25 (2), pp. 155–167. External Links: Document
20. [20] A. Aswani, H. Gonzalez, S. Sastry, and C. Tomlin (2013) Provably safe and robust learning-based model predictive control. Automatica. External Links: Document
21. [21] M. Lorenzen, M. Cannon, and F. Allgöwer (2019) Robust MPC with recursive model update. Automatica 103, pp. 461–471. External Links: Document
22. [22] J. Köhler, P. Kötting, R. Soloperto, F. Allgöwer, and M. A. Müller (2021) A robust adaptive model predictive control framework for nonlinear uncertain systems. IJRNC 31 (18). External Links: Document
23. [23] R. Sinha, J. Harrison, S. M. Richards, and M. Pavone (2022) Adaptive robust model predictive control with matched and unmatched uncertainty. In 2022 American Control Conference (ACC), pp. 906–913. External Links: Document, 2104.08261
24. [24] X. Lu, M. Cannon, and D. Koksal-Rivet (2021) Robust adaptive model predictive control: performance and parameter estimation. IJRNC 31 (18), pp. 8703–8724. External Links: Document
25. [25] A. Didier, K. Wabersich, and M. Zeilinger (2021) Adaptive model predictive safety certification for learning-based control. In CDC, External Links: Document
26. [26] K. Pereida, L. Brunke, and A. P. Schoellig (2021) Robust adaptive model predictive control for guaranteed fast and accurate stabilization in the presence of model errors. IJRNC 31 (18). External Links: Document
27. [27] A. Sasfi, M. N. Zeilinger, and J. Köhler (2023) Robust adaptive MPC using control contraction metrics. Automatica 155, pp. 111169. External Links: Document
28. [28] F. Faliero, E. Capello, and A. Iannelli (2026) Robust adaptive model predictive control for tracking in interconnected systems via distributed optimization. IJRNC 36 (5). External Links: Document
29. [29] A. Mesbah (2018) Stochastic model predictive control with active uncertainty learning: a survey on dual control. Ann. Rev. in Control.
30. [30] X. Lu and M. Cannon (2023) Robust adaptive model predictive control with persistent excitation conditions. Automatica. External Links: Document
31. [31] A. Parsi, D. Liu, A. Iannelli, and R. S. Smith (2023) Dual adaptive MPC using an exact set-membership reformulation. In IFAC, External Links: Document
32. [32] J. Fang, K. Shen, A. Srinivasan, and G. Chou (2026) GPU-parallel linearization error bounds for real-time robust optimal control of nonlinear and neural network dynamics. In IEEE CDC,
33. [33] J. Fang and G. Chou (2026) Safe large-scale robust nonlinear MPC in milliseconds via reachability-constrained system level synthesis on the GPU. In Robotics: Science and Systems XXII,
34. [34] K. Shen and G. Chou (2026) Parallel differentiable reachability for learning and planning with certified neural dynamics and controllers.
35. [35] G. Golub and W. Kahan (1965) Calculating the singular values and pseudo-inverse of a matrix. J. Soc. Indust. Appl. Math. Ser. B Numer. Anal. 2 (2), pp. 205–224.
36. [36] G. H. Golub and C. F. Van Loan (2013) Matrix computations. 4th edition, Johns Hopkins University Press, Baltimore, MD.
37. [37] T. Alamo, J. M. Bravo, and E. F. Camacho (2005) Guaranteed state estimation by zonotopes. Automatica 41 (6), pp. 1035–1043.
38. [38] A. Girard (2005) Reachability of uncertain linear systems using zonotopes. In HSCC, Vol. 3414, pp. 291–305.
39. [39] S. Zhan, C. Chiu, A. Leeman, and G. Chou (2026) Robustly constrained dynamic games for uncertain nonlinear dynamics. In ICRA,
40. [40] A. Srinivasan, A. Leeman, and G. Chou (2026) Safety beyond the training data: robust out-of-distribution MPC via conformalized system level synthesis. In L4DC,
41. [41] A. P. Leeman, J. Köhler, and M. N. Zeilinger (2026) Guaranteed robust nonlinear MPC via disturbance feedback. In ICRA,
42. [42] F. Sabatino (2015) Quadrotor control: modeling, nonlinear control design, and simulation. Master’s Thesis, KTH.
43. [43] W. Li, J. Fang, S. Polisetti, Y. Song, and G. Chou (2026) Robustness without wrinkles: parallel simulation and robust MPC for certified deformable manipulation. Conference on Robot Learning.
44. [44] A. P. Leeman, S. Zhan, M. N. Zeilinger, and G. Chou (2026) Vision-SLS: safe perception-based control from learned visual representations via system level synthesis. Robotics: Science and Systems XXII.

-A Proof of Proposition 1

Proof. From the parameter measurement (11) and the center update (12),

\displaystyle\Delta\hat{\theta}_{t} \\ \displaystyle=K_{t}\left(\widetilde{\theta}_{t+1}-\Pi_{t}\hat{\theta}_{t}\right) \\ \displaystyle=K_{t}\Pi_{t}\left(\theta-\hat{\theta}_{t}\right)+K_{t}W_{t}w_{t} \\ \displaystyle=K_{t}\Pi_{t}e_{t}+K_{t}W_{t}w_{t}.

Since e_{t}=\theta-\hat{\theta}_{t} and \theta is constant over the horizon,

\displaystyle e_{t+1} \\ \displaystyle=\theta-\hat{\theta}_{t+1}=e_{t}-\Delta\hat{\theta}_{t} \\ \displaystyle=(I_{{n_{\theta}}}-K_{t}\Pi_{t})e_{t}-K_{t}W_{t}w_{t}.

For clarity, the ordered product in \mathbf{\Psi}_{j,\ell} is understood as

\mathbf{\Psi}_{j,\ell}=(I_{{n_{\theta}}}-K_{j-1}\Pi_{j-1})\cdots(I_{{n_{\theta}}}-K_{\ell}\Pi_{\ell}),\qquad j>\ell.

Repeated substitution of (47), starting from e_{0}=G_{0}\xi_{0}, gives

e_{j}=\mathbf{\Psi}_{j,0}G_{0}\xi_{0}-\sum_{\ell=0}^{j-1}\mathbf{\Psi}_{j,\ell+1}K_{\ell}W_{\ell}w_{\ell},

which is (24). Finally, substituting this expression for e_{j} into (45) yields

\displaystyle\Delta\hat{\theta}_{j} \\ \displaystyle=K_{j}\Pi_{j}\mathbf{\Psi}_{j,0}G_{0}\xi_{0}+K_{j}W_{j}w_{j} \\ \displaystyle\quad-\sum_{\ell=0}^{j-1}K_{j}\Pi_{j}\mathbf{\Psi}_{j,\ell+1}K_{\ell}W_{\ell}w_{\ell},

which is (25). \square

-B Proof of Theorem 1

Proof. Partition the augmented SLS response as \mathbf{\Phi}_{k,j}=[\mathbf{\tilde{\Phi}}_{k,j}\;\mathbf{\bar{\Phi}}_{k,j}], so that (22) becomes

\displaystyle\begin{bmatrix}\Delta s_{k}\\
\Delta u_{k}\end{bmatrix} \\ \displaystyle=\sum_{t=0}^{k-1}\mathbf{\tilde{\Phi}}_{k,t}(F_{t}w_{t}+E_{t}e_{t})+\sum_{t=0}^{k-1}\mathbf{\bar{\Phi}}_{k,t}\Delta\hat{\theta}_{t}.

Using the one-step identity \Delta\hat{\theta}_{t}=K_{t}\Pi_{t}e_{t}+K_{t}W_{t}w_{t} from (45), (51) can be regrouped as

\displaystyle\begin{bmatrix}\Delta s_{k}\\
\Delta u_{k}\end{bmatrix} \\ \displaystyle=\sum_{t=0}^{k-1}\left(\mathbf{\tilde{\Phi}}_{k,t}E_{t}+\mathbf{\bar{\Phi}}_{k,t}K_{t}\Pi_{t}\right)e_{t} \\ \displaystyle\quad+\sum_{t=0}^{k-1}\left(\mathbf{\tilde{\Phi}}_{k,t}F_{t}+\mathbf{\bar{\Phi}}_{k,t}K_{t}W_{t}\right)w_{t}.

Substituting (24) into (52), the coefficient multiplying the initial parameter realization \xi_{0} is

\sum_{t=0}^{k-1}\left(\mathbf{\tilde{\Phi}}_{k,t}E_{t}+\mathbf{\bar{\Phi}}_{k,t}K_{t}\Pi_{t}\right)\mathbf{\Psi}_{t,0}G_{0}=\bm{M}_{k,\xi}.

Now fix a disturbance index j<k. The disturbance w_{j} contributes directly at t=j through both the plant and the estimator, giving

\mathbf{\tilde{\Phi}}_{k,j}F_{j}+\mathbf{\bar{\Phi}}_{k,j}K_{j}W_{j}.

It also contributes indirectly to every later parameter error e_{t}, t>j, through the term -\mathbf{\Psi}_{t,j+1}K_{j}W_{j}w_{j}. Hence the total coefficient of w_{j} is

\displaystyle\mathbf{\tilde{\Phi}}_{k,j}F_{j}+\mathbf{\bar{\Phi}}_{k,j}K_{j}W_{j} \\ \displaystyle\quad-\sum_{t=j+1}^{k-1}\left(\mathbf{\tilde{\Phi}}_{k,t}E_{t}+\mathbf{\bar{\Phi}}_{k,t}K_{t}\Pi_{t}\right)\mathbf{\Psi}_{t,j+1}K_{j}W_{j}=\bm{M}_{k,j}.

Collecting the coefficients of \xi_{0} and all w_{j}, j=0,\ldots,k-1, therefore gives

\begin{bmatrix}\Delta s_{k}\\
\Delta u_{k}\end{bmatrix}=\bm{M}_{k,\xi}\xi_{0}+\sum_{j=0}^{k-1}\bm{M}_{k,j}w_{j},

as claimed. \square

-C Proof of Corollary 1

Proof. For each time k, Theorem 1 gives the deviation

\delta_{k}:=\begin{bmatrix}\Delta s_{k}\\
\Delta u_{k}\end{bmatrix}=\bm{M}_{k,\xi}\xi_{0}+\sum_{j=0}^{k-1}\bm{M}_{k,j}w_{j},

where \|\xi_{0}\|_{\infty}\leq 1 and \|w_{j}\|_{\infty}\leq 1. For any row vector a^{\top}, the dual-norm identity for the \ell_{\infty} ball is

\sup_{\|z\|_{\infty}\leq 1}a^{\top}z=\|a\|_{1}.

Applying (58) independently to the initial parameter uncertainty and each process disturbance gives, row-wise,

\displaystyle\sup_{\begin{subarray}{c}\|\xi_{0}\|_{\infty}\leq 1\\
\|w_{j}\|_{\infty}\leq 1\end{subarray}}P_{k}\delta_{k} \\ \displaystyle=\|P_{k}\bm{M}_{k,\xi}\|_{1,r}+\sum_{j=0}^{k-1}\|P_{k}\bm{M}_{k,j}\|_{1,r}.

Thus the nominal constraint value, plus the support function of the reachable uncertainty set in each constraint direction and the linearization-error backoff b_{k}^{\textrm{lin}}, is no greater than zero whenever

g_{k}(z_{k},v_{k})+\|P_{k}\bm{M}_{k,\xi}\|_{1,r}+\sum_{j=0}^{k-1}\|P_{k}\bm{M}_{k,j}\|_{1,r}+b_{k}^{\textrm{lin}}\leq 0_{n_{c}}.

The same argument at the terminal time, with P_{N} and the response at N, yields

g_{N}(z_{N})+\|P_{N}\bm{M}_{N,\xi}\|_{1,r}+\sum_{j=0}^{N-1}\|P_{N}\bm{M}_{N,j}\|_{1,r}+b_{N}^{\textrm{lin}}\leq 0_{n_{c}^{f}}.

Therefore the stated tightenings imply robust satisfaction for every admissible \xi_{0} and disturbance sequence. \square