package test.atriaSoft.etk.math;

import org.atriaSoft.gameEngine.geometry.AABB;
import org.atriaSoft.gameEngine.geometry.OBB;
import org.atriaSoft.gameEngine.geometry.Geometry3D;
import org.atriaSoft.gameEngine.geometry.Plane;
import org.atriaSoft.gameEngine.geometry.Sphere;
import org.atriaSoft.gameEngine.geometry.Triangle;
import org.atriaSoft.etk.math.Matrix3f;
import org.atriaSoft.etk.math.Vector3f;
import org.junit.jupiter.api.*;


import static org.junit.Assert.assertEquals;
import static org.junit.Assert.assertFalse;
import static org.junit.Assert.assertTrue;

public class testTransformation3D{

	@Test
	void testPointInLine() {
		Sphere shape = new Sphere(new Vector3f(4,4,4), 2);
		assertFalse(Geometry3D.pointInSphere(new Vector3f(0,0,0), shape));
		assertFalse(Geometry3D.pointInSphere(new Vector3f(6,6,6), shape));
		assertTrue(Geometry3D.pointInSphere(new Vector3f(3,3,3), shape));
		assertTrue(Geometry3D.pointInSphere(new Vector3f(4,4,4), shape));
		assertTrue(Geometry3D.pointInSphere(new Vector3f(4,4,2.0001f), shape));
		assertTrue(Geometry3D.pointInSphere(new Vector3f(4,2.0001f,4), shape));
		assertTrue(Geometry3D.pointInSphere(new Vector3f(2.0001f,4,4), shape));
	}
	@Test
	void testPointInAABB() {
		AABB shape = new AABB(new Vector3f(4,4,4), new Vector3f(1,2,3));
		assertFalse(Geometry3D.pointInAABB(new Vector3f(0,0,0), shape));
		assertFalse(Geometry3D.pointInAABB(new Vector3f(6,6,6), shape));
		assertTrue(Geometry3D.pointInAABB(new Vector3f(3,3,3), shape));
		assertTrue(Geometry3D.pointInAABB(new Vector3f(4,4,4), shape));
		assertTrue(Geometry3D.pointInAABB(new Vector3f(4,4,1.0001f), shape));
		assertTrue(Geometry3D.pointInAABB(new Vector3f(4,2.0001f,4), shape));
		assertTrue(Geometry3D.pointInAABB(new Vector3f(3.0001f,4,4), shape));
	}
	@Test
	void testPointInOBB() {
		Matrix3f orientation = Matrix3f.identity();
		orientation.multiply(Matrix3f.createMatrixRotate(new Vector3f(0,0,1), (float)Math.toRadians(45)));
		OBB shape = new OBB(new Vector3f(4,4,4), new Vector3f(1,2,3), orientation);
		assertFalse(Geometry3D.pointInOBB(new Vector3f(0,0,0), shape));
		assertFalse(Geometry3D.pointInOBB(new Vector3f(6,6,6), shape));
		assertTrue(Geometry3D.pointInOBB(new Vector3f(3,3,3), shape));
		assertTrue(Geometry3D.pointInOBB(new Vector3f(4,4,4), shape));
		assertTrue(Geometry3D.pointInOBB(new Vector3f(4,4,1.0001f), shape));
		assertTrue(Geometry3D.pointInOBB(new Vector3f(4,2.0001f,4), shape));
		assertTrue(Geometry3D.pointInOBB(new Vector3f(3.0001f,4,4), shape));
	}
	@Test
	void testPointInPlane() {
		Plane shape = new Plane((new Vector3f(4,4,4)).normalize(), (float)Math.sqrt(1*1+1*1));
		assertFalse(Geometry3D.pointInPlane(new Vector3f(0,0,0), shape));
		assertFalse(Geometry3D.pointInPlane(new Vector3f(6,6,6), shape));
		assertTrue(Geometry3D.pointInPlane(new Vector3f(3,3,3), shape));
		assertTrue(Geometry3D.pointInPlane(new Vector3f(4,4,4), shape));
		assertTrue(Geometry3D.pointInPlane(new Vector3f(4,4,1.0001f), shape));
		assertTrue(Geometry3D.pointInPlane(new Vector3f(4,2.0001f,4), shape));
		assertTrue(Geometry3D.pointInPlane(new Vector3f(3.0001f,4,4), shape));
	}
	@Test
	void testPointInTriangle() {
		Triangle shape = new Triangle(new Vector3f(1,0,0), new Vector3f(0,1,0), new Vector3f(0,0,1));
//		assertTrue(Geometry3D.pointInTriangle(new Vector3f(1,0,0), shape));
//		assertTrue(Geometry3D.pointInTriangle(new Vector3f(0,1,0), shape));
//		assertTrue(Geometry3D.pointInTriangle(new Vector3f(0,0,1), shape));
//		assertFalse(Geometry3D.pointInTriangle(new Vector3f(5252,25252521,41458), shape));
//		assertFalse(Geometry3D.pointInTriangle(new Vector3f(1,1,1), shape));
		assertFalse(Geometry3D.pointInTriangle(new Vector3f(0.1f,0.1f,0.1f), shape));
		assertFalse(Geometry3D.pointInTriangle(new Vector3f(0,0,0), shape));
	}
}