Advertisement

Controller Synthesis Made Real: Reach-Avoid Specifications and Linear Dynamics

  • Chuchu Fan
  • Umang Mathur
  • Sayan Mitra
  • Mahesh Viswanathan
Open Access
Conference paper
Part of the Lecture Notes in Computer Science book series (LNCS, volume 10981)

Abstract

We address the problem of synthesizing provably correct controllers for linear systems with reach-avoid specifications. Our solution uses a combination of an open-loop controller and a tracking controller, thereby reducing the problem to smaller tractable problems. We show that, once a tracking controller is fixed, the reachable states from an initial neighborhood, subject to any disturbance, can be over-approximated by a sequence of ellipsoids, with sizes that are independent of the open-loop controller. Hence, the open-loop controller can be synthesized independently to meet the reach-avoid specification for an initial neighborhood. Exploiting several techniques for tightening the over-approximations, we reduce the open-loop controller synthesis problem to satisfiability over quantifier-free linear real arithmetic. The overall synthesis algorithm, computes a tracking controller, and then iteratively covers the entire initial set to find open-loop controllers for initial neighborhoods. The algorithm is sound and, for a class of robust systems, is also complete. We present RealSyn, a tool implementing this synthesis algorithm, and we show that it scales to several high-dimensional systems with complex reach-avoid specifications.

1 Introduction

The controller synthesis question asks whether an input can be generated for a given system (or a plant) so that it achieves a given specification. Algorithms for answering this question hold the promise of automating controller design. They have the potential to yield high-assurance systems that are correct-by-construction, and even negative answers to the question can convey insights about unrealizability of specifications. This is not a new or a solved problem, but there has been resurgence of interest with the rise of powerful tools and compelling applications such as vehicle path planning [11], motion control [10, 23], circuits design [30] and various other engineering areas.

In this paper, we study synthesis for linear, discrete-time, plant models with bounded disturbance—a standard view of control systems [3, 17]. We will consider reach-avoid specifications which require that starting from any initial state \(\varTheta \), the controller has to drive the system to a target set \(G\), while avoiding certain unsafe states or obstacles \(\mathbf{{O}}\). Reach-avoid specifications arise naturally in many domains such as autonomous and assisted driving, multi-robot coordination, and spacecraft autonomy, and have been studied for linear, nonlinear, as well as stochastic models [7, 9, 14, 18].

Textbook control design methods address specifications like stability, disturbance rejection, asymptotic convergence, but they do not provide formal guarantees about reach-avoid specifications. Another approach is based on discrete abstraction, where a discrete, finite-state, symbolic abstraction of the original control system is computed, and a discrete controller is synthesized by solving a two-player game on the abstracted game graph. Theoretically, these methods can be applied to systems with nonlinear dynamics and they can synthesize controllers for a general class of LTL specifications. However, in practice, the discretization step leads to a severe state space explosion for higher dimensional models. Indeed, we did not find any reported evaluation of these tools (see related work) on benchmarks that go beyond 5-dimensional plant models.

In this paper, the controller we synthesize, follows a natural paradigm for designing controllers. The approach is to first design an open-loop controller for a single initial state \(x_0 \in \varTheta \) to meet the reach-avoid specification. This is called the reference trajectory. For the remaining states in the initial set, a tracking controller is combined, that drives these other trajectories towards the trajectory starting from \(x_0\).

However, designing such a combined controller can be computationally expensive [32] because of the interdependency between the open-loop controller and the tracking controller. Our secret sauce in making this approach feasible, is to demonstrate that the two controllers can be synthesized in a decoupled way. Our strategy is as follows. We first design a tracking controller using a standard control-theoretical method called LQR (linear quadratic regulator) [5]. The crucial observation that helps decouple the synthesis of the tracking and open-loop controller, is that for such a combined controller, once the tracking controller is fixed, the set of states reached from the initial set is contained within a sequence of ellipsoidal sets [24] centered around the reference trajectory. The size of these ellipsoidal sets is solely dependent on the tracking controller, and is independent of the reference trajectory or the open-loop controller. On the flip side, the open-loop controller and the resulting reference trajectory can be chosen independent of the fixed tracking controller. Based on this, the problem of synthesizing the open-loop controller can be completely decoupled from synthesizing the tracking controller. Our open-loop controller is synthesized by encoding the problem in logic. The straightforward encoding of the synthesis problem results in a \(\exists \forall \) formula in the theory of linear arithmetic. Unfortunately, solving large instances of such formulas using current SMT solvers is challenging. To overcome this, we exploit special properties of polytopes and hyper-rectangles, and reduce the original \(\exists \forall \)-formula into the quantifier-free fragment of linear arithmetic (QF-LRA).

Our overall algorithm (Algorithm 1), after computing an initial tracking controller, iteratively synthesizes open-loop controllers by solving QF-LRA formulas for smaller subsets that cover the initial set. The algorithm will automatically identify the set of initial states for which the combined tracking+open-loop controller is guaranteed to work. Our algorithm is sound (Theorem 1), and for a class of robust linear systems, it is also complete (Theorem 2).

We have implemented the synthesis algorithm in a tool called RealSyn. Any SMT solver can be plugged-in for solving the open-loop problem; we present experimental results with Z3, CVC4 and Yices. We report the performance on 24 benchmark problems (using all three solvers). Results show that our approach scales well for complex models—including a system with 84-dimensional dynamics, another system with 3 vehicles (12-dimensional) trying to reach a common goal while avoiding collision with the obstacles and each other, and yet another system with 10 vehicles (20 dimensional) trying to maintain a platoon. RealSyn usually finds a controller within 10 min with the fastest SMT solver. The closest competing tool, Tulip [13, 39], does not return any result even for some of the simpler instances.

Related Work. We briefly review related work on formal controller synthesis according to the plant model type, specifications, and approaches.

Plants and Specifications. In increasing order of generality, the types of plant models that have been considered for controller synthesis are double-integrator models [10], linear dynamical models [20, 28, 34, 38], piecewise affine models [18, 40], and nonlinear (possibly switched) models [7, 25, 31, 33]. There is also a line of work on synthesis approaches for stochastic plants (see [1], and the references therein). With the exceptions noted below, most of these papers consider continuous time plant models, unlike our work.

There are three classes of specifications typically used for synthesis. In the order of generality, they are: (1) pure safety or invariance specifications [2, 15, 33], (2) reach-avoid [7, 14, 15, 18, 33], and (3) more general LTL and GR(1) [20, 26, 39] [16, 38, 40]. For each of these classes both bounded and unbounded-time variants have been considered.

Synthesis Tools. There is a growing set of controller synthesis algorithms that are available as implemented tools and libraries. This includes tools like CoSyMa [27], Pessoa [30], LTLMop [22, 37], Tulip [13, 39], SCOTS [31], that rely on the computation of some sort of a discrete (or symbolic) abstraction. Our trial with a 4-dimensional example on Tulip [13, 39] did not finish the discretization step in one hour. LTLMop [22, 37] handles GR(1) LTL specifications, which are more general than reach-avoid specifications considered in this paper, but it is designed for 2-dimensional robot models working in the Euclidean plane. An alternative synthesis approach generates mode switching sequences for switched system models [19, 21, 29, 35, 41] to meet the specifications. This line of work focuses on a finite input space, instead of the infinite input space we are considering in this paper. Abate et al. [2] use a controller template similar to the one considered in this paper for invariant specifications. A counter-example guided inductive synthesis (CEGIS) approach is used to first find a feedback controller for stabilizing the system. Since this feedback controller may not be safe for all initial states of the system, a separate verification step is employed to verify safety, or alternatively find a counter-example. In the latter case, the process is repeated until a valid controller is found. This is different from our approach, where any controller found needs no further verification. Several of the benchmarks are adopted from [2].

2 Preliminaries and Problem Statement

Notation. For a set A and a finite sequence \(\sigma \) in \(A^*\), we denote the \(t^{th}\) element of \(\sigma \) by \(\sigma [t]\). \({\mathbb R}^n\) is the n-dimensional Euclidean space. Given a vector \(x \in {\mathbb R}^n\), x(i) is the \(i^{th}\) component of x. We will use boldfaced letters (for example, \(\mathbf{x},\mathbf{d},\mathbf{u},\) etc.,) to denote a sequence of vectors.

For a vector x, \(x^{\intercal }\) is its transpose. Given an invertible matrix \(M \in {\mathbb R}^{n \times n}\), \(\Vert x\Vert _M \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\sqrt{x^{\intercal }M^{\intercal } Mx}\) is called the M-norm of x. For \(M=I\), \(\Vert x\Vert _M\) is the familiar 2-norm. Alternatively, \(\Vert x\Vert _M = \Vert Mx\Vert _2\). For a matrix A, \(A \succ 0\) means A is positive definite. Given two symmetric matrices A and B, \(A \preceq B\) means \(A - B\) is negative semi-definite. Given a matrix A and an invertible matrix M of the same dimension, there exists an \(\alpha \ge 0\) such that \(A^\intercal M^\intercal MA \preceq \alpha M^\intercal M\). Intuitively, \(\alpha \) is the largest scaling factor that can be achieved by the linear transformation from x to Ax when using M for computing the norm, and can be found as the largest eigenvalue of the symmetric matrix \((MAM^{-1})^\intercal (MAM^{-1})\).

