Next Article in Journal
Learning Peer Recommendation Based on Weighted Heterogeneous Information Networks on Online Learning Platforms
Previous Article in Journal
A Charge Sensitive Amplifier in a 28 nm CMOS Technology for Pixel Detectors at Future Particle Colliders
Previous Article in Special Issue
Distributed Stochastic Model Predictive Control for a Microscopic Interactive Traffic Model
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Safety-Critical Control for Control Affine Systems under Spatio-Temporal and Input Constraints

1
Chair of Automatic Control Engineering, Technical University of Munich, 80333 Munich, Germany
2
Research Institute of Intelligent Control and Systems, Harbin Institute of Technology, Harbin 150001, China
3
Department of Automation, Univeristy of Science and Technology of China, Hefei 230000, China
*
Author to whom correspondence should be addressed.
Electronics 2023, 12(9), 2053; https://doi.org/10.3390/electronics12092053
Submission received: 17 March 2023 / Revised: 20 April 2023 / Accepted: 21 April 2023 / Published: 29 April 2023

Abstract

:
Safety-critical control is a type of modern control task where potentially conflicting stability, safety, and input constraints coexist. In this paper, the Prescribed-Time Zeroing Control Barrier Function (PT-ZCBF) is introduced, which can be applied as a prescribed-time stability constraint in safety-critical control tasks. Furthermore, we formulate a PT-ZCBF-based Quadratic Program (QP), which is able to mediate the potentially conflicting constraints of safety-critical control. The solution of the newly designed QP, acting as the control input of a safety-critical system, can drive the closed-loop trajectories to converge in a user-defined prescribed time period while observing the safety and input constraints. Finally, we use the Adaptive Cruise Control (ACC) problem as an example of numerical simulation to evaluate the performance of the QP-based method.

Graphical Abstract

1. Introduction

Safety-critical control is one of the most critical tasks in the research field of modern control theory. A safety-critical control problem often consists of spatio-temporal constraints and input constraints that are potentially conflicting [1]. Spatio-temporal constraints can be understood as the combination of spatial and temporal constraints [2]. Spatial constraints require the system states to converge in a surface or a point (stability constraint) while maintaining in a safe set (safety constraint). In addition, temporal constraints require the trajectories of the states to converge within a prescribed time period. Moreover, input constraints, e.g., saturation of actuators, are also unavoidable in reality.
In practice, an effective and efficient method in solving safety-critical control problems is to use Control Barrier Functions (CBFs) to describe spatio-temporal constraints [1]. The Zeroing Control Barrier Function (ZCBF) is a type of CBF that drives the value of a function to zero when the states approach the boundary of its predefined desired set. Using ZCBF-based methods, the system states can be rendered forward-invariant [2], which is a significant criterion for safety in control theory. Furthermore, ZCBFs can also be applied to describe stability constraints. In [3], it is shown that ZCBFs can guarantee asymptotic convergence to desired sets. Despite the advantages of ZCBF, it cannot fulfill the temporal specifications of safety-critical systems. As an alternative, the Finite-Time (convergence) Control Barrier Function (FCBF) [4] is proposed to ensure finite-time stability (FTS). Furthermore, fixed-time stability (FxTS) [5] control methods are also proposed, where the time of convergence is determined by various parameters and is independent of the initial condition [2]. Nevertheless, in the research field of safety-critical control, it is necessary to design control inputs that drive the system state to converge within a prescribed time period defined by the user, namely to achieve prescribed-time stability (PTS) [6,7,8,9] instead of FTS or FxTS. For instance, the space robot is required to catch the expired inhabited spacecraft within a prescribed time period [10]. Inspired by the advantages of ZCBF, we can extend its property of asymptotic stability (AS) to PTS via time transformation techniques. Hence, it is necessary to propose the Prescribed-Time (convergence) ZCBF (PT-ZCBF), which can be applied as a stability constraint function for a safety-critical control system.
From another perspective, it is a challenging problem to describe and solve a safety-critical control task under the coexistence of the prescribed-time stability constraint, safety constraint, and input constraints [2]. For example, the proposed methods in [1,2,4] only achieved exponential stability (ES), FTS, and FxTS, respectively, instead of PTS. In addition, although the authors of [11] designed a PTS controller, it failed to take the input constraints into consideration. A crucial approach of the current research is the application of a Quadratic Program (QP) to describe these constraints, which could be conflicting since a QP can find the optimal solutions to constrained optimization problems efficiently [1,12]. Therefore, in this paper, we aim at proposing a PT-ZCBF-based QP under safety and input constraints to address safety-critical control tasks.
Take the trajectory planning of a robot as an example [13,14]. A finite amount of goal sets with intersections are set up to constrain the trajectory of the robot. This is shown in Figure 1. The robot goes from the point Start into the circle G 1 within time T 1 . Then, it goes from G 1 into G 2 within time T 2 , and so on. Thus, the robot follows this trajectory with a prescribed time limit.
In this paper, we propose the PT-ZCBF to characterize the practical requirement that the system states converge within a prescribed time period, and obtain the control strategy via PT-ZCBF-based Quadratic Programs. To the best of the authors’ knowledge, the prescribed-time stability is realized in safety-critical control systems under safety and input constraints for the first time. Specifically, a time transformation technique is utilized to convert the normal ZCBF into the newly designed PT-ZCBF. This PT-ZCBF is incorporated as the prescribed-time stability constraint in QP. By introducing slack variables, we ensure the solvability of the QP such that the feasible control input always exists.
The remainder of the paper is organized as follows. The notations, preliminaries, and the main problem of the paper are demonstrated in Section 2. Then, the main results and the related proofs are illustrated in Section 3. Afterward, the Adaptive Cruise Control (ACC) problem is applied as an example of numerical simulation to evaluate the performance of the newly designed QP-based method in Section 4. Finally, the paper is concluded with possibilities for future research in Section 5.

