// =-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-==-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-= //
//  »Project«   Teikitu Gaming System (TgS) (∂)
//  »File«      TgS Common - Geometry 3D - Circle.i_inc
//  »Author«    Andrew Aye (EMail: mailto:andrew.aye@gmail.com, Web: http://www.andrewaye.com)
//  »Version«   4.0
// ------------------------------------------------------------------------------------------------------------------------------ //
//  Copyright: © 2002-2010, Andrew Aye.  All Rights Reserved.
//  This software is free for non-commercial use. Redistribution and use in source and binary forms, with or without modification,
//  are permitted provided that the following conditions are met: 
//    Redistributions of source code must retain this copyright notice, this list of conditions and the following disclaimers. 
//    Redistributions in binary form must reproduce this copyright notice, this list of conditions and the following
//      disclaimers in the documentation and other materials provided with the distribution. 
//  Neither the names of the copyright owner nor the names of its contributors may be used to endorse or promote products derived
//  from this software without specific prior written permission. 
//  The intellectual property rights of the algorithms used reside with Andrew Aye.  You may not use this software, in whole or
//  in part, in support of any commercial product without the express written consent of the author.
//  There is no warranty or other guarantee of fitness of this software for any purpose. It is provided solely "as is".
// =-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-==-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-= //
// == Geometry ================================================================================================================== //

TgINLINE TgVOID V(tgGM_Constructor_CI)( V(PCU_TgCIRCLE) psCI0 )
{
    V(tgGM_Reset_CI)( psCI0 );
}


TgINLINE TgVOID V(tgGM_Reset_CI)( V(PCU_TgCIRCLE) psCI0 )
{
    psCI0->m.m.vU        = V(F_SETV_ELEM)( MKL(0.0), MKL(0.0), MKL(0.0) );
    psCI0->m.m.vNormal   = V(F_SETV_ELEM)( MKL(0.0), MKL(0.0), MKL(0.0) );
    psCI0->m.m.vV        = V(F_SETV_ELEM)( MKL(0.0), MKL(0.0), MKL(0.0) );
    psCI0->m.m.vOrigin   = V(F_SETP_ELEM)( MKL(0.0), MKL(0.0), MKL(0.0) );
    psCI0->m_fRadius   = MKL(0.0);
    psCI0->m_fRadiusSq = MKL(0.0);
}


TgINLINE TYPE V(tgGM_Area_CI)( V(CPCU_TgCIRCLE) psCI1 )
{
    return (F(KTgF_PI)*psCI1->m_fRadiusSq);
}


TgINLINE TgVOID V(tgGM_Sweep_BA_CI)( V(PCU_TgBOXAA) psBA0, V(CPCU_TgCIRCLE) psCI1, V(CPCU_TgVEC) pvDT )
{
    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( pvDT ));

    V(tgGM_BA_CI)( psBA0, psCI1 );
    V(tgGM_Sweep_BA)( psBA0, pvDT );
}


TgINLINE TgBOOL V(tgGM_Is_Contained_CI)( V(CPCU_TgCIRCLE) psCI1, V(CPCU_TgVEC) pvS0 )
{
    V(C_TgVEC)                          vDS = V(F_SUB_VV)( pvS0, &psCI1->m.m.vOrigin );
    const TYPE                          tyDS_E0 = V(F_DOT_VV)( &vDS, &psCI1->m.m.vU );
    const TYPE                          tyDS_E1 = V(F_DOT_VV)( &vDS, &psCI1->m.m.vV );

    TgGEOM_ASSERT_PARAM(V(tgGM_Is_Valid_CI)( psCI1 ) && V(F_Is_Point_Valid)( pvS0 ));

    return (tyDS_E0*tyDS_E0 + tyDS_E1*tyDS_E1 < psCI1->m_fRadiusSq);
}


TgINLINE TgVOID V(tgGM_TX_CI)( V(PCU_TgCIRCLE) psCI0, M34(CPCU_TgMAT) pxM0 )
{
    TgGEOM_ASSERT_PARAM(!M34(F_NaN)( pxM0 ));

    psCI0->m.m.vU      = V(F_TX_V_34)( pxM0, &psCI0->m.m.vU );
    psCI0->m.m.vNormal = V(F_TX_V_34)( pxM0, &psCI0->m.m.vNormal );
    psCI0->m.m.vV      = V(F_TX_V_34)( pxM0, &psCI0->m.m.vV );
    psCI0->m.m.vOrigin = V(F_TX_P_34)( pxM0, &psCI0->m.m.vOrigin );
}


