Motion Planning for Autonomous Driving With Extended Constrained Iterative LQR

Author(s):  
Yutaka Shimizu ◽  
Wei Zhan ◽  
Liting Sun ◽  
Jianyu Chen ◽  
Shinpei Kato ◽  
...  

Abstract Autonomous driving planning is a challenging problem when the environment is complicated. It is difficult for the planner to find a good trajectory that navigates autonomous cars safely with crowded surrounding vehicles. To solve this complicated problem, a fast algorithm that generates a high-quality, safe trajectory is necessary. Constrained Iterative Linear Quadratic Regulator (CILQR) is appropriate for this problem, and it successfully generates the required trajectory in realtime. However, CILQR has some deficiencies. Firstly, CILQR uses logarithmic barrier functions for hard constraints, which will cause numerical problems when the initial trajectory is infeasible. Secondly, the convergence speed is slowed with a bad initial trajectory, which might violate the real-time requirements. To address these problems, we propose the extended CILQR by adding two new features. The first one is using relaxed logarithmic barrier functions instead of the standard logarithmic barrier function to prevent numerical issues. The other one is adding an efficient initial trajectory creator to generate a good initial trajectory. Moreover, this initial trajectory helps CILQR to converge to a desired local optimum. These new features extend CILQR’s usage to more practical autonomous driving applications. Simulation results show that our algorithm is effective in challenging driving environments.

Author(s):  
Taejun Song ◽  
Jongmin Lee ◽  
Kwangseok Oh ◽  
Kyongsu Yi

This paper describes model-based separated fault detection and fault tolerant control of longitudinal autonomous driving using dual-sliding mode observer for functional safety. Internal and environment sensors such as camera or radar are required to measure the acceleration information of the subject vehicle and the relative distance and velocity information between the preceding and subject vehicles in longitudinal autonomous driving. In order to detect the independent fault of each sensor, a dual-sliding mode observer (SMO) is used for fault reconstruction under the assumption that V2V (Vehicle to Vehicle) communication for vehicle driving state is available. The each SMO reconstructs the expected fault in sensor based on discontinuous injection term used for converging output error to zero. Based on the reconstructed fault by each SMO, faults are detected using threshold approach. When the fault is detected, the reconstructed fault is used for fault tolerant control by subtracting to faulty data. The proposed fault detection (FD) and fault tolerant control (FTC) algorithms were evaluated using actual driving data and a three-dimensional (3D) vehicle model with a linear quadratic regulator for following control. The evaluation results are presented and analyzed with regard to fault reconstruction, detection, and tolerant control in four cases wherein two types of faults were applied.


Author(s):  
Omveer Singh

A new technique of evaluating optimal gain settings for full state feedback controllers for automatic generation control (AGC) problem based on a hybrid evolutionary algorithms (EA) i.e. genetic algorithm (GA)-simulated annealing (SA) is proposed in this chapter. The hybrid EA algorithm can take dynamic curve performance as hard constraints which are precisely followed in the solutions. This is in contrast to the modern and single hybrid evolutionary technique where these constraints are treated as soft/hard constraints. This technique has been investigated on a number of case studies and gives satisfactory solutions. This technique is also compared with linear quadratic regulator (LQR) and GA based proportional integral (PI) controllers. This proves to be a good alternative for optimal controller's design. This technique can be easily enhanced to include more specifications viz. settling time, rise time, stability constraints, etc.


2013 ◽  
Vol 133 (12) ◽  
pp. 2167-2175 ◽  
Author(s):  
Katsuhiko Fuwa ◽  
Satoshi Murayama ◽  
Tatsuo Narikiyo

Author(s):  
Wulf Loh ◽  
Janina Loh

In this chapter, we give a brief overview of the traditional notion of responsibility and introduce a concept of distributed responsibility within a responsibility network of engineers, driver, and autonomous driving system. In order to evaluate this concept, we explore the notion of man–machine hybrid systems with regard to self-driving cars and conclude that the unit comprising the car and the operator/driver consists of such a hybrid system that can assume a shared responsibility different from the responsibility of other actors in the responsibility network. Discussing certain moral dilemma situations that are structured much like trolley cases, we deduce that as long as there is something like a driver in autonomous cars as part of the hybrid system, she will have to bear the responsibility for making the morally relevant decisions that are not covered by traffic rules.


Sensors ◽  
2021 ◽  
Vol 21 (2) ◽  
pp. 420
Author(s):  
Stefano Quer ◽  
Luz Garcia

Research on autonomous cars has become one of the main research paths in the automotive industry, with many critical issues that remain to be explored while considering the overall methodology and its practical applicability. In this paper, we present an industrial experience in which we build a complete autonomous driving system, from the sensor units to the car control equipment, and we describe its adoption and testing phase on the field. We report how we organize data fusion and map manipulation to represent the required reality. We focus on the communication and synchronization issues between the data-fusion device and the path-planner, between the CPU and the GPU units, and among different CUDA kernels implementing the core local planner module. In these frameworks, we propose simple representation strategies and approximation techniques which guarantee almost no penalty in terms of accuracy and large savings in terms of memory occupation and memory transfer times. We show how we adopt a recent implementation on parallel many-core devices, such as CUDA-based GPGPU, to reduce the computational burden of rapidly exploring random trees to explore the state space along with a given reference path. We report on our use of the controller and the vehicle simulator. We run experiments on several real scenarios, and we report the paths generated with the different settings, with their relative errors and computation times. We prove that our approach can generate reasonable paths on a multitude of standard maneuvers in real time.


Sensors ◽  
2021 ◽  
Vol 21 (1) ◽  
pp. 287
Author(s):  
Byeongjin Kim ◽  
Soohyun Kim

Walking algorithms using push-off improve moving efficiency and disturbance rejection performance. However, the algorithm based on classical contact force control requires an exact model or a Force/Torque sensor. This paper proposes a novel contact force control algorithm based on neural networks. The proposed model is adapted to a linear quadratic regulator for position control and balance. The results demonstrate that this neural network-based model can accurately generate force and effectively reduce errors without requiring a sensor. The effectiveness of the algorithm is assessed with the realistic test model. Compared to the Jacobian-based calculation, our algorithm significantly improves the accuracy of the force control. One step simulation was used to analyze the robustness of the algorithm. In summary, this walking control algorithm generates a push-off force with precision and enables it to reject disturbance rapidly.


Sign in / Sign up

Export Citation Format

Share Document