[CGAL] 3D快速相交和距离计算（AABB_tree）- 三角形碰撞检测

已于 2022-03-27 21:08:30 修改
阅读量9.3k 收藏 38
点赞数 9
分类专栏： 计算几何 文章标签： CGAL 快速相交 AABBTree
于 2020-08-06 16:18:04 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/summer_dew/article/details/107842978
版权

文章目录

更多CGAL文章，请看CGAL知识库
计算几何技术交流群：604668232

AABB Tree简介

「AABB Tree」AABB树组件提供了静态数据结构和算法，以支持对有限的3D对象集执行相交和距离查询。可以查询存储在数据结构中的一组几何对象，以进行相交检测、相交计算和距离计算。

  1. 如果在traits类中实现了相应的相交谓词和构造函数，则相交查询可以支持任何类型
  2. 距离查询仅限于点查询


「官方提供的例子」

  1. 相交查询：针对三角形集的线对象（射线、线、线段）查询、针对线段集的平面对象（平面、三角形）
  2. 距离查询：查找从点查询到一组三角形的最近点


「注意」此组件不适合在n个对象集中查找所有对象的交对。适用于dD lso定向盒的相交序列组件，它可以找到所有ISO定向盒的相交对


「工作原理」

  1. AABB树将几何数据的迭代器（例如，std::list<Triangle>的迭代器）作为输入，然后将其转换为基元(primitives)
  2. 根据这些原语(primitives)，构建轴对齐边界框（AABB）的层次结构，并将其用于加快相交和距离查询。每个图元(primitive)可以访问一个输入几何对象（称之为基准）和该对象的一个参考标识。
  3. 每个相交查询可以返回相交图元的相交对象（例如，用于射线查询的3D点或线段）以及id（face的句柄）
  4. 同样，每个距离查询都可以返回点查询中最接近的点以及最接近的图元id

接口

构造

AABB Tree组件的主要入口点是AABB_tree，该类从几何数据集中构建一个静态的AABB树，该类实例化后，即可进行相交和距离查询等操作。

由Triangle构造

#include <CGAL/Simple_cartesian.h>
#include <CGAL/AABB_tree.h>
#include <CGAL/AABB_traits.h>
#include <CGAL/AABB_triangle_primitive.h>

typedef CGAL::Simple_cartesian<double> K;

typedef K::FT FT;
typedef K::Ray_3 Ray;
typedef K::Line_3 Line;
typedef K::Point_3 Point;
typedef K::Triangle_3 Triangle;

typedef std::list<Triangle>::iterator Iterator;
typedef CGAL::AABB_triangle_primitive<K, Iterator> Primitive;
typedef CGAL::AABB_traits<K, Primitive> AABB_triangle_traits;
typedef CGAL::AABB_tree<AABB_triangle_traits> Tree;

Point a(1.0, 0.0, 0.0);
Point b(0.0, 1.0, 0.0);
Point c(0.0, 0.0, 1.0);
Point d(0.0, 0.0, 0.0);

std::list<Triangle> triangles;
triangles.push_back(Triangle(a,b,c));
triangles.push_back(Triangle(a,b,d));
triangles.push_back(Triangle(a,d,c));

Tree tree(triangles.begin(),triangles.end());

由Polyhedron构造

#include <CGAL/Simple_cartesian.h>
#include <CGAL/AABB_tree.h>
#include <CGAL/AABB_traits.h>
#include <CGAL/Polyhedron_3.h>
#include <CGAL/AABB_face_graph_triangle_primitive.h>

typedef CGAL::Simple_cartesian<double> K;
typedef K::Point_3 Point;
typedef K::Plane_3 Plane;
typedef K::Vector_3 Vector;
typedef K::Segment_3 Segment;
typedef K::Ray_3 Ray;
typedef CGAL::Polyhedron_3<K> Polyhedron;
typedef CGAL::AABB_face_graph_triangle_primitive<Polyhedron> Primitive;
typedef CGAL::AABB_traits<K, Primitive> Traits;
typedef CGAL::AABB_tree<Traits> Tree;
typedef boost::optional< Tree::Intersection_and_primitive_id<Segment>::Type > Segment_intersection;
typedef boost::optional< Tree::Intersection_and_primitive_id<Plane>::Type > Plane_intersection;
typedef Tree::Primitive_id Primitive_id;

