glc_octreenode.cpp

Go to the documentation of this file.

/****************************************************************************

 This file is part of the GLC-lib library.
 Copyright (C) 2005-2008 Laurent Ribon (laumaya@users.sourceforge.net)
 Version 2.0.0, packaged on July 2010.

 http://glc-lib.sourceforge.net

 GLC-lib is free software; you can redistribute it and/or modify
 it under the terms of the GNU Lesser General Public License as published by
 the Free Software Foundation; either version 3 of the License, or
 (at your option) any later version.

 GLC-lib is distributed in the hope that it will be useful,
 but WITHOUT ANY WARRANTY; without even the implied warranty of
 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 GNU Lesser General Public License for more details.

 You should have received a copy of the GNU Lesser General Public License
 along with GLC-lib; if not, write to the Free Software
 Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA

 *****************************************************************************/

#include "glc_octreenode.h"

bool GLC_OctreeNode::m_useBoundingSphere= true;

GLC_OctreeNode::GLC_OctreeNode(const GLC_BoundingBox& boundingBox, GLC_OctreeNode* pParent)
: m_BoundingBox(boundingBox)
, m_pParent(pParent)
, m_Children()
, m_3DViewInstanceSet()
, m_Empty(true)
{


}

GLC_OctreeNode::GLC_OctreeNode(const GLC_OctreeNode& octreeNode, GLC_OctreeNode* pParent)
: m_BoundingBox(octreeNode.m_BoundingBox)
, m_pParent(pParent)
, m_Children()
, m_3DViewInstanceSet(octreeNode.m_3DViewInstanceSet)
, m_Empty(octreeNode.m_Empty)
{
        if (!octreeNode.m_Children.isEmpty())
        {
                const int size= octreeNode.m_Children.size();
                for (int i= 0; i < size; ++i)
                {
                        m_Children.append(new GLC_OctreeNode(*(octreeNode.m_Children.at(i)), this));
                }
        }
}

GLC_OctreeNode::~GLC_OctreeNode()
{
        const int size= m_Children.size();
        for (int i= 0; i < size; ++i)
        {
                delete m_Children.at(i);
        }
}

bool GLC_OctreeNode::intersectionWithBoundingSphereUsed()
{
        return m_useBoundingSphere;
}

QSet<GLC_3DViewInstance*> GLC_OctreeNode::setOfIntersectedInstances(const GLC_BoundingBox& bBox)
{
        QSet<GLC_3DViewInstance*> instanceSet;
        if (intersect(bBox))
        {
                QSet<GLC_3DViewInstance*>::iterator iInstance= m_3DViewInstanceSet.begin();
                while (m_3DViewInstanceSet.constEnd() != iInstance)
                {
                        if ((*iInstance)->boundingBox().intersect(bBox))
                        {
                                instanceSet << *(iInstance);
                        }
                        ++iInstance;
                }
                const int childCount= m_Children.size();
                for (int i= 0; i < childCount; ++i)
                {
                        instanceSet.unite(m_Children[i]->setOfIntersectedInstances(bBox));
                }
        }

        return instanceSet;
}
// Set Functions

