Abstract:This paper explores a rapid, optimal smooth path-planning algorithm for robots (e.g., autonomous vehicles) in point cloud environments. Derivative maps such as dense point clouds, mesh maps, Octomaps, etc. are frequently used for path planning purposes. A bi-directional target-oriented point planning algorithm, directly using point clouds to compute the optimized and dynamically feasible trajectories, is presented in this paper. This approach searches for obstacle-free, low computational cost, smooth, and dynamically feasible paths by analyzing a point cloud of the target environment, using a modified bi-directional and RRT-connect-based path planning algorithm, with a k-d tree-based obstacle avoidance strategy and three-step optimization. This presented approach bypasses the common 3D map discretization, directly leveraging point cloud data and it can be separated into two parts: modified RRT-based algorithm core and the three-step optimization. Simulations on 8 2D maps with different configurations and characteristics are presented to show the efficiency and 2D performance of the proposed algorithm. Benchmark comparison and evaluation with other RRT-based algorithms like RRT, B-RRT, and RRT star are also shown in the paper. Finally, the proposed algorithm successfully achieved different levels of mission goals on three 3D point cloud maps with different densities. The whole simulation proves that not only can our algorithm achieves a better performance on 2D maps compared with other algorithms, but also it can handle different tasks(ground vehicles and UAV applications) on different 3D point cloud maps, which shows the high performance and robustness of the proposed algorithm. The algorithm is open-sourced at \url{<a class="link-external link-https" href="https://github.com/zhz03/BTO-RRT" rel="external noopener nofollow">this https URL</a>}

Approximate Distance Queries for Path-planning in Massive Point Clouds

Generating Large Convex Polytopes Directly on Point Clouds

VDBblox: Accurate and Efficient Distance Fields for Path Planning and Mesh Reconstruction

Advanced Methods for Point Cloud Processing and Simplification

Collision-Affording Point Trees: SIMD-Amenable Nearest Neighbors for Fast Collision Checking

A Method to Order Point Clouds for Visualization on the Ray Tracing Pipeline

Study on a nearest neighbor algorithm for point clouds based on the space partition principle

Massive Point Cloud Processing for Efficient Construction Quality Inspection and Control

Algorithm for Fast Calculating the Nearest Distance Between Space Point and Arbitrary Polyhedron

Point Cloud Collision Detection

Fast occlusion-based point cloud exploration

An Efficient Method to Mesh Point Cloud

Balancing Cpu And Gpu: Real-Time Visualization Of Large Scale 3d Scanning Models

2L-LSH: A Locality-Sensitive Hash Function-Based Method For Rapid Point Cloud Indexing

Sphere sets from point clouds for efficient collision detection in robot motion planning

BTO-RRT: A rapid, optimal, smooth and point cloud-based path planning algorithm

Point Cloud Trajectory Planning Based on Octree and K-Dimensional Tree Algorithm

Hash Map Method of 3D Point Cloud Data for Real-time Organizing

Efficient Global Navigational Planning in 3D Structures based on Point Cloud Tomography

Compressed Geometric Arrays for Point Cloud Processing

Progressive Real‐Time Rendering of One Billion Points Without Hierarchical Acceleration Structures