//----------------------------------------------------------------------------
//  EgalTech 2016-2020
//----------------------------------------------------------------------------
// File : CDBoxSurfTm.cpp      Data : 09.01.20        Versione : 2.2a2
// Contenuto : Implementazione della verifica di collisione tra
//             BoundingBox e Closed SurftriMesh.
//
//
// Modifiche : 05.10.16 DS Creazione modulo.
//             09.01.20 DS Cambio nome alla funzione.
//
//----------------------------------------------------------------------------

//--------------------------- Include ----------------------------------------
#include "stdafx.h"
#include "CDeBoxTria.h"
#include "/EgtDev/Include/EGkCDeBoxClosedSurfTm.h"
#include "/EgtDev/Include/EGkDistPointSurfTm.h"

using namespace std ;

//----------------------------------------------------------------------------
bool
CDeBoxClosedSurfTm( const Frame3d& frBox, const Vector3d& vtDiag, double dSafeDist, const ISurfTriMesh& Stm)
{
  // Recupero BBox del poliedro
   BBox3d b3Poly = Stm.GetAllTriaBox() ;
  // Calcolo il BBox del parallelepipedo
   BBox3d b3BoxL( ORIG, ORIG + vtDiag) ;
   if ( dSafeDist > EPS_SMALL)
      b3BoxL.Expand( dSafeDist) ;
   BBox3d b3Box = GetToGlob( b3BoxL, frBox) ;
  // Se i BBox non interferiscono, non c'è collisione
   if ( ! b3Poly.Overlaps( b3Box)  ||  ! b3Poly.Overlaps( frBox, b3BoxL))
      return false ;
  // Verifico se il parallelepipedo interferisce con i triangoli del poliedro presenti nel suo BBox
   INTVECTOR vT ;
   Stm.GetAllTriaOverlapBox( b3Box, vT) ;
   for ( int nT : vT) {
      Triangle3d Tria ;
      if ( Stm.GetTriangle( nT, Tria)) {
         if ( CDeBoxTria( frBox, vtDiag, dSafeDist, Tria))
            return true ;
      }
   }
  // Se superficie aperta, non c'è collisione
   if ( ! Stm.IsClosed())
      return false ;
  // Se il BBox del parallelepipedo non è interno a quello del poliedro e viceversa, non c'è collisione
   if ( ! b3Poly.Encloses( b3Box)  &&  ! b3Box.Encloses( b3Poly))
      return false ;
  // Verifico se il box è dentro la superficie tramite calcolo distanza minima del suo centro
   Point3d ptBoxCen = ORIG + vtDiag / 2 ;
   ptBoxCen.ToGlob( frBox) ;
   DistPointSurfTm DistBoxCenSurfCalc( ptBoxCen, Stm) ;
  // Se il box è interno c'è collisione
   return DistBoxCenSurfCalc.IsPointInside() ;
}