AngleRZFull.h

/**************************************************************************
* BASF2 (Belle Analysis Framework 2)                                     *
* Copyright(C) 2014 - Belle II Collaboration                             *
*                                                                        *
* Author: The Belle II Collaboration                                     *
* Contributors: Jakob Lettenbichler (jakob.lettenbichler@oeaw.ac.at)     *
*                                                                        *
* This software is provided "as is" without any warranty.                *
**************************************************************************/
 
#pragma once
 
#include <tracking/trackFindingVXD/filterMap/filterFramework/SelectionVariable.h>
#include <framework/geometry/B2Vector3.h>
#include <math.h>
 
#define ANGLERZFULL_NAME AngleRZFull
 
namespace Belle2 {
  template <typename PointType >
  class ANGLERZFULL_NAME : public SelectionVariable< PointType , 3, double > {
  public:
    PUT_NAME_FUNCTION(ANGLERZFULL_NAME);
 
 
    static double value(const PointType& outerHit, const PointType& centerHit, const PointType& innerHit)
    {
 
      B2Vector3D outerVector(outerHit.X() - centerHit.X(), outerHit.Y() - centerHit.Y(), outerHit.Z() - centerHit.Z());
      B2Vector3D innerVector(centerHit.X() - innerHit.X(), centerHit.Y() - innerHit.Y(), centerHit.Z() - innerHit.Z());
 
      B2Vector3D rzVecAB(outerVector.Perp(), outerVector[2], 0.);
      B2Vector3D rzVecBC(innerVector.Perp(), innerVector[2], 0.);
 
      double result = acos(CosDirectionXY<B2Vector3D>::value(rzVecAB, rzVecBC));  // 0-pi
      result *= double(180. / M_PI);
      return (std::isnan(result) || std::isinf(result)) ? double(0) : result;
    } // return unit: ° (0 - 180°)
  };
 
}