Point p(1.0, 0.0, 0.0);
Point q(0.0, 1.0, 0.0);
Point r(0.0, 0.0, 1.0);
Point s(0.0, 0.0, 0.0);

Polyhedron polyhedron;
polyhedron.make_tetrahedron(p, q, r, s);

// constructs AABB tree
Tree tree(faces(polyhedron).first, faces(polyhedron).second, polyhedron);

相交测试

  1. AABB_tree::do_intersect()：测试输入图形是否与AABB树相交。此函数之所以快速，是因为它仅涉及谓词，并在遇到第一个相交点后就停止
  2. AABB_tree::number_of_intersected_primitives()：计算所有相交图元，返回个数
  3. AABB_tree::all_intersected_primitives()：枚举出所有相交图元的id（所以无需构造相应的相交对象）
  4. AABB_tree::any_intersected_primitive()：返回第一个相交的图元id（如果存在相交情况）
  5. AABB_tree::first_intersected_primitive()：返回与射线最近的相交对象ID（如果存在）
// 与线段是否相交
Segment segment_query(a,b);
if(tree.do_intersect(segment_query))
        std::cout << "intersection(s)" << std::endl;
else
    std::cout << "no intersection" << std::endl;

// 与射线相交的个数
Ray ray_query(a,b);
std::cout << tree.number_of_intersected_primitives(ray_query) 
    << " intersections(s) with ray query" << std::endl;

// 与线段相交的所有图元的ID
std::list<Primitive_id> primitives;
tree.all_intersected_primitives(segment_query, std::back_inserter(primitives));

构造出结果（Constructions）

  1. AABB_tree::all_intersections()：与输入图元做相交检测，并构造出所有对象
  2. AABB_tree::any_intersection()：检测并构造出第一个相交图元
  3. AABB_tree::first_intersection()：检测并构造出与射线最近的相交对象
// 获得所有结果
std::list<Segment_intersection> intersections;
tree.all_intersections(segment_query, std::back_inserter(intersections));

// 检测并构造出第一个相交图元
Vector vec(0.0,0.0,1.0);
Plane plane_query(a,vec);
Plane_intersection plane_intersection = tree.any_intersection(plane_query);
if(plane_intersection) {
    if(boost::get<Segment>(&(plane_intersection->first)))
        std::cout << "intersection object is a segment" << std::endl;
}

距离计算

  1. AABB_tree::closet_point()：获得距离给定点最近的点
  2. AABB_tree::closest_point_and_primitive()：获得距离给定点最近的图元ID

说明：AABB_tree使用辅助搜索结构来加快距离查询，但默认情况下并不会生成此数据结构，因为它仅用于距离计算。用户可在第一次计算距离之前，通过调用AABB_tree::accelerate_distance_queries()来请求二级结构的构造。

// 计算最近点
Point point_query(2.0, 2.0, 2.0);
Point closest_point = tree.closest_point(point_query);
std::cerr << "closest point is: " << closest_point << std::endl;

// 最近的距离
FT sqd = tree.squared_distance(point_query);
std::cout << "squared distance: " << sqd << std::endl;

// 计算最近点和最近点所在的图元ID
typedef Tree::Point_and_primitive_id Point_and_primitive_id;
Point_and_primitive_id pp = tree.closest_point_and_primitive(query);
Point closest_point = pp.first; // 最近点
Polyhedron::Face_handle f = pp.second;	// 最近点所在的图元ID
std::cout << "closest point: " << closest_point << std::endl;
std::cout << "closest triangle: ( "
    << f->halfedge()->vertex()->point() << " , " 
    << f->halfedge()->next()->vertex()->point() << " , "
    << f->halfedge()->next()->next()->vertex()->point()
    << " )" << std::endl;

简单例子

三角形碰撞检测

// Author(s) : GeoDoer

#include <iostream>
#include <list>

#include <CGAL/Simple_cartesian.h>
#include <CGAL/AABB_tree.h>
#include <CGAL/AABB_traits.h>
#include <CGAL/AABB_triangle_primitive.h>