Given a vector \(c \in {\mathbb R}^{n}\), an invertible matrix M, and a scalar value \(r \ge 0\), we define \(\mathcal {E}_r(c, M) \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\{x \ |\ \Vert x-c\Vert _M \le r \}\) to be the ellipsoid centered at c with radius r and shape M. \(\mathcal{B}_r(c) \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\mathcal{E}_r(c, I)\) is the ball of radius r centered at c. Given two vectors \(c, v \in {\mathbb R}^{n}\), \(\mathcal {\mathcal{R}}_v(c) \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\{x \ | \ \wedge _{i=1}^{n} c(i) - v(i) \le x(i) \le c(i) + v(i)\}\) is the rectangle centered at c with the length vector v. For a set \(S \subseteq {\mathbb R}^n\), a vector \(v \in {\mathbb R}^n\), and a matrix \(M \in {\mathbb R}^{n\times n}\) we define \(v\oplus S \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\{x + v \ | \ x \in S\}\) and \(M\otimes S \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\{ Mx \ | \ x \in S\}\). We say a set \(S \subseteq {\mathbb R}^n\) is a polytope if there is a matrix \(A^{m\times n}\) and a vector \(b \in {\mathbb R}^m\) such that \(S = \{x \ | \ Ax \le b\}\), and denote by \( vert (S)\) the set of vertices of S.

2.1 Discrete Time Linear Control Systems

An (nm)-dimensional discrete-time linear system \(\mathcal{A}\) is a 5-tuple \(\langle A, B, \varTheta , U, D\rangle \), where (i) \(A \in {\mathbb R}^{n\times n}\) is called the dynamic matrix, (ii) \(B \in {\mathbb R}^{n\times m}\) is called the input matrix, (iii) \(\varTheta \subseteq {\mathbb R}^n\) is a set of initial states (iv) \(U\subseteq {\mathbb R}^m\) is the space of inputs, (v) \(D\subseteq {\mathbb R}^n\) is the space of disturbances.

A control sequence for an (nm)-dimensional system \(\mathcal{A}\) is a (possibly infinite) sequence \(\mathbf{u}= \mathbf{u}[0], \mathbf{u}[1], \ldots \), where each \(\mathbf{u}[t] \in U\). Similarly, a disturbance sequence for \(\mathcal{A}\) is a (possibly infinite) sequence \(\mathbf{d}= \mathbf{d}[0], \mathbf{d}[1], \ldots \), where each \(\mathbf{d}[t] \in D\). Given control \(\mathbf{u}\) and disturbance \(\mathbf{d}\), and an initial state \(\mathbf{x}[0] \in \varTheta \), the execution of \(\mathcal{A}\) is uniquely defined as the (possibly infinite) sequence of states \(\mathbf{x}= \mathbf{x}[0], \mathbf{x}[1], \dots \), where for each \(t>0\),
$$\begin{aligned} \mathbf{x}[t+1] = A\mathbf{x}[t] + B\mathbf{u}[t] + \mathbf{d}[t]. \end{aligned}$$
(1)
A (state feedback) controller for \(\mathcal{A}\) is a function \(g: \varTheta \times {\mathbb R}^n \rightarrow {\mathbb R}^m\), that maps an initial state and a (current) state to an input. That is, given an initial state \(x_0 \in \varTheta \) and state \(x\in {\mathbb R}^n\) at time t, the control input to the plant at time t is:
$$\begin{aligned} \mathbf{u}[t] = g(x_0,x). \end{aligned}$$
(2)
This controller is allowed to use the memory of some initial state \(x_0\) (not necessarily the current execution’s initial state) for deciding the current state-dependent feedback. Thus, given an initial state \(\mathbf{x}[0]\), a disturbance \(\mathbf{d}\), and a state feedback controller g, Eqs. (1) and (2) define a unique execution \(\mathbf{x}\) of \(\mathcal{A}\). A state x is reachable in t-steps if there exists an execution \(\mathbf{x}\) of \(\mathcal{A}\) such that \(\mathbf{x}[t] = x\). The set of all reachable states from \(S \subseteq \varTheta \) in exactly T steps using the controller g is denoted by \(\textsf {Reach}_{\mathcal{A}, g}(S, T)\). When \(\mathcal{A}\) and g are clear from the context, we write \(\textsf {Reach}_{}(S, T)\).

2.2 Bounded Controller Synthesis Problem

Given a (nm)-dimensional discrete-time linear system \(\mathcal{A}\), a sequence \(\mathbf{{O}}\) of obstacles or unsafe sets (with \(\mathbf{{O}}[t] \subseteq {\mathbb R}^n\), for each t), a goal \(G\subseteq {\mathbb R}^n\), and a time bound T, the bounded time controller synthesis problem is to find, a state feedback controller g such that for every initial state \(\theta \in \varTheta \) and disturbance \(\mathbf{d}\in D^T\), the unique execution \(\mathbf{x}\) of \(\mathcal{A}\) with g, starting from \(\mathbf{x}[0] = \theta \) satisfies (i) for all \(t \le T\), \(\mathbf{u}[t] \in U\), (ii) for all \(t \le T\), \(\mathbf{x}[t] \not \in {\mathbf{{O}}}[t]\), and (iii) \(\mathbf{x}[T] \in G\).

For the rest of the paper, we will assume that each of the sets in \(\{\mathbf{{O}}[t]\}_{t\in {\mathbb N}}\), \(G\) and \(U\) are closed polytopes. Moreover, we assume that the pair (AB) is controllable [3].
Fig. 1.

The settings for controller synthesis of a mobile robot with reach-avoid specification.

Example Consider a mobile robot that needs to reach the green area of an apartment starting from the entrance area, while avoiding the gray areas (Fig. 1). The robot’s dynamics is described by a linear model (for example the navigation model from [12]). The obstacle sequence \(\mathbf{{O}}\) here is static, that is, \(\mathbf{{O}}[t] = \mathbf{{O}}[0]\) for all \(t\ge 0\). Both \(\varTheta \) and G are rectangles. Although these sets are depicted in 2D, the dynamics of the robot may involve a higher dimensional state space.

In this example, there is no disturbance, but a similar problem can be formulated for an drone flying outdoors, in which case, the disturbance input would model the effect of wind. Time-varying obstacle sets are useful for modeling safety requirements of multi-robot systems.

3 Synthesis Algorithm

3.1 Overview

The controller synthesis problem requires one to find a state feedback controller that ensures that the trajectory starting from any initial state in \(\varTheta \) will meet the reach-avoid specification. Since the set of initial states \(\varTheta \) will typically be an infinite set, this requires the synthesized feedback controller g to have an effective representation. Thus, an “enumerative” representation, where a (separate) open-loop controller is constructed for each initial state, is not feasible — by an open-loop controller for initial state \(x_0 \in \varTheta \), we mean a control sequence \(\mathbf{u}\) such that the corresponding execution \(\mathbf{x}\) with \(\mathbf{x}[0] = x_0\) and 0 disturbance satisfies the reach-avoid constraints. We, therefore, need a useful template that will serve as the representation for the feedback controller.

In control theory, one natural controller design paradigm is to first find a reference execution \(\mathbf{x}_\textsf {ref}\) which uses an open-loop controller, then add a tracking controller which tries to force other executions \(\mathbf{x}\) starting from different initial states \(\mathbf{x}[0]\) to get close to \(\mathbf{x}_\textsf {ref}\) by minimizing the distance between \(\mathbf{x}_{\textsf {ref}}\) and \(\mathbf{x}\). This form of controller combining open-loop control with tracking control is also proposed in [32] for reach-avoid specifications. The resulting trajectory under a combination of tracking controller plus reference trajectory can be described by the following system of equations.
$$\begin{aligned} \begin{array}{l} \mathbf{u}[t] = \mathbf{u}_{\textsf {ref}}[t] + K(\mathbf{x}[t] - \mathbf{x}_{\textsf {ref}}[t]), \text{ with } \\ \mathbf{x}_{\textsf {ref}}[t+1] = A \mathbf{x}_{\textsf {ref}}[t] + B \mathbf{u}_{\textsf {ref}}[t] \end{array} \end{aligned}$$
(3)
The tracking controller is given by the matrix K that determines the additive component of the input based on the difference between the current state and the reference trajectory. Once \(\mathbf{x}_{\textsf {ref}}[0]\) and the open-loop control sequence \(\mathbf{u}_\textsf {ref}\) is fixed, the value of \(\mathbf{x}_\textsf {ref}[t]\) is determined at each time step \(t \in {\mathbb N}\). Therefore, the controller g is uniquely defined by the tuple \(\langle K, \mathbf{x}_\textsf {ref}[0], \mathbf{u}_\textsf {ref}\rangle \). We could rewrite the linear system in (3) as an augmented system
$$ \left[ \begin{array}{c} \mathbf{x}\\ \mathbf{x}_{\textsf {ref}} \end{array}\right] [t+1] = \left[ \begin{array}{cc} A + B K &{} -BK\\ 0 &{} A \\ \end{array} \right] \left[ \begin{array}{c} \mathbf{x}\\ \mathbf{x}_{\textsf {ref}} \end{array}\right] [t] + \left[ \begin{array}{cc} B &{} 0 \\ 0 &{} B \end{array} \right] \left[ \begin{array}{c} \mathbf{u}_\textsf {ref}\\ \mathbf{u}_\textsf {ref}\\ \end{array} \right] [t], + \left[ \begin{array}{c} \mathbf{d}\\ 0 \end{array} \right] [t]. $$
This can be rewritten as \( \hat{\mathbf{x}}[t+1] = \hat{A} \hat{\mathbf{x}}[t] + \hat{B} \hat{\mathbf{u}}[t] + \hat{\mathbf{d}}[t]. \) The closed-form solution is \(\hat{\mathbf{x}}[t] = \hat{A}^{t} \hat{\mathbf{x}}[0] + \sum _{i=0}^{t-1}\hat{A}^{t-1-i} (\hat{B} \hat{\mathbf{u}}[i] + \hat{\mathbf{d}}[i])\). To synthesize a controller g of this form, therefore, requires finding \(K, \mathbf{x}_\textsf {ref}[0], \mathbf{u}_\textsf {ref}\) such that the closed-form solution meets the reach-avoid specification. This is indeed the approach followed in [32], albeit in the continuous time setting. Observe that in the closed-form solution, \(\hat{A}\), \(\hat{\mathbf{u}}\), and \(\hat{\mathbf{x}}[0]\) all depend on parameters that we need to synthesize. Therefore, solving such constraints involves polynomials whose degrees grow with the time bound. This is very expensive, and unlikely to scale to large dimensions and time bounds.

