mrq/reactphysics3d
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
9deb90dc6f
reactphysics3d/test/tests/collision/TestDynamicAABBTree.h

553 lines
24 KiB
C
Raw Normal View History

Add (empty) unit tests for DynamicAABBTree
2016-02-14 19:55:40 +00:00
/********************************************************************************
* ReactPhysics3D physics library, http://www.reactphysics3d.com *
Change version number of the library
2016-04-11 18:15:20 +00:00
* Copyright (c) 2010-2016 Daniel Chappuis *
Add (empty) unit tests for DynamicAABBTree
2016-02-14 19:55:40 +00:00
*********************************************************************************
* *
* This software is provided 'as-is', without any express or implied warranty. *
* In no event will the authors be held liable for any damages arising from the *
* use of this software. *
* *
* Permission is granted to anyone to use this software for any purpose, *
* including commercial applications, and to alter it and redistribute it *
* freely, subject to the following restrictions: *
* *
* 1. The origin of this software must not be misrepresented; you must not claim *
* that you wrote the original software. If you use this software in a *
* product, an acknowledgment in the product documentation would be *
* appreciated but is not required. *
* *
* 2. Altered source versions must be plainly marked as such, and must not be *
* misrepresented as being the original software. *
* *
* 3. This notice may not be removed or altered from any source distribution. *
* *
********************************************************************************/
#ifndef TEST_DYNAMIC_AABB_TREE_H
#define TEST_DYNAMIC_AABB_TREE_H
// Libraries
#include "Test.h"
#include "collision/broadphase/DynamicAABBTree.h"
Replace malloc/free calls by use of the MemoryManager of ReactPhysics3D
2018-02-04 18:43:17 +00:00
#include "memory/MemoryManager.h"
Refactor the way headers are included and use more forward declarations for faster compilation time
2018-04-20 05:13:39 +00:00
#include "utils/Profiler.h"
Add (empty) unit tests for DynamicAABBTree
2016-02-14 19:55:40 +00:00
/// Reactphysics3D namespace
namespace reactphysics3d {
Update tests of collision world according to changes in collision detection
2017-01-09 20:34:31 +00:00
class TestOverlapCallback : public DynamicAABBTreeOverlapCallback {
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
public :
Simplify broad-phase
2019-03-26 21:57:38 +00:00
// TODO : Replace this by rp3d::List
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
std::vector<int> mOverlapNodes;
// Called when a overlapping node has been found during the call to
// DynamicAABBTree:reportAllShapesOverlappingWithAABB()
Use override keyword to mark virtual overriden methods
2016-07-11 06:33:24 +00:00
virtual void notifyOverlappingNode(int nodeId) override {
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
mOverlapNodes.push_back(nodeId);
}
void reset() {
mOverlapNodes.clear();
}
bool isOverlapping(int nodeId) const {
return std::find(mOverlapNodes.begin(), mOverlapNodes.end(), nodeId) != mOverlapNodes.end();
}
};
class DynamicTreeRaycastCallback : public DynamicAABBTreeRaycastCallback {
public:
std::vector<int> mHitNodes;
// Called when the AABB of a leaf node is hit by a ray
Use override keyword to mark virtual overriden methods
2016-07-11 06:33:24 +00:00
virtual decimal raycastBroadPhaseShape(int32 nodeId, const Ray& ray) override {
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
mHitNodes.push_back(nodeId);
return 1.0;
}
void reset() {
mHitNodes.clear();
}
bool isHit(int nodeId) const {
return std::find(mHitNodes.begin(), mHitNodes.end(), nodeId) != mHitNodes.end();
}
};
Add (empty) unit tests for DynamicAABBTree
2016-02-14 19:55:40 +00:00
// Class TestDynamicAABBTree
/**
* Unit test for the dynamic AABB tree
*/
class TestDynamicAABBTree : public Test {
private :
// ---------- Atributes ---------- //
Update tests of collision world according to changes in collision detection
2017-01-09 20:34:31 +00:00
TestOverlapCallback mOverlapCallback;
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
DynamicTreeRaycastCallback mRaycastCallback;
Add (empty) unit tests for DynamicAABBTree
2016-02-14 19:55:40 +00:00
public :
// ---------- Methods ---------- //
/// Constructor
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
TestDynamicAABBTree(const std::string& name): Test(name) {
}
Add (empty) unit tests for DynamicAABBTree
2016-02-14 19:55:40 +00:00
/// Run the tests
void run() {
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
testBasicsMethods();
testOverlapping();
testRaycast();
Add (empty) unit tests for DynamicAABBTree
2016-02-14 19:55:40 +00:00
}
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
void testBasicsMethods() {
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// ------------ Create tree ---------- //
// Dynamic AABB Tree
Replace malloc/free calls by use of the MemoryManager of ReactPhysics3D
2018-02-04 18:43:17 +00:00
DynamicAABBTree tree(MemoryManager::getBaseAllocator());
Use List in HalfEdgeStructure with some changes in memory allocation
2017-12-27 19:53:09 +00:00
#ifdef IS_PROFILING_ACTIVE
/// Pointer to the profiler
Profiler* profiler = new Profiler();
tree.setProfiler(profiler);
#endif
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
int object1Data = 56;
int object2Data = 23;
int object3Data = 13;
int object4Data = 7;
// First object
AABB aabb1 = AABB(Vector3(-6, 4, -3), Vector3(4, 8, 3));
int object1Id = tree.addObject(aabb1, &object1Data);
// Second object
AABB aabb2 = AABB(Vector3(5, 2, -3), Vector3(10, 7, 3));
int object2Id = tree.addObject(aabb2, &object2Data);
// Third object
AABB aabb3 = AABB(Vector3(-5, 1, -3), Vector3(-2, 3, 3));
int object3Id = tree.addObject(aabb3, &object3Data);
// Fourth object
AABB aabb4 = AABB(Vector3(0, -4, -3), Vector3(3, -2, 3));
int object4Id = tree.addObject(aabb4, &object4Data);
// ----------- Tests ----------- //
// Test root AABB
AABB rootAABB = tree.getRootAABB();
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(rootAABB.getMin().x == -6);
rp3d_test(rootAABB.getMin().y == -4);
rp3d_test(rootAABB.getMin().z == -3);
rp3d_test(rootAABB.getMax().x == 10);
rp3d_test(rootAABB.getMax().y == 8);
rp3d_test(rootAABB.getMax().z == 3);
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// Test data stored at the nodes of the tree
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(*(int*)(tree.getNodeDataPointer(object1Id)) == object1Data);
rp3d_test(*(int*)(tree.getNodeDataPointer(object2Id)) == object2Data);
rp3d_test(*(int*)(tree.getNodeDataPointer(object3Id)) == object3Data);
rp3d_test(*(int*)(tree.getNodeDataPointer(object4Id)) == object4Data);
Use List in HalfEdgeStructure with some changes in memory allocation
2017-12-27 19:53:09 +00:00
#ifdef IS_PROFILING_ACTIVE
delete profiler;
#endif
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
}
void testOverlapping() {
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// ------------- Create tree ----------- //
// Dynamic AABB Tree
Replace malloc/free calls by use of the MemoryManager of ReactPhysics3D
2018-02-04 18:43:17 +00:00
DynamicAABBTree tree(MemoryManager::getBaseAllocator());
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
Use List in HalfEdgeStructure with some changes in memory allocation
2017-12-27 19:53:09 +00:00
#ifdef IS_PROFILING_ACTIVE
/// Pointer to the profiler
Profiler* profiler = new Profiler();
tree.setProfiler(profiler);
#endif
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
int object1Data = 56;
int object2Data = 23;
int object3Data = 13;
int object4Data = 7;
// First object
AABB aabb1 = AABB(Vector3(-6, 4, -3), Vector3(4, 8, 3));
int object1Id = tree.addObject(aabb1, &object1Data);
// Second object
AABB aabb2 = AABB(Vector3(5, 2, -3), Vector3(10, 7, 3));
int object2Id = tree.addObject(aabb2, &object2Data);
// Third object
AABB aabb3 = AABB(Vector3(-5, 1, -3), Vector3(-2, 3, 3));
int object3Id = tree.addObject(aabb3, &object3Data);
// Fourth object
AABB aabb4 = AABB(Vector3(0, -4, -3), Vector3(3, -2, 3));
int object4Id = tree.addObject(aabb4, &object4Data);
// ---------- Tests ---------- //
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping nothing
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-10, 12, -4), Vector3(10, 50, 4)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(!mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping everything
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-15, -15, -4), Vector3(15, 15, 4)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mOverlapCallback.isOverlapping(object1Id));
rp3d_test(mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping object 1 and 3
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-4, 2, -4), Vector3(-1, 7, 4)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping object 3 and 4
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-6, -5, -2), Vector3(2, 2, 0)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping object 2
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(5, -10, -2), Vector3(7, 10, 9)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(mOverlapCallback.isOverlapping(object2Id));
rp3d_test(!mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// ---- Update the object AABBs with the initial AABBs (no reinsertion) ----- //
Remove code to update proxy-shape broad-phase state from proxy-shape, move it to broad-phase system
2019-03-17 21:50:10 +00:00
tree.updateObject(object1Id, aabb1, Vector3::zero());
tree.updateObject(object2Id, aabb2, Vector3::zero());
tree.updateObject(object3Id, aabb3, Vector3::zero());
tree.updateObject(object4Id, aabb4, Vector3::zero());
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping nothing
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-10, 12, -4), Vector3(10, 50, 4)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(!mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping everything
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-15, -15, -4), Vector3(15, 15, 4)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mOverlapCallback.isOverlapping(object1Id));
rp3d_test(mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping object 1 and 3
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-4, 2, -4), Vector3(-1, 7, 4)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping object 3 and 4
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-6, -5, -2), Vector3(2, 2, 0)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping object 2
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(5, -10, -2), Vector3(7, 10, 9)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(mOverlapCallback.isOverlapping(object2Id));
rp3d_test(!mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// ---- Update the object AABBs with the initial AABBs (with reinsertion) ----- //
Remove code to update proxy-shape broad-phase state from proxy-shape, move it to broad-phase system
2019-03-17 21:50:10 +00:00
tree.updateObject(object1Id, aabb1, Vector3::zero());
tree.updateObject(object2Id, aabb2, Vector3::zero());
tree.updateObject(object3Id, aabb3, Vector3::zero());
tree.updateObject(object4Id, aabb4, Vector3::zero());
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping nothing
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-10, 12, -4), Vector3(10, 50, 4)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(!mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping everything
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-15, -15, -4), Vector3(15, 15, 4)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mOverlapCallback.isOverlapping(object1Id));
rp3d_test(mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping object 1 and 3
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-4, 2, -4), Vector3(-1, 7, 4)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping object 3 and 4
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-6, -5, -2), Vector3(2, 2, 0)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(mOverlapCallback.isOverlapping(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// AABB overlapping object 2
mOverlapCallback.reset();
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(5, -10, -2), Vector3(7, 10, 9)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(mOverlapCallback.isOverlapping(object2Id));
rp3d_test(!mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// ---- Move objects 2 and 3 ----- //
AABB newAABB2(Vector3(-7, 10, -3), Vector3(1, 13, 3));
tree.updateObject(object2Id, newAABB2, Vector3::zero());
AABB newAABB3(Vector3(7, -6, -3), Vector3(9, 1, 3));
tree.updateObject(object3Id, newAABB3, Vector3::zero());
// AABB overlapping object 3
mOverlapCallback.reset();
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(6, -10, -2), Vector3(8, 5, 3)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mOverlapCallback.isOverlapping(object1Id));
rp3d_test(!mOverlapCallback.isOverlapping(object2Id));
rp3d_test(mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// AABB overlapping objects 1, 2
mOverlapCallback.reset();
tree.reportAllShapesOverlappingWithAABB(AABB(Vector3(-8, 5, -3), Vector3(-2, 11, 3)), mOverlapCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mOverlapCallback.isOverlapping(object1Id));
rp3d_test(mOverlapCallback.isOverlapping(object2Id));
rp3d_test(!mOverlapCallback.isOverlapping(object3Id));
rp3d_test(!mOverlapCallback.isOverlapping(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
Use List in HalfEdgeStructure with some changes in memory allocation
2017-12-27 19:53:09 +00:00
#ifdef IS_PROFILING_ACTIVE
delete profiler;
#endif
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
}
void testRaycast() {
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// ------------- Create tree ----------- //
// Dynamic AABB Tree
Replace malloc/free calls by use of the MemoryManager of ReactPhysics3D
2018-02-04 18:43:17 +00:00
DynamicAABBTree tree(MemoryManager::getBaseAllocator());
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
Use List in HalfEdgeStructure with some changes in memory allocation
2017-12-27 19:53:09 +00:00
#ifdef IS_PROFILING_ACTIVE
/// Pointer to the profiler
Profiler* profiler = new Profiler();
tree.setProfiler(profiler);
#endif
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
int object1Data = 56;
int object2Data = 23;
int object3Data = 13;
int object4Data = 7;
// First object
AABB aabb1 = AABB(Vector3(-6, 4, -3), Vector3(4, 8, 3));
int object1Id = tree.addObject(aabb1, &object1Data);
// Second object
AABB aabb2 = AABB(Vector3(5, 2, -3), Vector3(10, 7, 3));
int object2Id = tree.addObject(aabb2, &object2Data);
// Third object
AABB aabb3 = AABB(Vector3(-5, 1, -3), Vector3(-2, 3, 3));
int object3Id = tree.addObject(aabb3, &object3Data);
// Fourth object
AABB aabb4 = AABB(Vector3(0, -4, -3), Vector3(3, -2, 3));
int object4Id = tree.addObject(aabb4, &object4Data);
// ---------- Tests ---------- //
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// Ray with no hits
mRaycastCallback.reset();
Ray ray1(Vector3(4.5, -10, -5), Vector3(4.5, 10, -5));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.raycast(ray1, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// Ray that hits object 1
mRaycastCallback.reset();
Ray ray2(Vector3(-1, -20, -2), Vector3(-1, 20, -2));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.raycast(ray2, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// Ray that hits object 1 and 2
mRaycastCallback.reset();
Ray ray3(Vector3(-7, 6, -2), Vector3(8, 6, -2));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.raycast(ray3, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mRaycastCallback.isHit(object1Id));
rp3d_test(mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
// Ray that hits object 3
mRaycastCallback.reset();
Ray ray4(Vector3(-7, 2, 0), Vector3(-1, 2, 0));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
tree.raycast(ray4, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// ---- Update the object AABBs with the initial AABBs (no reinsertion) ----- //
Remove code to update proxy-shape broad-phase state from proxy-shape, move it to broad-phase system
2019-03-17 21:50:10 +00:00
tree.updateObject(object1Id, aabb1, Vector3::zero());
tree.updateObject(object2Id, aabb2, Vector3::zero());
tree.updateObject(object3Id, aabb3, Vector3::zero());
tree.updateObject(object4Id, aabb4, Vector3::zero());
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// Ray with no hits
mRaycastCallback.reset();
tree.raycast(ray1, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// Ray that hits object 1
mRaycastCallback.reset();
tree.raycast(ray2, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// Ray that hits object 1 and 2
mRaycastCallback.reset();
tree.raycast(ray3, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mRaycastCallback.isHit(object1Id));
rp3d_test(mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// Ray that hits object 3
mRaycastCallback.reset();
tree.raycast(ray4, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// ---- Update the object AABBs with the initial AABBs (with reinsertion) ----- //
Remove code to update proxy-shape broad-phase state from proxy-shape, move it to broad-phase system
2019-03-17 21:50:10 +00:00
tree.updateObject(object1Id, aabb1, Vector3::zero());
tree.updateObject(object2Id, aabb2, Vector3::zero());
tree.updateObject(object3Id, aabb3, Vector3::zero());
tree.updateObject(object4Id, aabb4, Vector3::zero());
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// Ray with no hits
mRaycastCallback.reset();
tree.raycast(ray1, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// Ray that hits object 1
mRaycastCallback.reset();
tree.raycast(ray2, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// Ray that hits object 1 and 2
mRaycastCallback.reset();
tree.raycast(ray3, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mRaycastCallback.isHit(object1Id));
rp3d_test(mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// Ray that hits object 3
mRaycastCallback.reset();
tree.raycast(ray4, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// ---- Move objects 2 and 3 ----- //
AABB newAABB2(Vector3(-7, 10, -3), Vector3(1, 13, 3));
tree.updateObject(object2Id, newAABB2, Vector3::zero());
AABB newAABB3(Vector3(7, -6, -3), Vector3(9, 1, 3));
tree.updateObject(object3Id, newAABB3, Vector3::zero());
// Ray that hits object 1, 2
Ray ray5(Vector3(-4, -5, 0), Vector3(-4, 12, 0));
mRaycastCallback.reset();
tree.raycast(ray5, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(mRaycastCallback.isHit(object1Id));
rp3d_test(mRaycastCallback.isHit(object2Id));
rp3d_test(!mRaycastCallback.isHit(object3Id));
rp3d_test(!mRaycastCallback.isHit(object4Id));
Fix issues and add unit tests
2016-04-01 23:51:41 +00:00
// Ray that hits object 3 and 4
Ray ray6(Vector3(11, -3, 1), Vector3(-2, -3, 1));
mRaycastCallback.reset();
tree.raycast(ray6, mRaycastCallback);
Fix compilation issue of the unit tests
2018-08-05 14:10:13 +00:00
rp3d_test(!mRaycastCallback.isHit(object1Id));
rp3d_test(!mRaycastCallback.isHit(object2Id));
rp3d_test(mRaycastCallback.isHit(object3Id));
rp3d_test(mRaycastCallback.isHit(object4Id));
Use List in HalfEdgeStructure with some changes in memory allocation
2017-12-27 19:53:09 +00:00
#ifdef IS_PROFILING_ACTIVE
delete profiler;
#endif
Add unit tests for Dynamic AABB tree
2016-03-30 05:10:15 +00:00
}
Add (empty) unit tests for DynamicAABBTree
2016-02-14 19:55:40 +00:00
};
}
#endif
Reference in New Issue Copy Permalink