typedef CGAL::Simple_cartesian<double> Kernel;
typedef Kernel::Point_3 Point3;
typedef Kernel::Triangle_3 Triangle_3;
typedef std::list<Triangle_3>::iterator Iterator;
typedef CGAL::AABB_triangle_primitive<Kernel, Iterator> Primitive;
typedef CGAL::AABB_traits<Kernel, Primitive> AABB_triangle_traits;
typedef CGAL::AABB_tree<AABB_triangle_traits> Tree;
typedef Tree::Primitive_id Primitive_id;

int main()
{
	三角网
	Point3 a(1.0, 0.0, 0.0);
	Point3 b(0.0, 1.0, 0.0);
	Point3 c(0.0, 0.0, 1.0);
	Point3 d(0.0, 0.0, 0.0);

	std::list<Triangle_3> triangles;
	triangles.push_back(Triangle_3(a, b, c));
	triangles.push_back(Triangle_3(a, b, d));
	triangles.push_back(Triangle_3(a, d, c));

	三角网的AABB_tree
	Tree tree(triangles.begin(), triangles.end());

	用一个三角形与该三角网做相撞测试
	Triangle_3 tri_query(c, d, b);

	碰撞检测
	if(!tree.do_intersect(tri_query))
	{
		std::cout << "不相交" << std::endl;
	}

	相交个数
	std::cout << "相交个数" << tree.number_of_intersected_primitives(tri_query) << std::endl;

	获得与tri_query相交的所有图元
	std::list<Primitive_id> primitives;
	tree.all_intersected_primitives(tri_query, std::back_inserter(primitives));

	for(std::list<Primitive_id>::iterator it = primitives.begin(); it != primitives.end(); ++it)
	{
		const Primitive_id& primitive_id = *it;
		int index = std::distance(primitives.begin(), it); //第几个
		std::cout << "第" << index << "个三角形：";
		std::cout << primitive_id->vertex(0) << ";" << primitive_id->vertex(1) << ";" << primitive_id->vertex(2) << std::endl;
	}

	第一个相交的图元
	auto first_intersection_id = tree.any_intersected_primitive(tri_query);
    
	return EXIT_SUCCESS;
}

三角网太复杂时，遇到这种问题：初判是精度问题，还不知道如何解决

在这里插入图片描述

在这里插入图片描述