In this paper, to achieve scalability, we take a slightly different approach than the one where \(K,\mathbf{x}_\textsf {ref}[0]\), and \(\mathbf{u}_\textsf {ref}\) are simultaneously synthesized. We first synthesize a tracking controller K, independent of \(\mathbf{x}_\textsf {ref}[0]\) and \(\mathbf{u}_\textsf {ref}\), using the standard LQR method. Once K is synthesized, we show that, no matter what \(\mathbf{x}_\textsf {ref}[0]\), and \(\mathbf{u}_\textsf {ref}\) are, the state of the system at time t starting from \(x_0\) is guaranteed to be contained within an ellipsoid centered at \(\mathbf{x}_\textsf {ref}[t]\) and of radius that depends only on K, the initial distance between \(x_0\) and \(\mathbf{x}_\textsf {ref}[0]\), time t, and disturbance. Moreover, this radius is only a linear function of the initial distance (Lemma 1). Thus, if we can synthesize an open-loop controller \(\mathbf{u}_\textsf {ref}\) starting from some state \(\mathbf{x}_\textsf {ref}[0]\), such that ellipsoids centered around \(\mathbf{x}_\textsf {ref}\) satisfy the reach-avoid specification, we can conclude that the combined controller will work correctly for all initial states in some ball around the initial state \(\mathbf{x}_\textsf {ref}[0]\). The radius of the ball around \(\mathbf{x}_\textsf {ref}[0]\) for which the controller is guaranteed to work, will depend on the radii of the ellipsoids around \(\mathbf{x}_\textsf {ref}\) that satisfy the reach-avoid specification. This decoupled approach to synthesis is the first key idea in our algorithm.

Following the above discussion, crucial to the success of the decoupled approach is to obtain a tight characterization of the radius of the ellipsoid around \(\mathbf{x}_\textsf {ref}[t]\) that contains the reach set, as a function of the initial distance — too conservative a bound will imply that the combined controller only works for a tiny set of initial states. The ellipsoid’s shape and direction, which is characterized by a coordinate transformation matrix M, also affect the tightness of the over-approximations. We determine the shape and direction of the ellipsoids that give us the tightest over-approximation using an SDP solver (Sect. 3.4).

Synthesizing the tracking controller K, still leaves open the problem of synthesizing an open-loop controller for an initial state \(\mathbf{x}_\textsf {ref}[0]\). A straightforward encoding of the problem of synthesizing a open-loop controller, that works for all initial states in some ball around \(\mathbf{x}_\textsf {ref}[0]\), results in a \(\exists \forall \)-formula in the theory of real arithmetic. Unfortunately solving such formulas does not scale to large dimensional systems using current SMT solvers. The next key idea in our algorithm is to simplify these constraints. By exploiting special properties of polytopes and hyper-rectangles, we reduce the original \(\exists \forall \)-formula into the quantifier-free fragment of linear real arithmetic (QF-LRA) (Sect. 3.5).

Putting it all together, the overall algorithm (Algorithm 1) works as follows. After computing an initial tracking controller K, coordinate transformation M for optimal ellipsoidal approximation of reach-sets, it synthesizes open-loop controllers for different initial states by solving QF-LRA formulas. After each open-loop controller is synthesized, the algorithm identifies the set of initial states for which the combined tracking+open-loop controller is guaranteed to work, and removes this set from \(\varTheta \). In each new iteration, it picks a new initial state not covered by previous combined controllers, and the process terminates when all of \(\varTheta \) is covered. Our algorithm is sound (Theorem 1)—whenever a controller is synthesized, it meets the specifications. Further, for robust systems (defined later in the paper), our algorithm is guaranteed to terminate when the system has a combined controller for all initial states (Theorem 2).

3.2 Synthesizing the Tracking Controller K

Given any open-loop controller \(\mathbf{u}_{\textsf {ref}}\) and the corresponding reference execution \(\mathbf{x}_{\textsf {ref}}\), by replacing in Eq. (1) the controller of Eq. (3) we get:
$$\begin{aligned} \mathbf{x}[t+1] = (A + BK)\mathbf{x}[t] - BK\mathbf{x}_{\textsf {ref}}[t] + B\mathbf{u}_{\textsf {ref}}[t] + \mathbf{d}[t]. \end{aligned}$$
(4)
Subtracting \(\mathbf{x}_{\textsf {ref}}[t+1]\) from both sides, we have that for any execution \(\mathbf{x}\) starting from the initial states \(\mathbf{x}[0]\) and with disturbance \(\mathbf{d}\), the distance between \(\mathbf{x}\) and \(\mathbf{x}_{\textsf {ref}}\) changes with time as:
$$\begin{aligned} \mathbf{x}[t+1] - \mathbf{x}_{\textsf {ref}}[t+1] = (A+BK)(\mathbf{x}[t] - \mathbf{x}_{\textsf {ref}}[t]) + \mathbf{d}[t]. \end{aligned}$$
(5)
With \(A_c \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}A+BK\), \(\mathbf{y}[t] \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\mathbf{x}[t+1] - \mathbf{x}_{\textsf {ref}}[t+1]\), Eq. (5) becomes \(\mathbf{y}[t+1] = A_c \mathbf{y}[t] + d[t]\). We want \(\mathbf{x}[t]\) to be as close to \(\mathbf{x}_{\textsf {ref}}[t]\) as possible, which means K should be designed to make \(|\mathbf{y}[t]|\) converge to 0. Equivalently, K should be designed as a linear feedback controller such that \(A_c\) is stable1. Such a matrix K can be computed using classical control theoretic methods. In this work, we compute K as a linear (stable) feedback controller using LQR as stated in the following proposition.

Proposition 1

(LQR). For linear system \(\mathcal{A}\) with (AB) to be controllable and 0 disturbance, fix any \(Q, R \succ 0\) and let \(J \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\mathbf{x}^\intercal [T] Q\mathbf{x}[T] + \sum _{i=0}^{T-1}(\mathbf{x}^\intercal [i] Q \mathbf{x}[i] + \mathbf{u}^\intercal [i] R \mathbf{u}[i])\) be the corresponding quadratic cost. Let X be the unique positive definite solution to the discrete-time Algebraic Riccati Equation (ARE): \( A^{\intercal } X A - X - A^{\intercal } X B(B^{\intercal } X B + R)^{-1}B^{\intercal }XA + Q = 0, \) and \(K \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}-(B^{\intercal } X B + R)^{-1} B^{\intercal } X A\). Then \(A+BK\) is stable, and the corresponding feedback input minimizes J.

Methods for choosing Q and R are outside the scope of this paper. We fix Q and R to be identity matrices for most examples. Roughly, for a given R, scaling up Q results in a K that makes an execution \(\mathbf{x}\) converge faster to the reference execution \(\mathbf{x}_\textsf {ref}\).

3.3 Reachset Over-Approximation with Tracking Controller

We present a method for over-approximating the reachable states of the system for a given tracking controller K (computed as in Proposition 1) and an open-loop controller \(\mathbf{u}_{\textsf {ref}}\) (to be computed in Sect. 3.5).

Lemma 1

Consider any \(K \in {\mathbb R}^{m \times n}\), any initial set \(S \subseteq \mathcal {E}_{r_0}{(\mathbf{x}_{\textsf {ref}}[0], M )}\) and disturbance \(D\subseteq \mathcal {E}_{\delta }(0, M )\), where \(r_0, \delta \ge 0\) and \(M \in {\mathbb R}^{n \times n}\) is invertible.

For any open-loop controller \(\mathbf{u}_{\textsf {ref}}\) and the corresponding reference execution \(\mathbf{x}_\textsf {ref}\),
$$\begin{aligned} \textsf {Reach}_{}(S, t) \subseteq \mathcal {E}_{r_t}( \mathbf{x}_{\textsf {ref}}[t], M), \forall \ t \le T, \end{aligned}$$
(6)
where \(r_t = \alpha ^\frac{t}{2} r_0 + \sum _{i=0}^{t-1}\alpha ^\frac{i}{2} \delta \), and \(\alpha \ge 0\) is such that \( (A + BK)^{\intercal } M^{\intercal } M (A + BK) \preceq \alpha M^{\intercal } M\).

