/*
 * Copyright (c) 2008-2011 Hypertriton, Inc. <http://hypertriton.com/>
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
 * USE OF THIS SOFTWARE EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

/*
 * Triangle routines.
 */

#include <agar/core/core.h>
#include <agar/math/m.h>

M_Triangle2
M_TriangleFromLines2(M_Line2 a, M_Line2 b, M_Line2 c)
{
	M_Triangle2 T;
	T.a = a.p;
	T.b = b.p;
	T.c = c.p;
	return (T);
}

M_Triangle3
M_TriangleFromLines3(M_Line3 a, M_Line3 b, M_Line3 c)
{
	M_Triangle3 T;
	T.a = a.p;
	T.b = b.p;
	T.c = c.p;
	return (T);
}

M_Triangle2
M_TriangleRead2(AG_DataSource *ds)
{
	M_Triangle2 T;

	T.a = M_ReadVector2(ds);
	T.b = M_ReadVector2(ds);
	T.c = M_ReadVector2(ds);
	return (T);
}

M_Triangle3
M_TriangleRead3(AG_DataSource *ds)
{
	M_Triangle3 T;

	T.a = M_ReadVector3(ds);
	T.b = M_ReadVector3(ds);
	T.c = M_ReadVector3(ds);
	return (T);
}

void
M_TriangleWrite2(AG_DataSource *ds, M_Triangle2 *T)
{
	M_WriteVector2(ds, &T->a);
	M_WriteVector2(ds, &T->b);
	M_WriteVector2(ds, &T->c);
}

void
M_TriangleWrite3(AG_DataSource *ds, M_Triangle3 *T)
{
	M_WriteVector3(ds, &T->a);
	M_WriteVector3(ds, &T->b);
	M_WriteVector3(ds, &T->c);
}

/*
 * Test whether the given point lies inside the polygon using barycentric
 * coordinates. From http://blackpawn.com/texts/pointinpoly/.
 */
int
M_PointInTriangle2(M_Triangle2 T, M_Vector2 p)
{
	M_Vector2 ca, ba, pa;
	M_Real dot00, dot01, dot02, dot11, dot12;
	M_Real d, u, v;

	ca = M_VecSub2(T.c, T.a);
	ba = M_VecSub2(T.b, T.a);
	pa = M_VecSub2(p,   T.a);
	dot00 = M_VecDot2p(&ca, &ca);
	dot01 = M_VecDot2p(&ca, &ba);
	dot02 = M_VecDot2p(&ca, &pa);
	dot11 = M_VecDot2p(&ba, &ba);
	dot12 = M_VecDot2p(&ba, &pa);
	d = 1.0 / (dot00*dot11 - dot01*dot01);
	u = (dot11*dot02 - dot01*dot12)*d;
	v = (dot00*dot12 - dot01*dot02)*d;
	return (u > 0) && (v > 0) && (u+v < 1);
}