Search Results

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.

Positioning system is a key module of autonomous driving. As for LiDAR SLAM system, it faces great challenges in scenarios where there are repetitive and sparse features. Without loop closure or measurements from other sensors, odometry match errors or accumulated errors cannot be corrected. This paper proposes a construction method of LiDAR anchor constraints to improve the robustness of the SLAM system in the above challenging environment. We propose a robust anchor extraction method that adaptively extracts suitable cylindrical anchors in the environment, such as tree trunks, light poles, etc. Skewed tree trunks are detected by feature differences between laser lines. Boundary points on cylinders are removed to avoid misleading. After the appropriate anchors are detected, a factor graph-based anchor constraint construction method is designed. Where direct scans are made to anchor, direct constraints are constructed.

Steering of skid-steered vehicles without steering mechanism is realized by differential drive/brake torque generated from in-wheel motors at left and right sides. Compared to traditional Ackerman-steered vehicles, skid-steered vehicles consume much more energy while steering due to greater steering resistance. Torque allocation is critical to the distributed drive skid-steered vehicles, since it influences not only steering performance, but also energy efficiency. In this paper, the dynamic characteristics of six-wheeled skid-steered vehicles were analyzed, and a 2-DOF vehicle model was established, which is important for both motion tracking control and torque allocation. Furthermore, a hierarchical controller was proposed. Considering tire force characteristics and tire slip, the upper layer calculates the generalized force and desired yaw moment based on anti-windup PI (proportion-integral) control method.