#if !defined(_TGS_COLLISION_SEGMENT_INL_)
#define _TGS_COLLISION_SEGMENT_INL_
#pragma once
namespace TGS {
namespace COL {
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_DistSq( CR_(SEGMENT,DIM) tgSG0, M_(VECTOR,DIM) tvS0 )
{
return (TTgFSQ_LNPT<TYPE,DIM,1,1>::DO( tgSG0.Query_Origin(), tgSG0.Query_DirN(), tvS0 ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Dist( CR_(SEGMENT,DIM) tgSG0, M_(VECTOR,DIM) tvS0 )
{
register const TYPE tyTA = F_DistSq( tgSG0,tvS0 );
return (P::FSEL( tyTA, P::SQRT( tyTA ), tyTA));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_DistSq( M_(VECTOR,DIM) tvS0, CR_(SEGMENT,DIM) tgSG0 )
{
return (F_DistSq( tgSG0,tvS0 ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Dist( M_(VECTOR,DIM) tvS0, CR_(SEGMENT,DIM) tgSG0 )
{
return (F_Dist( tgSG0,tvS0 ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( PC_(VECTOR,DIM) ptvSG0, CR_(SEGMENT,DIM) tgSG0,M_(VECTOR,DIM) tvS0 )
{
return (TTgCSQ_LNPT<TYPE,DIM,1,1>::DO( ptvSG0, tgSG0.Query_Origin(), tgSG0.Query_DirN(), tvS0 ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( PC_(VECTOR,DIM) ptvSG0, CR_(SEGMENT,DIM) tgSG0,M_(VECTOR,DIM) tvS0 )
{
register const TYPE tyTA = F_ClosestSq( ptvSG0, tgSG0,tvS0 );
return (P::FSEL( tyTA, P::SQRT( tyTA ), tyTA));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( PC_(VECTOR,DIM) ptvSG0, M_(VECTOR,DIM) tvS0, CR_(SEGMENT,DIM) tgSG0 )
{
return (F_ClosestSq( ptvSG0, tgSG0,tvS0 ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( PC_(VECTOR,DIM) ptvSG0, M_(VECTOR,DIM) tvS0, CR_(SEGMENT,DIM) tgSG0 )
{
return (F_Closest( ptvSG0, tgSG0,tvS0 ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( TYPE *ptySG0, CR_(SEGMENT,DIM) tgSG0, M_(VECTOR,DIM) tvS0 )
{
return (TTgCSQ_LNPT<TYPE,DIM,1,1>::DO( ptySG0, tgSG0.Query_Origin(), tgSG0.Query_DirN(), tvS0 ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( TYPE *ptySG0, CR_(SEGMENT,DIM) tgSG0, M_(VECTOR,DIM) tvS0 )
{
register const TYPE tyTA = F_ClosestSq( ptySG0, tgSG0,tvS0 );
return (P::FSEL( tyTA, P::SQRT( tyTA ), tyTA));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( TYPE *ptySG0, M_(VECTOR,DIM) tvS0, CR_(SEGMENT,DIM) tgSG0 )
{
return (F_ClosestSq( ptySG0, tgSG0,tvS0 ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( TYPE *ptySG0, M_(VECTOR,DIM) tvS0, CR_(SEGMENT,DIM) tgSG0 )
{
return (F_Closest( ptySG0, tgSG0,tvS0 ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_DistSq( CR_(SEGMENT,DIM) tgSG0, CR_(LINE,DIM) tgLN0 )
{
return (TTgFSQ_LNLN<TYPE,DIM,1,1,0,0>::DO( tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgLN0.Query_Origin(),tgLN0.Query_DirN() ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_DistSq( CR_(SEGMENT,DIM) tgSG0, CR_(RAY,DIM) tgRY0 )
{
return (TTgFSQ_LNLN<TYPE,DIM,1,1,1,0>::DO( tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgRY0.Query_Origin(),tgRY0.Query_DirN() ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_DistSq( CR_(SEGMENT,DIM) tgSG0, CR_(SEGMENT,DIM) tgSG1 )
{
return (TTgFSQ_LNLN<TYPE,DIM,1,1,1,1>::DO( tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgSG1.Query_Origin(),tgSG1.Query_DirN() ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Dist( CR_(SEGMENT,DIM) tgSG0, CR_(LINE,DIM) tgLN0 )
{
return (P::SQRT( F_DistSq( tgSG0,tgLN0 ) ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Dist( CR_(SEGMENT,DIM) tgSG0, CR_(RAY,DIM) tgRY0 )
{
return (P::SQRT( F_DistSq( tgSG0,tgRY0 ) ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Dist( CR_(SEGMENT,DIM) tgSG0, CR_(SEGMENT,DIM) tgSG1 )
{
return (P::SQRT( F_DistSq( tgSG0,tgSG1 ) ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( PC_(VECTOR,DIM) ptvSG0, PC_(VECTOR,DIM) ptvLN0, CR_(SEGMENT,DIM) tgSG0, CR_(LINE,DIM) tgLN0 )
{
return (TTgCSQ_LNLN<TYPE,DIM,1,1,0,0>::DO(
ptvSG0, ptvLN0, tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgLN0.Query_Origin(),tgLN0.Query_DirN()
));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( PC_(VECTOR,DIM) ptvSG0, PC_(VECTOR,DIM) ptvRY0, CR_(SEGMENT,DIM) tgSG0, CR_(RAY,DIM) tgRY0 )
{
return (TTgCSQ_LNLN<TYPE,DIM,1,1,1,0>::DO(
ptvSG0, ptvRY0, tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgRY0.Query_Origin(),tgRY0.Query_DirN()
));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( PC_(VECTOR,DIM) ptvSG0, PC_(VECTOR,DIM) ptvSG1, CR_(SEGMENT,DIM) tgSG0, CR_(SEGMENT,DIM) tgSG1 )
{
return (TTgCSQ_LNLN<TYPE,DIM,1,1,1,1>::DO(
ptvSG0, ptvSG1, tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgSG1.Query_Origin(),tgSG1.Query_DirN()
));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( PC_(VECTOR,DIM) ptvSG0, PC_(VECTOR,DIM) ptvLN0, CR_(SEGMENT,DIM) tgSG0, CR_(LINE,DIM) tgLN0 )
{
return (P::SQRT( F_ClosestSq( ptvSG0,ptvLN0, tgSG0,tgLN0 ) ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( PC_(VECTOR,DIM) ptvSG0, PC_(VECTOR,DIM) ptvRY0, CR_(SEGMENT,DIM) tgSG0, CR_(RAY,DIM) tgRY0 )
{
return (P::SQRT( F_ClosestSq( ptvSG0,ptvRY0, tgSG0,tgRY0 ) ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( PC_(VECTOR,DIM) ptvSG0, PC_(VECTOR,DIM) ptvSG1, CR_(SEGMENT,DIM) tgSG0, CR_(SEGMENT,DIM) tgSG1 )
{
return (P::SQRT( F_ClosestSq( ptvSG0,ptvSG1, tgSG0,tgSG1 ) ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( TYPE *ptySG0, TYPE *ptyLN0, CR_(SEGMENT,DIM) tgSG0, CR_(LINE,DIM) tgLN0 )
{
return (TTgCSQ_LNLN<TYPE,DIM,1,0,0,0>::DO(
ptySG0, ptyLN0, tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgLN0.Query_Origin(),tgLN0.Query_DirN()
));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( TYPE *ptySG0, TYPE *ptyRY0, CR_(SEGMENT,DIM) tgSG0, CR_(RAY,DIM) tgRY0 )
{
return (TTgCSQ_LNLN<TYPE,DIM,1,0,1,0>::DO(
ptySG0, ptyRY0, tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgRY0.Query_Origin(),tgRY0.Query_DirN()
));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_ClosestSq( TYPE *ptySG0, TYPE *ptySG1, CR_(SEGMENT,DIM) tgSG0, CR_(SEGMENT,DIM) tgSG1 )
{
return (TTgCSQ_LNLN<TYPE,DIM,1,0,1,1>::DO(
ptySG0, ptySG1, tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgSG1.Query_Origin(),tgSG1.Query_DirN()
));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( TYPE *ptySG0, TYPE *ptyLN0, CR_(SEGMENT,DIM) tgSG0, CR_(LINE,DIM) tgLN0 )
{
return (P::SQRT( F_ClosestSq( ptySG0,ptyLN0, tgSG0,tgLN0 ) ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( TYPE *ptySG0, TYPE *ptyRY0, CR_(SEGMENT,DIM) tgSG0, CR_(RAY,DIM) tgRY0 )
{
return (P::SQRT( F_ClosestSq( ptySG0,ptyRY0, tgSG0,tgRY0 ) ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TYPE F_Closest( TYPE *ptySG0, TYPE *ptySG1, CR_(SEGMENT,DIM) tgSG0, CR_(SEGMENT,DIM) tgSG1 )
{
return (P::SQRT( F_ClosestSq( ptySG0,ptySG1, tgSG0,tgSG1 ) ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TgBOOL F_Contact_Test( CR_(SEGMENT,DIM) tgSG0, CR_(LINE,DIM) tgLN0 )
{
return (TTgTST_LNLN<TYPE,DIM,0,0,0,0>::DO( tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgLN0.Query_Origin(),tgLN0.Query_DirN() ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TgBOOL F_Contact_Test( CR_(SEGMENT,DIM) tgSG0, CR_(RAY,DIM) tgRY0 )
{
return (TTgTST_LNLN<TYPE,DIM,0,0,1,0>::DO( tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgRY0.Query_Origin(),tgRY0.Query_DirN() ));
};
template <typename TYPE, int DIM> TgFORCEINLINE
TgBOOL F_Contact_Test( CR_(SEGMENT,DIM) tgSG0, CR_(SEGMENT,DIM) tgSG1 )
{
return (TTgTST_LNLN<TYPE,DIM,0,0,1,1>::DO( tgSG0.Query_Origin(),tgSG0.Query_DirN(), tgSG1.Query_Origin(),tgSG1.Query_DirN() ));
};
};
};
#endif