Lemma 1 can be proved using the triangular inequality for the norm of Eq. (5). From Lemma 1, it follows that given a open-loop controller \(\mathbf{u}_\textsf {ref}\) and the corresponding reference trajectory \(\mathbf{x}_{\textsf {ref}}\), the reachable states from \(S \subseteq \mathcal {E}_{r_0}{(\mathbf{x}_{\textsf {ref}}[0], M )}\) at time t can be over-approximated by an ellipsoid centered at \(\mathbf{x}_{\textsf {ref}}[t]\) with size \(r_t \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\alpha ^\frac{t}{2} r_0 + \sum _{i=0}^{t-1}\alpha ^\frac{i}{2} \delta \). Here M is any invertible matrix that defines the shape of the ellipsoid and it influences the value of \(\alpha \). As the over-approximation (\(r_t\)) grows exponentially with Open image in new window , it makes sense to choose M in a way that makes \(\alpha \) small. In next section, we discuss how M and \(\alpha \) are chosen to achieve this.

3.4 Shaping Ellipsoids for Tight Over-Approximating Hyper-rectangles

The choice of M and the resulting \(\alpha \) may seem like a minor detail, but a bad choice here can doom the rest of the algorithm to be impractical. For example, if we fix M to be the identity matrix I, the resulting value of \(\alpha \) may give over-approximations that are too conservative. Even if the actual executions are convergent to \(\mathbf{x}_{\textsf {ref}}\) the resulting over-approximation can exponentially blow up.

We find the smallest exponential convergence/divergence rate (\(\alpha \)) by solving for P in the following semi-definite program (SDP):
$$\begin{aligned} \begin{array}{cc} \min \limits _{P \succ 0, \alpha \in \mathbb {R}} &{} \alpha \\ \hbox {s.t} &{} (A + BK)^{\intercal } P (A + BK) \preceq \alpha P. \\ \end{array} \end{aligned}$$
(7)
This gives M as the unique matrix such that \(P = M^T M\).
In the rest of the paper, the reachset over-approximations will be represented by hyper-rectangles to allow us to efficiently use the existing SMT solvers. That is, the ellipsoids given by Lemma 1 have to be bounded by hyper-rectangles. For any coordinate transformation matrix M, the ellipsoid with unit size \(\mathcal {E}_{1}(0, M) \subseteq \mathcal {\mathcal{R}}_v(0),\) with \(v(i) = \min \limits _{x \in \mathcal {E}_{1}(0, M)} x(i)\). This v(i) is also computed by solving an SDP. Similarly, \(\mathcal {E}_{r}(0, M) \subseteq \mathcal {\mathcal{R}}_{rv}(0)\). Therefore, from Lemma 1, it follows that \(\textsf {Reach}_{}(S,t) \subseteq \mathcal {\mathcal{R}}_{r_t v}( \mathbf{x}_{\textsf {ref}}[t]) \) with \( r_t = \alpha ^\frac{t}{2} r_0 + \sum _{i=0}^{t-1}\alpha ^\frac{i}{2} \delta \) and v is the size vector of the rectangle bounding \(\mathcal {E}_{1}(0, M)\). These optimization problems for computing \(M, \alpha ,\) and v have to be solved once per synthesis problem.
Fig. 2.

Robot’s position with the synthesized controllers using Algorithm 1.

Example Continuing the previous example. Suppose robot is asked to reach the target set in 20 steps. Figure 2 shows the projection of the reachset on the robot’s position with synthesized controller. The curves are the references executions \(\mathbf{x}_\textsf {ref}\) from 2 initials cover and the rectangles are reachset over-approximations such that every execution of the system starting from each initial cover is guaranteed to be inside the rectangles at each time step.

3.5 Synthesis of Open-Loop Controller

In this section, we will discuss the synthesis of the open-loop controller \(\mathbf{u}_{\textsf {ref}}\) in \(\langle K, \mathbf{x}_\textsf {ref}[0], \mathbf{u}_\textsf {ref}\rangle \). From the previous section, we know that given an initial set S, a tracking controller K, and an open-loop controller \(\mathbf{u}_\textsf {ref}\), the reachable set (under any disturbance) at time t is over-approximated by \(\mathcal{R}_{ r_tv}(\mathbf{x}_\textsf {ref}[t])\). Thus, once we fix K and \(\mathbf{x}_\textsf {ref}[0]\), the problem of synthesizing a controller reduces to the problem of synthesizing an appropriate \(\mathbf{u}_\textsf {ref}\) such that the reachset over-approximations meet the reach-avoid specification. Indeed, for the rest of the presentation, we will assume a fixed K.

For synthesizing \(\mathbf{u}_\textsf {ref}\), we would like to formalize the problem in terms of constraints that will allow us to use SMT solvers. In the following, we describe the details of how this problem can be formalized as a quantifier-free first order formula over the theory of reals. We will then lay out specific assumptions and/or simplifications required to reduce the problem to QF-LRA theory, which is implemented efficiently in existing state-of-the-art SMT solvers. Most SMT solvers also provide the functionality of explicit model generation, and the concrete controller values can be read-off from the models generated when the constraints are satisfiable.

Constraints for Synthesizing \(\mathbf{u}_\textsf {ref}\). Let us fix an initial state \(x_0\) and a radius r, defining a set of initial states \(S = \mathcal{B}_r(x_0)\). The \(\mathbf{u}_{\textsf {ref}}\) synthesis problem can be stated as finding satisfying solutions for the formula \(\phi _\textsf {synth}(x_0, r)\).
$$\begin{aligned} { \begin{array}{rcl} \phi _\textsf {synth}(x_0, r) &{} \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}&{} \exists \mathbf{u}_\textsf {ref}[0], \mathbf{u}_\textsf {ref}[1], \ldots \mathbf{u}_\textsf {ref}[T{-}1], \\ &{} &{} \exists \mathbf{x}_\textsf {ref}[0], \mathbf{x}_\textsf {ref}[1], \ldots \mathbf{x}_\textsf {ref}[T], \\ &{} &{} \phi _\textsf {control}(\mathbf{u}_\textsf {ref}) \wedge \phi _\textsf {execution}(\mathbf{u}_\textsf {ref}, \mathbf{x}_\textsf {ref}, x_0) \\ &{} &{} \wedge \phi _\textsf {avoid}(x_0, r, \mathbf{u}_\textsf {ref}, \mathbf{x}_\textsf {ref}) \wedge \phi _\textsf {reach}(x_0, r, \mathbf{u}_\textsf {ref}, \mathbf{x}_\textsf {ref}) \end{array}} \end{aligned}$$
(8)
where \(\phi _\textsf {control}\) constrains the space of inputs, \(\phi _\textsf {execution}\) states that the sequence \(\mathbf{x}_\textsf {ref}\) is a reference execution following Eq. (3), \(\phi _\textsf {avoid}\) specifies the safety constraint, \(\phi _\textsf {reach}\) specifies that the system reaches \(G\):
$$\begin{aligned} { \begin{array}{rcl} \phi _\textsf {control}(\mathbf{u}_\textsf {ref}) &{} \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}&{} \bigwedge \limits _{t=0}^{T-1} \mathbf{u}_\textsf {ref}[t] \oplus \big (K\otimes \mathcal {\mathcal{R}}_{r_tv}(0)\big ) \subseteq U\\ \phi _\textsf {execution}(\mathbf{u}_\textsf {ref}, \mathbf{x}_\textsf {ref}, x_0) &{} \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}&{} (\mathbf{x}_\textsf {ref}[0] = x_0) \wedge \bigwedge \limits _{t=0}^{T-1} (\mathbf{x}_\textsf {ref}[t+1] = A\mathbf{x}_\textsf {ref}[t] + B\mathbf{u}_\textsf {ref}[t]) \\ \phi _\textsf {avoid}(x_0, r, \mathbf{u}_\textsf {ref}, \mathbf{x}_\textsf {ref}) &{}\mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}&{} \bigwedge \limits _{t=0}^T \mathcal {\mathcal{R}}_{r_tv}(\mathbf{x}_\textsf {ref}[t]) \cap \mathbf{{O}}[t] = \varnothing \\ \phi _\textsf {reach}(x_0, r, \mathbf{u}_\textsf {ref}, \mathbf{x}_\textsf {ref}) &{}\mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}&{} \mathcal {\mathcal{R}}_{r_Tv}(\mathbf{x}_\textsf {ref}[T]) \subseteq G. \end{array}} \end{aligned}$$
(9)
As discussed in Sect. 3.2, the vector v and the constants \(r_0, \ldots , r_T\) are precomputed using the radius r of the initial ball.