void GLC_OctreeNode::addChildren()
{
        Q_ASSERT(m_Children.isEmpty());
        Q_ASSERT(!m_BoundingBox.isEmpty());

        const double xLower=  m_BoundingBox.lowerCorner().x();
        const double yLower=  m_BoundingBox.lowerCorner().y();
        const double zLower=  m_BoundingBox.lowerCorner().z();

        const double xUpper=  m_BoundingBox.upperCorner().x();
        const double dX= (xUpper - xLower) / 2.0;
        const double yUpper=  m_BoundingBox.upperCorner().y();
        const double dY= (yUpper - yLower) / 2.0;
        const double zUpper=  m_BoundingBox.upperCorner().z();
        const double dZ= (zUpper - zLower) / 2.0;


        // Add 8 Children
        GLC_Point3d lower;
        GLC_Point3d upper;
        GLC_OctreeNode* pOctreeNode= NULL;

        { // Child 1
                lower.setVect(xLower, yLower, zLower);
                upper.setVect(xLower + dX, yLower + dY, zLower + dZ);
                GLC_BoundingBox box(lower, upper);
                pOctreeNode= new GLC_OctreeNode(box, this);
                m_Children.append(pOctreeNode);
        }
        { // Child 2
                lower.setVect(xLower + dX, yLower, zLower);
                upper.setVect(xUpper, yLower + dY, zLower + dZ);
                GLC_BoundingBox box(lower, upper);
                pOctreeNode= new GLC_OctreeNode(box, this);
                m_Children.append(pOctreeNode);
        }
        { // Child 3
                lower.setVect(xLower + dX, yLower + dY, zLower);
                upper.setVect(xUpper, yUpper, zLower + dZ);
                GLC_BoundingBox box(lower, upper);
                pOctreeNode= new GLC_OctreeNode(box, this);
                m_Children.append(pOctreeNode);
        }
        { // Child 4
                lower.setVect(xLower, yLower + dY, zLower);
                upper.setVect(xLower + dX, yUpper, zLower + dZ);
                GLC_BoundingBox box(lower, upper);
                pOctreeNode= new GLC_OctreeNode(box, this);
                m_Children.append(pOctreeNode);
        }
        { // Child 5
                lower.setVect(xLower, yLower, zLower + dZ);
                upper.setVect(xLower + dX, yLower + dY, zUpper);
                GLC_BoundingBox box(lower, upper);
                pOctreeNode= new GLC_OctreeNode(box, this);
                m_Children.append(pOctreeNode);
        }
        { // Child 6
                lower.setVect(xLower + dX, yLower, zLower + dZ);
                upper.setVect(xUpper, yLower + dY, zUpper);
                GLC_BoundingBox box(lower, upper);
                pOctreeNode= new GLC_OctreeNode(box, this);
                m_Children.append(pOctreeNode);
        }
        { // Child 7
                lower.setVect(xLower + dX, yLower + dY, zLower + dZ);
                upper.setVect(xUpper, yUpper, zUpper);
                GLC_BoundingBox box(lower, upper);
                pOctreeNode= new GLC_OctreeNode(box, this);
                m_Children.append(pOctreeNode);
        }
        { // Child 8
                lower.setVect(xLower, yLower + dY, zLower + dZ);
                upper.setVect(xLower + dX, yUpper, zUpper);
                GLC_BoundingBox box(lower, upper);
                pOctreeNode= new GLC_OctreeNode(box, this);
                m_Children.append(pOctreeNode);
        }
}


void GLC_OctreeNode::addInstance(GLC_3DViewInstance* pInstance, int depth)
{
        m_Empty= false;
        const GLC_BoundingBox instanceBox= pInstance->boundingBox();
        // Check if the instance's bounding box intersect this node bounding box
        if (intersect(instanceBox))
        {
                if (0 == depth)
                {
                        m_3DViewInstanceSet.insert(pInstance);
                }
                else
                {
                        if (m_Children.isEmpty())
                        {
                                // Create children
                                addChildren();
                        }
                        QVector<bool> childIntersect(8);
                        bool allIntersect= true;
                        bool currentIntersect= false;
                        for (int i= 0; i < 8; ++i)
                        {
                                currentIntersect= m_Children.at(i)->intersect(instanceBox);
                                allIntersect= allIntersect && currentIntersect;
                                childIntersect[i]= currentIntersect;
                        }
                        if (allIntersect)
                        {
                                m_3DViewInstanceSet.insert(pInstance);
                        }
                        else
                        {
                                for (int i= 0; i < 8; ++i)
                                {
                                        if (childIntersect[i])
                                        {
                                                m_Children[i]->addInstance(pInstance, depth - 1);
                                        }
                                }
                        }
                }

        }
}