2. Preliminaries and Problem Formulation

2.1. Notations

Let R denote the set of real numbers and R 0 denote the set of non-negative real numbers. Let · denote the Euclidean norm. We denote | x | S = inf y S x y as the distance of a point x R n \ S from a set S . Let C k denote the set of k times continuously differentiable functions. We denote the Lie derivative of a C 1 function h : R n R in a vector field direction f : R n R at x R n as L f h ( x ) : = h x f ( x ) . We define the following classes of functions [15].
Definition 1.
A continuous function α : [ 0 , a ) [ 0 , ) belongs to class K if α ( 0 ) = 0 and it is strictly increasing.
Definition 2.
The class K function α belongs to class K if a = and α ( r ) when r .
Definition 3.
A continuous function β : [ 0 , a ) × [ 0 , ) [ 0 , ) belongs to class K L , if β ( r , s ) belongs to class K in relation to r for each s and β ( r , s ) is decreasing in relation to s for each r and β ( r , s ) 0 when s .
Definition 4.
A continuous function α : ( b , a ) ( , ) belongs to the extended class K for a , b > 0 if α ( 0 ) = 0 and it is strictly increasing.

2.2. Preliminaries

2.2.1. Dynamic System

Consider a control affine system given by the differential equation
x ˙ ( t ) = f ( x ( t ) ) + g ( x ( t ) ) u , x ( t 0 ) = x 0
with the state vector x R n , and the input vector u R m . The system vector fields f : R n R n and g : R n R n × m are assumed Lipschitz continuous. We denote x ( 0 ) as the initial values of the states at t = 0 .

2.2.2. Goal Set and Safe Set

Define a set S R n , and its boundary and interior as
S = x R n : h ( x ) 0 ,
Int ( S ) = x R n : h ( x ) < 0 ,
S = x R n : h ( x ) = 0
with the continuously differentiable function h : R n R .
We define the goal set
S g = { x | h g ( x ) 0 }
and the safe set
S s = { x | h s ( x ) 0 } ,
where the functions h g , h s : R n R are defined by the user. We need the following assumption for the theoretical analysis in Section 3.
Assumption 1
([2] (Assumption 1)). The sets S s S g , and the functions h g , h s C 1 . The goal set S g is assumed to be compact. For the safe set S s and goal set S g , it is assumed that their interiors are not empty. In addition, the function h g is proper in relation to the set S g , i.e., a class K function α g exists, which satisfies h g ( x ) α g ( | x | S g ) , x S g .

2.3. ZCBF and Its Properties

Garg et al. [2] use Nagumo’s Theorem on set invariance [16] to prove the safety (forward invariance) of S s for (1), where the following assumption in combination with the conditions of ZCBF is required.
Assumption 2
([2] (Assumption 2)). Consider the system (1). A control input u exists for all x S s , which satisfies
L f h s ( x ) + L g h s ( x ) u < 0 .
Assumption 2 appears in [1,17]. Its rationality can be obtained in [2] (Section III).
Next, the definition of ZCBF is presented.
Definition 5
([2] (Definition 1)). Consider the system (1) and a set S , which is defined in (2) with a C 1 function h. The function h is defined as a ZCBF on set E with S E R n , if an extended class K function α exists, which satisfies
inf u U L f h ( x ) + L g h ( x ) u α ( h ( x ) ) , x E
Note that the function h s satisfies (5) if it is a ZCBF with respect to the system (1). A special case of (6) is
inf u U L f h ( x ) + L g h ( x ) u ρ h ( x ) ,
where ρ 0 , as discussed in [1] (Remark 6). We need (7) for the QP formulation in Section 3.
In addition to forward invariance [1], another important property of ZCBF-based control is the ability to render the system states asymptotically stable. We now introduce a lemma that summarizes both important characteristics of ZCBFs.
Lemma 1
([3] (Theorem S5)). Consider the control affine system (1). The set S with a C 1 function h is defined in (2). Then, any Lipschitz continuous controller u satisfying (6) for all x E will cause the set S to become asymptotically stable and forward-invariant, namely
  • if x ( 0 ) S , then x ( t ) converges to S when t (asymptotic stability);
  • if x ( 0 ) S , then x ( t ) S , t 0 (forward invariance).
Both properties are essential for the theoretical analysis in Section 3.

2.4. Prescribed-Time Stability and Time Transformation

Definition 6
([11] (Definition 1)). The dynamical system (1) is called prescribed-time stable if the states of (1) converge to a bounded set or a point in finite prescribed time T ( 0 , ) defined by the user.
In order to analyze prescribed-time stability, a commonly used technique is time transformation, where a finite-time interval t [ 0 , T ) in domain t is converted into an infinite-time interval s [ 0 , ) in domain s [6,18,19]. We define the function λ : R 0 R 0 as
t = λ ( s )
with s [ 0 , ) , t [ 0 , T ) such that
λ ( 0 ) = 0 ,
λ ( 0 ) = 1 ,
s 1 > s 2 0 λ ( s 1 ) > λ ( s 2 ) ,
lim s λ ( s ) = T ,
lim s λ ( s ) = 0 ,
where λ ( s ) : = d λ ( s ) d s . With (9a) and (9b), the mapping from the set s [ 0 , ) to the set t [ 0 , T ) is feasible. It can be implied from (9c) that the function λ is strictly increasing. According to (9d) and (9e), we can conclude that the system (1) is prescribed-time stable in domain t if it is asymptotically stable in domain s.

2.5. Problem Formulation

