A 3D probabilistic pathfinder built for the 2021 AUVSI-SUAS UAV competition.
Currently only box search spaces and cylinderical obstacles are supported.
Obstacles are represented by triangular meshes. This allows efficient line segment intersections using the Moller-Trumbore ray-triangle intersection algorithm
Additionally, obstacles must have a well-defined inside.