Search Results

In recent years, intelligent driving technology is being extensively studied. This paper proposes a path planning method for perpendicular parking based on vehicle kinematics model using MPC optimization, which aims to solve the perpendicular parking task. Firstly, in the case of any initial position and orientation of the vehicle, judging whether the vehicle can be parked at one step according to the location of the parking place and the width of the lane, and then calculating the starting position for parking, and use the Bezier curve to connect the initial position and the starting position. Secondly, reference parking path is calculated according to the collision constraints of the parking space. Finally, because the parking path based on the vehicle kinematics model is composed of circle arcs and straight lines, the curvature of the path is discontinuous. The reference parking path is optimized using Model Predictive Control (MPC).

A tractor-trailer vehicle (TTV) consists of an actuated tractor attached with several full trailers. Because of its nonlinear and noncompleted constraints, it is a challenging task to avoid collisions for path planner. In this paper, we propose an efficient method to plan an optimal trajectory for TTV to reach the destination without any collision. To deal with the complicated constraints, the trajectory planning problem is formulated as an optimal control problem uniformly, which can be solved by the interior point method. A novel incremental optimization solving algorithm (IOSA) is proposed to accelerate the optimization process, which makes the number of trailers and the size of obstacles increase asynchronously. Simulation experiments are carried out in two scenarios with static obstacles. Compared with other methods, the results show that the planning method with IOSA outperforms in the efficiency.

SLAM (Simultaneous Localization and Mapping) plays a key role in autonomous driving. Recently, 4D Radar has attracted widespread attention because it breaks through the limitations of 3D millimeter wave radar and can simultaneously detect the distance, velocity, horizontal azimuth and elevation azimuth of the target with high resolution. However, there are few studies on 4D Radar in SLAM. In this paper, RI-FGO, a 4D Radar-Inertial SLAM method based on Factor Graph Optimization, is proposed. The RANSAC (Random Sample Consensus) method is used to eliminate the dynamic obstacle points from a single scan, and the ego-motion velocity is estimated from the static point cloud. A 4D Radar velocity factor is constructed in GTSAM to receive the estimated velocity in a single scan as a measurement and directly integrated into the factor graph. The 4D Radar point clouds of consecutive frames are matched as the odometry factor.