We define the main problem as follows.
Problem 1.
Design a control input
u ( t ) U = { u R m | u m i n i u i u m a x i , i = 1 , 2 , , m }
of the system (1), such that the trajectories of the closed-loop system converge to the goal set S g in user-defined prescribed time T. Meanwhile, the states x ( t ) should always remain in the safe set S s for all x 0 S s and t 0 .

3. Main Results

We present the main results of this paper and the related proofs in this section. First, we introduce our design of the Prescribed-Time (convergence) ZCBF (PT-ZCBF) via the time transformation technique. Afterward, we propose the QP-based formulation, using PT-ZCBF as a constraint function. We prove the feasibility of the QP and the continuity of its solution under certain conditions, which are necessary to prove that Problem 1 can be solved by the QP solution under certain conditions. All the main results in this section are demonstrated under Assumptions 1 and 2.

3.1. PT-ZCBF and Its Properties

In this subsection, we propose the definition of PT-ZCBF, showing its property of prescribed-time stability.
We define PT-ZCBF as follows.
Definition 7.
Consider the system (1). Consider a set S with a C 1 function h defined as in (2). The function h is a PT-ZCBF on set E with S E R n , if an extended class K function α exists, which satisfies
inf u U L f h ( x ) + L g h ( x ) u α ( h ( x ) ) T T t , t [ 0 , T ) ,
inf u U L f h ( x ) + L g h ( x ) u α ( h ( x ) ) , t [ T , ) .
Furthermore, we introduce the Comparison Lemma, which is essential for the proof of Theorem 1.
Lemma 2
([20] (Lemma 4.4)). Consider the following scalar differential equation:
z ˙ = α ( z ) , z ( t 0 ) = z 0 ,
with the locally Lipschitz class K function α defined on [ 0 , a ) . The solution z ( t ) of this differential equation in time interval t [ t 0 , ) is unique for all 0 z 0 < a . In addition, the solution can be described as
z ( t ) = σ ( z 0 , t t 0 )
with a class KL function σ defined on [ 0 , a ) × [ 0 , ) .
Now, we are ready to present our first main result.
Theorem 1.
Consider the system (1). The set S with a C 1 function h is defined as in (2). If there exists an extended class K function α, such that the function h is a PT-ZCBF on set E with S E R n satisfying (11) and (12), then there exists a function σ ( h 0 , t ) such that
h ( x ( t ) ) σ ( h 0 , t ) , t [ 0 , T ) ,
h ( x ( t ) ) 0 , t [ T , )
for any given time limit T > 0 , where the initial value h 0 = h ( x ( 0 ) ) , σ ( h 0 , t ) decreases strictly in t for t [ 0 , T ) , and lim t T σ ( h 0 , t ) = 0 holds. Specifically, any Lipschitz continuous controller u U of the system (1) satisfying (11) and (12) renders the trajectories of the closed-loop system (1) to converge to the set S in user-defined prescribed time T, and then remain forward-invariant.
Using the time transformation technique and the Comparison Lemma, Theorem 1 can be proven.
Proof. 
First, t [ 0 , T ) is considered.
From (11) and (1), we can derive
h ˙ ( x ( t ) ) : = d h ( x ( t ) ) d t α ( h ( x ( t ) ) ) T T t , t [ 0 , T ) .
We use the time transformation candidate function
t = λ ( s ) T ( 1 e s / T )
with the time constant T > 0 defined by the user. It is easy to prove that (18) satisfies (9). The back-transformation of (18) is
s = λ 1 ( t ) = T log T T t .
It can be derived that
d s d t = T T t .
Inserting (20) into (17), we can derive
h ˙ ( x ( t ) ) : = d h ( x ( t ) ) d t α ( h ( x ( t ) ) ) d s d t , t [ 0 , T ) .
Since we have
h s ( x ( s ) ) : = d h s ( x ( s ) ) d s = d h ( x ( t ) ) d t d t d s ,
where we denote h s ( x ( s ) ) as the value of the function h ( x ( t ) ) in domain s, we can derive
h s ( x ( s ) ) : = d h s ( x ( s ) ) d s α ( h s ( x ( s ) ) ) , s [ 0 , ) .
Next, we apply Lemma 2. In Lemma 2, let y denote h s ( x ( s ) ) , and let t denote s with t 0 = s 0 = 0 . It can be concluded that a class K L function σ s ( h 0 , s ) with
h s ( x ( s ) ) σ s ( h 0 , s ) , s [ 0 , )
exists, where h 0 is the initial value of the function h at t = s = 0 . Applying the back-transformation (19) to (24), we can prove (15). Based on the definition of the class K L function, it can be concluded that σ ( h 0 , t ) decreases strictly with t for t [ 0 , T ) , and
lim t T σ ( h 0 , t ) = 0
holds. According to (6) in Definition 5, it is evident that h s ( x ) is a ZCBF in the s domain. Thus, we can conclude according to Lemma 1 that any Lipschitz continuous controller u U of (1) forces the closed-loop trajectories to converge in the set S in user-defined time T.
Then, t [ T , ) is considered. At t = T , we can conclude from (15) that
h ( x ( t = T ) ) 0
holds. According to (12), we can conclude that h is a ZCBF for t [ T , ) . Therefore, the set S is forward-invariant for t [ T , ) . Hence, (16) is proven.
Thus, Theorem 1 is proven.    □

3.2. PT-ZCBF-Based QP

