CoordSysSvc.cc

Go to the documentation of this file.

#include "CoordSysSvc.h"
#include "GaudiKernel/MsgStream.h"
#include "GaudiKernel/SmartDataPtr.h"
#include "GaudiKernel/IDataProviderSvc.h"
#include "DetDesc/DetectorElement.h"
#include "DetDesc/IGeometryInfo.h"

using namespace std;

CoordSysSvc::CoordSysSvc(const std::string& name, ISvcLocator *svc)
    : Service(name,svc)
    , m_detSvc(0)
    , m_topGI(0)
    , m_lastBelongsTo(0)
    , m_lastCoordSys(0)
{
    declareProperty("CoordSysUserParameter",m_CoordSysUserParameter="CoordinateSystem",
                    "Name of the user parameter attached to the DetectorElement "
                    "that has the LVolume that provides the coordinate system.");
    declareProperty("TopDetectorElementName",
                    m_TopDetectorElementName="/dd/Structure/DayaBay",
                    "Name of the DetectorElement that holds all others");

}

CoordSysSvc::~CoordSysSvc()
{
}

StatusCode CoordSysSvc::initialize()
{
    this->Service::initialize();

    MsgStream msg(msgSvc(),name());
    msg << MSG::DEBUG << "CoordSysSvc::initialize()" << endreq;

    StatusCode sc = service("DetectorDataSvc",m_detSvc,true);
    if (sc.isFailure()) return sc;

    SmartDataPtr<IDetectorElement> topDE(m_detSvc,m_TopDetectorElementName);
    if (!topDE) return StatusCode::FAILURE;

    m_topGI = topDE->geometry();

    return StatusCode::SUCCESS;
}
StatusCode CoordSysSvc::finalize()
{
    m_detSvc->release();
    m_detSvc = 0;
    return StatusCode::SUCCESS;
}
StatusCode CoordSysSvc::queryInterface(const InterfaceID& riid, 
                                       void** ppvInterface)
{
    StatusCode sc = StatusCode::FAILURE;
    if (ppvInterface) {
        *ppvInterface = 0;
    
        if (ICoordSysSvc::interfaceID().versionMatch(riid)) {
            *ppvInterface = static_cast<ICoordSysSvc*>(this);
            sc = StatusCode::SUCCESS;
            addRef();
        }
        else sc = Service::queryInterface( riid, ppvInterface );    
    }
    return sc;
}

IDetectorElement* CoordSysSvc::belongsToDE(const Gaudi::XYZPoint& globalPoint,
                                           IDetectorElement* start, int depth)
{
    MsgStream msg(msgSvc(),name());

    // first check if we can try to optimize a little and get lucky
    // starting at last result.
    if (!start && depth < 0 && m_lastBelongsTo) {
        IGeometryInfo* gi = m_lastBelongsTo->geometry();
        if (gi->isInside(globalPoint)) {
            string path = gi->belongsToPath(globalPoint,-1);
            //msg << MSG::VERBOSE
            //    << "cached DE ("<< m_lastBelongsTo->name() 
            //    <<") gives belongsToPath = " << path << endreq;

            SmartDataPtr<IDetectorElement> de(m_detSvc,path);
            if (!de) {
                msg << MSG::ERROR
                    << "Failed to get DetectorElement " << path << endreq;
                return 0;
            }
            m_lastBelongsTo = de;
            return m_lastBelongsTo;
        }
        m_lastBelongsTo = 0;    // bummer
    }

    IGeometryInfo* gi = m_topGI;
    if (start) gi = start->geometry();

    string path = gi->belongsToPath(globalPoint,depth);
    if (!gi->isInside(globalPoint)) {
        MsgStream msg(msgSvc(),name());
        msg << MSG::DEBUG
            << "Failed to get DetectorElement path for point " << globalPoint << endreq;
        return 0;
    }

    SmartDataPtr<IDetectorElement> de(m_detSvc,path);
    if (!de) {
        MsgStream msg(msgSvc(),name());
        msg << MSG::WARNING
            << "No Detector Element at " << path << endreq;
        return 0;
    }
    m_lastBelongsTo = de;
    return m_lastBelongsTo;
}

IDetectorElement* CoordSysSvc::nextHigherCoordSysDE(IDetectorElement* csde)
{
    do {
        csde = csde->parentIDetectorElement();
        if (!csde) return 0;
        const ParamValidDataObject* params = csde->params();
        if (params && params->exists(m_CoordSysUserParameter)) 
            return csde;
    } while (csde);
    return 0;
}

IDetectorElement* CoordSysSvc::coordSysDE(const Gaudi::XYZPoint& globalPoint, 
                                          IDetectorElement* start, int height)
{

    IDetectorElement* de = start;

    // Start from start and work our way up, require a DE that has a
    // matching CoordinateSystem value and contains the global point.
    // If not, go to next larger CoordinateSystem DE.
    while (de) {

        const ParamValidDataObject* params = de->params();
        if (params && params->exists(m_CoordSysUserParameter)) {
            int level = params->param<int>(m_CoordSysUserParameter);
            if (!height || level == height) {
                if (de->geometry()->isInside(globalPoint)) {
                    m_lastCoordSys = de;
                    return m_lastCoordSys;
                }
            }
        }
        de = this->nextHigherCoordSysDE(de);
    }
            
    // reach here, got nuttin.
    MsgStream msg(msgSvc(),name());
    msg << MSG::DEBUG
        << "Failed to find coord sys DE starting from " 
        << start->name() << endreq;
    Gaudi::XYZPoint lpoint = start->geometry()->toLocal(globalPoint);
    msg << "In that frame the point is " << lpoint << endreq;
    return 0;
}

IDetectorElement* CoordSysSvc::coordSysDE(const Gaudi::XYZPoint& globalPoint, 
                                          int height)
{
    // Try to optimize, guess that the last one is right for this one
    IDetectorElement* de = m_lastBelongsTo;

    // check to see if last found or one of its parents can be reused
    while (de) {

        // if the DE doesn't contain the point, try its parent
        if (!de->geometry()->isInside(globalPoint)) {
            de = this->nextHigherCoordSysDE(de);
            continue;
        }

        // if DE doesn't have a CoordinateSystem parameter, keep going higher
        const ParamValidDataObject* params = de->params();
        if (!(params && params->exists(m_CoordSysUserParameter))) {
            de = this->nextHigherCoordSysDE(de);
            continue;
        }

        // know the DE has a CS parameter and contains the point, so drill down...
        de = this->belongsToDE(globalPoint,de,-1);

        // and come back up
        de = this->coordSysDE(globalPoint,de,height);
        if (de) {
            m_lastBelongsTo = de;
            return de;
        }

    }

    // Got to start from the scratch...
    de = this->belongsToDE(globalPoint);
    if (!de) {
        MsgStream msg(msgSvc(),name());
        msg << MSG::DEBUG
            << "Failed to find DE belonging to point " << globalPoint << endreq;
        return 0;
    }
    m_lastBelongsTo = this->coordSysDE(globalPoint,de,height);
    if (!m_lastBelongsTo) {
        MsgStream msg(msgSvc(),name());
        msg << MSG::DEBUG
            << "Failed to find DE starting with " << de->name()
            << " and height " << height << " using global point: " << globalPoint
            << endreq;
        Gaudi::XYZPoint lpoint = de->geometry()->toLocal(globalPoint);
        msg << "In that frame the point is " << lpoint << endreq;
    }
    return m_lastBelongsTo;
}