With increased developments and interest in cooperative driving and higher levels of automation (SAE level 3+), the need for safety systems that are capable to monitor system health and maintain safe operations in faulty scenarios is increasing. A variety of faults or failures could occur, and there exists a high variety of ways to respond to such events. Once a fault or failure is detected, there is a need to classify its severity and decide on appropriate and safe mitigating actions. To provide a solution to this mitigation challenge, in this paper a functional-safety architecture is proposed and an optimization-based mitigation algorithm is introduced. This algorithm uses nonlinear model predictive control (NMPC) to bring a vehicle, suffering from a severe fault, such as a power steering failure, to a safe-state. The internal model of the NMPC uses the information from the fault detection, isolation and identification to optimize the tracking performance of the controller, showcasing the need of the proposed architecture. Given a string of ACC vehicles, our results demonstrate a variety of tactical decision-making approaches that a fault-affected vehicle could employ to manage any faults. Furthermore, we show the potential for improving the safety of the affected vehicle as well as the effect of these approaches on the duration of the manoeuvre.

In this article, we propose a tractable nonlinear fault estimation filter along with explicit performance bounds for a class of linear dynamical systems in the presence of both additive and nonlinear multiplicative faults. We consider the case, where both faults may occur simultaneously and through an identical dynamical relationship, a setting that is relevant to several application domains, including automotive driving, aviation, and chemical plants. The proposed filter architecture combines tools from model-based approaches in the control literature and regression techniques from machine learning. To this end, we view the regression operator through a system-theoretic perspective to develop operator bounds that are then utilized to derive performance bounds for the proposed estimation filter. In the case of constant, simultaneously, and identically acting additive and multiplicative faults, it can be shown that the estimation error converges to zero with an exponential rate. The performance of the proposed estimation filter in the presence of incipient faults is validated through an application on the lateral safety systems of SAE level 4 automated vehicles. The numerical results show that the theoretical bounds of this study are indeed close to the actual estimation error.

Estimating and detecting faults is crucial in ensuring safe and efficient automated systems. In the presence of disturbances, noise, or varying system dynamics, such estimation is even more challenging. To address this challenge, this letter proposes a novel filter to estimate multiple fault signals for a class of discrete-time linear parameter-varying (LPV) systems. The design of such a filter is formulated as an optimization problem and is solved recursively, while the system dynamics may vary over time. Conditions for the existence and detectability of the fault are introduced and the problem is formulated and solved using the quadratic programming framework. We further propose an approximate scheme that can be arbitrarily precise while it enjoys an analytical solution, which supports real-time implementation. The method is illustrated and validated on an automated vehicle's lateral dynamics, which is a practically relevant example for LPV systems. The results show that the estimation filter can decouple unknown disturbances and known or measurable parameter variations in the dynamics while estimating the unknown fault.

Lateral control in the absence of lane markings is an essential safety fallback for an autonomous vehicle in cooperative driving applications. Point following control is one such solutions for lateral control. However, it suffers from corner cutting and severe disturbance amplification throughout the platoon. In this paper, a new model for controller synthesis is proposed which supports including the error induced by the road curvature in the communication between two vehicles. This enables the trailing vehicle to deduce the actual road error states, which negates steady-state corner cutting if these errors are controlled to zero. To demonstrate the benefits of this new control model, an control framework is used to design a lateral controller which minimizes the lateral overshoot of the vehicles during transient maneuvering. The proposed approach has been evaluated using numerical simulations. Simulation results show that the lateral overshoot can be reduced by a factor 10 with respect to existing lateral control solutions.