In this subsection, the PT-ZCBF-based QP and its feasibility are demonstrated, and it is proven that Problem 1 can be solved by the QP solution under certain conditions. Define
z = u δ 1 δ 2 R m + 2 ,
and the PT-ZCBF-based QP is defined as follows:
min u , δ 1 , δ 2 1 2 z T H z
s . t . A u u b u
L f h g ( x ) + L g h g ( x ) u + γ 1 h g ( x ) T T t δ 1 , t < T
L f h g ( x ) + L g h g ( x ) u + γ 2 h g ( x ) δ 1 , t T
L f h s ( x ) + L g h s ( x ) u δ 2 h s ( x ) .
The matrix H = diag w u 1 , , w u m , w 1 , w 2 is diagonal with weights w u 1 , , w u m , w 1 ,   w 2 > 0 . The matrix A u R 2 m × m and the vector b u R 2 m define the input constraints. T > 0 is the user-defined prescribed time of convergence, and the hyperparameters γ 1 , γ 2 > 0 . According to Theorem 1, the constraints (28c) and (28d) are designed according to the PT-ZCBF, which aim to ensure prescribed-time convergence. According to Lemma 1, the constraint (28e) guarantees safety.
Parameters δ 1 , δ 2 are relaxation parameters. With the relaxation parameters, the feasibility of the QP (28) is guaranteed.
We can rewrite the constraints (28b)–(28e) in the form of
A ( x ) z b ( x ) ,
where
A ( x ) = A u 0 2 m 0 2 m L g h g ( x ) 1 0 L g h s ( x ) 0 h s ( x ) ,
b ( x ) = b u L f h g ( x ) γ 1 h g ( x ) T T t L f h s ( x ) , t < T b u L f h g ( x ) γ 2 h g ( x ) L f h s ( x ) , t T .
The elements of the column vector 0 2 m R 2 m are zeros. Furthermore, we define the functions
G j ( x , z ) = A j ( x ) z b j ( x )
where A j , b j denote the j-th row of A and b. Then, we can express the constraints of the QP (28) as
G j ( x , z ) 0 , j 2 m + 2 , j N + .
Lemma 3.
Parameters ( u , δ 1 , δ 2 ) , which satisfy (28b)–(28e), always exist for all x. In other words, the QP (28) is always feasible for all x.
Proof. 
Consider the cases of h s ( x ) < 0 and h s ( x ) = 0 separately.
First, the case h s ( x ) < 0 ( x Int ( S s ) ) is to be considered. Because the set U is not empty, there exists u = u ¯ U , which satisfies (28b). We define
δ 2 ¯ = L f h S ( x ) + L g h S ( x ) u ¯ h s ( x ) ,
which satisfies (28e) with equality. Finally, we choose
δ 1 ¯ = L f h G ( x ) + L g h G ( x ) u ¯ + γ 1 h g ( x ) T T t , t [ 0 , T ) ,
and
δ 1 ¯ = L f h G ( x ) + L g h G ( x ) u ¯ + γ 1 h g ( x ) , t [ T , ) ,
so that (28c) and (28d) are satisfied with equality. Therefore, in the first case, parameters ( u ¯ , δ 1 ¯ , δ 2 ¯ ) exist, which satisfy (28b)–(28e).
Then, the case h s ( x ) = 0 ( x S s ) is to be considered. According to Assumption 2, it can be concluded that u = u ¯ U satisfying (28b) exists. Because h s ( x ) = 0 , any value of δ 2 is possible. Therefore, δ 2 = 0 can be chosen. As a result, we can choose
z = u δ 1 δ 2 = u ¯ δ 1 ¯ 0 ,
which satisfies (28b)–(28e).
Therefore, the QP (28) is always feasible.    □
Remark 1.
Due to the coexistence of multiple constraints that are potentially conflicting, we must add slack variables (relaxation parameters) δ 1 and δ 2 to ensure the feasibility of the QP (28). However, due to the slack variables δ 1 , the stability constraint, i.e., prescribed-time stability, may not be perfectly guaranteed. When the input, stability, and safety constraints are not conflicting, the solution of the QP will result in δ 1 0 if a weight w 1 is chosen appropriately. As a result, a sufficiently large weight w 1 will result in a negligible value of δ 1 , which ensures the effectiveness of the stability constraint. In short, the stability objective is a soft constraint because of the existence of the relaxation parameter, and it is still effective if a sufficiently large weight w 1 is chosen. Setting δ 1 = 0 will make the stability constraint a hard constraint, but the feasibility of the QP cannot be guaranteed [21,22].
In contrast, the safety constraint (28e) implies that the forward invariance of the safe set S s can never be violated according to Definition 5 and Assumption 2. Therefore, the safety constraint (28e) is a hard constraint.
Next, we would like to prove that under certain assumptions, the solution of the QP (28) solves Problem 1. That is, the solution of the QP (28) can render the trajectories of the system (1) forward-invariant in the safe set S s , and the system states will converge to the goal set S g in user-defined prescribed time T while satisfying the input constraints (28b).
According to [2], the authors’ idea to ensure safety is a combination of Nagumo’s theorem [16] and Assumption 2. As the prerequisite for safety and stability, the continuity of the solution z * ( x ) of the QP (28) has to be ensured. Thus, we make the following assumptions to prove that the solution z * ( x ) of the QP (28) is continuous.
Assumption 3.
At t = T , the solution z * ( x ) of the QP (28) is continuous.
Let z * and λ * R + 2 m + 2 denote the optimal solution of the QP (28) and the corresponding Lagrange multiplier.
Assumption 4
([2] (Assumption 3)). The constraints (28b)–(28e) of the QP (28) satisfy strict complementary slackness, which means that either λ j * > 0 or G j ( x , z * ) < 0 holds for all x Int ( S s ) \ S g and for each j 2 m + 2 , j N + .
Remark 2.
For an explanation of complementary slackness, please refer to [2] (Section IV).
Assumption 5.
The functions h g ( x ) , h s ( x ) are at least three times continuously differentiable in x.
Theorem 2.
Under Assumptions 3–5, the solution z * ( · ) of the QP (28) is continuous on Int ( S s ) \ S g .
Proof. 
According to [2] (Theorem 5), the QP (28) solution z * ( · ) is continuous under the assumptions above. Note that the Lie derivatives L f h g ( x ) , L g h g ( x ) , L f h s ( x ) , L g h s ( x ) should be at least twice continuously differentiable in x [23] (Theorem 2.1). Therefore, h s , h g should be at least three times continuously differentiable in x, which corresponds to Assumption 5.    □
Now, we are ready to show that the solution of the QP (28) solves Problem 1 under the aforementioned assumptions.
Theorem 3.
Under Assumptions 1–5, if the solution z * ( x ) of the QP (28) given as
z * ( x ) = u * ( x ) δ 1 * ( x ) δ 2 * ( x )
satisfies δ 1 * ( x ) 0 , x S s , then u ( x ) = u * ( x ) solves Problem 1 for all x ( 0 ) S s .
Proof. 
This proof is based on [2] (Theorem 6).
First, we show that the closed-loop trajectories of (1) have the property of prescribed-time stability with respect to S g . From Theorem 2, it can be concluded that the closed-loop system dynamics are continuous when we choose u ( x ) = u * ( x ) . Applying [24] (Theorem 3.15.1) and using a Lyapunov function candidate
V ( w ) = 1 2 | w | 2 ,
we can prove that w 0 is the unique solution of the equation
w ˙ = ϕ ( w ) : = γ 1 T T t w , t < T γ 2 w , t T
for w ( 0 ) = 0 under Assumption 3. From the properties of the goal set function h g ( x ) , we have that
h g ( x ) = 0 , x S g ,
and that
h g ( x ) > 0 , x S g ,
i.e., the goal set function h g ( x ) is positive definite with respect to the goal set S g . Therefore, per [24] (Theorem 3.18.1), with the function g defined as ϕ and the fact that
h g ˙ ( x ) ϕ ( h g ( x ) ) , x S g
holds since δ 1 * ( x ) 0 , the closed-loop system (1) has a unique solution. According to Theorem 1, it can be concluded that the closed-loop trajectories of (1) with u ( x ) = u * ( x ) converge to the goal set S g within user-defined prescribed time T for all x ( 0 ) S s , and then remain forward-invariant with respect to the goal set S g .
Then, we show that the closed-loop trajectories have the property of safety, i.e., x ( t ) S s for all t > 0 when we choose u ( x ) = u * ( x ) . Since the solution z * ( · ) is continuous under the assumptions above, the optimal control input u ( x ) = u * ( x ) is also continuous. Furthermore, a bounded safe set S s results in bounded closed-loop trajectories. Thus, the solution of the closed-loop system (1) is well-defined and unique [24] (Chapter 3). Since h s is a ZCBF, it satisfies (5). Therefore, by Nagumo’s Theorem on set invariance [16], we directly obtain the forward invariance (safety) of the safe set S s .
Additionally, according to the input constraints (28b) and the solvability of the QP (28) from Theorem 3, it can be concluded that the control input u ( x ) = u * ( x ) satisfies the linear input constraints (28b).
Therefore, the optimal control input u ( x ) = u * ( x ) solves Problem 1 for all x ( 0 ) S s under the aforementioned assumptions.    □
In many engineering problems, the system vector fields and the control input are assumed to be Lipschitz continuous. Next, we will show that under the following technical assumption, Problem 1 can be solved by the solution of QP (28) [1,3].
Assumption 6.
The system vector fields f, g in (1) and the solution z * ( x ) of the QP (28) are (locally) Lipschitz continuous.
Theorem 4.
Denote
z * ( x ) = u * ( x ) δ 1 * ( x ) δ 2 * ( x )
as the solution of the QP (28). Under Assumptions 1, 2, 3 and 6, Problem 1 can be solved by u ( x ) = u * ( x ) for all x ( 0 ) S s .
Proof. 
According to Lemma 1, if the solution of the QP (28) is Lipschitz continuous for all x ( 0 ) S s , then the trajectory of the closed-loop system (1) will be forward-invariant in safe set S s under the safety constraint (28e). Furthermore, according to Theorem 1, under the condition that the QP solution is Lipschitz continuous for all x ( 0 ) S s , the system states will be driven into the goal set S g within user-defined prescribed time period T under the stability constraint (28c), and then remain forward-invariant under the stability constraint (28d). Moreover, the input constraint (28b) specifies the upper and lower bounds of control inputs as described in Problem 1. In addition, the QP (28) is always feasible according to Lemma 3. Hence, Problem 1 can be solved by u * for all x ( 0 ) S s .    □
Remark 3.
According to [1] (Theorem 3), if we ignore the input constraints (28b), we can prove the Lipschitz continuity of the solution of QP (28) for x Int ( S s ) under the assumptions that the QP solution is locally Lipschitz continuous at t = T , and that the functions f, g in (1), the gradients of h s , h g are locally Lipschitz continuous, and that the relative degree one condition holds. However, the Lipschitz continuity of the QP solution with input constraints (28b) is not currently guaranteed.
Remark 4.
The newly designed QP (28) can find the optimal control input of a control affine system (1) under the prescribed-time stability constraint, safety constraint, and input constraints of a typical safety-critical system, which is different from the function of the controllers designed in [1,2]. We learn from the ideas of proofs in [1,2], but for our newly designed QP (28), it is proven that the control goal of PTS is achieved. Although we are inspired by the ideas in previous research, the prescribed-time stability constraint in our QP (28) is based on PT-ZCBF, which is different from the stability constraints in [1,2]. Then, the resulted closed-loop trajectories of the safety-critical system will be prescribed-time stable under safety and input constraints.