We make a few remarks about this formulation. First, each of the formulas \(\phi _\textsf {control}, \phi _\textsf {avoid}\) and \(\phi _\textsf {reach}\) represent sufficient conditions to check for the existence of \(\mathbf{u}_{\textsf {ref}}\). Second, the constraints stated above belong to the (decidable) theory of reals. However, \(\phi _\textsf {control}, \phi _\textsf {avoid}\) and \(\phi _\textsf {reach}\), and thus \(\phi _\textsf {synth}\), are not quantifier free as they use subset and disjointness checks. This is because for sets ST expressed as predicates \(\varphi _S(\cdot )\) and \(\varphi _T(\cdot )\), \(S\cap T =\varnothing \) corresponds to the formula \(\forall x \cdot \lnot (\varphi _S(x) \wedge \varphi _T(x))\) and \(S \subseteq T\) (or equivalently \(S\cap T^c = \varnothing \)) corresponds to the formula \(\forall x \cdot \varphi _S(x) \implies \varphi _T(x)\).

Reduction to QF-LRA. Since the sets \(G\) and \(U\) are bounded polytopes, \(G^c\) and \(U^c\) can be expressed as finite unions of (possibly unbounded) polytopes. Thus, the subset predicates \(\mathbf{u}_\textsf {ref}[t] \oplus \big (K\otimes \mathcal {\mathcal{R}}_{r_tv}(0)\big ) \subseteq U\) in \(\phi _\textsf {control}\) and \(\mathcal {\mathcal{R}}_{r_tv}(\mathbf{x}_\textsf {ref}[t]) \subseteq G\) in \(\phi _\textsf {reach}\) can be expressed as a disjunction over finitely many predicates, each expressing the disjointness of two polytopes.

The central idea behind eliminating the universal quantification in the disjointness predicates in \(\phi _\textsf {avoid}\) or in the inferred disjointness predicates in \(\phi _\textsf {reach}\) and \(\phi _\textsf {control}\), is to find a separating hyperplane that witnesses the disjointness of two polytopes. Let \(P_1 = \{x \ | \ A_1x\le b_1\}\) and \(P_2 = \{x \ | \ A_2x\le b_2\}\) be two polytopes such that \(P_1\) is closed and bounded. Then, if there is an i for which each vertex v of \(P_1\) satisfies \(A_2^{(i)}v > b_2(i)\), we must have that \(P_1 \cap P_2 = \varnothing \), where \(A_2^{(i)}\) is the \(i^{\text {th}}\) row vector of the matrix \(A_2\). That is, such a check is sufficient to ensure disjointness. Thus, in the formula \(\phi _\textsf {avoid}\), in order to check if \(\mathcal {\mathcal{R}}_{r_tv}(\mathbf{x}_\textsf {ref}[t])\) does not intersect with \(\mathbf{{O}}[t]\), we check if there is a face of the polytope \(\mathbf{{O}}[t]\) such that all the vertices of \(\mathcal {\mathcal{R}}_{r_tv}(\mathbf{x}_\textsf {ref}[t])\) lie on the other side of the face. The same holds for each of the inferred predicates in \(\phi _\textsf {reach}\) and \(\phi _\textsf {control}\). Eliminating quantifiers is essential to scale our analysis to large high dimensional systems.

Further, when the set \(G\) has a hyper-rectangle representation, the containment check \(\mathcal {\mathcal{R}}_{r_tv}(\mathbf{x}_\textsf {ref}[T]) \subseteq G\) can directly be encoded as the conjunction of O(n) linear inequalities, stating that for each dimension i, the lower and the upper bounds of \(\mathcal {\mathcal{R}}_{r_tv}(\mathbf{x}_\textsf {ref}[t])\) in the \(i^{\text {th}}\) dimension, satisfy \(l'_i \le l_i \le u_i \le u'_i\), where \(l'_i\) and \(r'_i\) represent the bounds for \(G\) in the \(i^{\text {th}}\) dimension. Similarly, when \(\mathbf{{O}}[t]\) has a rectangle representation, we can formulate the emptiness constraint \(\mathcal {\mathcal{R}}_{r_tv}(\mathbf{x}_\textsf {ref}[t]) \cap \mathbf{{O}}[t] = \varnothing \) as \(\bigvee \limits _{i=1}^n (u_i < l'_i\vee l_i > u'_i)\), where \(l_i\) and \(u_i\) (resp. \(l'_i\) and \(u'_i\)) are the lower and upper bounds of \(\mathcal {\mathcal{R}}_{r_tv}(\mathbf{x}_\textsf {ref}[t])\) (resp. \(\mathbf{{O}}[t]\)) in the \(i^{\text {th}}\) dimension. Since such simplifications can exponentially reduce the number of constraints generated, they play a crucial for the scalability.

The constraints for checking emptiness and disjointness, as discussed above, only give rise to linear constraints, do not have the \(\forall \) quantification over states, and is a sound transformation of \(\phi _\textsf {synth}\) into QF-LRA. In Sect. 3.6 we will see that the reach set over-approximation can be made arbitrarily small when the disturbance is 0 by arbitrarily shrinking the size of the initial cover. Thus, these checks will also turn out to be sufficient to ensure that if there exists a controller, \(\phi _\textsf {synth}\) is satisfiable.

Lemma 2

Let \(v \in {\mathbb R}^n\) and \(r_0, \ldots , r_T \in {\mathbb R}\) be such that for any execution \(\mathbf{x}_\textsf {ref}\) starting at \(x_0\), we have \(\forall t\le T \cdot \textsf {Reach}_{}(\mathcal{B}_r(x_0), t) \subseteq \mathcal {\mathcal{R}}_{r_tv}(\mathbf{x}_\textsf {ref}[t])\). If the formula \(\phi _\textsf {synth}(x_0, r)\) is satisfiable, then there is a control sequence \(\mathbf{u}_\textsf {ref}\) such that for every \(x \in \mathcal{B}_r(x_0)\) and for every \(\mathbf{d}\in \mathcal{D}^T\), the unique execution \(\mathbf{x}\) defined by the controller \(\langle K, x_0, \mathbf{u}_\textsf {ref} \rangle \) and \(\mathbf{d}\), starting at x satisfies \(\mathbf{x}[T] \in G\wedge \forall t\le T \cdot \mathbf{x}[t] \not \in \mathbf{{O}}[t]\).

We remark that a possible alternative for eliminating the \(\forall \) quantifier is the use of Farkas’ Lemma, but this gives rise to nonlinear constraints2. Indeed, in our experimental evaluation, we observed the downside of resorting to Farkas’ Lemma in this problem.

3.6 Synthesis Algorithm Putting It All Together

The presentation in Sect. 3.5 describes how to formalize constraints to generate a control sequence that works for a subset of the initial set \(\varTheta \). The overall synthesis procedure (Algorithm 1), first computes a tracking controller K, then generates open-loop control sequences and reference executions in order to cover the entire set \(\varTheta \).

