| 1 | /**************************************************************************/ |
| 2 | /* godot_broad_phase_2d_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_2D_BVH_H |
| 32 | #define GODOT_BROAD_PHASE_2D_BVH_H |
| 33 | |
| 34 | #include "godot_broad_phase_2d.h" |
| 35 | |
| 36 | #include "core/math/bvh.h" |
| 37 | #include "core/math/rect2.h" |
| 38 | #include "core/math/vector2.h" |
| 39 | |
| 40 | class GodotBroadPhase2DBVH : public GodotBroadPhase2D { |
| 41 | template <class T> |
| 42 | class UserPairTestFunction { |
| 43 | public: |
| 44 | static bool user_pair_check(const T *p_a, const T *p_b) { |
| 45 | // return false if no collision, decided by masks etc |
| 46 | return p_a->interacts_with(p_b); |
| 47 | } |
| 48 | }; |
| 49 | |
| 50 | template <class T> |
| 51 | class UserCullTestFunction { |
| 52 | public: |
| 53 | static bool user_cull_check(const T *p_a, const T *p_b) { |
| 54 | return true; |
| 55 | } |
| 56 | }; |
| 57 | |
| 58 | enum Tree { |
| 59 | TREE_STATIC = 0, |
| 60 | TREE_DYNAMIC = 1, |
| 61 | }; |
| 62 | |
| 63 | enum TreeFlag { |
| 64 | TREE_FLAG_STATIC = 1 << TREE_STATIC, |
| 65 | TREE_FLAG_DYNAMIC = 1 << TREE_DYNAMIC, |
| 66 | }; |
| 67 | |
| 68 | BVH_Manager<GodotCollisionObject2D, 2, true, 128, UserPairTestFunction<GodotCollisionObject2D>, UserCullTestFunction<GodotCollisionObject2D>, Rect2, Vector2> bvh; |
| 69 | |
| 70 | static void *_pair_callback(void *, uint32_t, GodotCollisionObject2D *, int, uint32_t, GodotCollisionObject2D *, int); |
| 71 | static void _unpair_callback(void *, uint32_t, GodotCollisionObject2D *, int, uint32_t, GodotCollisionObject2D *, int, void *); |
| 72 | |
| 73 | PairCallback pair_callback = nullptr; |
| 74 | void *pair_userdata = nullptr; |
| 75 | UnpairCallback unpair_callback = nullptr; |
| 76 | void *unpair_userdata = nullptr; |
| 77 | |
| 78 | public: |
| 79 | // 0 is an invalid ID |
| 80 | virtual ID create(GodotCollisionObject2D *p_object, int p_subindex = 0, const Rect2 &p_aabb = Rect2(), bool p_static = false) override; |
| 81 | virtual void move(ID p_id, const Rect2 &p_aabb) override; |
| 82 | virtual void set_static(ID p_id, bool p_static) override; |
| 83 | virtual void remove(ID p_id) override; |
| 84 | |
| 85 | virtual GodotCollisionObject2D *get_object(ID p_id) const override; |
| 86 | virtual bool is_static(ID p_id) const override; |
| 87 | virtual int get_subindex(ID p_id) const override; |
| 88 | |
| 89 | virtual int cull_segment(const Vector2 &p_from, const Vector2 &p_to, GodotCollisionObject2D **p_results, int p_max_results, int *p_result_indices = nullptr) override; |
| 90 | virtual int cull_aabb(const Rect2 &p_aabb, GodotCollisionObject2D **p_results, int p_max_results, int *p_result_indices = nullptr) override; |
| 91 | |
| 92 | virtual void set_pair_callback(PairCallback p_pair_callback, void *p_userdata) override; |
| 93 | virtual void set_unpair_callback(UnpairCallback p_unpair_callback, void *p_userdata) override; |
| 94 | |
| 95 | virtual void update() override; |
| 96 | |
| 97 | static GodotBroadPhase2D *_create(); |
| 98 | GodotBroadPhase2DBVH(); |
| 99 | }; |
| 100 | |
| 101 | #endif // GODOT_BROAD_PHASE_2D_BVH_H |
| 102 | |