Preprint has been published in a journal as an article
DOI of the published article https://doi.org/10.5194/isprs-annals-XI-1-2026-245-2026
Preprint / Version 1

3L-Planner: Lightweight LiDAR mapping and real-time local planning for ground robot autonomous navigation

##article.authors##

  • Wenlei Fan State Key Laboratory of Information Engineering in Surveying, Mapping and Remote Sensing, Wuhan University, China
  • Zhenqi Zheng

DOI:

https://doi.org/10.31224/7563

Keywords:

NMPC, mapping, LIDAR

Abstract

Mobile robots are widely used in unmanned surveying, warehouse logistics, and emergency response. However, achieving safe, reliable, and efficient autonomous navigation in unknown environments remains challenging, where accurate environment representation and feasible trajectory planning are crucial. This paper presents an autonomous navigation method integrating lightweight LiDAR mapping with real-time local planning for ground robots. At the perception level, an incremental single-frame point cloud update is used to accumulate and project locally traversable space, producing a lightweight obstacle map that preserves geometric accuracy while reducing planning computation. At the planning level, A* is employed to generate reference control points, and uniform B-spline curves are used to optimize the trajectory while enforcing kinematic feasibility and smoothness. At the control level, nonlinear model predictive control (NMPC) ensures accurate trajectory tracking by producing control commands that satisfy velocity and acceleration constraints. The framework also supports low-cost evaluation in simulation. Experiments in simulated forests, simulated indoor corridors, and real-world gardens and hallways show average navigation speeds of 2.24 m/s, 0.76 m/s, 0.43 m/s, and 0.38 m/s, respectively. Results demonstrate that the proposed method generates smooth, feasible, and safe trajectories and completes autonomous navigation and mapping tasks across diverse environments.

Downloads

Download data is not yet available.

Additional Files

Posted

2026-07-13