TgINLINE TgVOID V(tgGM_Copy_TX_CI)( V(PCU_TgCIRCLE) psCI0, V(CPCU_TgCIRCLE) psCI1, M34(CPCU_TgMAT) pxM0 )
{
    TgGEOM_ASSERT_PARAM(V(tgGM_Is_Valid_CI)( psCI1 ) && !M34(F_NaN)( pxM0 ));

    psCI0->m.m.vU        = V(F_TX_V_34)( pxM0, &psCI1->m.m.vU );
    psCI0->m.m.vNormal   = V(F_TX_V_34)( pxM0, &psCI1->m.m.vNormal );
    psCI0->m.m.vV        = V(F_TX_V_34)( pxM0, &psCI1->m.m.vV );
    psCI0->m.m.vOrigin   = V(F_TX_P_34)( pxM0, &psCI1->m.m.vOrigin );
    psCI0->m_fRadius   = psCI1->m_fRadius;
    psCI0->m_fRadiusSq = psCI1->m_fRadiusSq;
}


TgINLINE TgVOID V(tgGM_Init_CI)(
    V(PCU_TgCIRCLE) psCI0, V(CPCU_TgVEC) pvU, V(CPCU_TgVEC) pvNM, V(CPCU_TgVEC) pvV, V(CPCU_TgVEC) pvOG, const TYPE tyRadius )
{
    V(tgGM_Set_U_CI)( psCI0, pvU );
    V(tgGM_Set_Normal_CI)( psCI0, pvNM );
    V(tgGM_Set_V_CI)( psCI0, pvV );
    V(tgGM_Set_Origin_CI)( psCI0, pvOG );
    V(tgGM_Set_Radius_CI)( psCI0, tyRadius );
}


TgINLINE TgVOID V(tgGM_Init_3D_CI)( V(PCU_TgCIRCLE) psCI0, M34(CPCU_TgMAT) pxM0, const TYPE tyRadius )
{
    V(tgGM_Set_3D_CI)( psCI0, pxM0 );
    V(tgGM_Set_Radius_CI)( psCI0, tyRadius );
}


TgINLINE TgVOID V(tgGM_Copy_CI)( V(PCU_TgCIRCLE) psCI0, V(CPCU_TgCIRCLE) psCI1 )
{
    TgGEOM_ASSERT_PARAM(V(tgGM_Is_Valid_CI)( psCI1 ));

    psCI0->m.m.vU        = psCI1->m.m.vU;
    psCI0->m.m.vNormal   = psCI1->m.m.vNormal;
    psCI0->m.m.vV        = psCI1->m.m.vV;
    psCI0->m.m.vOrigin   = psCI1->m.m.vOrigin;
    psCI0->m_fRadius   = psCI1->m_fRadius;
    psCI0->m_fRadiusSq = psCI1->m_fRadiusSq;
}


TgINLINE TgVOID V(tgGM_Set_Origin_CI)( V(PCU_TgCIRCLE) psCI0, V(CPCU_TgVEC) pvS0 )
{
    TgGEOM_ASSERT_PARAM(V(F_Is_Point_Valid)( pvS0 ));
    psCI0->m.m.vOrigin = *pvS0;
}


TgINLINE TgVOID V(tgGM_Set_Axes_Unit_CI)( V(PCU_TgCIRCLE) psCI0, M34(CPCU_TgMAT) pxM0 )
{
    V(C_TgVEC)                          vS0 = psCI0->m.avData[3];

    TgGEOM_ASSERT_PARAM(!M34(F_NaN)( pxM0 ));

    M34(F_TR)( &psCI0->m.xData, pxM0 );

    psCI0->m.avData[3] = vS0;

    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( psCI0->m.avData + 0 ) && F(tgCM_NR1)( V(F_LSQ)( psCI0->m.avData + 0 ) ));
    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( psCI0->m.avData + 1 ) && F(tgCM_NR1)( V(F_LSQ)( psCI0->m.avData + 1 ) ));
    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( psCI0->m.avData + 2 ) && F(tgCM_NR1)( V(F_LSQ)( psCI0->m.avData + 2 ) ));
}


TgINLINE TgVOID V(tgGM_Set_U_CI)( V(PCU_TgCIRCLE) psCI0, V(CPCU_TgVEC) pvU )
{
    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( pvU ) && F(tgCM_NR1)( V(F_LSQ)( pvU ) ));
    psCI0->m.m.vU = *pvU;
}


TgINLINE TgVOID V(tgGM_Set_Normal_CI)( V(PCU_TgCIRCLE) psCI0, V(CPCU_TgVEC) pvN )
{
    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( pvN ) && F(tgCM_NR1)( V(F_LSQ)( pvN ) ));
    psCI0->m.m.vNormal = *pvN;
}


