An autonomous vehicle sideslip angle estimation algorithm is proposed based on consensus and vehicle kinematics/ dynamics synthesis. Based on the velocity error measurements between the reduced Inertial Navigation System (R-INS) and the global navigation satellite system (GNSS), a velocity-based Kalman filter is formalized to estimate the velocity errors, attitude errors, and gyro bias errors of the R-INS. The observability issue of the heading error, which affects sideslip estimation, is analyzed. Then, to enhance the observability and improve the estimation accuracy of the heading error under normal driving conditions, a consensus Kalman information filter is developed to synthesize the vehicle kinematics and dynamics and estimate the heading error. Within the developed consensus framework, one node augments a novel heading error measurement from a linear vehicle-dynamic-based sideslip estimator and another node adopts the heading error from the GNSS course. Next, based on the vehicle lateral excitation level, a weighting scheme is proposed to fuse the error state estimates from the velocity-based and consensus Kalman state observers. The stability of the proposed state observers is also investigated. Comprehensive experimental studies, including critical slalom, slight/normal double lane change, and normal driving maneuvers, were conducted to verify the proposed estimation framework; they confirm the reliability and accuracy of the estimator in various automated driving conditions even in comparison with state-of-the-art methods that utilize more measurements (dual-antenna GNSS). Also, this novel multisensor framework is extendable to leverage speed information from other sensors such as cameras and light detection and ranging (LiDAR) to increase reliability and accuracy.

Vehicle control is one of the most critical challenges in autonomous vehicles (AVs) and connected and automated vehicles (CAVs), and it is paramount in vehicle safety, passenger comfort, transportation efficiency, and energy saving. This survey attempts to provide a comprehensive and thorough overview of the current state of vehicle control technology, focusing on the evolution from vehicle state estimation and trajectory tracking control in AVs at the microscopic level to collaborative control in CAVs at the macroscopic level. First, this review starts with vehicle key state estimation, specifically vehicle sideslip angle, which is the most pivotal state for vehicle trajectory control, to discuss representative approaches. Then, we present symbolic vehicle trajectory tracking control approaches for AVs. On top of that, we further review the collaborative control frameworks for CAVs and corresponding applications. Finally, this survey concludes with a discussion of future research directions and the challenges. This survey aims to provide a contextualized and in-depth look at the state of the art in vehicle control for AVs and CAVs, identifying critical areas of focus and pointing out the potential areas for further exploration.

Vehicle slip angle (VSA) estimation is of paramount importance for connected automated vehicle dynamic control, especially in critical lateral driving scenarios. In this paper, a novel kinematic-model-based VSA estimation method is proposed by fusing information from a global navigation satellite system (GNSS) and an inertial measurement unit (IMU). First, to reject the gravity components induced by the vehicle roll and pitch, a vehicle attitude angle observer based on the square-root cubature Kalman filter (SCKF) is designed to estimate the roll and pitch. A novel feedback mechanism based on the vehicle intrinsic information (the steering angle and wheel speed) for the pitch and roll is designed. Then, the integration of the reverse smoothing and grey prediction is adopted to compensate for the cumulative velocity errors during the relatively low sampling interval of the GNSS. Moreover, the GNSS signal delay has been addressed by an estimation-prediction integrated framework. Finally, the results confirm that the proposed method can estimate the VSA under both the slalom and double lane change (DLC) scenarios.

The sideslip angle and attitude are crucial for automated driving especially for chassis integrated control and environmental perception. In this article an inertial measurement unit (IMU)-based automated vehicle body sideslip angle and attitude estimation method aided by low-sample-rate global navigation satellite system (GNSS) velocity and position measurements using parallel adaptive Kalman filters is proposed. This method can estimate the sideslip angle and attitude simultaneously and is robust against the vehicle parameters and road friction even as the vehicle enters critical maneuvers. First, based on the acceleration and angular rate from the six-dimensional inertial measurement unit, the attitude, velocity and position (AVP) are integrated with the navigation coordinates and the AVP error dynamics and observation equations of the integration results are developed. Second, parallel innovation adaptive estimation (IAE)-based Kalman filters is designed to estimate the AVP error of the integration method to address the issues of the GNSS low sampled rate and abnormal measurements. Then the AVP error is forwarded to the AVP integration to compensate the accumulated error. To improve the heading angle estimation accuracy, the heading error is estimated by a decoupled IAE-based Kalman filter aided by GNSS heading. In addition, time synchronization of the IMU and GNSS is realized through hardware based on the pulse per second signal of the GNSS receiver and the spatial synchronization is achieved by a direct compensation method. Lastly, the sideslip angle and attitude estimation method is validated by a comprehensive experimental test including critical double lane change and slalom maneuvers. The results show that the estimation error of the longitudinal velocity and lateral velocity is smaller than 0.1 m/s (1σ), and the estimation error of the sideslip angle is smaller than 0.15° (1σ).

Vehicle localization is essential for intelligent and autonomous vehicles. To improve the accuracy of vehicle stand-alone localization in highly dynamic driving conditions during GNSS (Global Navigation Satellites Systems) outages, this paper proposes a vehicle localization system based on vehicle chassis sensors considering vehicle lateral velocity. Firstly, a GNSS/On-board sensors fusion localization framework is established, which could estimate vehicle states such as attitude, velocity, and position. Secondly, when the vehicle has a large lateral motion, nonholonomic constraint in the lateral direction loses fidelity. Instead of using nonholonomic constraint, we propose a vehicle dynamics/kinematics fusion lateral velocity estimation algorithm, which combines the advantage of vehicle dynamic model in low dynamic driving conditions and the advantage of kinematic model in highly dynamic driving conditions. Thirdly, vehicle longitudinal velocity estimated by WSS (Wheel Speed Sensor) and lateral velocity estimated by proposed method are as measurements for the localization system. All information is fused by an adaptive Kalman filter. Finally, vehicle experiments in U-turn maneuver and left-turn maneuver at a traffic intersection are conducted to verify the proposed method. Four different methods are compared in the experiments, and the results show that the estimated position accuracy of our method is below half a meter during a 5s GNSS outage and could keep a sub-meter-level during a 20s GNSS outage while the vehicle has a relatively large lateral motion.

Autonomous driving requires efficient and safe decision making and motion planning in dynamic and uncertain environments. Future movement of surrounding vehicles is often difficult to represent. Besides, most existing studies consider decision making and planning/control separately. Both them may lead to the oscillation and unsafe for autonomous driving. This paper proposes an integrated framework of decision making and motion planning with oscillation-free capability. The proposed approach overcomes the shortcomings of autonomous driving for lane change/keeping maneuvers and is able to: i) make oscillation-free behavior decisions given biased prediction; ii) cut through in the traffic efficiently and safely when being in squeezed; iii) accelerate computation efficiency by building a state transfer model based on prediction uncertainty; iv) reduce the dissonance between decision-making and motion planning. A belief decision planner is designed with the uncertainty of the prediction trajectories. Lateral and longitudinal drivable corridors including the reference state and the related boundary constraints are built, which provide better suited information for planning to solve the optimal motion sequence more quickly and stably, and improve its consistency with decision module. Finally, the problem is formulated as an optimal control problem considering the vehicle dynamics and some soft constraints and the motion trajectory is solved by OSQP. Simulation and experimental tests are implemented to evaluate the feasibility and effectiveness of the proposed approach. Test results show that the integrated approach can make proper, safe and continuous decision and planning for autonomous vehicles and the calculation time is very low.