Abstract:Autonomous driving systems rely on a comprehensive understanding of the surrounding environment, and trees, as important roadside features, have a significant impact on vehicle positioning and safety analysis. Existing methods use mobile LiDAR systems (MLS) to collect environmental information and automatically generate tree inventories based on dense point clouds, providing accurate geometric parameters. However, the use of MLS systems requires expensive survey-grade laser scanners and high-precision GNSS/IMU systems, which limits their large-scale deployment and results in poor real-time performance. Although LiDAR-based simultaneous localization and mapping (SLAM) techniques have been widely applied in the navigation field, to the best of my knowledge, there has been no research conducted on simultaneous real-time localization and roadside tree inventory. This paper proposes an innovative approach that uses LiDAR technology to achieve vehicle positioning and a roadside tree inventory. Firstly, a front-end odometry based on an error-state Kalman filter (ESKF) and a back-end optimization framework based on factor graphs are employed. The updated poses from the back-end are used for establishing point-to-plane residual constraints for the front-end in the local map. Secondly, a two-stage approach is adopted to minimize global mapping errors, refining accumulated mapping errors through GNSS-assisted registration to enhance system robustness. Additionally, a method is proposed for creating a tree inventory that extracts line features from real-time LiDAR point cloud data and projects them onto a global map, providing an initial estimation of possible tree locations for further tree detection. This method uses shared feature extraction results and data pre-processing results from SLAM to reduce the computational load of simultaneous vehicle positioning and roadside tree inventory. Compared to methods that directly search for trees in the global map, this approach benefits from fast perception of the initial tree position, meeting real-time requirements. Finally, our system is extensively evaluated on real datasets covering various road scenarios, including urban and suburban areas. The evaluation metrics are divided into two parts: the positioning accuracy of the vehicle during operation and the detection accuracy of trees. The results demonstrate centimeter-level positioning accuracy and real-time automatic creation of a roadside tree inventory.

Bayesian Simultaneous Localization and Multi-Lane Tracking Using Onboard Sensors and a SD Map

Multimodal Localization: Stereo over LiDAR Map

Persistent Stereo Visual Localization on Cross-Modal Invariant Map

Road-Map Aided GM-PHD Filter for Multivehicle Tracking With Automotive Radar

A lane-level localization method via the lateral displacement estimation model on expressway

Tightly coupled integration of vector HD map, LiDAR, GNSS, and INS for precise vehicle navigation in GNSS-challenging environment

TopoSD: Topology-Enhanced Lane Segment Perception with SDMap Prior

SafeDrive: A Robust Lane Tracking System for Autonomous and Assisted Driving Under Limited Visibility

Deep Multi-Sensor Lane Detection

Improving Vision-based Self-positioning in Intelligent Transportation Systems via Integrated Lane and Vehicle Detection

Lane Information Extraction for High Definition Maps Using Crowdsourced Data

Simultaneous Vehicle Localization and Roadside Tree Inventory Using Integrated LiDAR-Inertial-GNSS System

3D Extended Object Tracking by Fusing Roadside Sparse Radar Point Clouds and Pixel Keypoints

Robust Lane-Detection Method for Low-Speed Environments

Multi-Target Tracking Algorithm Combined with High-Precision Map

Real-time Lane Detection and Tracking for Autonomous Vehicle Applications

Global Navigation Satellite System/Inertial Measurement Unit/Camera/HD Map Integrated Localization for Autonomous Vehicles in Challenging Urban Tunnel Scenarios

High Precision Vehicle Localization Based on Tightly-coupled Visual Odometry and Vector HD Map

Continuous and Precise Positioning in Urban Environments by Tightly Coupled Integration of GNSS, INS and Vision

Camera-Based Lane-Aided Multi-Information Integration for Land Vehicle Navigation

L2T-BEV: Local Lane Topology Prediction from Onboard Surround-View Cameras in Bird's Eye View Perspective.