package org.mt4j.test.util.math;



import org.mt4j.util.math.ToolsMath;

import org.mt4j.util.math.Vector3D;



import junit.framework.TestCase;



public class Vector3DTest extends TestCase {

	

	public void testVector3D(){

		Vector3D a = new Vector3D(1,2,3);

		Vector3D b = new Vector3D(3,2,1);

		Vector3D c = new Vector3D(1,0,0);

		Vector3D d = new Vector3D(0,1,0);

		

		assertTrue(new Vector3D(5,6,7).equalsVector(new Vector3D(5,6,7)));

		assertTrue(new Vector3D(5,6,7).equalsVectorWithTolerance(new Vector3D(4.8f, 6,6.9f), 0.2f));

		

		assertTrue("Vector3D getAdded test" , a.getAdded(b).equalsVector(new Vector3D(4,4,4)));

		assertTrue("Vector3D getAdded test" , a.getSubtracted(b).equalsVector(new Vector3D(-2,0,2)));

		assertTrue("Vector3D addLocal(), subtractLocal() test" , new Vector3D(a).subtractLocal(b).addLocal(b).equalsVector(a));

		assertTrue(a.equalsVectorWithTolerance(new Vector3D(0.8f, 2,2.9f), 0.2f));

		

		System.out.println(c.angleBetween(d) * ToolsMath.RAD_TO_DEG);

		assertTrue(c.angleBetween(d) * ToolsMath.RAD_TO_DEG == 90 );

		

		Vector3D e = new Vector3D(c);

		e.rotateZ(90 * ToolsMath.DEG_TO_RAD);

		e.rotateZ(-90 * ToolsMath.DEG_TO_RAD);

		assertTrue(e.equalsVector(c));

	}



}