void GLC_OctreeNode::updateViewableInstances(const GLC_Frustum& frustum, QSet<GLC_3DViewInstance*>* pInstanceSet)
{

        bool firstCall= false;
        // Create the set of viewable instance if necessary
        if (NULL == pInstanceSet)
        {
                pInstanceSet= new QSet<GLC_3DViewInstance*>();
                firstCall= true;
        }

        // Test the localisation of current octree node
        GLC_Frustum::Localisation nodeLocalisation= frustum.localizeBoundingBox(m_BoundingBox);
        if (nodeLocalisation == GLC_Frustum::OutFrustum)
        {
                disableViewFlag(pInstanceSet);
        }
        else if (nodeLocalisation == GLC_Frustum::InFrustum)
        {
                unableViewFlag(pInstanceSet);
        }
        else // The current node intersect the frustum
        {
                QSet<GLC_3DViewInstance*>::iterator iInstance= m_3DViewInstanceSet.begin();
                while (m_3DViewInstanceSet.constEnd() != iInstance)
                {
                        // Test if the instances is in the viewable set
                        if (!pInstanceSet->contains(*iInstance))
                        {
                                GLC_3DViewInstance* pCurrentInstance= (*iInstance);
                                // Test the localisation of the current instance
                                GLC_Frustum::Localisation instanceLocalisation= frustum.localizeBoundingBox(pCurrentInstance->boundingBox());

                                if (instanceLocalisation == GLC_Frustum::OutFrustum)
                                {
                                        pCurrentInstance->setViewable(GLC_3DViewInstance::NoViewable);
                                }
                                else if (instanceLocalisation == GLC_Frustum::InFrustum)
                                {
                                        pInstanceSet->insert(pCurrentInstance);
                                        pCurrentInstance->setViewable(GLC_3DViewInstance::FullViewable);
                                }
                                else
                                {
                                        pInstanceSet->insert(pCurrentInstance);
                                        pCurrentInstance->setViewable(GLC_3DViewInstance::PartialViewable);
                                        //Update the geometries viewable property of the instance
                                        GLC_Matrix4x4 instanceMat= pCurrentInstance->matrix();
                                        const int size= pCurrentInstance->numberOfBody();
                                        for (int i= 0; i < size; ++i)
                                        {
                                                // Get the geometry bounding box
                                                GLC_BoundingBox geomBox= pCurrentInstance->geomAt(i)->boundingBox();
                                                GLC_Point3d center(instanceMat * geomBox.center());
                                                double radius= geomBox.boundingSphereRadius() * instanceMat.scalingX();
                                                GLC_Frustum::Localisation geomLocalisation= frustum.localizeSphere(center, radius);

                                                pCurrentInstance->setGeomViewable(i, geomLocalisation != GLC_Frustum::OutFrustum);
                                        }
                                }
                        }

                        ++iInstance;
                }
                const int size= m_Children.size();
                for (int i= 0; i < size; ++i)
                {
                        m_Children.at(i)->updateViewableInstances(frustum, pInstanceSet);
                }
        }
        if (firstCall) delete pInstanceSet;
}


void GLC_OctreeNode::removeEmptyChildren()
{
        NodeList::iterator iList= m_Children.begin();
        while(m_Children.constEnd() != iList)
        {
                GLC_OctreeNode* pCurrentChild= *iList;
                if (pCurrentChild->isEmpty())
                {
                        delete pCurrentChild;
                        iList= m_Children.erase(iList);
                }
                else
                {
                        pCurrentChild->removeEmptyChildren();
                        if (pCurrentChild->isEmpty())
                        {
                                delete pCurrentChild;
                                iList= m_Children.erase(iList);
                        }
                        else ++iList;
                }
        }
        // Update empty flag
        if (m_Children.isEmpty() && (NULL != m_pParent))
        {
                if (1 == m_3DViewInstanceSet.size())
                {
                        m_pParent->m_3DViewInstanceSet.insert(*(m_3DViewInstanceSet.begin()));
                        m_3DViewInstanceSet.clear();
                }
                m_Empty= m_3DViewInstanceSet.isEmpty();
        }
}

void GLC_OctreeNode::useBoundingSphereIntersection(bool use)
{
        m_useBoundingSphere= use;
}

void GLC_OctreeNode::unableViewFlag(QSet<GLC_3DViewInstance*>* pInstanceSet)
{
        QSet<GLC_3DViewInstance*>::iterator iInstance= m_3DViewInstanceSet.begin();
        while (m_3DViewInstanceSet.constEnd() != iInstance)
        {
                if (!pInstanceSet->contains(*iInstance))
                {
                        (*iInstance)->setViewable(GLC_3DViewInstance::FullViewable);
                        pInstanceSet->insert(*iInstance);
                }

                ++iInstance;
        }
        const int size= m_Children.size();
        for (int i= 0; i < size; ++i)
        {
                m_Children.at(i)->unableViewFlag(pInstanceSet);
        }
}


void GLC_OctreeNode::disableViewFlag(QSet<GLC_3DViewInstance*>* pInstanceSet)
{
        QSet<GLC_3DViewInstance*>::iterator iInstance= m_3DViewInstanceSet.begin();
        while (m_3DViewInstanceSet.constEnd() != iInstance)
        {
                if (!pInstanceSet->contains(*iInstance))
                        (*iInstance)->setViewable(GLC_3DViewInstance::NoViewable);

                ++iInstance;
        }
        const int size= m_Children.size();
        for (int i= 0; i < size; ++i)
        {
                m_Children.at(i)->disableViewFlag(pInstanceSet);
        }
}