-
Priority-Driven Safe Model Predictive Control Approach to Autonomous Driving Applications
Authors:
Francesco Prignoli,
Ying Shuai Quan,
Mohammad Jeddi,
Jonas Sjöberg,
Paolo Falcone
Abstract:
This paper demonstrates the applicability of the safe model predictive control (SMPC) framework to autonomous driving scenarios, focusing on the design of adaptive cruise control (ACC) and automated lane-change systems. Building on the SMPC approach with priority-driven constraint softening -- which ensures the satisfaction of \emph{hard} constraints under external disturbances by selectively soft…
▽ More
This paper demonstrates the applicability of the safe model predictive control (SMPC) framework to autonomous driving scenarios, focusing on the design of adaptive cruise control (ACC) and automated lane-change systems. Building on the SMPC approach with priority-driven constraint softening -- which ensures the satisfaction of \emph{hard} constraints under external disturbances by selectively softening a predefined subset of adjustable constraints -- we show how the algorithm dynamically relaxes lower-priority, comfort-related constraints in response to unexpected disturbances while preserving critical safety requirements such as collision avoidance and lane-keeping. A learning-based algorithm approximating the time consuming SMPC is introduced to enable real-time execution. Simulations in real-world driving scenarios subject to unpredicted disturbances confirm that this prioritized softening mechanism consistently upholds stringent safety constraints, underscoring the effectiveness of the proposed method.
△ Less
Submitted 9 May, 2025;
originally announced May 2025.
-
Priority-driven Constraints Softening in Safe MPC for Perturbed Systems
Authors:
Ying Shuai Quan,
Mohammad Jeddi,
Francesco Prignoli,
Paolo Falcone
Abstract:
This paper presents a safe model predictive control (SMPC) framework designed to ensure the satisfaction of hard constraints for systems perturbed by an external disturbance. Such safety guarantees are ensured, despite the disturbance, by online softening a subset of adjustable constraints defined by the designer. The selection of the constraints to be softened is made online based on a predefined…
▽ More
This paper presents a safe model predictive control (SMPC) framework designed to ensure the satisfaction of hard constraints for systems perturbed by an external disturbance. Such safety guarantees are ensured, despite the disturbance, by online softening a subset of adjustable constraints defined by the designer. The selection of the constraints to be softened is made online based on a predefined priority assigned to each adjustable constraint. The design of a learning-based algorithm enables real-time computation while preserving the original safety properties.
Simulations results, obtained from an automated driving application, show that the proposed approach provides guarantees of collision-avoidance hard constraints despite the unpredicted behaviors of the surrounding environment.
△ Less
Submitted 19 March, 2025;
originally announced March 2025.
-
Optimization-based Heuristic for Vehicle Dynamic Coordination in Mixed Traffic Intersections
Authors:
Muhammad Faris,
Mario Zanon,
Paolo Falcone
Abstract:
In this paper, we address a coordination problem for connected and autonomous vehicles (CAVs) in mixed traffic settings with human-driven vehicles (HDVs). The main objective is to have a safe and optimal crossing order for vehicles approaching unsignalized intersections. This problem results in a mixed-integer quadratic programming (MIQP) formulation which is unsuitable for real-time applications.…
▽ More
In this paper, we address a coordination problem for connected and autonomous vehicles (CAVs) in mixed traffic settings with human-driven vehicles (HDVs). The main objective is to have a safe and optimal crossing order for vehicles approaching unsignalized intersections. This problem results in a mixed-integer quadratic programming (MIQP) formulation which is unsuitable for real-time applications. Therefore, we propose a computationally tractable optimization-based heuristic that monitors platoons of CAVs and HDVs to evaluate whether alternative crossing orders can perform better. It first checks the future constraint violation that consistently occurs between pairs of platoons to determine a potential swap. Next, the costs of quadratic programming (QP) formulations associated with the current and alternative orders are compared in a depth-first branching fashion. In simulations, we show that the heuristic can be a hundred times faster than the original and simplified MIQPs and yields solutions that are close to optimal and have better order consistency.
△ Less
Submitted 22 April, 2024;
originally announced April 2024.
-
Experimental Validation of Safe MPC for Autonomous Driving in Uncertain Environments
Authors:
Ivo Batkovic,
Ankit Gupta,
Mario Zanon,
Paolo Falcone
Abstract:
The full deployment of autonomous driving systems on a worldwide scale requires that the self-driving vehicle be operated in a provably safe manner, i.e., the vehicle must be able to avoid collisions in any possible traffic situation. In this paper, we propose a framework based on Model Predictive Control (MPC) that endows the self-driving vehicle with the necessary safety guarantees. In particula…
▽ More
The full deployment of autonomous driving systems on a worldwide scale requires that the self-driving vehicle be operated in a provably safe manner, i.e., the vehicle must be able to avoid collisions in any possible traffic situation. In this paper, we propose a framework based on Model Predictive Control (MPC) that endows the self-driving vehicle with the necessary safety guarantees. In particular, our framework ensures constraint satisfaction at all times, while tracking the reference trajectory as close as obstacles allow, resulting in a safe and comfortable driving behavior. To discuss the performance and real-time capability of our framework, we provide first an illustrative simulation example, and then we demonstrate the effectiveness of our framework in experiments with a real test vehicle.
△ Less
Submitted 5 May, 2023;
originally announced May 2023.
-
Collective Decision Making using Attractive and Repulsive Forces in Markovian Opinion Dynamics
Authors:
Carl-Johan Heiker,
Paolo Falcone
Abstract:
In this paper, we model a decision-making process involving a set of interacting agents. We use Markovian opinion dynamics, where each agent switches between decisions according to a continuous time Markov chain. Existing opinion dynamics models are extended by introducing attractive and repulsive forces that act within and between groups of agents, respectively. Such an extension enables the rese…
▽ More
In this paper, we model a decision-making process involving a set of interacting agents. We use Markovian opinion dynamics, where each agent switches between decisions according to a continuous time Markov chain. Existing opinion dynamics models are extended by introducing attractive and repulsive forces that act within and between groups of agents, respectively. Such an extension enables the resemblance of behaviours emerging in networks where agents make decisions that depend both on their own preferences and the decisions of specific groups of surrounding agents. The considered modeling problem and the contributions in this paper are inspired by the interaction among road users (RUs) at traffic junctions, where each RU has to decide whether to go or to yield.
△ Less
Submitted 27 May, 2022; v1 submitted 21 March, 2022;
originally announced March 2022.
-
Road User Position Prediction in Urban Environments via Locally Weighted Learning
Authors:
Angelos Toytziaridis,
Paolo Falcone,
Jonas Sjöberg
Abstract:
This paper focuses on the problem of predicting the future position of a target road user given its current state, consisting of position and velocity. A weighted average approach is adopted, where the weights are determined from data containing the state trajectories of previously observed road users. In particular, a similarity function is introduced to extract from data those previously observe…
▽ More
This paper focuses on the problem of predicting the future position of a target road user given its current state, consisting of position and velocity. A weighted average approach is adopted, where the weights are determined from data containing the state trajectories of previously observed road users. In particular, a similarity function is introduced to extract from data those previously observed road users' states that are most similar to the target's one. This formulation results in an easily interpretable model with few parameters to calibrate. The performance of this weighted average model(WAM) is evaluated on the same real-world data as state-of-the-art methods, showing promising results. WAM outperforms the baseline constant velocity model at longer prediction horizons, making WAM suitable for motion planning applications. WAM and a baseline neural network model performs comparably. Still, WAM has only three parameters which are easily interpretable, while the complex neural network model has thousands of parameters which are difficult to analyze.
△ Less
Submitted 21 April, 2022; v1 submitted 30 January, 2022;
originally announced January 2022.
-
A Semi-Distributed Interior Point Algorithm for Optimal Coordination of Automated Vehicles at Intersections
Authors:
Robert Hult,
Mario Zanon,
Sebastien Gros,
Paolo Falcone
Abstract:
In this paper, we consider the optimal coordination of automated vehicles at intersections under fixed crossing orders. We formulate the problem using direct optimal control and exploit the structure to construct a semi-distributed primal-dual interior-point algorithm to solve it by parallelizing most of the computations. Differently from standard distributed optimization algorithms, where the opt…
▽ More
In this paper, we consider the optimal coordination of automated vehicles at intersections under fixed crossing orders. We formulate the problem using direct optimal control and exploit the structure to construct a semi-distributed primal-dual interior-point algorithm to solve it by parallelizing most of the computations. Differently from standard distributed optimization algorithms, where the optimization problem is split, in our approach we split the linear algebra steps, such that the algorithm takes the same steps as a fully centralized one, while still performing computations in a distributed fashion. We analyze the communication requirements of the algorithm, and propose an approximation scheme which can significantly reduce the data exchange. We demonstrate the effectiveness of the algorithm in hard but realistic scenarios, which show that the approximation leads to reductions in communicated data of almost 99\% of the exact formulation, at the expense of less than 1\% suboptimality.
△ Less
Submitted 19 November, 2021;
originally announced November 2021.
-
On the distributed backward reachability problem for large scale systems
Authors:
Davide Liuzza,
Paolo Falcone,
Massimo Tipaldi,
Luigi Glielmo
Abstract:
Backward reachability (also termed controllability) has been extensively studied in control theory, and tools for a wide class of systems have been developed. Nevertheless, assessing a backward reachability analysis or synthesis remains challenging as the system dimension grows. In this paper we study the backward reachability problem for large scale networked nonlinear systems with coupled dynami…
▽ More
Backward reachability (also termed controllability) has been extensively studied in control theory, and tools for a wide class of systems have been developed. Nevertheless, assessing a backward reachability analysis or synthesis remains challenging as the system dimension grows. In this paper we study the backward reachability problem for large scale networked nonlinear systems with coupled dynamics and subject to states and inputs nonlinear constraints. We propose a theory for completely general nonlinear constrained large scale controllability problems. We demonstrate that it is always possible to recast such problems for the overall large scale system into an equivalent distributed form where, without introducing any conservativeness, each node of the network iteratively solves a local reachability subproblem by exchanging information with the adjacent nodes. Although the proposed algorithm is completely decentralized, the solution of the backward reachability problem for the overall system is equivalently determined by the local ones and satisfies all the given constraints. Not being linked to any specific assumption on the system dynamics nor static constraints, the proposed results hold irrespectively of any possible analytical/numerical solver to be adopted for backward reachability computation.
△ Less
Submitted 10 September, 2021;
originally announced September 2021.
-
Model Predictive Control with Infeasible Reference Trajectories
Authors:
Ivo Batkovic,
Mohammad Ali,
Paolo Falcone,
Mario Zanon
Abstract:
Model Predictive Control (MPC) formulations are typically built on the requirement that a feasible reference trajectory is available. In practical settings, however, references that are infeasible with respect to the system dynamics are used for convenience. In this paper, we prove under which conditions an MPC formulation is Input-to-State Stable~(ISS) in closed-loop when an infeasible reference…
▽ More
Model Predictive Control (MPC) formulations are typically built on the requirement that a feasible reference trajectory is available. In practical settings, however, references that are infeasible with respect to the system dynamics are used for convenience. In this paper, we prove under which conditions an MPC formulation is Input-to-State Stable~(ISS) in closed-loop when an infeasible reference is used, and that with proper terminal conditions, asymptotic stability towards an optimal reference may be achieved. We illustrate the theoretical results with a four-dimensional robotic joint example.
△ Less
Submitted 10 September, 2021;
originally announced September 2021.
-
Computation of Parameter Dependent Robust Invariant Sets for LPV Models with Guaranteed Performance
Authors:
Ankit Gupta,
Manas Mejari,
Paolo Falcone,
Dario Piga
Abstract:
This paper presents an iterative algorithm to compute a Robust Control Invariant (RCI) set, along with an invariance-inducing control law, for Linear Parameter-Varying (LPV) systems. As the real-time measurements of the scheduling parameters are typically available, in the presented formulation, we allow the RCI set description along with the invariance-inducing controller to be scheduling paramet…
▽ More
This paper presents an iterative algorithm to compute a Robust Control Invariant (RCI) set, along with an invariance-inducing control law, for Linear Parameter-Varying (LPV) systems. As the real-time measurements of the scheduling parameters are typically available, in the presented formulation, we allow the RCI set description along with the invariance-inducing controller to be scheduling parameter dependent. The considered formulation thus leads to parameter-dependent conditions for the set invariance, which are replaced by sufficient Linear Matrix Inequality (LMI) conditions via Polya's relaxation. These LMI conditions are then combined with a novel volume maximization approach in a Semidefinite Programming (SDP) problem, which aims at computing the desirably large RCI set. In addition to ensuring invariance, it is also possible to guarantee performance within the RCI set by imposing a chosen quadratic performance level as an additional constraint in the SDP problem. The reported numerical example shows that the presented iterative algorithm can generate invariant sets which are larger than the maximal RCI sets computed without exploiting scheduling parameter information.
△ Less
Submitted 30 November, 2022; v1 submitted 21 September, 2020;
originally announced September 2020.
-
Robust Control Invariance and Communication Scheduling in Lossy Wireless Networked Control Systems
Authors:
Masoud Bahraini,
Mario Zanon,
Paolo Falcone,
Alessandro Colombo
Abstract:
In Networked Control Systems (NCS) impairments of the communication channel can be disruptive to stability and performance. In this paper, we consider the problem of scheduling the access to limited communication resources for a number of decoupled closed-loop systems subject to state and input constraint. The control objective is to preserve the invariance property of local state and input sets,…
▽ More
In Networked Control Systems (NCS) impairments of the communication channel can be disruptive to stability and performance. In this paper, we consider the problem of scheduling the access to limited communication resources for a number of decoupled closed-loop systems subject to state and input constraint. The control objective is to preserve the invariance property of local state and input sets, such that constraint satisfaction can be guaranteed. Offline and online, state feedback scheduling policies are proposed and illustrated through numerical examples, also in case the network is subject to packet losses.
△ Less
Submitted 12 May, 2020;
originally announced May 2020.
-
ParkPredict: Motion and Intent Prediction of Vehicles in Parking Lots
Authors:
Xu Shen,
Ivo Batkovic,
Vijay Govindarajan,
Paolo Falcone,
Trevor Darrell,
Francesco Borrelli
Abstract:
We investigate the problem of predicting driver behavior in parking lots, an environment which is less structured than typical road networks and features complex, interactive maneuvers in a compact space. Using the CARLA simulator, we develop a parking lot environment and collect a dataset of human parking maneuvers. We then study the impact of model complexity and feature information by comparing…
▽ More
We investigate the problem of predicting driver behavior in parking lots, an environment which is less structured than typical road networks and features complex, interactive maneuvers in a compact space. Using the CARLA simulator, we develop a parking lot environment and collect a dataset of human parking maneuvers. We then study the impact of model complexity and feature information by comparing a multi-modal Long Short-Term Memory (LSTM) prediction model and a Convolution Neural Network LSTM (CNN-LSTM) to a physics-based Extended Kalman Filter (EKF) baseline. Our results show that 1) intent can be estimated well (roughly 85% top-1 accuracy and nearly 100% top-3 accuracy with the LSTM and CNN-LSTM model); 2) knowledge of the human driver's intended parking spot has a major impact on predicting parking trajectory; and 3) the semantic representation of the environment improves long term predictions.
△ Less
Submitted 21 April, 2020;
originally announced April 2020.
-
Safe Trajectory Tracking in Uncertain Environments
Authors:
Ivo Batkovic,
Mohammad Ali,
Paolo Falcone,
Mario Zanon
Abstract:
In Model Predictive Control (MPC) formulations of trajectory tracking problems, infeasible reference trajectories and a-priori unknown constraints can lead to cumbersome designs, aggressive tracking, and loss of recursive feasibility. This is the case, for example, in trajectory tracking applications for mobile systems in the presence of constraints which are not fully known a-priori. In this pape…
▽ More
In Model Predictive Control (MPC) formulations of trajectory tracking problems, infeasible reference trajectories and a-priori unknown constraints can lead to cumbersome designs, aggressive tracking, and loss of recursive feasibility. This is the case, for example, in trajectory tracking applications for mobile systems in the presence of constraints which are not fully known a-priori. In this paper, we propose a new framework called Model Predictive Flexible trajectory Tracking Control (MPFTC), which relaxes the trajectory tracking requirement. Additionally, we accommodate recursive feasibility in the presence of a-priori unknown constraints, which might render the reference trajectory infeasible. In the proposed framework, constraint satisfaction is guaranteed at all times while the reference trajectory is tracked as good as constraint satisfaction allows, thus simplifying the controller design and reducing possibly aggressive tracking behavior. The proposed framework is illustrated with three numerical examples.
△ Less
Submitted 2 April, 2021; v1 submitted 30 January, 2020;
originally announced January 2020.
-
Cooperative Intersection Crossing over 5G
Authors:
Luca Maria Castiglione,
Paolo Falcone,
Alberto Petrillo,
Simon Pietro Romano,
Stefania Santini
Abstract:
Autonomous driving is a safety critical application of sensing and decision-making technologies. Communication technologies extend the awareness capabilities of vehicles, beyond what is achievable with the on-board systems only. Nonetheless, issues typically related to wireless networking must be taken into account when designing safe and reliable autonomous systems. The aim of this work is to pre…
▽ More
Autonomous driving is a safety critical application of sensing and decision-making technologies. Communication technologies extend the awareness capabilities of vehicles, beyond what is achievable with the on-board systems only. Nonetheless, issues typically related to wireless networking must be taken into account when designing safe and reliable autonomous systems. The aim of this work is to present a control algorithm and a communication paradigm over 5G networks for negotiating traffic junctions in urban areas. The proposed control framework has been shown to converge in a finite time and the supporting communication software has been designed with the objective of minimising communication delays. At the same time, the underlying network guarantees reliability of the communication. The proposed framework has been successfully deployed and tested, in partnership with Ericsson AB, at the AstaZero proving ground in Goteborg, Sweden. In our experiments, three autonomous vehicles successfully drove through an intersection of 235 square meters in a urban scenario.
△ Less
Submitted 17 July, 2019;
originally announced July 2019.
-
Real-Time Constrained Trajectory Planning and Vehicle Control for Proactive Autonomous Driving With Road Users
Authors:
Ivo Batkovic,
Mario Zanon,
Mohammad Ali,
Paolo Falcone
Abstract:
For motion planning and control of autonomous vehicles to be proactive and safe, pedestrians' and other road users' motions must be considered. In this paper, we present a vehicle motion planning and control framework, based on Model Predictive Control, accounting for moving obstacles. Measured pedestrian states are fed into a prediction layer which translates each pedestrians' predicted motion in…
▽ More
For motion planning and control of autonomous vehicles to be proactive and safe, pedestrians' and other road users' motions must be considered. In this paper, we present a vehicle motion planning and control framework, based on Model Predictive Control, accounting for moving obstacles. Measured pedestrian states are fed into a prediction layer which translates each pedestrians' predicted motion into constraints for the MPC problem.
Simulations and experimental validation were performed with simulated crossing pedestrians to show the performance of the framework. Experimental results show that the controller is stable even under significant input delays, while still maintaining very low computational times. In addition, real pedestrian data was used to further validate the developed framework in simulations.
△ Less
Submitted 18 March, 2019;
originally announced March 2019.
-
A Computationally Efficient Model for Pedestrian Motion Prediction
Authors:
Ivo Batkovic,
Mario Zanon,
Nils Lubbe,
Paolo Falcone
Abstract:
We present a mathematical model to predict pedestrian motion over a finite horizon, intended for use in collision avoidance algorithms for autonomous driving. The model is based on a road map structure, and assumes a rational pedestrian behavior. We compare our model with the state-of-the art and discuss its accuracy, and limitations, both in simulations and in comparison to real data.
We present a mathematical model to predict pedestrian motion over a finite horizon, intended for use in collision avoidance algorithms for autonomous driving. The model is based on a road map structure, and assumes a rational pedestrian behavior. We compare our model with the state-of-the art and discuss its accuracy, and limitations, both in simulations and in comparison to real data.
△ Less
Submitted 13 March, 2018;
originally announced March 2018.
-
A Feasibility-Enforcing Primal-Decomposition SQP Algorithm for Optimal Vehicle Coordination
Authors:
Mario Zanon,
Robert Hult,
Sebastien Gros,
Paolo Falcone
Abstract:
In this paper we consider the problem of coordinating autonomous vehicles approaching an intersection. We cast the problem in the distributed optimisation framework and propose an algorithm to solve it in real time. We extend previous work on the topic by testing two alternative algorithmic solutions in simulations. Moreover, we test our algorithm in experiments using real cars on a test track. Th…
▽ More
In this paper we consider the problem of coordinating autonomous vehicles approaching an intersection. We cast the problem in the distributed optimisation framework and propose an algorithm to solve it in real time. We extend previous work on the topic by testing two alternative algorithmic solutions in simulations. Moreover, we test our algorithm in experiments using real cars on a test track. The experimental results demonstrate the applicability and real-time feasibility of the algorithm.
△ Less
Submitted 4 April, 2017;
originally announced April 2017.
-
Optimal Scheduling of Downlink Communication for a Multi-Agent System with a Central Observation Post
Authors:
Mario Zanon,
Themistoklis Charalambous,
Henk Wymeersch,
Paolo Falcone
Abstract:
In this paper, we consider a set of agents, which may receive an observation of their state by a central observa- tion post via a shared wireless network. The aim of this work is to design a scheduling mechanism for the central observation post to decide how to allocate the available communication resources. The problem is tackled in two phases: (i) first, the local controllers are designed so as…
▽ More
In this paper, we consider a set of agents, which may receive an observation of their state by a central observa- tion post via a shared wireless network. The aim of this work is to design a scheduling mechanism for the central observation post to decide how to allocate the available communication resources. The problem is tackled in two phases: (i) first, the local controllers are designed so as to stabilise the subsystems for the case of perfect communication; (ii) second, the com- munication schedule is decided with the aim of maximising the stability of the subsystems. To this end, we formulate an optimisation problem which explicitly minimises the Lyapunov function increase due to communication limitations. We show how the proposed optimisation can be expressed in terms of Value of Information (VoI), we prove Lyapunov stability in probability and we test our approach in simulations.
△ Less
Submitted 1 April, 2017;
originally announced April 2017.
-
Cooperation with Disagreement Correction in the Presence of Communication Failures
Authors:
Oscar Morales-Ponce,
Elad M. Schiller,
Paolo Falcone
Abstract:
Vehicle-to-vehicle communication is a fundamental requirement in cooperative vehicular systems to achieve high performance while keeping high safety standards. Vehicles periodically exchange critical information with nearby vehicles to determine their maneuvers according to the information quality and established strategies. However, wireless communication is prone to failures. Thus, participants…
▽ More
Vehicle-to-vehicle communication is a fundamental requirement in cooperative vehicular systems to achieve high performance while keeping high safety standards. Vehicles periodically exchange critical information with nearby vehicles to determine their maneuvers according to the information quality and established strategies. However, wireless communication is prone to failures. Thus, participants can be unaware that other participants have not received the information on time resulting in conflicting trajectories that may not be safe. We present a deterministic solution that allows all participants to use a default strategy when other participants have not received on time the complete information. We base our solution on a timed distributed protocol that adapts its output according to the effect of message omission failures so that the disagreement period occurs for no longer than a constant time (of the order of milliseconds) that only depends on the message delay. We formally show the correctness and perform experiments to corroborate its efficiency. We explain how the proposed solution can be used on vehicular platooning to attain high performance and still guarantee high safety standards despite communication failures. We believe that this work can facilitate the implementation of cooperative driving systems that have to deal with inherent (communication) uncertainties.
△ Less
Submitted 26 February, 2015; v1 submitted 29 August, 2014;
originally announced August 2014.