CGAL 碰撞测试
dayuhaitang1的博客
08-19 398
CGAL 碰撞测试
aabb-tree：MATLAB的d维aabb-tree实现
02-04
aabb-tree：MATLAB的d维aabb-tree实现
CGAL的AABB tree
weixin_44897632的博客
01-01 2876
AABB树组件提供了一种静态数据结构和算法，用于对有限的三维几何对象集进行高效的交集和距离查询。可以查询数据结构中存储的几何对象集，以进行交集检测、交集计算和距离计算。交集查询可以是任何类型的，只要在traits类中实现了相应的交集谓词和构造函数。距离查询仅限于点查询。交集查询的例子包括针对三角形集的线对象（射线、线、线段），或针对线段集的平面对象（平面、三角形）。距离查询的一个例子包括从点查询中找到最接近三角形集的点。请注意，该组件不适合查找所有相交对象对的问题。
C++自研游戏引擎-碰撞检测组件-八叉树AABB检测算法实现
最新发布
失业求捞！
02-13 1085
八叉树碰撞检测是一种在三维空间中高效处理物体碰撞检测的算法，其原理可以类比为一个管理三维空间物体的智能系统。这个示例包含两个部分：八叉树部分用于宏观检测，AABB用于微观检测。AABB可以更换为均值或节点检测来提高检测精度。
CG碰撞检测 Collision Testing
zhanghanqmx的博客
06-09 267
实时性精确性Acturaty 近似检测、精确检测临界状态 几何空间试图相互穿透 描述对象的运动状态-四维空间点集边界球、边界框 virtual&intangible Simplify the solution of methemetical model.visualizationwandering dropback Box colliderdooropen doorshothousedoor tag Mesh Collider delete choose door Component-physics
碰撞检测
laziji的专栏
04-10 471
#include <vtkVersion.h> #include <vtkProperty.h> #include <vtkCellArray.h> #include<vtkPolyDataMapper.h> #include<vtkDelaunay3D.h> #include <vtkSphereSource.h> #in...
【CGAL】自相交检测
Beyond欣
01-19 4298
【CGAL 】自相交检测 自相交包括三种（三角形片体），而模型有自相交则无法生成体网格等。 vcg（meshlab）有提供一个自相交检测接口，在实际使用时有些bug，比如补完部分自相交后，其余自相交检测不准确。这里用cgal测试一下效果。 思路就是vtk读取片体的stl模型，生成off文件。 cgal读取off文件，识别自相交并记录相交片体。 vtk显示自相交片体。 cmake_minimum_required(VERSION 3.1.0) set(CMAKE_INCLUDE_CURRENT_DIR O
CGAL-vc100-mt-gt-4.0-3D.rar_CGAL 4.0_CGAL-vc100-m_cgal
09-20
5. **碰撞检测**：通过CGAL，可以检测两个或多个多面体是否相交，这对于游戏开发和物理模拟至关重要。 6. **接口与API**：CGAL提供C++接口，并且兼容多种编程语言，如Python和Java，使得集成到各种项目中变得简单。...
CGAL-vc100-mt-gd-4.0.rar_CGAL dll_CGAL-vc90-mt.lib_MT 2D
09-20
通过正确使用"CGAL-vc100-mt-gd-4.0.dll"和"CGAL-vc90-mt.lib"，开发者可以在不同版本的Visual C++环境中构建和运行依赖CGAL的项目。而"main.cpp"和"main.h"文件则提供了实践CGAL功能的实例，对于理解CGAL库的使用...
使用CGAL AABBTree计算点到obj模型的距离
WoW的博客
12-18 3250
文档：https://doc.cgal.org/latest/AABB_tree/index.html 文档中关于距离计算的实现： Distance. An AABB tree computes the closest point from a given point query to the input primitives through the function AABB_tree::c
cgal-swig-bindings:使用SWIG的CGAL绑定
05-25
文件"**cgal-swig-bindings-main**"很可能是一个包含示例代码、文档或者绑定生成脚本的主目录，用于指导用户如何构建和使用这些绑定。在实践中，开发者通常需要下载CGAL库，安装SWIG，然后按照提供的指南配置和编译...
matlab开发-AABBtreeadDimensionalBoundingBoxTree（AABBtreeadDimensionalBoundingBoxTree）
08-23
matlab开发-AABBtreeadDimensionalBoundingBoxTree（AABBtreeadDimensionalBoundingBoxTree）。用于对象集合的三维边界框树。
aabb_三角形相交_网格快速判断_saildrp_三角形相交_AABB_
09-30
快速判断，三角形是否相交，头文件，C++，
bvh：动态AABB树实现
02-22
bvh：动态AABB树实现
八叉树 Octree.cpp
05-23
关于八叉树实现的代码,可创建八叉树，先序遍历八叉树，查看树深度，查找节点
物理引擎学习08-AABB树
游蓝海 的专栏
05-19 6581
AABB树是由AABB结点构成的二叉树，常用来加速场景中的射线检测和碰撞检测。树的每个结点都是一个包围盒，且结点的包围盒包裹了所有子结点的包围盒。本文深入的讲解了AABB树相关的算法，以及结合物理引擎使用。
方盒与三角网格碰撞检测
yuan18710903822的博客
05-15 406
检测两个物体在分离轴上的投影是否有重叠，以下为方盒与三角网格中的一个三角形的碰撞检测，源代码为开源Open Dynamics Engine。
CGAL AABB树
dayuhaitang1的博客
09-27 334
CGAL AABB树
UE5.5 Geometry库的空间加速结构--AABBTree
qq_29523119的博客
12-03 1305
AABB 树（Axis-Aligned Bounding Box Tree）是一种在计算机图形学、计算机游戏、机器人运动规划、碰撞检测等领域广泛应用的数据结构，用于高效地处理几何对象之间的空间关系，尤其是碰撞检测方面。是一个简单的几何概念，它是一个长方体（在二维空间中是矩形），其各边分别与坐标轴平行。对于一组几何对象（如三维模型中的多个三角形面片组成的物体），可以找到一个刚好能包围这些对象的 AABB，这个 AABB 能简单且快速地描述这些对象在空间中的大致位置和范围。
评论 5
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

geodoer

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付：¥1
获取中
扫码支付

您的余额不足，请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值