dc14636e68
Refactors the BVH to make it more generic and customizable. Instead of hard coding the system of pairable_mask and pairable_type into the BVH, this information is no longer stored internally, and instead the BVH uses callbacks both for determining whether pairs of objects can pair with each other, and for filtering cull / intersection tests. In addition, instead of hard coding the number of trees, the BVH now supports up to 32 trees, and each object can supply a tree collision mask to determine which trees it can collide against. This enables the BVH to scale to either the two or 3 trees needed in physics, and the single tree used without pairing in Godot 4 render tree.
101 lines
4.7 KiB
C++
101 lines
4.7 KiB
C++
/*************************************************************************/
|
|
/* broad_phase_bvh.h */
|
|
/*************************************************************************/
|
|
/* This file is part of: */
|
|
/* GODOT ENGINE */
|
|
/* https://godotengine.org */
|
|
/*************************************************************************/
|
|
/* Copyright (c) 2007-2022 Juan Linietsky, Ariel Manzur. */
|
|
/* Copyright (c) 2014-2022 Godot Engine contributors (cf. AUTHORS.md). */
|
|
/* */
|
|
/* Permission is hereby granted, free of charge, to any person obtaining */
|
|
/* a copy of this software and associated documentation files (the */
|
|
/* "Software"), to deal in the Software without restriction, including */
|
|
/* without limitation the rights to use, copy, modify, merge, publish, */
|
|
/* distribute, sublicense, and/or sell copies of the Software, and to */
|
|
/* permit persons to whom the Software is furnished to do so, subject to */
|
|
/* the following conditions: */
|
|
/* */
|
|
/* The above copyright notice and this permission notice shall be */
|
|
/* included in all copies or substantial portions of the Software. */
|
|
/* */
|
|
/* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */
|
|
/* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */
|
|
/* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
|
|
/* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */
|
|
/* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */
|
|
/* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */
|
|
/* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
|
|
/*************************************************************************/
|
|
|
|
#ifndef BROAD_PHASE_BVH_H
|
|
#define BROAD_PHASE_BVH_H
|
|
|
|
#include "broad_phase_sw.h"
|
|
#include "core/math/bvh.h"
|
|
|
|
class BroadPhaseBVH : public BroadPhaseSW {
|
|
template <class T>
|
|
class UserPairTestFunction {
|
|
public:
|
|
static bool user_pair_check(const T *p_a, const T *p_b) {
|
|
// return false if no collision, decided by masks etc
|
|
return p_a->test_collision_mask(p_b);
|
|
}
|
|
};
|
|
|
|
template <class T>
|
|
class UserCullTestFunction {
|
|
public:
|
|
static bool user_cull_check(const T *p_a, const T *p_b) {
|
|
return true;
|
|
}
|
|
};
|
|
|
|
enum Tree {
|
|
TREE_STATIC = 0,
|
|
TREE_DYNAMIC = 1,
|
|
};
|
|
|
|
enum TreeFlag {
|
|
TREE_FLAG_STATIC = 1 << TREE_STATIC,
|
|
TREE_FLAG_DYNAMIC = 1 << TREE_DYNAMIC,
|
|
};
|
|
|
|
BVH_Manager<CollisionObjectSW, 2, true, 128, UserPairTestFunction<CollisionObjectSW>, UserCullTestFunction<CollisionObjectSW>> bvh;
|
|
|
|
static void *_pair_callback(void *p_self, uint32_t p_id_A, CollisionObjectSW *p_object_A, int p_subindex_A, uint32_t p_id_B, CollisionObjectSW *p_object_B, int p_subindex_B);
|
|
static void _unpair_callback(void *p_self, uint32_t p_id_A, CollisionObjectSW *p_object_A, int p_subindex_A, uint32_t p_id_B, CollisionObjectSW *p_object_B, int p_subindex_B, void *p_pair_data);
|
|
static void *_check_pair_callback(void *p_self, uint32_t p_id_A, CollisionObjectSW *p_object_A, int p_subindex_A, uint32_t p_id_B, CollisionObjectSW *p_object_B, int p_subindex_B, void *p_pair_data);
|
|
|
|
PairCallback pair_callback;
|
|
void *pair_userdata;
|
|
UnpairCallback unpair_callback;
|
|
void *unpair_userdata;
|
|
|
|
public:
|
|
// 0 is an invalid ID
|
|
virtual ID create(CollisionObjectSW *p_object, int p_subindex = 0, const AABB &p_aabb = AABB(), bool p_static = false);
|
|
virtual void move(ID p_id, const AABB &p_aabb);
|
|
virtual void recheck_pairs(ID p_id);
|
|
virtual void set_static(ID p_id, bool p_static);
|
|
virtual void remove(ID p_id);
|
|
|
|
virtual CollisionObjectSW *get_object(ID p_id) const;
|
|
virtual bool is_static(ID p_id) const;
|
|
virtual int get_subindex(ID p_id) const;
|
|
|
|
virtual int cull_point(const Vector3 &p_point, CollisionObjectSW **p_results, int p_max_results, int *p_result_indices = nullptr);
|
|
virtual int cull_segment(const Vector3 &p_from, const Vector3 &p_to, CollisionObjectSW **p_results, int p_max_results, int *p_result_indices = nullptr);
|
|
virtual int cull_aabb(const AABB &p_aabb, CollisionObjectSW **p_results, int p_max_results, int *p_result_indices = nullptr);
|
|
|
|
virtual void set_pair_callback(PairCallback p_pair_callback, void *p_userdata);
|
|
virtual void set_unpair_callback(UnpairCallback p_unpair_callback, void *p_userdata);
|
|
|
|
virtual void update();
|
|
|
|
static BroadPhaseSW *_create();
|
|
BroadPhaseBVH();
|
|
};
|
|
|
|
#endif // BROAD_PHASE_BVH_H
|