TgINLINE TgVOID V(tgGM_Set_V_CI)( V(PCU_TgCIRCLE) psCI0, V(CPCU_TgVEC) pvV )
{
    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( pvV ) && F(tgCM_NR1)( V(F_LSQ)( pvV ) ));
    psCI0->m.m.vV = *pvV;
}


TgINLINE TgVOID V(tgGM_Set_3D_CI)( V(PCU_TgCIRCLE) psCI0, M34(CPCU_TgMAT) pxM0 )
{
    TgGEOM_ASSERT_PARAM(!M34(F_NaN)( pxM0 ));

    M34(F_TR)( &psCI0->m.xData, pxM0 );

    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( psCI0->m.avData + 0 ) && F(tgCM_NR1)( V(F_LSQ)( psCI0->m.avData + 0 ) ));
    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( psCI0->m.avData + 1 ) && F(tgCM_NR1)( V(F_LSQ)( psCI0->m.avData + 1 ) ));
    TgGEOM_ASSERT_PARAM(V(F_Is_Vector_Valid)( psCI0->m.avData + 2 ) && F(tgCM_NR1)( V(F_LSQ)( psCI0->m.avData + 2 ) ));
    TgGEOM_ASSERT_PARAM(V(F_Is_Point_Valid)( psCI0->m.avData + 3 ) );
}


TgINLINE TgVOID V(tgGM_Set_Radius_CI)( V(PCU_TgCIRCLE) psCI0, const TYPE tyRadius )
{
    TgGEOM_ASSERT_PARAM(!F(tgCM_NaN)( tyRadius ) && tyRadius > MKL(0.0));

    psCI0->m_fRadius = tyRadius;
    psCI0->m_fRadiusSq = tyRadius*tyRadius;
}


TgINLINE V(CP_TgVEC) V(tgGM_Query_Origin_CI)( V(CPCU_TgCIRCLE) psCI1 )
{
    return (&psCI1->m.m.vOrigin);
}


TgINLINE V(CP_TgVEC) V(tgGM_Query_U_CI)( V(CPCU_TgCIRCLE) psCI1 )
{
    return (&psCI1->m.m.vU);
}


TgINLINE V(CP_TgVEC) V(tgGM_Query_Normal_CI)( V(CPCU_TgCIRCLE) psCI1 )
{
    return (&psCI1->m.m.vNormal);
}


TgINLINE V(CP_TgVEC) V(tgGM_Query_V_CI)( V(CPCU_TgCIRCLE) psCI1 )
{
    return (&psCI1->m.m.vV);
}


TgINLINE TYPE V(tgGM_Query_Radius_CI)( V(CPCU_TgCIRCLE) psCI1 )
{
    return (psCI1->m_fRadius);
}


TgINLINE TYPE V(tgGM_Query_Radius_Sq_CI)( V(CPCU_TgCIRCLE) psCI1 )
{
    return (psCI1->m_fRadiusSq);
}


//TgINLINE TgVOID V(tgGM_M_TX_CI)( V(PCU_TgCIRCLE) psCI0, M34(CPCU_TgMAT) pxM0 )
//{
//    TgGEOM_ASSERT_PARAM(!M34(F_NaN)( pxM0 ));
//
//    psCI0->m.m.vOrigin = V(tgGM_M_TX)( pxM0, psCI0->m.m.vOrigin );
//    psCI0->m.m.vU      = V(tgGM_M_TX)( pxM0, psCI0->m.m.vU );
//    psCI0->m.m.vNormal = V(tgGM_M_TX)( pxM0, psCI0->m.m.vNormal );
//    psCI0->m.m.vV      = V(tgGM_M_TX)( pxM0, psCI0->m.m.vV );
//};
//
//
//TgINLINE TgVOID V(tgGM_M_TX_CI)( V(PCU_TgCIRCLE) psCI0, V(CPCU_TgCIRCLE) psCI1, M34(CPCU_TgMAT) pxM0 )
//{
//    TgGEOM_ASSERT_PARAM(V(tgGM_Is_Valid_CI)( psCI1 ) && !M34(F_NaN)( pxM0 ));
//
//    psCI0->m.m.vU        = V(tgGM_M_TX)( pxM0, psCI1->m.m.vU );
//    psCI0->m.m.vNormal   = V(tgGM_M_TX)( pxM0, psCI1->m.m.vNormal );
//    psCI0->m.m.vV        = V(tgGM_M_TX)( pxM0, psCI1->m.m.vV );
//    psCI0->m.m.vOrigin   = V(tgGM_M_TX)( pxM0, psCI1->m.m.vOrigin );
//    psCI0->m_fRadius   = psCI1->m_fRadius;
//    psCI0->m_fRadiusSq = psCI1->m_fRadiusSq;
//};