The procedure \(\textsc {bloatParams}\), computes a tracking controller K, a vector v and real valued parameters \(\{ c_1[t]\}_{t\le T}\), \(\{c_2[t]\}_{t\le T}\), for the system \(\mathcal{A}\) and time bound T with QR for the LQR method. Given any reference execution \(\mathbf{x}_\textsf {ref}\) and an initial set \(\mathcal{B}_{r}(\mathbf{x}_\textsf {ref}[0])\), the parameters computed by \(\textsc {bloatParams}\) can be used to over-approximate \(\textsf {Reach}_{}(\mathcal{B}_{r}(\mathbf{x}_\textsf {ref}[0]), t)\) with the rectangle \(\mathcal {\mathcal{R}}_{v'}(\mathbf{x}_\textsf {ref}[t])\), where \(v' = (c_1[t] r + c_2[t])v\). The computation of these parameters proceeds as follows. Matrix K is determined using LQR (Proposition 1). Now we use Equation (7) to compute the matrix M and the rate of convergence \(\alpha \). Vector v is then computed such that \(\mathcal {E}_{1}(0, M)\) is bounded by \(\mathcal {\mathcal{R}}_v(0)\). Let \(r_\textsf {unit}= \max _{x \in \mathcal{B}_{1}(0)} \Vert x\Vert _M\) and \(\delta = \max _{d \in \mathcal{D}} \Vert d\Vert _M\). Then we have, \(\mathcal{B}_r(x_0) \subseteq \mathcal {E}_{r{\cdot }r_\textsf {unit}}(x_0, M)\) for any \(x_0\). The constants \(c_1[0], \ldots c_1[T]\), \(c_2[0], \ldots c_2[T]\) are computed as \(c_1[t] = \alpha ^\frac{t}{2} r_\textsf {unit}\) and \(c_2[t] = \sum _{i=0}^{t-1}\alpha ^\frac{i}{2} \delta \); Sects. 3.23.4 establish the correctness guarantees of these parameters. Clearly, these computations are independent of any reference executions \(\mathbf{x}_\textsf {ref}\) and control sequences \(\mathbf{u}_\textsf {ref}\).

The procedure \(\textsc {getConstraints}\) constructs the logical formula \(\psi _\textsf {synth}\) below such that whenever \(\psi _\textsf {synth}\) holds, we can find an initial radius r, and center \(x_0\) in the set \(\varTheta \setminus \texttt {cover}\) and a control sequence \(\mathbf{u}_\textsf {ref}\) such that any controlled execution starting from \(\mathcal{B}_r(x_0)\) satisfies the reach-avoid requirements.
$$\begin{aligned} \psi _\textsf {synth}\mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\exists x_0 \, \exists r\, \cdot \Big ( x_0 \in \varTheta \wedge x_0 \not \in \texttt {cover}\wedge r > r^* \wedge \phi _\textsf {synth}(x_0, r) \Big ) \end{aligned}$$
(10)
Recall that the constants \(r_0, \ldots , r_T\) used in \(\phi _\textsf {synth}\) are affine functions of r and thus \(\psi _\textsf {synth}\) falls in the QF-LRA fragment.

Line 8 checks for the satisfiability of \(\psi _\textsf {synth}\). If satisfiable, we extract the model generated to get the radius of the initial ball, the control sequence \(\mathbf{u}_\textsf {ref}\) and the reference execution \(\mathbf{x}_\textsf {ref}\) in Line 9. The generated controller \(\langle K, \mathbf{x}_\textsf {ref}[0], \mathbf{u}_\textsf {ref} \rangle \) is guaranteed to work for the ball \(\mathcal{B}_{r}(\mathbf{x}_\textsf {ref}[0])\), which can be marked covered by adding it to the set \(\texttt {cover}\). In order to keep all the constraints linear, one can further underapproximate \(\mathcal{B}_{r}(\mathbf{x}_\textsf {ref}[0])\) with the rectangle \(\mathcal{R}_{w}(\mathbf{x}_\textsf {ref}[0])\), where \(w(i) = r/\sqrt{n}\) for each dimension \(i \le n\). If \(\psi _\textsf {synth}\) is unsatisfiable, then we reduce the minimum radius \(r^*\) (Line 13) and continue to look for controllers, until we find that \(\varTheta \subseteq \texttt {cover}\).

The set \(\texttt {controllers}\) is the set of pairs \((\langle K, x_0, \mathbf{u}_\textsf {ref} \rangle , S)\), such that the controller \(\langle K, x_0, \mathbf{u}_\textsf {ref} \rangle \) drives the set S to meet the desired specification. Each time a new controller is found, it is added to the set \(\texttt {controllers}\) together with the initial set for which it works (Line 11). The following theorem asserts the soundness of Algorithm 1, and it follows from Lemmas 1 and 2.

Theorem 1

If Algorithm 1 terminates, then the synthesized controller is correct. That is, (a) for each \(x \in \varTheta \), there is a \((\langle K, x_0, \mathbf{u}_\textsf {ref} \rangle , S) \in \texttt {controllers}\), such that \(x \in S\), and (b) for each \((\langle K, x_0, \mathbf{u}_\textsf {ref} \rangle , S) \in \texttt {controllers}\), the unique controller \(\langle K, x_0, \mathbf{u}_\textsf {ref} \rangle \) is such that for every \(x \in S\) and for every \(\mathbf{d}\in D^T\), the unique execution defined by \(\langle K, x_0, \mathbf{u}_\textsf {ref} \rangle \) and \(\mathbf{d}\), starting at x, satisfies the reach-avoid specification.

Algorithm 1 ensures that, upon termination, every \(x \in \varTheta \) is covered, i.e., one can construct a combined controller that drives x to \(G\) while avoiding \(\mathbf{{O}}\). However it may find multiple controllers for a point \(x \in \varTheta \). This non-determinism can be easily resolved by picking any controller assigned for x.

Below, we show that, under certain robustness assumptions on the system \(\mathcal{A}\), \(G\) and the sets \(\mathbf{{O}}\), and in the absence of disturbance Algorithm 1 terminates.

Robustly Controllable Systems. A system \(\mathcal{A}= \langle A, B, \varTheta , U, D \rangle \) is said to be \(\varepsilon \)-robustly controllable (\(\varepsilon > 0\)) with respect to the reach-avoid specification (\(\mathbf{{O}}\), \(G\)) and matrix K, if (a) \(D= \{0\}\), and (b) for every initial state \(\theta \in \varTheta \) and for every open loop-controller \(\mathbf{u}_\textsf {ref}\in U^T\) such that the unique execution starting from \(\theta \) using the open-loop controller \(\mathbf{u}_\textsf {ref}\) satisfies the reach-avoid specification, then with the controller \(\langle K, \theta , \mathbf{u}_\textsf {ref}\rangle \) defined as in Equation (3), \(\forall t \le T, \textsf {Reach}_{}(\mathcal{B}_\varepsilon (\theta ), t) \cap \mathbf{{O}}[t] = \varnothing \) and \(\textsf {Reach}_{}(\mathcal{B}_\varepsilon (\theta ), T) \subseteq G\), i.e., \(\forall x \in \mathcal{B}_\varepsilon (\theta )\), the unique trajectory \(\mathbf{x}\) defined by the controller \(\langle K, \theta , \mathbf{u}_\textsf {ref}\rangle \) starting from x also satisfies the reach avoid specification.

Theorem 2

Let \(\mathcal{A}\) be \(\varepsilon \)-robust with respect to the reach-avoid specification \((\mathbf{{O}}, G)\) and K, for some \(\varepsilon > 0\). If there is a controller for \(\mathcal{A}\) that satisfies the reach-avoid specification, then Algorithm 1 terminates.

When the system is robust, then (in the absence of any disturbance i.e., \(D= \{0\}\)), the sizes \(r_0, r_1, \ldots , r_T\) of the hyper-rectangles that overapproximate reach-sets go arbitrarily close to 0 as the initial cover converges to a single point (as seen in Lemma 1). Therefore, the over-approximations can be made arbitrarily precise as \(r^*\) decreases. Moreover, as \(r^*\) approaches 0, Eq. (9) (with simplifications for QF-LRA), also becomes satisfiable whenever there is a controller. The correctness of Theorem 2 follows from both these observations.

4 RealSyn Implementation and Evaluation

4.1 Implementation

We have implemented our synthesis algorithm in a tool called RealSyn. RealSyn is written in Python. For solving Eq. (10) it can interface with any SMT solver through Python APIs. We present experimental results with Z3 (version 4.5.1) [6], Yices (version 2.5.4) [8], and CVC4 (version 1.5) [4]. RealSyn leverages the incremental solving capabilities of these solvers as follows: The constraints \(\psi _\textsf {synth}\) generated (line 8 in Algorithm 1) can be expressed as \(\exists x_0,\exists r \cdot \psi _1 \wedge \psi _2\), where \(\psi _1 \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}\phi _\textsf {synth}(x_0, r) \) and \(\psi _2 \mathrel {{\mathop {=}\limits ^{\scriptscriptstyle \Delta }}}x_0 \in \varTheta \wedge x_0 \not \in \texttt {cover}\wedge r > r^* \). Since the bulk of the formula \(\phi _\textsf {synth}(x_0, r)\) is in \(\psi _1\) and it does not change across iterations, we can generate this formula only once, and push it on the context stack of the solvers. The formula \(\psi _2\) is different across iterations, and can be pushed and popped out of the stack as required. This minimizes the time taken for generation of constraints.

4.2 Evaluation

We use 24 benchmark examples3 to evaluate the performance of RealSyn with three different solvers on a standard laptop with Intel® \(\text {Core}^\mathrm{TM}\) i7 processor, 16 GB RAM, running Ubuntu 16.04. The results are reported in Table 1. The results are encouraging and demonstrate the effectiveness of using our approach and the feasibility of scalable controller synthesis for high dimensional systems and complex reach-avoid specifications.
Table 1.

Controller synthesis using RealSyn and different SMT solvers. An explanation for the \(^*\) marked entries can be found in Sect. 4.

Model

n

m

Z3

CVC4

Yices