4. A Numerical Case Study

In this section, the Adaptive Cruise Control (ACC) problem [1] (Section V.A) is adopted to show the effectiveness of the designed method. The objective of our problem is to track the expected speed of the following vehicle while keeping a safe distance from the leading vehicle. QP (28) is applied to find the control input that solves the ACC problem. The Matlab solver ode4 with a fixed step size is applied in our program. The Matlab function quadprog is applied to find the QP solution at every time step.

4.1. Introduction of the ACC Problem

The ACC problem contains a following vehicle and a leading vehicle. The following vehicle possesses the ACC system, which aims to converge to a prescribed driving speed (stability constraint, soft constraint). Furthermore, the following vehicle needs to keep a safe distance behind the leading vehicle (safety constraint, hard constraint). Therefore, the following vehicle’s speed has to be reduced to observe the safety constraint when the distance between the two vehicles decreases. We assume that both vehicles are modeled as mass points, and they travel in a one-dimensional coordinate.
The system equation of the ACC problem is [1]
x ˙ = f ( x ) + g ( x ) u .
By choosing the system vector fields properly, we can derive
x ˙ = F r / M a L x 2 x 1 f ( x ) + 1 / M 0 0 g ( x ) u .
In the system equations,
x = x 1 x 2 x 3 = v f v l D
are the system states, where we define v f as the following vehicle speed (in m/s), v l as the leading vehicle speed (in m/s), and D as the space between both vehicles (in m). u [ u m a x , u m a x ] is the control input, whose physical significance is the driving wheel force (in N) of the following vehicle supplied from the powertrain system. M is defined as the mass of the following vehicle (in kg); F r ( x ) = f 0 + f 1 v + f 2 v f 2 is the resistance (in N), where the constants f 0 , f 1 , and f 2 are chosen empirically. We define a L [ a l g , a l g ] as the acceleration (or deceleration) of the leading vehicle (in m/s2).
Furthermore, we have to define the goal set function h g ( x ) and safe set function h s ( x ) in our QP (28). We set
h g ( x ) = ( x 1 v d ) 2 ,
and
h s ( x ) = τ d x 1 x 3 ,
with v d being the prescribed velocity defined by the user and τ d the desired time headway.
Next, we choose the model parameters according to the physical systems in reality. We set the desired velocity v d = 22 m/s, the desired time headway τ d = 1.82 s, the mass of the following vehicle M = 1650 kg, the gravitational acceleration g = 9.81 m/s2, the maximum available control effort (driving wheel force) u m a x = 0.25 M g , the constants in the expression of aerodynamic drag force f 0 = 0.1 N, f 1 = 5 Ns/m, f 2 = 0.25 Ns2/m2, and the leading vehicle acceleration parameter a l = 0.3 . Then, we define the initial condition of the dynamic system: v l ( 0 ) = 10 m/s, v f ( 0 ) [ 14 , 30 ] m/s, D ( 0 ) = 150 m. We choose T = 5 s.
To achieve better performance for our control system in the ACC problem, we slightly change the QP (28) such that the stability constraints are forced to be invalid when the value of the safe set function h s ( x ( t ) ) approximates zero (when h s ( x ( t ) ) > 10 ), which can result in better obedience to the safety constraints. We implement the QP (28) with H = diag 2 M 2 , 100 , 400 , A u = 1 0 0 1 0 0 , b u = u m a x u m a x , γ 1 = 1000 , γ 2 = 1000 , T = 5 , and h g ( x ) , h s ( x ) defined in (48), (49).

