Robust Steady-State-Aware Model Predictive Control for Systems with Limited Computational Resources and External Disturbances Hassan Jafari Ozoumchelooei, Mehdi Hosseinzadeh Abstract Model Predictive Control (MPC) is a powerful control strategy; however, its reliance on online optimization poses significant challenges for implementation on systems with limited computational resources. One possible approach to address this issue is to shorten the prediction horizon and adjust the conventional MPC formulation to enlarge the region of attraction. However, these methods typically introduce additional computational load. Recently, steady-state-aware MPC has been introduced to ensure output tracking and convergence to a given desired steady-state configuration while maintaining constraint satisfaction at all times without adding extra computational load. Despite its promising performance, steady-state-aware MPC does not account for external disturbances, which can significantly limit its applicability to real-world systems. This paper aims to advance the method further by enhancing its robustness against external disturbances. To achieve this, we adopt the tube-based design framework, which decouples nominal trajectory optimization from robust control synthesis, thereby requiring no additional online computational resources. Theoretical guarantees of the proposed methodology are shown analytically, and its effectiveness is assessed through simulations and experimental studies on a Parrot Bebop 2 drone. I Introduction M odel Predictive Control (MPC) is a widely used strategy for controlling systems with constraints on both states and control inputs [ 1 , 2 ] . At each time step, MPC solves an optimization problem over a finite prediction horizon to determine the optimal control input. Despite its effectiveness, MPC relies on online optimization, which can be computationally challenging for systems with limited computational resources [ 3 ] . Approaches to address the issue of limited computational power have been investigated over the last several decades. Methods proposed include pre-computing the optimal solutions for different operating conditions offline and storing them for online use [ 4 ] ; using neural networks to approximate the optimal solution [ 5 , 6 ] ; using triggering mechanisms to determine when the optimization problem needs to be solved [ 7 , 8 ] ; and relying on inexact computations (e.g., with a fixed number of optimization iterations) to obtain a sub-optimal approximation of the solution [ 9 , 10 ] . An alternative approach is to shorten the prediction horizon, thereby reducing the dimension of the optimization problem; this approach has been explored in [ 11 , 12 ] . Although these methods guarantee constraint satisfaction at all times, they do not simultaneously ensure output tracking and convergence to a given steady-state configuration. This issue has been addressed in [ 13 ] . However, [ 13 ] does not account for external disturbances, which limits its applicability and practicality in real-world scenarios. This paper aims to address this issue by further advancing the method presented in [ 13 ] . To achieve this, we employ tube-based MPC methodology [ 14 , 15 , 16 , 17 ] , which uses set-theoretic techniques to ensure that all possible trajectories of a system impacted by external disturbances stay within a series of acceptable regions known as reachability tubes. Our motivation for building upon tube-based techniques is their ability to decouple nominal trajectory optimization from robust control synthesis, thereby reducing computational demands for handling disturbances. The key contributions of this paper are: i) the development of a novel robust MPC that can handle external disturbances, ensure constraint satisfaction, and address control objectives for any given prediction horizon length; ii) the provision of theoretical guarantees for its recursive feasibility and closed-loop stability; and iii) the analysis and validation of the proposed scheme through extensive simulation and experimental studies. The rest of this paper is organized as follows. Section II presents the preliminary materials and states the problem. The proposed control scheme is developed in Section III , and its theoretical properties are investigated in Section IV . Sections V and VI present simulation and experimental results, respectively. Finally, Section VII concludes the paper. Notations: We use \mathbb{R} to denote the set of real numbers, \mathbb{R}_{>0} to denote the set of positive real numbers, and \mathbb{R}_{\geq 0} to denote the set of non-negative real numbers. Similarly, we use \mathbb{Z} , \mathbb{Z}_{>0} , and \mathbb{Z}_{\geq 0} to denote the sets of integers, positive integers, and non-negative integers, respectively. We use x\in\mathbb{R}^{n} to indicate that x belongs to the n -dimensional real space. Given x\in\mathbb{R}^{n} , we denote its transpose by x^{\top} . Also, \left\|x\right\|_{Q}^{2}=x^{\top}Qx , where Q\in\mathbb{R}^{n\times n} . We use \ast in the superscript to indicate an optimal decision. We use \text{diag}\{a_{1},a_{2},\dots,a_{n}\} to denote an n\times n matrix with diagonal entries a_{1},a_{2},\dots,a_{n}\in\mathbb{R} . For given sets X,Y\subset\mathbb{R}^{n} , X\ominus Y:=\{x\mid x-y\in X,\forall y\in Y\} is the Pontryagin set difference, and X\oplus Y:=\{x+y\mid x\in X,y\in Y\} is the Minkowski set sum. We use I_{n} to denote the n\times n identity matrix, and \mathbf{0} to denote a zero matrix of appropriate dimensions. II Preliminaries and Problem Statement Problem Setting: Consider that the system to be controlled can be represented by the following disturbed discrete-time linear time-invariant model: \displaystyle x(t+1) \displaystyle=Ax(t)+Bu(t)+w(t), (1a) \displaystyle y(t) \displaystyle=Cx(t)+Du(t), (1b) where x(t)\in\mathbb{R}^{n} is the state vector, u(t)\in\mathbb{R}^{p} is the control input, y(t)\in\mathbb{R}^{m} is the output vector, and w(t)\in\mathcal{W}\subset\mathbb{R}^{n} is an unknown bounded disturbance vector. Assumption II.1 The pair (A,B) is stabilizable. At any time instant t , the state and input must satisfy the following constraints: x(t)\in\mathcal{X},~~u(t)\in\mathcal{U}, (2) where \mathcal{X}\subseteq\mathbb{R}^{n} and \mathcal{U}\subseteq\mathbb{R}^{p} are convex and compact sets containing the origin. The disturbance-free (a.k.a. nominal) dynamics of system ( 1 ) can be expressed as follows: \displaystyle\bar{x}(t+1) \displaystyle=A\bar{x}(t)+B\bar{u}(t), (3a) \displaystyle\bar{y}(t) \displaystyle=C\bar{x}(t)+D\bar{u}(t), (3b) where \bar{x} , \bar{u} and \bar{y} are nominal state, input and output respectively. For any given reference r\in\mathbb{R}^{m} , suppose that there exists at least one steady-state pair \big(\bar{x}_{s},\bar{u}_{s}\big) such that \bar{x}_{s}=A\bar{x}_{s}+B\bar{u}_{s},~~r=C\bar{x}_{s}+D\bar{u}_{s}, (4) where \bar{x}_{s}\in\mathcal{X} and \bar{u}_{s}\in\mathcal{U} . A reference that meets this criterion is called a steady-state admissible reference; we denote the set of all such references by \mathcal{R}\subseteq\mathbb{R}^{m} . Thus, for any r\in\mathcal{R} , the set of all admissible steady-state configurations is: \displaystyle\mathcal{Z}_{r}=\big\{(\bar{x}_{s},\bar{u}_{s})\in\mathcal{X}\times\mathcal{U}| \displaystyle\bar{x}_{s}=A\bar{x}_{s}+B\bar{u}_{s}, \displaystyle r=C\bar{x}_{s}+D\bar{u}_{s}\big\}. (5) According to Assumption II.1 , elements of \mathcal{Z}_{r} can be parameterized as [ 18 , 13 , 19 , 20 ] : \displaystyle\bar{x}_{s}=M_{1}\theta,~\bar{u}_{s}=M_{2}\theta,~r=L\theta, (6) Where M_{1}\in\mathbb{R}^{n\times n_{\theta}} , M_{2}\in\mathbb{R}^{p\times n_{\theta}} , L\in\mathbb{R}^{m\times n_{\theta}} , and \theta\in\mathbb{R}^{n_{\theta}} is the parameterizing vector, with n_{\theta} denoting the dimensionality of \theta . See [ 13 ] for guidelines on determining the matrices M_{1} , M_{2} , and L . Tube of Trajectories: Suppose that the control input \bar{u}(t) is calculated at time instant t for the nominal system given in ( 3 ). Considering that the actual system may be disturbed by the external disturbance w(t) , the trajectory of the disturbed system is likely to deviate from the nominal prediction. To mitigate the impact of these disturbances and keep the trajectory as close to the nominal path as possible, we can determine the control input applied to the system, denoted by u(t) , as follows [ 21 , 15 ] : u(t)=\bar{u}(t)+K\big(x(t)-\bar{x}(t)\big), (7) where K\in\mathbb{R}^{p\times n} is such that A+BK is Schur. In this case, according to ( 1 ) and ( 3 ), the dynamics of the error signal e(t)\triangleq x(t)-\bar{x}(t) are: e(t+1)=(A+BK)e(t)+w(t). (8) Since A+BK is Schur and the disturbance signal w(t) is bounded, ( 8 ) implies that e(t) is bounded, and thus the actual trajectory remains within a neighborhood around the nominal trajectory; such a neighborhood can be seen [ 22 ] as a tube of trajectories around the nominal trajectory. At this stage, we define the concept of a Robustly Positively Invariant (RPI) set [ 23 ] , which will be used later to tighten the constraints and account for the external disturbance signal w(t) . Definition II.2 The set \mathcal{F}\subseteq\mathbb{R}^{n} is called a RPI set for system ( 8 ) if, for any e(t)\in\mathcal{F} and w(t)\in\mathcal{W} , we have e(k+1)\in\mathcal{F} . The minimal RPI set for system ( 8 ), denoted by \mathcal{F}_{\infty} , is given by [ 21 ] as \mathcal{F}_{\infty}=\bigoplus_{i=0}^{\infty}(A+BK)^{i}\mathcal{W} . Remark II.3 In general, it is impossible to obtain an explicit characterization of \mathcal{F}_{\infty} . However, one can follow the procedure detailed in [ 24 ] to obtain an invariant approximation of the minimal RPI \mathcal{F}_{\infty} . Note that the computation of \mathcal{F}_{\infty} is performed offline and thus does not add an online computational load to the MPC problem. Goal: This paper aims to address the following problem. Problem II.4 Given r\in\mathcal{R} , the desired steady-state configuration \big(\bar{x}_{\text{des}},\bar{u}_{\text{des}}\big)\in\mathbb{R}^{n}\times\mathbb{R}^{p} , and the initial condition x(0)\in\mathcal{X} , obtain a robust optimal control input that guides the output of system ( 1 ) to r and achieves the steady-state configuration \big(\bar{x}_{\text{des}},\bar{u}_{\text{des}}\big) , while satisfying the constraints ( 2 ), despite the presence of the disturbance signal w(t) . III Robust Steady-State-Aware Model Predictive Control In this section, we propose a Robust Steady-State-Aware Model Predictive Control (RSSA-MPC) scheme to address Problem II.4 , which is developed by building upon the recently introduced Steady-State-Aware Model Predictive Control (SSA-MPC) [ 13 ] . The proposed RSSA-MPC scheme ensures tracking of piecewise constant references, convergence to the desired steady-state configuration, and satisfaction of state and input constraints without requiring prior knowledge of the reference and despite the presence of external disturbances. Let N\in\mathbb{Z}_{>0} be the length of the prediction horizon. At any time instant t , the proposed RSSA-MPC determines the optimal parameterizing vector \theta^{\ast}(t)\in\mathbb{R}^{n_{\theta}} , the optimal initial condition for the nominal system \bar{x}^{\ast}_{0}(t) , and the optimal control sequence \mathbf{\bar{u}}^{\ast}(t):=\Big[\big(\bar{u}^{\ast}(0|t)\big)^{\top},\cdots,\big(\bar{u}^{\ast}(N-1|t)\big)^{\top}\Big]^{\top}\in\mathbb{R}^{N\times p} by solving the following optimization problem: \displaystyle\theta^{\ast}(t),\bar{x}^{\ast}_{0}(t),\mathbf{\bar{u}}^{\ast}(t)=\arg\min_{\theta,\bar{x}_{0},\mathbf{\bar{u}}}\Bigg(\sum_{k=0}^{N-1}\|\hat{\bar{x}}(k|t)-M_{1}\theta\|^{2}_{Q_{x}} \displaystyle\quad+\sum_{k=0}^{N-1}\|\bar{u}(k|t)-M_{2}\theta\|^{2}_{Q_{u}}+\|\hat{\bar{x}}(N|t)-M_{1}\theta\|^{2}_{Q_{N}} \displaystyle\quad+\|r-L\theta\|^{2}_{Q_{r}}+\left\|\bar{x}_{s}-\bar{x}_{\text{des}}\right\|_{Q_{sx}}^{2}+\left\|\bar{u}_{s}-\bar{u}_{\text{des}}\right\|_{Q_{su}}^{2}\Bigg), (9a) subject to the following constraints: \displaystyle\hat{\bar{x}}(k+1|t)=A\hat{\bar{x}}(k|t)+B\bar{u}(k|t),~\hat{\bar{x}}(0|t)=\bar{x}_{0} (9b) \displaystyle\bar{x}_{0}\in x(t)\oplus\mathcal{F}_{\infty}, (9c) \displaystyle\hat{\bar{x}}(k|t)\in\mathcal{X}\ominus\mathcal{F}_{\infty},\quad k\in\{0,\ldots,N-1\}, (9d) \displaystyle\bar{u}(k|t)\in\mathcal{U}\ominus K\mathcal{F}_{\infty},\quad k\in\{0,\ldots,N-1\}, (9e) \displaystyle\big(\hat{\bar{x}}(N|t),\theta\big)\in\Omega. (9f) In ( 9 ), \hat{\bar{x}}(k|t) represents the predicted nominal state at instant k , Q_{x}=Q_{x}^{\top}\succeq 0 ( Q_{x}\in\mathbb{R}^{n\times n} ), Q_{u}=Q_{u}^{\top}\succ 0 ( Q_{u}\in\mathbb{R}^{p\times p} ), Q_{N}\succeq 0 ( Q_{N}\in\mathbb{R}^{n\times n} ), Q_{r}=Q_{r}^{\top}\succ 0 ( Q_{r}\in\mathbb{R}^{m\times m} ), Q_{sx}=Q_{sx}^{\top}\succeq 0 ( Q_{sx}\in\mathbb{R}^{n\times n} ), Q_{su}=Q_{su}^{\top}\succeq 0 ( Q_{su}\in\mathbb{R}^{p\times p} ), and \bar{x}_{\text{des}}\in\mathbb{R}^{n} and \bar{u}_{\text{des}}\in\mathbb{R}^{p} are the desired steady state and control input determined by the designer. Also, given a terminal control law \bar{u}(t)=\kappa\big(\hat{\bar{x}}(k|t),\theta\big) with \kappa:\mathbb{R}^{n}\times\mathbb{R}^{n_{\theta}}\rightarrow\mathbb{R}^{p} , the robust terminal constraint set \Omega\subseteq\mathbb{R}^{n}\times\mathbb{R}^{n_{\theta}} is designed to ensure that if \big(\hat{\bar{x}}(N|t),\theta\big)\in\Omega , then \Big(\hat{\bar{x}}(k|t),\kappa\big(\hat{\bar{x}}(k|t),\theta\big)\Big)\in(\mathcal{X}\ominus\mathcal{F}_{\infty}\times\mathcal{U}\ominus K\mathcal{F}_{\infty}) for all k\geq N . By K\mathcal{F}_{\infty} , we mean the matrix multiplication of K by all elements of the set \mathcal{F}_{\infty} . Remark III.1 In line with conventional MPC [ 25 , 26 , 15 ] , it is effective to select Q_{N} in ( 9a ) as the solution to the algebraic Riccati equation Q_{N}=A^{\top}Q_{N}A-(A^{\top}Q_{N}B)(Q_{u}+B^{\top}Q_{N}B)^{-1}(B^{\top}Q_{N}A)+Q_{x} , and to use the terminal control law \kappa(\bar{x}(t),\theta)=M_{2}\theta+K_{\infty}(\bar{x}(t)-M_{1}\theta) , where K_{\infty}=-(Q_{u}+B^{\top}Q_{N}B)^{-1}B^{\top}Q_{N}A . It is easy to show that A+BK_{\infty} is Schur. III-A Robust Terminal Constraint Set \Omega When nominal system ( 3 ) is controlled by the terminal control law \kappa(\bar{x}(t),\theta)=M_{2}\theta+K_{\infty}(\bar{x}(t)-M_{1}\theta) , it evolves as follows: \bar{x}(t+1)=(A+BK_{\infty})\bar{x}(t)+(BM_{2}-BK_{\infty}M_{1})\theta. (10) Thus, the robust terminal constraint set \Omega can be implemented as \Omega=\mathcal{O}^{\epsilon}\cap\mathcal{O}_{\infty} , where \mathcal{O}^{\epsilon} is defined as: \displaystyle\mathcal{O}^{\epsilon}=\big\{\theta| \displaystyle M_{1}\theta\in(1-\epsilon)(\mathcal{X}\ominus\mathcal{F}_{\infty}), \displaystyle M_{2}\theta\in(1-\epsilon)(\mathcal{U}\ominus K\mathcal{F}_{\infty})\big\}, (11) for some \epsilon\in(0,1) , and \mathcal{O}_{\infty} is the tightened maximal output admissible set defined as: \displaystyle\mathcal{O}_{\infty}=\{(\bar{x},\theta)\mid\hat{\bar{x}}(\gamma\mid\bar{x},\theta)\in\mathcal{X}\ominus\mathcal{F}_{\infty},~M_{2}\theta \displaystyle+K_{\infty}\left(\hat{\bar{x}}(\gamma|\bar{x},\theta)-M_{1}\theta\right)\in\mathcal{U}\ominus K\mathcal{F}_{\infty},\,\gamma=0,1,\cdots\}, (12) with \hat{\bar{x}}(\gamma|\bar{x},\theta) being the predicted state at the prediction instant \gamma starting from \bar{x} with \theta being kept constant, which, according to ( 10 ), can be computed as follows: \displaystyle\hat{\bar{x}}(\gamma\mid\bar{x},\theta)=(A+BK_{\infty})^{\gamma}\bar{x} \displaystyle~~~~~~+\sum_{i=1}^{\gamma}(A+BK_{\infty})^{i-1}(BM_{2}-BK_{\infty}M_{1})\theta, (13) Note that since \mathcal{O}_{\infty} is bounded (see [ 13 ] and [ 27 ] ), the robust terminal constraint set defined above is finitely determined. That is, there exists a finite index \gamma^{\ast} such that \mathcal{O}_{\gamma}=\mathcal{O}_{\infty},~\gamma\geq\gamma^{\ast} , and thus the robust terminal constraint set can be defined as \Omega=\mathcal{O}^{\epsilon}\cap\mathcal{O}_{\gamma^{\ast}} . The index \gamma^{\ast} can be obtained by solving a sequence of programming problems as discussed in [ 27 ] . IV Theoretical Properties of the Proposed RSSA-MPC In this section, we will investigate the theoretical properties of the proposed RSSA-MPC. First, we will show that the proposed scheme is recursively feasible; starting from a feasible initial condition, the optimization problem ( 9 ) remains feasible at all times. Next, we will show that the control inputs obtained from the optimization problem ( 9 ) steer the output of system ( 1 ) toward the desired reference without violating the constraints given in ( 2 ). Theorem IV.1 Consider the system described by ( 1 ) and subject to the constraints specified in ( 2 ). Assume that the optimization problem ( 9 ) is feasible at the time instant t . Then, it remains feasible for all t\in\mathbb{Z}_{\geq 0} . Proof: Suppose that at time instant t , the RSSA-MPC problem given in ( 9 ) is feasible. Thus, the optimal parameterizing vector \theta^{\ast}(t) , the optimal initial condition \bar{x}_{0}^{\ast}(t) , and the optimal control sequence \mathbf{\bar{u}}^{\ast}(t) are available. Define the following sequences: \displaystyle\theta^{\dagger}= \displaystyle\theta^{\ast}(t), (14a) \displaystyle\bar{x}_{0}^{\dagger}= \displaystyle A\bar{x}_{0}^{\ast}+B\bar{u}^{\ast}(0|t), (14b) \displaystyle\mathbf{\bar{u}}^{\dagger}= \displaystyle\Big[\big(\bar{u}^{\ast}(1|t)\big)^{\top},\cdots,\big(\bar{u}^{\ast}(N-1|t)\big)^{\top} \displaystyle~~\big(\kappa\big(\hat{\bar{x}}(N|t),\theta^{\ast}(t)\big)\big)^{\top}\Big]^{\top}. (14c) The \big(\theta^{\dagger},\bar{x}_{0}^{\dagger},\mathbf{\bar{u}}^{\dagger}\big) given in ( 14 ) is a feasible solution for the optimization problem ( 9 ) at time instant t+1 , as: i) we know that x(t+1)\in\left(A\bar{x}_{0}^{\ast}+B\bar{u}^{\ast}(0|t)\right)\oplus\mathcal{F}_{\infty} , which according to the fact that \mathbf{0}\in\mathcal{F}_{\infty} implies A\bar{x}_{0}^{\ast}+B\bar{u}^{\ast}(0|t)\in x(t+1)\oplus\mathcal{F}_{\infty}=\big((A\bar{x}_{0}^{\ast}+B\bar{u}^{\ast}(0|t))\oplus\mathcal{F}_{\infty}\big)\oplus\mathcal{F}_{\infty} ; and ii) the terminal constraint set \Omega is positively invariant, which implies that \kappa(\hat{\bar{x}}(N|t),\theta^{\ast}(t))\in\mathcal{U}\ominus K\mathcal{F}_{\infty} and \hat{\bar{x}}(N+1|t)=A\hat{\bar{x}}(N|t)+B\kappa(\hat{\bar{x}}(N|t),\theta^{\ast}(t))\in\mathcal{X}\ominus\mathcal{F}_{\infty} . Thus, feasibility at time instant t implies feasibility at time instant t+1 , indicating that the proposed RSSA-MPC is recursively feasible; this completes the proof. ∎ Now, we study the closed-loop stability of the proposed RSSA-MPC and show that the steady-state configuration converges to the desired configuration if it is admissible, or else to the best admissible configuration, while ensuring output tracking and constraint satisfaction at all times. Theorem IV.2 Consider system ( 1 ) and suppose that the control input is obtained by solving the optimization problem ( 9 ). Then, if (\bar{x}_{\text{des}},\bar{u}_{\text{des}})\in(\mathcal{X}\ominus\mathcal{F}_{\infty}\times\ \mathcal{U}\ominus K\mathcal{F}_{\infty})\bigcap\mathcal{Z}_{r} , the system output \bar{y}(t) will converge to r , and the state (\bar{x}_{s},\bar{u}_{s}) will approach (\bar{x}_{\text{des}},\bar{u}_{\text{des}}) as k\to\infty . Otherwise, the system output \bar{y}(t) will converge to L\tilde{\theta} , and the state (\bar{x}_{s},\bar{u}_{s}) will approach (M_{1}\tilde{\theta},M_{2}\tilde{\theta}) as k\to\infty , where \tilde{\theta} satisfies: \displaystyle\|\theta^{\diamond}-\tilde{\theta}\|\leq\frac{f(\tilde{\theta})}{\alpha} (15) for some \alpha\in\mathbb{R}_{\geq 0} , with f(\theta) being a positive definite function such that f(\theta)=0\Leftrightarrow\left(M_{1}\theta,M_{2}\theta\right)=\left(\bar{x}_{\text{des}},\bar{u}_{\text{des}}\right) , \theta^{\diamond} being the solution to the following optimization problem: \displaystyle\theta^{\diamond}=\left\{\begin{array}[]{ll}&\arg\min_{\theta}\left\|M_{1}\theta-\bar{x}_{\text{des}}\right\|_{Q_{sx}}^{2}\\ &~~~~~~~~~+\left\|M_{2}\theta-\bar{u}_{\text{des}}\right\|_{Q_{su}}^{2}\\ \text{s.t.}&(M_{1}\theta,M_{2}\theta)\in(\mathcal{X}\ominus\mathcal{F}_{\infty}\times\mathcal{U}\ominus K\mathcal{F}_{\infty})\bigcap\mathcal{Z}_{r}\end{array}\right. Proof: Let J\big(\theta,\bar{x}_{0},\bar{u}\mid x(t)\big) and J\big(\theta,\bar{x}_{0},\bar{u}\mid x(t+1)\big) denote the cost functions of the RSSA-MPC at time instants t and t+1 , respectively. Hence, J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)|x(t)\big) and J\big(\theta^{\ast}(t+1),\bar{x}_{0}^{\ast}(t+1),\mathbf{\bar{u}}^{\ast}(t+1)|x(t+1)\big) represent the optimal solutions at times t and t+1 , respectively. Optimality of \big(\theta^{\ast}(t+1),\bar{x}_{0}^{\ast}(t+1),\mathbf{\bar{u}}^{\ast}(t+1)\big) yields: \displaystyle J\big(\theta^{\ast}(t+1),\bar{x}_{0}^{\ast}(t+1),\mathbf{\bar{u}}^{\ast}(t+1)\mid x(t+1)\big) (19) \displaystyle\leq J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t+1)\mid x(t+1)\big). Subtracting J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big) from both sides of this last inequality gives: \displaystyle J\big(\theta^{\ast}(t+1),\bar{x}_{0}^{\ast}(t+1),\mathbf{\bar{u}}^{\ast}(t+1)\mid x(t+1)\big) (20) \displaystyle-J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big) \displaystyle\leq J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t+1)\mid x(t+1)\big) \displaystyle-J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big). It is obvious that when \bar{x}_{0}^{\ast}(t)=\bar{x}_{0}^{\ast}(t+1) , we have \bar{u}^{\ast}(k+1\mid t)=\bar{u}^{\ast}(k\mid t+1) and \hat{\bar{x}}(k+1\mid t)=\hat{\bar{x}}(k\mid t+1) , for k=0,\cdots,N-2 . Thus, according to ( 9a ), it follows from ( 20 ) that: \displaystyle J\big(\theta^{\ast}(t\!+\!1),\bar{x}_{0}^{\ast}(t\!+\!1),\mathbf{\bar{u}}^{\ast}(t\!+\!1)\mid x(t\!+\!1)\big) \displaystyle\quad-J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big)\leq \displaystyle\left\|\hat{\bar{x}}(N\!\mid\!t\!+\!1)\!-\!M_{1}\theta^{\ast}(t)\right\|^{2}_{Q_{N}}-\left\|\hat{\bar{x}}(N\!\mid\!t)\!-\!M_{1}\theta^{\ast}(t)\right\|^{2}_{Q_{N}} \displaystyle+\left\|\hat{\bar{x}}(N\!-\!1\!\mid\!t\!+\!1)\!-\!M_{1}\theta^{\ast}(t)\right\|^{2}_{Q_{x}} \displaystyle+\left\|\bar{u}(N\!-\!1\!\mid\!t\!+\!1)\!-\!M_{2}\theta^{\ast}(t)\right\|^{2}_{Q_{u}} \displaystyle-\left\|\hat{\bar{x}}^{\ast}(0\!\mid\!t)\!-\!M_{1}\theta^{\ast}(t)\right\|^{2}_{Q_{x}}-\left\|\bar{u}^{\ast}(0\!\mid\!t)\!-\!M_{2}\theta^{\ast}(t)\right\|^{2}_{Q_{u}}. (21) As shown in [ 28 , 13 ] , when Q_{N} is derived from the algebraic Riccati equation mentioned in Remark III.1 , The right-hand side of inequality ( 21 ) is less than or equal to zero. Thus, we have: \begin{split}&J\big(\theta^{\ast}(t\!+\!1),\bar{x}_{0}^{\ast}(t\!+\!1),\mathbf{\bar{u}}^{\ast}(t\!+\!1)\mid x(t\!+\!1)\big)\\ &\quad-J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big)\leq\\ &-\left\|\hat{\bar{x}}^{\ast}(0\!\mid\!t)\!-\!M_{1}\theta^{\ast}(t)\right\|^{2}_{Q_{x}}\\ &\quad-\left\|\bar{u}^{\ast}(0\!\mid\!t)\!-\!M_{2}\theta^{\ast}(t)\right\|^{2}_{Q_{u}}\leq 0.\end{split} (22) Next, we will show that the only entire trajectory that satisfies J\big(\theta^{\ast}(t+1),\bar{x}_{0}^{\ast}(t+1),\mathbf{\bar{u}}^{\ast}(t+1)\mid x(t+1)\big)-J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big)\equiv 0 is the desired steady-state configuration (\bar{x}_{\text{des}},\bar{u}_{\text{des}}) if (\bar{x}_{\text{des}},\bar{u}_{\text{des}})\in(\mathcal{X}\ominus\mathcal{F}_{\infty}\times\mathcal{U}\ominus K\mathcal{F}_{\infty})\bigcap\mathcal{Z}_{r} , and is (M_{1}\tilde{\theta},M_{2}\tilde{\theta}) otherwise, where \tilde{\theta} is as in ( 15 ). Suppose that there exists a time instant t^{\circ} such that J\big(\theta^{\ast}(t+1),\bar{x}_{0}^{\ast}(t+1),\mathbf{\bar{u}}^{\ast}(t+1)\mid x(t+1)\big)-J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big)=0 for t\geq t^{\circ} . Following arguments similar to [ 13 ] , it can be shown that \displaystyle J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big)=\|r-L\theta^{\ast}(t)\|^{2}_{Q_{r}} \displaystyle+\left\|M_{1}\theta^{\ast}(t)-\bar{x}_{\text{des}}\right\|_{Q_{sx}}^{2}+\left\|M_{2}\theta^{\ast}(t)-\bar{u}_{\text{des}}\right\|_{Q_{su}}^{2}, (23) for all t\geq t^{\circ} . Also, optimality at time instant t^{\circ} implies that: \displaystyle J\big(\theta^{\ast}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big)\leq J\big(\theta^{\diamond}(t),\bar{x}_{0}^{\ast}(t),\mathbf{\bar{u}}^{\ast}(t)\mid x(t)\big), (24) where \theta^{\diamond} is as in ( IV.2 ). Since (M_{1}\theta^{\diamond},M_{2}\theta^{\diamond})\in\mathcal{Z}_{r} , it follows from ( 23 ) and ( 24 ) that for t\geq t^{\circ} we have: \displaystyle\|r-L\theta^{\ast}(t)\|^{2}_{Q_{r}}+\left\|M_{1}\theta^{\ast}(t)-\bar{x}_{\text{des}}\right\|_{Q_{sx}}^{2} \displaystyle+\left\|M_{2}\theta^{\ast}(t)-\bar{u}_{\text{des}}\right\|_{Q_{su}}^{2}\leq\left\|M_{1}\theta^{\diamond}-\bar{x}_{\text{des}}\right\|_{Q_{sx}}^{2} \displaystyle+\left\|M_{2}\theta^{\diamond}-\bar{u}_{\text{des}}\right\|_{Q_{su}}^{2}. (25) First, suppose that (\bar{x}_{\text{des}},\bar{u}_{\text{des}})\in(\mathcal{X}\ominus\mathcal{F}_{\infty}\times\ \mathcal{U}\ominus K\mathcal{F}_{\infty})\bigcap\mathcal{Z}_{r} . In this case, it follows from ( IV.2 ) that M_{1}\theta^{\diamond}=\bar{x}_{\text{des}} and M_{2}\theta^{\diamond}=\bar{u}_{\text{des}} . Thus, from ( 25 ), we also have r=L\theta^{\ast}(t) , M_{1}\theta^{\ast}(t)=\bar{x}_{\text{des}} and M_{2}\theta^{\ast}(t)=\bar{u}_{\text{des}} for t\geq t^{\circ} . Next, assume that (\bar{x}_{\text{des}},\bar{u}_{\text{des}})\not\in(\mathcal{X}\ominus\mathcal{F}_{\infty}\times\ \mathcal{U}\ominus K\mathcal{F}_{\infty})\bigcap\mathcal{Z}_{r} . In this case, since r=L\theta^{\diamond} , it can be shown that 1 1 1 Given z_{1},z_{2}\in\mathbb{R}^{n} and Q\succeq 0 , we have: \left\|z_{2}\right\|_{Q}^{2}-\left\|z_{2}\right\|_{Q}^{2}=\left\|z_{2}\right\|_{Q}^{2}-2\left\|z_{2}\right\|_{Q}^{2}+\left\|z_{2}\right\|_{Q}^{2}-2z_{1}^{\top}Qz_{2}+2z_{1}^{\top}Qz_{2}=\left\|z_{1}-z_{2}\right\|_{Q}^{2}+2(z_{1}^{\top}-z_{2}^{\top})Qz_{2}\leq\overline{\lambda}(Q)\left\|z_{1}-z_{2}\right\|^{2}+2\left\|z_{1}-z_{2}\right\|\left\|Q\right\|\left\|z_{2}\right\| , where \overline{\lambda}(Q) is the largest eigenvalue of matrix Q . : \displaystyle\underline{\lambda}(L^{\top}Q_{r}L)\left\|\theta^{\diamond}-\theta^{\ast}(t)\right\|^{2}\leq\overline{\lambda}(M_{1}^{\top}Q_{sx}M_{1})\left\|\theta^{\diamond}-\theta^{\ast}(t)\right\|^{2} \displaystyle+\overline{\lambda}(M_{2}^{\top}Q_{su}M_{2})\left\|\theta^{\diamond}-\theta^{\ast}(t)\right\|^{2} \displaystyle+2\left\|M_{1}\right\|\left\|\theta^{\diamond}-\theta^{\ast}(t)\right\|\left\|Q_{sx}\right\|\left\|M_{1}\theta^{\ast}(t)-\bar{x}_{\text{des}}\right\| \displaystyle+2\left\|M_{2}\right\|\left\|\theta^{\diamond}-\theta^{\ast}(t)\right\|\left\|Q_{su}\right\|\left\|M_{2}\theta^{\ast}(t)-\bar{u}_{\text{des}}\right\|, (26) where \underline{\lambda}(\cdot) and \overline{\lambda}(\cdot) indicate the smallest and largest eigenvalues, respectively. Thus, if Q_{r} is selected such that \underline{\lambda}(L^{\top}Q_{r}L)>\overline{\lambda}(M_{1}^{\top}Q_{sx}M_{1})+\overline{\lambda}(M_{2}^{\top}Q_{su}M_{2}) , ( 26 ) implies that \left\|\theta^{\diamond}-\theta^{\ast}(t)\right\| satisfies the bound ( 15 ) with f(\theta) and \alpha as: \displaystyle f(\theta)= \displaystyle 2\left\|M_{1}\right\|\left\|Q_{sx}\right\|\left\|M_{1}\theta-\bar{x}_{\text{des}}\right\| \displaystyle+2\left\|M_{2}\right\|\left\|Q_{su}\right\|\left\|M_{2}\theta-\bar{u}_{\text{des}}\right\|, (27) and \displaystyle\alpha=\underline{\lambda}(L^{\top}Q_{r}L)-\overline{\lambda}(M_{1}^{\top}Q_{sx}M_{1})-\overline{\lambda}(M_{2}^{\top}Q_{su}M_{2}). (28) ∎ Remark IV.3 Since Q_{r} , Q_{sx} , and Q_{su} are design parameters, the upper-bound in ( 15 ) can be made arbitrarily small. As a result, the output tracks r and the steady-state configuration converges to the best admissible one. V Simulation Studies The main goal of this section is to analyze the performance and effectiveness of the proposed RSSA-MPC scheme for position control of a Parrot Bebop 2 drone. Using a sampling period to 0.2 seconds, the position dynamics of the Parrot Bebop 2 drone can be expressed [ 29 , 30 ] as a linear system in the form of ( 1 ), where x=[p_{x}~\dot{p}_{x}~p_{y}~\dot{p}_{y}~p_{z}~\dot{p}_{z}]^{\top} with p_{x},p_{y},p_{z}\in\mathbb{R} being X, Y, and Z positions in the global Cartesian coordinate, u=[u_{x}~u_{y}~u_{z}]^{\top} with u_{x},u_{y},u_{z}\in\mathbb{R} being control inputs on X, Y, and Z directions, C=I_{6} , D=\mathbf{0} , and \displaystyle A=\begin{bmatrix}1&0.19895&0&0&0&0\\ 0&0.98952&0&0&0&0\\ 0&0&1.000&0.19963&0&0\\ 0&0&0&0.99627&0&0\\ 0&0&0&0&1.000&0.16816\\ 0&0&0&0&0&0.69946\end{bmatrix}, \displaystyle B=\begin{bmatrix}-0.10917348&0&0\\ -1.08982035&0&0\\ 0&-0.141040918&0\\ 0&-1.409531141&0\\ 0&0&-0.030967224\\ 0&0&-0.292295416\end{bmatrix}. The control inputs u_{x}(t) , u_{y}(t) , and u_{z}(t) should satisfy the following constraints for all t : |u_{x}(t)|\leq 0.05 , |u_{y}(t)|\leq 0.05 , and |u_{z}(t)|\leq 0.6 . Also, we assume that the position along Y direction is constrained as |p_{y}(t)|\leq 1.8 . We set r=[1~0~2~0~1.5~0]^{T} , the weighting matrices Q_{x}=\text{diag}\{5,5,5,5,5,5\} , Q_{u}=\text{diag}\{30,20,1\} , Q_{sx}=\text{diag}\{0,0,0,0,0,0\} , and Q_{su}=\text{diag}\{1,1,1\} , desired steady-state configuration \bar{x}_{\text{des}}=r and \bar{u}_{\text{des}}=[0~0~0]^{\top} , and the length of the prediction horizon is N=10 . We assume that w(t)=[0~w_{x}(t)~0~w_{y}(t)~0~w_{z}(t)]^{\top} , which implies that the disturbance signals |w_{x}(t)|\leq\beta , |w_{y}(t)|\leq\beta , and |w_{z}(t)|\leq\beta affect the velocity along the X, Y and Z directions, respectively, with \beta being the maximum magnitude of the disturbance in each direction. Fig. 1 : Time profile of p_{y} at different disturbance magnitudes. The solid lines show the average response, the shaded regions represent the standard deviation, and the red and black dashed lines show the constraint and reference Y position, respectively. Fig. 2 : Performance Index (PI) as a function of disturbance magnitude \beta . To provide a quantitative analysis, we consider 1,000 experiments with initial condition x(0)=[-1~0~0~0~0.5~0]^{\top} , wherein each experiment w_{x} , w_{y} , and w_{z} are uniformly selected from the interval [-\beta,\beta] . Fig. 1 illustrates the time-profile of p_{y} for \beta=0.015 and \beta=0.035 , where the solid lines represent the mean response, while the shaded areas denote the standard deviation. As shown in the figure, increasing the magnitude of the disturbance signal results in a slower response, reflecting the system’s need to adjust to the disturbance. Furthermore, as expected, larger disturbances lead to larger uncertainty, which in turn increases the tracking error. Fig. 3 : Region of Attraction for RSSA-MPC and the convectional robust MPC [ 21 ] with N=10 . The red dashed line represents the constraint. This observation is illustrated in Fig. 2 , where Performance Index (PI) is PI=\frac{1}{T}\sum_{t=0}^{t=T}\|x(t)-\bar{x}_{r}\|^{2} , with T being the duration of the experiments. This figure shows the mean and standard deviation of PI for 1,000 experiments with initial conditions x(0)=[\sigma_{1}~0~\sigma_{2}~0~\sigma_{3}~0]^{\top} , where in each experiment \sigma_{1} , \sigma_{2} , and \sigma_{3} are uniformly selected from the intervals [-0.5,0], [0,0.5], and [0.5,1], respectively. Fig. 2 reinforces the observation that larger disturbance magnitudes lead to increased uncertainty, resulting in a higher PI for the proposed RSSA-MPC. We also analyze the Region of Attraction (ROA) of the proposed RSSA-MPC, defined as the set of initial conditions for which the MPC problem remains feasible. Fig. 3 describes the ROA for both the proposed RSSA-MPC and the conventional robust MPC [ 21 ] with N=10 , calculated under identical conditions, including a disturbance magnitude of \beta=0.02 , state constraints indicated by the red dashed lines, and the previously mentioned control input constraints. As shown in Fig. 3 , the proposed RSSA-MPC demonstrates a larger ROA compared to the conventional robust MPC outlined in [ 21 ] . VI Experimental Results This section aims to experimentally validate the proposed RSSA-MPC by evaluating its performance in controlling the position of the Parrot Bebop 2 drone. Our experimental setup is shown in Fig. 4 . We use the OptiTrack system with ten Prime {}^{\text{x}} 13 cameras operating at a frequency of 120 Hz. These cameras provide 3D accuracy within \pm 0.02 millimeters. The computing unit consists of a 13th Gen \text{Intel}^{\text{\textregistered}} \text{Core}^{\text{\texttrademark}} i9-13900K processor with 64 GB of RAM, running the Motive software to analyze and interpret the camera data. We use the “Parrot Drone Support from MATLAB” package [ 31 ] to send control commands to the Parrot Bebop 2 via WiFi, utilizing the move( \cdot ) command. Communication between Motive and MATLAB is established via User Datagram Protocol (UDP) using the NatNet service. Experimental results for \beta=0.015 and \beta=0.035 are shown in Fig. 5 and Fig. 6 , respectively, illustrating both the drone’s position and control inputs. In these experiments, disturbances are introduced as variations in the control inputs. As demonstrated, the proposed RSSA-MPC effectively guides the Parrot Bebop 2 drone to the desired location while consistently satisfying state and input constraints. The results highlight the robustness of the RSSA-MPC against external disturbances. Fig. 4 : Overview of the experimental setup utilized to experimentally validate the proposed RSSA-MPC. Fig. 5 : Time profiles of the drone’s X, Y, and Z positions and control inputs for \beta=0.015 , with red dashed lines indicating constraints and black dashed lines representing reference positions. Fig. 6 : Time profiles of the drone’s X, Y, and Z positions and control inputs for \beta=0.035 , with red dashed lines indicating constraints and black dashed lines representing reference positions. VII Conclusion In this paper, we introduced an enhancement to the steady-state-aware MPC which has been developed to mediate between system performance and constraint satisfaction in systems with limited computing capacity. More precisely, we adopted a tube-based analysis to introduce robustness to the steady-state-aware MPC, leading to the development of the RSSA-MPC scheme. It has been shown that the proposed methodology effectively decouples nominal trajectory optimization from robust control synthesis, maintaining the same computational complexity as conventional steady-state-aware MPC; thus, it remains appropriate for systems with limited computational resources. Analytical guarantees were provided, which demonstrate the theoretical validity of the proposed method. Simulations and experimental validation on a Parrot Bebop 2 drone demonstrated the robustness and effectiveness of the proposed RSSA-MPC, highlighting its applicability to real-world systems subject to disturbances.