1 | /**************************************************************************/ |
2 | /* godot_broad_phase_3d_bvh.h */ |
3 | /**************************************************************************/ |
4 | /* This file is part of: */ |
5 | /* GODOT ENGINE */ |
6 | /* https://godotengine.org */ |
7 | /**************************************************************************/ |
8 | /* Copyright (c) 2014-present Godot Engine contributors (see AUTHORS.md). */ |
9 | /* Copyright (c) 2007-2014 Juan Linietsky, Ariel Manzur. */ |
10 | /* */ |
11 | /* Permission is hereby granted, free of charge, to any person obtaining */ |
12 | /* a copy of this software and associated documentation files (the */ |
13 | /* "Software"), to deal in the Software without restriction, including */ |
14 | /* without limitation the rights to use, copy, modify, merge, publish, */ |
15 | /* distribute, sublicense, and/or sell copies of the Software, and to */ |
16 | /* permit persons to whom the Software is furnished to do so, subject to */ |
17 | /* the following conditions: */ |
18 | /* */ |
19 | /* The above copyright notice and this permission notice shall be */ |
20 | /* included in all copies or substantial portions of the Software. */ |
21 | /* */ |
22 | /* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */ |
23 | /* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */ |
24 | /* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. */ |
25 | /* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */ |
26 | /* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */ |
27 | /* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */ |
28 | /* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */ |
29 | /**************************************************************************/ |
30 | |
31 | #ifndef GODOT_BROAD_PHASE_3D_BVH_H |
32 | #define GODOT_BROAD_PHASE_3D_BVH_H |
33 | |
34 | #include "godot_broad_phase_3d.h" |
35 | |
36 | #include "core/math/bvh.h" |
37 | |
38 | class GodotBroadPhase3DBVH : public GodotBroadPhase3D { |
39 | template <class T> |
40 | class UserPairTestFunction { |
41 | public: |
42 | static bool user_pair_check(const T *p_a, const T *p_b) { |
43 | // return false if no collision, decided by masks etc |
44 | return p_a->interacts_with(p_b); |
45 | } |
46 | }; |
47 | |
48 | template <class T> |
49 | class UserCullTestFunction { |
50 | public: |
51 | static bool user_cull_check(const T *p_a, const T *p_b) { |
52 | return true; |
53 | } |
54 | }; |
55 | |
56 | enum Tree { |
57 | TREE_STATIC = 0, |
58 | TREE_DYNAMIC = 1, |
59 | }; |
60 | |
61 | enum TreeFlag { |
62 | TREE_FLAG_STATIC = 1 << TREE_STATIC, |
63 | TREE_FLAG_DYNAMIC = 1 << TREE_DYNAMIC, |
64 | }; |
65 | |
66 | BVH_Manager<GodotCollisionObject3D, 2, true, 128, UserPairTestFunction<GodotCollisionObject3D>, UserCullTestFunction<GodotCollisionObject3D>> bvh; |
67 | |
68 | static void *_pair_callback(void *, uint32_t, GodotCollisionObject3D *, int, uint32_t, GodotCollisionObject3D *, int); |
69 | static void _unpair_callback(void *, uint32_t, GodotCollisionObject3D *, int, uint32_t, GodotCollisionObject3D *, int, void *); |
70 | |
71 | PairCallback pair_callback = nullptr; |
72 | void *pair_userdata = nullptr; |
73 | UnpairCallback unpair_callback = nullptr; |
74 | void *unpair_userdata = nullptr; |
75 | |
76 | public: |
77 | // 0 is an invalid ID |
78 | virtual ID create(GodotCollisionObject3D *p_object, int p_subindex = 0, const AABB &p_aabb = AABB(), bool p_static = false) override; |
79 | virtual void move(ID p_id, const AABB &p_aabb) override; |
80 | virtual void set_static(ID p_id, bool p_static) override; |
81 | virtual void remove(ID p_id) override; |
82 | |
83 | virtual GodotCollisionObject3D *get_object(ID p_id) const override; |
84 | virtual bool is_static(ID p_id) const override; |
85 | virtual int get_subindex(ID p_id) const override; |
86 | |
87 | virtual int cull_point(const Vector3 &p_point, GodotCollisionObject3D **p_results, int p_max_results, int *p_result_indices = nullptr) override; |
88 | virtual int cull_segment(const Vector3 &p_from, const Vector3 &p_to, GodotCollisionObject3D **p_results, int p_max_results, int *p_result_indices = nullptr) override; |
89 | virtual int cull_aabb(const AABB &p_aabb, GodotCollisionObject3D **p_results, int p_max_results, int *p_result_indices = nullptr) override; |
90 | |
91 | virtual void set_pair_callback(PairCallback p_pair_callback, void *p_userdata) override; |
92 | virtual void set_unpair_callback(UnpairCallback p_unpair_callback, void *p_userdata) override; |
93 | |
94 | virtual void update() override; |
95 | |
96 | static GodotBroadPhase3D *_create(); |
97 | GodotBroadPhase3DBVH(); |
98 | }; |
99 | |
100 | #endif // GODOT_BROAD_PHASE_3D_BVH_H |
101 | |