4.2. Simulation Results without Disturbances

Now, we are ready to present the simulation results. Figure 2 shows the tracking performance of the following vehicle with the control input computed from QP (28). The solid lines in different colors represent the following vehicle speeds for different initial conditions v f ( 0 ) [ 14 , 30 ] m/s. Figure 3 illustrates the dynamics of the safe set function h s ( x ( t ) ) with the same initial conditions. Figure 4 shows the dynamics of the computed control input u ( t ) (driving wheel force of the following vehicle supplied from the powertrain system).

4.3. Simulation Results with Disturbances

We now examine the robustness of the proposed approach against disturbances. Suppose that the system equations with disturbances can be written as
x ˙ = f ( x ) + g u + z ( x ) ,
where f ( x ) and g are given in (46), and we consider the Lipschitz continuous disturbance
z ( x ) = C δ M v f v d 0 0 ,
where C δ is the disturbance constant. In our simulation program, we set C δ [ 0 , 40 ] kg/s, the initial velocity of the following vehicle v f ( 0 ) = 30 m/s, and we slightly modify the proposed QP (28) such that the stability constraints are set to be invalid when the value of the safe set function h s ( x ( t ) ) approximates zero (when h s ( x ( t ) ) > 20 ). Figure 5, Figure 6 and Figure 7 illustrate the tracking performance, dynamics of the safe set function h s ( x ( t ) ) , and control input u ( t ) , respectively.

4.4. Conclusions of Simulation Results

It can be concluded that the desired velocity v d of the following vehicle can be reached in a user-defined prescribed time T = 5 s without violating the input constraints when the trajectories of the system states are away from the boundaries of the safe set, namely when the value of the function h s ( x ( t ) ) is much smaller than zero. Furthermore, the velocity of the following vehicle will be decreased to satisfy the safety constraint if the system states are near the safe set boundaries, namely if h s ( x ( t ) ) approaches zero.
We can see that there are slight oscillations in our simulation results, especially in Figure 4. One of the reasons lies in the fact that the computed control input varies when the value of the safe set function h s ( x ( t ) ) approaches the predefined value from above and below. Furthermore, there are small simulation errors in the solver ode4. For example, in Figure 2, the speed of the following vehicle oscillates between 21.95 m/s and 22.05 m/s in a steady state. Theoretically, many control techniques can be applied to reduce the oscillation (e.g., a dead-zone controller [25]). However, the oscillation of the vehicle speed with an amplitude of 0.1 m/s may not cause any serious problems in reality.