\(\# \mathsf {iter}\)

\(\mathsf {time}\)(s)

\(\# \mathsf {iter}\)

\(\mathsf {time}\)(s)

\(\# \mathsf {iter}\)

\(\mathsf {time}\)(s)

1

1-robot

2

1

9

0.21

1

0.06

7

0.06

2

2-robot

4

2

164

12.62

11

0.31

183

2.26

3

running-example

4

2

N/A

T/O

N/A

T/O

1

319.97

4

1-car dynamic avoid

4

2

9

53.17

1

96.43

12

8.49

5

1-car navigation

4

2

18

7.49

1

3.05

17

6.73

6

2-car navigation

8

4

1

60.14

1

2668.2

1

4.07

7

3-car navigation

12

6

1

733.42

1

481.88

1

741.73

8

4-car platoon

8

4

1

0.37

1

0.21

1

0.15

9

8-car platoon

16

8

1

23.02

1

1.44

1

0.62

10

10-car platoon

20

10

1

459.36

1

20.93

1

7.74

11

Example

3

1

82

2.32

18

0.10

67

0.43

12

Cruise

1

1

1

0.06

1

0.03

1

0.02

13

Motor

2

1

1

0.10

1

0.06

1

0.03

14

Helicopter

3

1

81

2.31

13

0.08

70

0.38

15

Magnetic suspension

2

1

39

0.47

2

0.05

39

0.08

16

Pendulum

2

1

30

0.32

8

0.05

42

0.07

17

Satellite

2

1

40

0.46

5

0.05

32

0.06

18

Suspension

4

1

1

0.17

1

0.11

1

0.09

19

Tape

3

1

1

0.12

1

0.07

1

0.07

20

Inverted pendulum

2

1

39

0.49

2

0.05

39

0.09

21

Magnetic pointer

3

1

44

1.12

12

0.08

134

0.83

22

Helicopter

28

6

N/A (1\(^*\))

T/O (650\(^*\))

1

651.21

N/A

T/O

23

Building

48

1

1 (1\(^*\))

1936.03 (240\(^*\))

N/A

T/O

1

552.48

24

Pde

84

1

N/A (1\(^*\))

T/O (1800\(^*\))

1

8.48

1

8.87

Comparison With Other Tools. We considered other controller synthesis tools for possible comparison with RealSyn. In summary, CoSyMa [27], Pessoa [30], and SCOTS [31] do not explicitly support discrete-time sytems. LTLMop [22, 37] is designed to analyze robotic systems in the (2-dimensional) Euclidean plane and thus not suitable for most of our examples. TuLiP [13, 39] comes closest to addressing the same class of problems. TuLip relies on discretization of the state space and a receding horizon approach for synthesizing controllers for more general GR(1) specifications. However, we found TuLip succumbs to the state space explosion problem when discretizing the state space, and it did not work on most of our examples. For instance, TuLiP was unable to synthesize a controller for the 2-dimensional system ‘1-robot’ (Table 1), and returned unrealizable. On the benchmark ‘2-robot’ (\(n=4\)), TuLip did not return any answer within 1 h. We checked these findings with the developers and they concurred that it is typical for TuLip to take hours even for 4-dimensional systems.

Benchmarks. Our benchmarks and their SMT encodings, could be of independent interest to the verification and SMT-community. Examples 1–10 are vehicle motion planning examples we have designed with reach-avoid specifications. Benchmarks 1–2 model robots moving on the Euclidean plane, where each robot is a 2-dimensional system and admits a 1-dimensional input. Starting from some initial region on the plane, the robots are required to reach the common goal area within the given time steps, while avoiding certain obstacles. For ‘2-robot’, the robots are also required to maintain a minimum separation. Benchmarks 3–7 are discrete vehicular models adopted from [12]. Each vehicle is a 4-dimensional system with 2-dimensional input. Benchmark 3 is the system as our running example. Benchmark 4 describes one ego vehicle running on a two-lane road, trying to overtake a vehicle in front of it. The second vehicle serves as the obstacle. Benchmarks 5–7 are similar to Benchmark 2 where the vehicles are required to reach a common goal area while avoiding collision with the obstacles and with each other (inspired by a merge). The velocities and accelerations of the vehicles are also constrained in each of these benchmarks.

Benchmarks 8–10 model multiple vehicles trying to form a platoon by maintaining the safe relative distance between consecutive vehicles. The models are adopted (and discretized) from [32]. Each vehicle is a 2-dimensional system with 1-dimensional input. For the 4-car platoon model, the running times reported in Table 1 are much smaller than the time (5 min) reported in [32]. This observation aligns with our analysis in Sect. 3.1.

Benchmarks 11–21 are from [2]. The specification here is that the reach set has to be within a safe rectangle (that is, \(G= true \)). In [2] each model is discretized using 8 different time steps and here we randomly pick one for each model. In general, the running time of RealSyn is less than those reported in [2] (their reported machine had better configuration). On the other hand, the synthesized controller from [2] considers quantization errors, while our approach does not provide any guarantee for that.

Benchmarks 22–24 are a set of high dimensional examples adopted and discretized from [36]. Similar to previous ones, the only specification is that the reach sets starting from an initial state with the controller should be contained within a safe rectangle.

Synthesis Performance. In Table 1, columns ‘n’ and ‘m’ stand for the dimensions of the state space and input space. For each background solver, ‘\(\# \mathsf {iter}\)’ is the number of iterations Algorithm 1 required to synthesize a controller, and ‘\(\mathsf {time}\)’ is the respective running times. We specify a time limit of 1 h and report T/O (timeout) for benchmarks that do not finish within this limit. All benchmarks are synthesized for a specification with 10–20 steps.

In general, for low-dimensional systems (for example, in Benchmarks 11–21), each of the solvers finish quickly (in less than 1 s), with CVC4 and Yices outperforming Z3 on most benchmarks. The Yices solver is faster than the other two on most examples. Z3 was the slowest on most, except a few (e.g., Benchmark 3, 6) where CVC4 was much slower. The running time, in general, increases with the increase of the dimensionality but this relationship is far from simple. For example, the 84-dimensional Benchmark 24 was synthesized in less than 9 s by both CVC4 and Yices, possibly because the safety specification is rather simple for this problem.

The three solvers use different techniques for solving QF-LRA formulae with support for incremental solving. The default tactic in Z3 is such that it spends a large chunk of time when a constraint is pushed to the solver stack. In fact, for Benchmark 24, while the other two solvers finish within 9 s, Z3 did not finish pushing the constraints in the solver stack. When we disable incremental solving in Z3, the Benchmarks 22, 23 and 24 finish in about 650, 240 and 1800 s respectively (marked with \(^*\)). The number of iterations widely vary across solvers, with CVC4 usually finishing in the fewest number of iterations. Despite the larger number of satisfiability queries, Yices manages to finish close to CVC4 on most examples.

5 Conclusion

We proposed a novel technique for synthesizing controllers for systems with discrete time linear dynamics, operating under bounded disturbances,and for reach-avoid specifications. Our approach relies on generating controllers that combine an open loop-controller with a tracking controller, thereby allowing a decoupled approach for synthesizing each component independently. Experimental evaluation using our tool RealSyn demonstrates the value of the approach when analyzing systems with complex dynamics and specifications.

There are several avenues for future work. This includes synthesis of combined controllers for nonlinear dynamical and hybrid systems, and for more general temporal logic specifications. Generating witnesses to show the absence of controllers is also an interesting direction.

Footnotes

  1. 1.

    \(A + BK\) has spectral radius \(\rho (A + BK)<1\).

  2. 2.

    Farkas’ Lemma introduces auxiliary variables that get multiplied with existing variables \(\mathbf{x}_\textsf {ref}[0], \ldots , \mathbf{x}_\textsf {ref}[T]\), leading to nonlinear constraints.

  3. 3.

    The examples are available at https://github.com/umangm/realsyn.

References

  1. 1.
    Abate, A., Amin, S., Prandini, M., Lygeros, J., Sastry, S.: Computational approaches to reachability analysis of stochastic hybrid systems. In: Bemporad, A., Bicchi, A., Buttazzo, G. (eds.) HSCC 2007. LNCS, vol. 4416, pp. 4–17. Springer, Heidelberg (2007).  https://doi.org/10.1007/978-3-540-71493-4_4CrossRefMATHGoogle Scholar
  2. 2.
    Abate, A., et al.: Automated formal synthesis of digital controllers for state-space physical plants. In: Majumdar, R., Kunčak, V. (eds.) CAV 2017. LNCS, vol. 10426, pp. 462–482. Springer, Cham (2017).  https://doi.org/10.1007/978-3-319-63387-9_23CrossRefGoogle Scholar
  3. 3.
    Antsaklis, P.J., Michel, A.N.: A Linear Systems Primer, vol. 1. Birkhäuser Boston, Cambridge (2007)MATHGoogle Scholar
  4. 4.
    Barrett, C., et al.: CVC4. In: Gopalakrishnan, G., Qadeer, S. (eds.) CAV 2011. LNCS, vol. 6806, pp. 171–177. Springer, Heidelberg (2011).  https://doi.org/10.1007/978-3-642-22110-1_14CrossRefGoogle Scholar
  5. 5.
    Boyd, S., Vandenberghe, L.: Convex Optimization (2004)Google Scholar
  6. 6.
    de Moura, L., Bjørner, N.: Z3: an efficient SMT solver. In: Ramakrishnan, C.R., Rehof, J. (eds.) TACAS 2008. LNCS, vol. 4963, pp. 337–340. Springer, Heidelberg (2008).  https://doi.org/10.1007/978-3-540-78800-3_24CrossRefGoogle Scholar
  7. 7.
    Ding, J., Tomlin, C.J.: Robust reach-avoid controller synthesis for switched nonlinear systems. In: Proceedings of the 49th IEEE Conference on Decision and Control, CDC 2010, 15–17 December 2010, Atlanta, Georgia, USA, pp. 6481–6486 (2010)Google Scholar
  8. 8.
    Dutertre, B.: Yices 2.2. In: Biere, A., Bloem, R. (eds.) CAV 2014. LNCS, vol. 8559, pp. 737–744. Springer, Cham (2014).  https://doi.org/10.1007/978-3-319-08867-9_49CrossRefGoogle Scholar
  9. 9.
    Esfahani, P.M., Chatterjee, D., Lygeros, J.: The stochastic reach-avoid problem and set characterization for diffusions. Automatica 70, 43–56 (2016)MathSciNetCrossRefGoogle Scholar
  10. 10.
    Fainekos, G.E., Girard, A., Kress-Gazit, H., Pappas, G.J.: Temporal logic motion planning for dynamic robots. Automatica 45(2), 343–352 (2009)MathSciNetCrossRefGoogle Scholar
  11. 11.
    Fainekos, G.E., Kress-Gazit, H., Pappas, G.J.: Hybrid controllers for path planning: a temporal logic approach. In: 2005 44th IEEE Conference on Decision and Control, and 2005 European Control Conference, CDC-ECC 2005, pp. 4885–4890. IEEE (2005)Google Scholar
  12. 12.
    Fehnker, A., Ivančić, F.: Benchmarks for hybrid systems verification. In: Alur, R., Pappas, G.J. (eds.) HSCC 2004. LNCS, vol. 2993, pp. 326–341. Springer, Heidelberg (2004).  https://doi.org/10.1007/978-3-540-24743-2_22CrossRefMATHGoogle Scholar
  13. 13.
    Filippidis, I., Dathathri, S., Livingston, S.C., Ozay, N., Murray, R.M.: Control design for hybrid systems with tulip: the temporal logic planning toolbox. In: 2016 IEEE Conference on Control Applications, CCA 2016, Buenos Aires, Argentina, 19–22 September 2016, pp. 1030–1041 (2016)Google Scholar
  14. 14.
    Fisac, J.F., Chen, M., Tomlin, C.J., Sastry, S.S.: Reach-avoid problems with time-varying dynamics, targets and constraints. In: Proceedings of the 18th International Conference on Hybrid Systems: Computation and Control, HSCC 2015, Seattle, WA, USA, 14–16 April 2015, pp. 11–20 (2015)Google Scholar
  15. 15.
    Girard, A.: Controller synthesis for safety and reachability via approximate bisimulation. Automatica 48(5), 947–953 (2012)MathSciNetCrossRefGoogle Scholar
  16. 16.
    Gol, E.A., Lazar, M., Belta, C.: Language-guided controller synthesis for linear systems. IEEE Trans. Autom. Control 59(5), 1163–1176 (2014)MathSciNetCrossRefGoogle Scholar
  17. 17.
    Hespanha, J.P.: Linear Systems Theory. Princeton University Press, Princeton (2009)MATHGoogle Scholar
  18. 18.
    Huang, Z., Wang, Y., Mitra, S., Dullerud, G.E., Chaudhuri, S.: Controller synthesis with inductive proofs for piecewise linear systems: an SMT-based algorithm. In: 54th IEEE Conference on Decision and Control, CDC 2015, Osaka, Japan, 15–18 December 2015, pp. 7434–7439 (2015)Google Scholar
  19. 19.
    Jha, S., Seshia, S.A., Tiwari, A.: Synthesis of optimal switching logic for hybrid systems. In: Proceedings of the 11th International Conference on Embedded Software, EMSOFT 2011, Part of the Seventh Embedded Systems Week, ESWeek 2011, Taipei, Taiwan, 9–14 October 2011, pp. 107–116 (2011)Google Scholar
  20. 20.
    Kloetzer, M., Belta, C.: A fully automated framework for control of linear systems from temporal logic specifications. IEEE Trans. Autom. Control 53(1), 287–297 (2008)MathSciNetCrossRefGoogle Scholar
  21. 21.
    Koo, T.J., Pappas, G.J., Sastry, S.: Mode switching synthesis for reachability specifications. In: Di Benedetto, M.D., Sangiovanni-Vincentelli, A. (eds.) HSCC 2001. LNCS, vol. 2034, pp. 333–346. Springer, Heidelberg (2001).  https://doi.org/10.1007/3-540-45351-2_28CrossRefGoogle Scholar
  22. 22.
    Kress-Gazit, H., Fainekos, G.E., Pappas, G.J.: Temporal logic based reactive mission and motion planning. IEEE Trans. Robot. 25(6), 1370–1381 (2009)CrossRefGoogle Scholar
  23. 23.
    Kress-Gazit, H., Lahijanian, M., Raman, V.: Synthesis for robots: guarantees and feedback for robot behavior. Ann. Rev. Control Robot. Auton. Syst. 1(1) (2018)Google Scholar
  24. 24.
    Kurzhanskiy, A.A., Varaiya, P.: Ellipsoidal techniques for reachability analysis of discrete-time linear systems. IEEE Trans. Autom. Control 52(1), 26–38 (2007)MathSciNetCrossRefGoogle Scholar
  25. 25.
    Liu, J., Ozay, N., Topcu, U., Murray, R.M.: Synthesis of reactive switching protocols from temporal logic specifications. IEEE Trans. Autom. Control 58(7), 1771–1785 (2013)MathSciNetCrossRefGoogle Scholar
  26. 26.
    Majumdar, R., Mallik, K., Schmuck, A.-K.: Compositional synthesis of finite state abstractions. CoRR, abs/1612.08515 (2016)Google Scholar
  27. 27.
    Mouelhi, S., Girard, A., Gössler, G.: Cosyma: a tool for controller synthesis using multi-scale abstractions. In: Proceedings of The 16th International Conference on Hybrid Systems: Computation and Control, HSCC 2013, pp. 83–88, New York. ACM (2013)Google Scholar
  28. 28.
    Rami, M.A., Tadeo, F.: Controller synthesis for positive linear systems with bounded controls. IEEE Trans. Circuits Syst. 54–II(2), 151–155 (2007)CrossRefGoogle Scholar
  29. 29.
    Ravanbakhsh, H., Sankaranarayanan, S.: Robust controller synthesis of switched systems using counterexample guided framework. In: Proceedings of the 13th International Conference on Embedded Software, EMSOFT 2016, pp. 8:1–8:10, New York. ACM (2016)Google Scholar
  30. 30.
    Roy, P., Tabuada, P., Majumdar, R.: Pessoa 2.0: a controller synthesis tool for cyber-physical systems. In: Proceedings of the 14th International Conference on Hybrid Systems: Computation and Control, HSCC 2011, pp. 315–316, New York. ACM (2011)Google Scholar
  31. 31.
    Rungger, M, Zamani, M.: SCOTS: a tool for the synthesis of symbolic controllers. In: Proceedings of the 19th International Conference on Hybrid Systems: Computation and Control, HSCC 2016, pp. 99–104, New York. ACM (2016)Google Scholar
  32. 32.
    Schürmann, B., Althoff, M.: Optimal control of sets of solutions to formally guarantee constraints of disturbed linear systems. In: 2017 American Control Conference, ACC 2017, Seattle, WA, USA, 24–26 May 2017, pp. 2522–2529 (2017)Google Scholar
  33. 33.
    Tabuada, P.: Verification and Control of Hybrid Systems - A Symbolic Approach. Springer, Heidelberg (2009).  https://doi.org/10.1007/978-1-4419-0224-5CrossRefMATHGoogle Scholar
  34. 34.
    Tabuada, P., Pappas, G.J.: Linear time logic control of discrete-time linear systems. IEEE Trans. Autom. Control 51(12), 1862–1877 (2006)MathSciNetCrossRefGoogle Scholar
  35. 35.
    Taly, A., Gulwani, S., Tiwari, A.: Synthesizing switching logic using constraint solving. STTT 13(6), 519–535 (2011)CrossRefGoogle Scholar
  36. 36.
    Tran, H.D., Nguyen, L.V., Johnson, T.T.: Large-scale linear systems from order-reduction. In: ARCH@CPSWeek 2016, 3rd International Workshop on Applied Verification for Continuous and Hybrid Systems, Vienna, Austria, pp. 60–67 (2016)Google Scholar
  37. 37.
    Wong, K.W., Finucane, C., Kress-Gazit, H.: Provably-correct robot control with LTLMoP, OMPL and ROS. In: 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems, Tokyo, Japan, 3–7 November 2013, p. 2073 (2013)Google Scholar
  38. 38.
    Wongpiromsarn, T., Topcu, U., Murray, R.M.: Receding horizon temporal logic planning. IEEE Trans. Autom. Control 57(11), 2817–2830 (2012)MathSciNetCrossRefGoogle Scholar
  39. 39.
    Wongpiromsarn, T., Topcu, U., Ozay, N., Xu, H., Murray, R.M.: TuLiP: a software toolbox for receding horizon temporal logic planning. In: Proceedings of the 14th International Conference on Hybrid Systems: Computation and Control, HSCC 2011, pp. 313–314, New York. ACM (2011)Google Scholar
  40. 40.
    Yordanov, B., Tumova, J., Cerna, I., Barnat, J., Belta, C.: Temporal logic control of discrete-time piecewise affine systems. IEEE Trans. Autom. Control 57(6), 1491–1504 (2012)MathSciNetCrossRefGoogle Scholar
  41. 41.
    Zhao, H., Zhan, N., Kapur, D.: Synthesizing switching controllers for hybrid systems by generating invariants. In: Liu, Z., Woodcock, J., Zhu, H. (eds.) Theories of Programming and Formal Methods. LNCS, vol. 8051, pp. 354–373. Springer, Heidelberg (2013).  https://doi.org/10.1007/978-3-642-39698-4_22CrossRefGoogle Scholar

Copyright information

© The Author(s) 2018

<SimplePara><Emphasis Type="Bold">Open Access</Emphasis>This chapter is licensed under the terms of the Creative Commons Attribution 4.0 International License(http://creativecommons.org/licenses/by/4.0/), which permits use, sharing, adaptation, distribution and reproduction in any medium or format, as long as you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons license and indicate if changes were made.</SimplePara><SimplePara>The images or other third party material in this chapter are included in the chapter's Creative Commons license, unless indicated otherwise in a credit line to the material. If material is not included in the chapter's Creative Commons license and your intended use is not permitted by statutory regulation or exceeds the permitted use, you will need to obtain permission directly from the copyright holder.</SimplePara>

Authors and Affiliations

  1. 1.University of Illinois at Urbana ChampaignChampaignUSA

Personalised recommendations