git-svn-id: svn://svn.code.sf.net/p/irrlicht/code/trunk@6000 dfc29bdd-3216-0410-991c-e03cc46cb475
		
			
				
	
	
		
			406 lines
		
	
	
		
			10 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
			
		
		
	
	
			406 lines
		
	
	
		
			10 KiB
		
	
	
	
		
			C++
		
	
	
	
	
	
| // Copyright (C) 2008-2012 Colin MacDonald
 | |
| // No rights reserved: this software is in the public domain.
 | |
| 
 | |
| #include "testUtils.h"
 | |
| 
 | |
| using namespace irr;
 | |
| using namespace core;
 | |
| 
 | |
| // These tests are also only called for f32 and f64, due to conversion problems
 | |
| // in the respective methods.
 | |
| template<class T>
 | |
| static bool checkCollisions()
 | |
| {
 | |
| 	aabbox3d<T> one(0,0,0,4,4,4);
 | |
| 	aabbox3d<T> two(2,2,2,4,4,4);
 | |
| 
 | |
| 	if (two.getInterpolated(one, 1) != two)
 | |
| 	{
 | |
| 		logTestString("aabbox3d<T> interpolation wrong on 1\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (two.getInterpolated(one, 0) != one)
 | |
| 	{
 | |
| 		logTestString("aabbox3d<T> interpolation wrong on 0\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	aabbox3d<T> three(two.getInterpolated(one, 0.5f));
 | |
| 	if (two == one)
 | |
| 	{
 | |
| 		logTestString("aabbox3d<T> interpolation wrong on 0.5 (right)\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (two == three)
 | |
| 	{
 | |
| 		logTestString("aabbox3d<T> interpolation wrong on 0.5 (left)\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	three.reset(aabbox3d<T>(2,2,2,5,5,5));
 | |
| 	if (!two.isFullInside(one))
 | |
| 	{
 | |
| 		logTestString("small aabbox3d<T> is not fully inside\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (three.isFullInside(one))
 | |
| 	{
 | |
| 		logTestString("large aabbox3d<T> is fully inside\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 
 | |
| 	if (!two.intersectsWithBox(one))
 | |
| 	{
 | |
| 		logTestString("small aabbox3d<T> does not intersect\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!three.intersectsWithBox(one))
 | |
| 	{
 | |
| 		logTestString("large aabbox3d<T> does not intersect\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 
 | |
| 	core::line3d<T> line(-2,-2,-2,2,2,2);
 | |
| 	if (!one.intersectsWithLine(line))
 | |
| 	{
 | |
| 		logTestString("aabbox3d<T> does not intersect with line(1)\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	line.end.set(2,2,10);
 | |
| 	if (!one.intersectsWithLine(line))
 | |
| 	{
 | |
| 		logTestString("aabbox3d<T> does not intersect with line(2)\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	line.end.set(0,2,10);
 | |
| 	if (one.intersectsWithLine(line))
 | |
| 	{
 | |
| 		logTestString("aabbox3d<T> does intersect with line(3)\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	return true;
 | |
| }
 | |
| 
 | |
| template<class T>
 | |
| static bool checkPoints()
 | |
| {
 | |
| 	aabbox3d<T> one(-1,-2,-3,2,2,2);
 | |
| 
 | |
| 	if (!one.isPointInside(core::vector3d<T>(-1,-2,-3)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed with min vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!one.isPointInside(core::vector3d<T>(-1,2,-3)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed with other min vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!one.isPointInside(core::vector3d<T>(2,-2,2)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed with other max vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!one.isPointInside(core::vector3d<T>(2,2,2)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed with max vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!one.isPointInside(core::vector3d<T>(0,0,0)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed with origin\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!one.isPointInside(core::vector3d<T>((T)1.2,-1,1)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed with random point inside\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isPointInside(core::vector3d<T>(-2,-2,-3)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed near min vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isPointInside(core::vector3d<T>(2,3,2)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed near max vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isPointInside(core::vector3d<T>(3,0,0)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed near origin\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isPointInside(core::vector3d<T>((T)10.2,-1,1)))
 | |
| 	{
 | |
| 		logTestString("isPointInside failed with random point outside\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isPointTotalInside(core::vector3d<T>(-1,-2,-3)))
 | |
| 	{
 | |
| 		logTestString("isPointTotalInside failed with min vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isPointTotalInside(core::vector3d<T>(-1,2,-3)))
 | |
| 	{
 | |
| 		logTestString("isPointTotalInside failed with other min vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isPointTotalInside(core::vector3d<T>(2,-2,2)))
 | |
| 	{
 | |
| 		logTestString("isPointTotalInside failed with other max vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isPointTotalInside(core::vector3d<T>(2,2,2)))
 | |
| 	{
 | |
| 		logTestString("isPointTotalInside failed with max vertex\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!one.isPointTotalInside(core::vector3d<T>(0,0,0)))
 | |
| 	{
 | |
| 		logTestString("isPointTotalInside failed with origin\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!one.isPointTotalInside(core::vector3d<T>((T)1.2,-1,1)))
 | |
| 	{
 | |
| 		logTestString("isPointTotalInside failed with random point inside\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isPointTotalInside(core::vector3d<T>((T)10.2,-1,1)))
 | |
| 	{
 | |
| 		logTestString("isPointTotalInside failed with random point outside\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 
 | |
| 	core::plane3d<T> plane(core::vector3d<T>(0,0,-1), -10);
 | |
| 	if (one.classifyPlaneRelation(plane) != core::ISREL3D_BACK)
 | |
| 	{
 | |
| 		logTestString("box not behind\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	plane.D=0;
 | |
| 	if (one.classifyPlaneRelation(plane) != core::ISREL3D_CLIPPED)
 | |
| 	{
 | |
| 		logTestString("box not clipped\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	plane.D=10;
 | |
| 	if (one.classifyPlaneRelation(plane) != core::ISREL3D_FRONT)
 | |
| 	{
 | |
| 		logTestString("box not in front\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	return true;
 | |
| }
 | |
| 
 | |
| template <class T>
 | |
| static bool doTests()
 | |
| {
 | |
| 	aabbox3d<T> empty;
 | |
| 	aabbox3d<T> one(-1,-1,-1,1,1,1);
 | |
| 	if (empty != one)
 | |
| 	{
 | |
| 		logTestString("default aabbox3d<T> wrong, or comparison failed\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (empty.getCenter() != core::vector3d<T>(0,0,0))
 | |
| 	{
 | |
| 		logTestString("default aabbox3d<T> has wrong Center\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (empty.getExtent() != core::vector3d<T>(2,2,2))
 | |
| 	{
 | |
| 		logTestString("default aabbox3d<T> has wrong Extent\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!core::equals(empty.getRadius(), (T)sqrt(3.0)))
 | |
| 	{
 | |
| 		logTestString("default aabbox3d<T> has wrong radius\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (empty.isEmpty())
 | |
| 	{
 | |
| 		logTestString("default aabbox3d<T> is empty\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (empty.getVolume() != 8)
 | |
| 	{
 | |
| 		logTestString("default aabbox3d<T> has wrong volume\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (empty.getArea() != 24)
 | |
| 	{
 | |
| 		logTestString("default aabbox3d<T> has wrong area\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	aabbox3d<T> two(core::vector3d<T>(-1,-1,-1),core::vector3d<T>(2,2,2));
 | |
| 	if (empty == two)
 | |
| 	{
 | |
| 		logTestString("empty aabbox3d<T> too large, or comparison failed\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (two.getCenter() != core::vector3d<T>((T)0.5,(T)0.5,(T)0.5))
 | |
| 	{
 | |
| 		logTestString("extended aabbox3d<T> has wrong Center\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (two.getExtent() != core::vector3d<T>(3,3,3))
 | |
| 	{
 | |
| 		logTestString("extended aabbox3d<T> has wrong Extent\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!core::equals(two.getRadius(), (T)sqrt(27./4.)))
 | |
| 	{
 | |
| 		logTestString("extended aabbox3d<T> has wrong radius\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (two.isEmpty())
 | |
| 	{
 | |
| 		logTestString("extended aabbox3d<T> is empty\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (two.getVolume() != 27)
 | |
| 	{
 | |
| 		logTestString("extended aabbox3d<T> has wrong volume\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (two.getArea() != 54)
 | |
| 	{
 | |
| 		logTestString("extended aabbox3d<T> has wrong area\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	one.reset(1,1,1);
 | |
| 	if (one==empty)
 | |
| 	{
 | |
| 		logTestString("reset failed, or comparison failed\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.getCenter() != core::vector3d<T>(1,1,1))
 | |
| 	{
 | |
| 		logTestString("singular aabbox3d<T> has wrong Center\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.getExtent() != core::vector3d<T>(0,0,0))
 | |
| 	{
 | |
| 		logTestString("singular aabbox3d<T> has Extent\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.getRadius() != 0)
 | |
| 	{
 | |
| 		logTestString("singular aabbox3d<T> has radius\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!one.isEmpty())
 | |
| 	{
 | |
| 		logTestString("empty aabbox3d<T> is not empty\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.getVolume() != 0)
 | |
| 	{
 | |
| 		logTestString("empty aabbox3d<T> has wrong volume\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.getArea() != 0)
 | |
| 	{
 | |
| 		logTestString("empty aabbox3d<T> has wrong area\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	one.addInternalPoint(core::vector3d<T>(-1,-1,-1));
 | |
| 	if (one!=empty)
 | |
| 	{
 | |
| 		logTestString("addInternalPoint failed, creating default bbox\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	one.reset(1,1,1);
 | |
| 	one.reset(empty);
 | |
| 	if (one!=empty)
 | |
| 	{
 | |
| 		logTestString("reset with bbox failed, creating default bbox\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	one.addInternalPoint(core::vector3d<T>(2,2,2));
 | |
| 	if (one != two)
 | |
| 	{
 | |
| 		logTestString("addInternalPoint for aabbox3d<T> failed.\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	one.addInternalBox(empty);
 | |
| 	if (one != two)
 | |
| 	{
 | |
| 		logTestString("addInternalBox with smaller box failed.\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	one.addInternalBox(two);
 | |
| 	if (one != two)
 | |
| 	{
 | |
| 		logTestString("addInternalBox with same box failed.\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	one.addInternalPoint(-1,-2,-3);
 | |
| 	two.addInternalPoint(-1,-2,-3);
 | |
| 	empty.addInternalBox(one);
 | |
| 	if (empty != two)
 | |
| 	{
 | |
| 		logTestString("addInternalBox with larger box failed\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.getCenter() != core::vector3d<T>((T)0.5,0,(T)-0.5))
 | |
| 	{
 | |
| 		logTestString("large aabbox3d<T> has wrong Center\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.getExtent() != core::vector3d<T>(3,4,5))
 | |
| 	{
 | |
| 		logTestString("large aabbox3d<T> has wrong Extent\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!core::equals(one.getRadius(), (T)sqrt(50./4.)))
 | |
| 	{
 | |
| 		logTestString("large aabbox3d<T> has wrong radius\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.isEmpty())
 | |
| 	{
 | |
| 		logTestString("large aabbox3d<T> is empty\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.getVolume() != 60)
 | |
| 	{
 | |
| 		logTestString("large aabbox3d<T> has wrong volume\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (one.getArea() != 94)
 | |
| 	{
 | |
| 		logTestString("large aabbox3d<T> has wrong area\n");
 | |
| 		return false;
 | |
| 	}
 | |
| 	if (!checkPoints<T>())
 | |
| 		return false;
 | |
| 	return true;
 | |
| }
 | |
| 
 | |
| 
 | |
| /** Test the functionality of aabbox3d<T>. */
 | |
| bool testaabbox3d(void)
 | |
| {
 | |
| 	bool f32Success = doTests<f32>();
 | |
| 	f32Success &= checkCollisions<f32>();
 | |
| 	if(f32Success)
 | |
| 		logTestString("aabbox3d<f32> tests passed\n\n");
 | |
| 	else
 | |
| 		logTestString("\n*** aabbox3d<f32> tests failed ***\n\n");
 | |
| 
 | |
| 	bool f64Success = doTests<f64>();
 | |
| 	f64Success &= checkCollisions<f64>();
 | |
| 	if(f64Success)
 | |
| 		logTestString("aabbox3d<f64> tests passed\n\n");
 | |
| 	else
 | |
| 		logTestString("\n*** aabbox3d<f64> tests failed ***\n\n");
 | |
| 
 | |
| 	bool s32Success = doTests<s32>();
 | |
| 	if(s32Success)
 | |
| 		logTestString("aabbox3d<s32> tests passed\n\n");
 | |
| 	else
 | |
| 		logTestString("\n*** aabbox3d<s32> tests failed ***\n\n");
 | |
| 
 | |
| 	return f32Success && f64Success && s32Success;
 | |
| }
 |