5. Conclusions

We presented the definition and properties of PT-ZCBF, which can describe the prescribed-time stability constraint of safety-critical systems. We combined the input, safety, and stability constraints of safety-critical systems in a PT-ZCBF-based QP formulation, which is able to find the optimal control input under the designated constraints. We discussed its feasibility and how it can solve the main problem under certain mild assumptions. Finally, we applied the proposed QP to the ACC problem as a numerical simulation example. The simulation results showed that the proposed approach can solve the ACC problem with satisfaction. Compared to previous works, a QP-based method combining the prescribed-time stability constraint, safety constraint, and input constraints is proposed in this paper for the first time.
In the future, we would like to search for a method to reduce the oscillation behaviors of the proposed method in numerical case studies. In addition, we are interested in different methods to solve the prescribed-time stability problem, e.g., the Control Lyapunov Function method introduced in [11]. We want to modify the stability constraints of the proposed QP according to different PTS methods, use the modified QP in numerical case studies, and compare the results using the QP with different PTS methods. Furthermore, we would like to study the applicability of the proposed approach to more numerical examples and large-scale systems [26,27], and then apply the methods to practical experimental studies.

Author Contributions

Conceptualization, F.L. and Q.L.; methodology, S.W.; software, S.W.; validation, C.L.; formal analysis, S.W.; investigation, S.W.; resources, F.L.; data curation, S.W.; writing—original draft preparation, S.W.; writing—review and editing, F.L., Q.L.; visualization, S.W.; supervision, F.L., C.L., Q.L.; project administration, Q.L. All authors have read and agreed to the published version of the manuscript.

Funding

This research received no external funding.

Data Availability Statement

The data that support the findings of this study are available from the corresponding author, Fangzhou Liu, upon reasonable request.

Acknowledgments

The authors are grateful to Zhiyong Sun for the insightful discussion and constructive suggestions.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Ames, A.D.; Xu, X.; Grizzle, J.W.; Tabuada, P. Control barrier function based quadratic programs for safety critical systems. IEEE Trans. Autom. Control 2016, 62, 3861–3876. [Google Scholar] [CrossRef]
  2. Garg, K.; Arabi, E.; Panagou, D. Fixed-time control under spatiotemporal and input constraints: A QP based approach. arXiv 2019, arXiv:1906.10091v5. [Google Scholar]
  3. Funada, R.; Cai, X.; Notomista, G.; Atman, M.W.S.; Yamauchi, J.; Fujita, M.; Egerstedt, M. Coordination of robot teams over long distances: From Georgia tech to Tokyo tech and back—An 11,000-km multirobot experiment. IEEE Control Syst. Mag. 2020, 40, 53–79. [Google Scholar] [CrossRef]
  4. Srinivasan, M.; Coogan, S. Control of mobile robots using barrier functions under temporal logic specifications. IEEE Trans. Robot. 2020, 37, 363–374. [Google Scholar] [CrossRef]
  5. Polyakov, A. Nonlinear feedback design for fixed-time stabilization of linear control systems. IEEE Trans. Autom. Control 2011, 57, 2106–2110. [Google Scholar] [CrossRef]
  6. Kan, Z.; Yucelen, T.; Doucette, E.; Pasiliao, E. A finite-time consensus framework over time-varying graph topologies with temporal constraints. J. Dyn. Syst. Meas. Control 2017, 139, 071012. [Google Scholar] [CrossRef]
  7. Aldana-López, R.; Gómez-Gutiérrez, D.; Jiménez-Rodrıguez, E.; Sánchez-Torres, J.; Defoort, M. On the design of new classes of predefined-time stable systems: A time-scaling approach. arXiv 2019, arXiv:1901.02782. [Google Scholar]
  8. Holloway, J.; Krstic, M. Prescribed-time observers for linear systems in observer canonical form. IEEE Trans. Autom. Control 2019, 64, 3905–3912. [Google Scholar] [CrossRef]
  9. Song, Y.; Wang, Y.; Holloway, J.; Krstic, M. Time-varying feedback for regulation of normal-form nonlinear systems in prescribed finite time. Automatica 2017, 83, 243–251. [Google Scholar] [CrossRef]
  10. Wang, Z.; Liang, B.; Sun, Y.; Zhang, T. Adaptive fault-tolerant prescribed-time control for teleoperation systems with position error constraints. IEEE Trans. Ind. Inform. 2019, 16, 4889–4899. [Google Scholar] [CrossRef]
  11. Garg, K.; Arabi, E.; Panagou, D. Prescribed-time convergence with input constraints: A control Lyapunov function based approach. In Proceedings of the 2020 American Control Conference (ACC), Denver, CO, USA, 1–3 July 2020; pp. 962–967. [Google Scholar]
  12. Garg, K.; Panagou, D. Control-Lyapunov and control-barrier functions based quadratic program for spatio-temporal specifications. In Proceedings of the 2019 IEEE 58th Conference on Decision and Control (CDC), Nice, France, 11–13 December 2019; pp. 1422–1429. [Google Scholar]
  13. Molnar, T.G.; Cosner, R.K.; Singletary, A.W.; Ubellacker, W.; Ames, A.D. Model-free safety-critical control for robotic systems. IEEE Robot. Autom. Lett. 2021, 7, 944–951. [Google Scholar] [CrossRef]
  14. Nguyen, Q.; Sreenath, K. Robust safety-critical control for dynamic robotics. IEEE Trans. Autom. Control 2021, 67, 1073–1088. [Google Scholar] [CrossRef]
  15. Kellett, C.M. A compendium of comparison function results. Math. Control Signals Syst. 2014, 26, 339–374. [Google Scholar] [CrossRef]
  16. Blanchini, F. Set invariance in control. Automatica 1999, 35, 1747–1767. [Google Scholar] [CrossRef]
  17. Romdlony, M.Z.; Jayawardhana, B. Stabilization with guaranteed safety using control Lyapunov–barrier function. Automatica 2016, 66, 39–47. [Google Scholar] [CrossRef]
  18. Yucelen, T.; Kan, Z.; Pasiliao, E. Finite-time cooperative engagement. IEEE Trans. Autom. Control 2018, 64, 3521–3526. [Google Scholar] [CrossRef]
  19. Arabi, E.; Yucelen, T.; Singler, J.R. Further results on finite-time distributed control of multiagent systems with time transformation. In Proceedings of the Dynamic Systems and Control Conference, New York, NY, USA, 30 September–3 October 2018; Volume 51913, p. V003T30A004. [Google Scholar]
  20. Khalil, H.K. Nonlinear Systems, 3rd ed.; Prentice Hall: Upper Saddle River, NJ, USA, 2002. [Google Scholar]
  21. Xu, X.; Tabuada, P.; Grizzle, J.W.; Ames, A.D. Robustness of control barrier functions for safety critical control. IFAC-PapersOnLine 2015, 48, 54–61. [Google Scholar] [CrossRef]
  22. Galloway, K.; Sreenath, K.; Ames, A.D.; Grizzle, J.W. Torque saturation in bipedal robotic walking through control Lyapunov function-based quadratic programs. IEEE Access 2015, 3, 323–332. [Google Scholar] [CrossRef]
  23. Robinson, S.M. Perturbed Kuhn-Tucker points and rates of convergence for a class of nonlinear-programming algorithms. Math. Program. 1974, 7, 1–16. [Google Scholar] [CrossRef]
  24. Agarwal, R.P.; Agarwal, R.P.; Lakshmikantham, V. Uniqueness and Nonuniqueness Criteria for Ordinary Differential Equations; World Scientific: Singapore, 1993; Volume 6. [Google Scholar]
  25. Zhao, Z.; Ahn, C.K.; Li, H.X. Dead zone compensation and adaptive vibration control of uncertain spatial flexible riser systems. IEEE/ASME Trans. Mechatron. 2020, 25, 1398–1408. [Google Scholar] [CrossRef]
  26. Wu, G.; Sreenath, K. Safety-critical control of a planar quadrotor. In Proceedings of the 2016 American Control Conference (ACC), Boston, MA, USA, 6–8 July 2016; pp. 2252–2258. [Google Scholar]
  27. Zhang, J.; Li, J. Testing and verification of neural-network-based safety-critical control software: A systematic literature review. Inf. Softw. Technol. 2020, 123, 106296. [Google Scholar] [CrossRef]
Figure 1. Trajectory planning sketch.
Figure 1. Trajectory planning sketch.
Electronics 12 02053 g001
Figure 2. Tracking performance for different initial following speeds v f ( 0 ) [ 14 , 30 ] m/s with T = 5 s.
Figure 2. Tracking performance for different initial following speeds v f ( 0 ) [ 14 , 30 ] m/s with T = 5 s.
Electronics 12 02053 g002
Figure 3. Dynamics of the safe set function h s ( x ( t ) ) for different initial following speeds v f ( 0 ) [ 14 , 30 ] m/s with T = 5 s.
Figure 3. Dynamics of the safe set function h s ( x ( t ) ) for different initial following speeds v f ( 0 ) [ 14 , 30 ] m/s with T = 5 s.
Electronics 12 02053 g003
Figure 4. Dynamics of the computed u ( t ) for different initial following speeds v f ( 0 ) [ 14 , 30 ] m/s with T = 5 s.
Figure 4. Dynamics of the computed u ( t ) for different initial following speeds v f ( 0 ) [ 14 , 30 ] m/s with T = 5 s.
Electronics 12 02053 g004
Figure 5. Tracking performance with disturbances for C δ [ 0 , 40 ] kg/s (red to blue) and v f ( 0 ) = 30 m/s.
Figure 5. Tracking performance with disturbances for C δ [ 0 , 40 ] kg/s (red to blue) and v f ( 0 ) = 30 m/s.
Electronics 12 02053 g005
Figure 6. Dynamics of the safe set function h s ( x ( t ) ) with disturbances for C δ [ 0 , 40 ] kg/s (red to blue) and v f ( 0 ) = 30 m/s.
Figure 6. Dynamics of the safe set function h s ( x ( t ) ) with disturbances for C δ [ 0 , 40 ] kg/s (red to blue) and v f ( 0 ) = 30 m/s.
Electronics 12 02053 g006
Figure 7. Dynamics of the control input u ( t ) with disturbances for C δ [ 0 , 40 ] kg/s (red to blue) and v f ( 0 ) = 30 m/s.
Figure 7. Dynamics of the control input u ( t ) with disturbances for C δ [ 0 , 40 ] kg/s (red to blue) and v f ( 0 ) = 30 m/s.
Electronics 12 02053 g007
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Wang, S.; Liu, F.; Li, C.; Liu, Q. Safety-Critical Control for Control Affine Systems under Spatio-Temporal and Input Constraints. Electronics 2023, 12, 2053. https://doi.org/10.3390/electronics12092053

AMA Style

Wang S, Liu F, Li C, Liu Q. Safety-Critical Control for Control Affine Systems under Spatio-Temporal and Input Constraints. Electronics. 2023; 12(9):2053. https://doi.org/10.3390/electronics12092053

Chicago/Turabian Style

Wang, Shang, Fangzhou Liu, Cong Li, and Qingchen Liu. 2023. "Safety-Critical Control for Control Affine Systems under Spatio-Temporal and Input Constraints" Electronics 12, no. 9: 2053. https://doi.org/10.3390/electronics12092053

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop