spacePoint.cc

/**************************************************************************
 * basf2 (Belle II Analysis Software Framework)                           *
 * Author: The Belle II Collaboration                                     *
 *                                                                        *
 * See git log for contributors and copyright holders.                    *
 * This file is licensed under LGPL-3.0, see LICENSE.md.                  *
 **************************************************************************/
 
#include <framework/logging/Logger.h>
#include <framework/utilities/TestHelpers.h>
#include <tracking/spacePointCreation/SpacePoint.h>
#include <vxd/dataobjects/VxdID.h>
#include <vxd/geometry/SensorInfoBase.h>
 
#include <gtest/gtest.h>
 
//root stuff
#include "TFile.h"
#include "TKey.h"
 
using namespace std;
 
namespace Belle2 {
  class SpacePointTest : public ::testing::Test {
 
  public:
    VXD::SensorInfoBase createSensorInfo(VxdID aVxdID, float width = 1., float length = 1., float width2 = -1.,
                                         VXD::SensorInfoBase::SensorType sensorType = VXD::SensorInfoBase::PXD)
    {
      // (SensorType type, VxdID id, float width, float length, float thickness, int uCells, int vCells, float width2=-1, double splitLength=-1, int vCells2=0)
      VXD::SensorInfoBase sensorInfoBase(sensorType, aVxdID, width, length, 0.3, 2, 4, width2);
 
      TGeoRotation r1;
      r1.SetAngles(45, 20, 30);      // rotation defined by Euler angles
      TGeoTranslation t1(-10, 10, 1);
      TGeoCombiTrans c1(t1, r1);
      TGeoHMatrix transform = c1;
      sensorInfoBase.setTransformation(transform);
 
      return sensorInfoBase;
    }
  protected:
  };
 
  TEST_F(SpacePointTest, testConstructorPXD)
  {
    VxdID aVxdID = VxdID(1, 1, 1);
    VXD::SensorInfoBase sensorInfoBase = createSensorInfo(aVxdID, 2.3, 4.2);
 
    // create new PXDCluster and fill it with Info getting a Hit which is not at the origin (here, first layer)
 
    PXDCluster aCluster = PXDCluster(aVxdID, 0., 0., 0.1, 0.1, 0, 0, 1, 1, 1, 1, 1, 1);
    SpacePoint testPoint = SpacePoint(&aCluster, &sensorInfoBase);
 
    EXPECT_DOUBLE_EQ(aVxdID, testPoint.getVxdID());
 
    // needing globalized position and error:
    ROOT::Math::XYZVector aPosition = sensorInfoBase.pointToGlobal(ROOT::Math::XYZVector(aCluster.getU(), aCluster.getV(), 0), true);
    ROOT::Math::XYZVector globalizedVariances = sensorInfoBase.vectorToGlobal(
                                                  ROOT::Math::XYZVector(
                                                    aCluster.getUSigma() * aCluster.getUSigma(),
                                                    aCluster.getVSigma() * aCluster.getVSigma(),
                                                    0
                                                  ),
                                                  true
                                                );
 
    ROOT::Math::XYZVector globalError;
    globalError.SetX(sqrt(abs(globalizedVariances.X())));
    globalError.SetY(sqrt(abs(globalizedVariances.Y())));
    globalError.SetZ(sqrt(abs(globalizedVariances.Z())));
 
    EXPECT_DOUBLE_EQ(aPosition.X(), testPoint.getPosition().X());
    EXPECT_DOUBLE_EQ(aPosition.Y(), testPoint.getPosition().Y());
    EXPECT_DOUBLE_EQ(aPosition.Z(), testPoint.getPosition().Z());
    EXPECT_FLOAT_EQ(globalError.X(), testPoint.getPositionError().X());
    EXPECT_FLOAT_EQ(globalError.Y(), testPoint.getPositionError().Y());
    EXPECT_FLOAT_EQ(globalError.Z(), testPoint.getPositionError().Z());
    // normalized coordinates, center of Plane should be at 0.5:
    EXPECT_DOUBLE_EQ(0.5, testPoint.getNormalizedLocalU());
    EXPECT_DOUBLE_EQ(0.5, testPoint.getNormalizedLocalV());
 
  }
 
 
 
  TEST_F(SpacePointTest, testConstructorSVD)
  {
    VxdID aVxdID = VxdID(3, 3, 3), anotherVxdID = VxdID(1, 1, 1);
    VXD::SensorInfoBase sensorInfoBase = createSensorInfo(aVxdID, 2.3, 4.2);
    VXD::SensorInfoBase anotherSensorInfoBase = createSensorInfo(anotherVxdID, 2.3, 4.2);
 
    // create new SVDClusters and fill it with Info getting a Hit which is not at the origin
    // SVDCluster (VxdID sensorID, bool isU, float position, float positionSigma, double clsTime, double clsTimeSigma, float seedCharge, float clsCharge, unsigned short clsSize, double clsSNR)
    SVDCluster clusterU1 = SVDCluster(aVxdID, true, -0.23, 0.1, 0.01, 0.001, 1, 1, 1, 1);
    SVDCluster clusterV1 = SVDCluster(aVxdID, false, 0.42, 0.1, 0.01, 0.001, 1, 1, 1, 1);
    SVDCluster clusterU2 = SVDCluster(aVxdID, true, 0.23, 0.1, 0.01, 0.001, 1, 1, 1, 1);
    SVDCluster clusterU3 = SVDCluster(anotherVxdID, true, 0.23, 0.1, 0.01, 0.001, 1, 1, 1, 1);
 
 
    // normal u+v = 2D Cluster (order of input irrelevant):
    std::vector<const SVDCluster*> good2D = { &clusterU1, &clusterV1 };
    SpacePoint testPoint2D = SpacePoint(good2D, &sensorInfoBase);
 
    // normal u-only = 1D Cluster, sensorInfoBase is normally not needed, since constructor can create it on its own, but here the geometry is not set up, therefore we have to pass the infoBase:
    std::vector<const SVDCluster*> good1D = { &clusterU3 };
    SpacePoint testPoint1D = SpacePoint(good1D, &anotherSensorInfoBase);
 
 
    // should throw, since no clusters given:
    std::vector<const SVDCluster*> badNoClusters;
    EXPECT_B2FATAL(SpacePoint(badNoClusters, &sensorInfoBase));
 
    // should throw, since too many clusters (of same sensor) given:
    std::vector<const SVDCluster*> bad3Clusters = { &clusterU1, &clusterV1, &clusterU2 };
    EXPECT_B2FATAL(SpacePoint(bad3Clusters, &sensorInfoBase));
 
    // should throw, since two clusters of same type (but on same sensor) given:
    std::vector<const SVDCluster*> badSameType = { &clusterU1, &clusterU2 };
    EXPECT_B2FATAL(SpacePoint(badSameType, &sensorInfoBase));
 
    // should throw, since two clusters of different sensors given:
    std::vector<const SVDCluster*> badDifferentSensors = { &clusterV1, &clusterU3 };
    EXPECT_B2FATAL(SpacePoint(badDifferentSensors, &sensorInfoBase));
 
 
    // check results for full 2D cluster-combi:
    ROOT::Math::XYZVector aPositionFor2D = sensorInfoBase.pointToGlobal(ROOT::Math::XYZVector(clusterU1.getPosition(),
                                           clusterV1.getPosition(), 0), true);
    ROOT::Math::XYZVector globalizedVariancesFor2D = sensorInfoBase.vectorToGlobal(
                                                       ROOT::Math::XYZVector(
                                                         clusterU1.getPositionSigma() * clusterU1.getPositionSigma(),
                                                         clusterV1.getPositionSigma() * clusterV1.getPositionSigma(),
                                                         0
                                                       ),
                                                       true
                                                     );
    ROOT::Math::XYZVector globalErrorFor2D;
    globalErrorFor2D.SetX(sqrt(abs(globalizedVariancesFor2D.X())));
    globalErrorFor2D.SetY(sqrt(abs(globalizedVariancesFor2D.Y())));
    globalErrorFor2D.SetZ(sqrt(abs(globalizedVariancesFor2D.Z())));
 
    // vxdID:
    EXPECT_EQ(aVxdID, testPoint2D.getVxdID());
    // global position:
    EXPECT_FLOAT_EQ(aPositionFor2D.X(), testPoint2D.getPosition().X());
    EXPECT_FLOAT_EQ(aPositionFor2D.Y(), testPoint2D.getPosition().Y());
    EXPECT_FLOAT_EQ(aPositionFor2D.Z(), testPoint2D.getPosition().Z());
    //global error:
    EXPECT_FLOAT_EQ(globalErrorFor2D.X(), testPoint2D.getPositionError().X());
    EXPECT_FLOAT_EQ(globalErrorFor2D.Y(), testPoint2D.getPositionError().Y());
    EXPECT_FLOAT_EQ(globalErrorFor2D.Z(), testPoint2D.getPositionError().Z());
    //local normalized position:
    EXPECT_FLOAT_EQ(0.4, testPoint2D.getNormalizedLocalU());
    EXPECT_FLOAT_EQ(0.6, testPoint2D.getNormalizedLocalV());
 
 
    // check results for single-cluster-only-case:
    ROOT::Math::XYZVector aPositionFor1D = anotherSensorInfoBase.pointToGlobal(ROOT::Math::XYZVector(clusterU3.getPosition(), 0, 0),
                                           true);
    ROOT::Math::XYZVector globalizedVariancesFor1D = anotherSensorInfoBase.vectorToGlobal(
                                                       ROOT::Math::XYZVector(
                                                         clusterU3.getPositionSigma() * clusterU3.getPositionSigma(),
                                                         anotherSensorInfoBase.getVSize() * anotherSensorInfoBase.getVSize() / 12.,
                                                         0
                                                       ),
                                                       true
                                                     );
    ROOT::Math::XYZVector globalErrorFor1D;
    globalErrorFor1D.SetX(sqrt(abs(globalizedVariancesFor1D.X())));
    globalErrorFor1D.SetY(sqrt(abs(globalizedVariancesFor1D.Y())));
    globalErrorFor1D.SetZ(sqrt(abs(globalizedVariancesFor1D.Z())));
 
 
    // vxdID:
    EXPECT_EQ(anotherVxdID, testPoint1D.getVxdID());
    // global position:
    EXPECT_FLOAT_EQ(aPositionFor1D.X(), testPoint1D.getPosition().X());
    EXPECT_FLOAT_EQ(aPositionFor1D.Y(), testPoint1D.getPosition().Y());
    EXPECT_FLOAT_EQ(aPositionFor1D.Z(), testPoint1D.getPosition().Z());
    //global error:
    EXPECT_FLOAT_EQ(globalErrorFor1D.X(), testPoint1D.getPositionError().X());
    EXPECT_FLOAT_EQ(globalErrorFor1D.Y(), testPoint1D.getPositionError().Y());
    EXPECT_FLOAT_EQ(globalErrorFor1D.Z(), testPoint1D.getPositionError().Z());
    //local normalized position:
    EXPECT_FLOAT_EQ(0.6, testPoint1D.getNormalizedLocalU());
    EXPECT_FLOAT_EQ(0.5, testPoint1D.getNormalizedLocalV()); // center of sensor since v-cluster was not given
  }
 
  TEST_F(SpacePointTest, testRootIOPXDCluster)
  {
    string fNameCluster = "demoClusters.root";
    VxdID aVxdID = VxdID(1, 2, 3);
    VXD::SensorInfoBase sensorInfoBase = createSensorInfo(aVxdID, 2.3, 4.2);
 
 
    PXDCluster aCluster = PXDCluster(aVxdID, 0., 0., 0.1, 0.1, 0, 0, 1, 1, 1, 1, 1, 1);
    EXPECT_EQ(aVxdID, aCluster.getSensorID());
 
    B2INFO("open root file: " << fNameCluster);
    TFile f(fNameCluster.c_str(), "recreate");
    f.cd();
    aCluster.Write();
    f.Close();
 
    TFile f2(fNameCluster.c_str());
    if (f2.IsZombie()) { B2ERROR("file could not be reopened!"); }
    else {
      PXDCluster* retrievedCluster;
      f2.GetListOfKeys()->Print();
 
      TIter next(f2.GetListOfKeys());
      TKey* key;
      while ((key = (TKey*)next())) {
 
        try {
          retrievedCluster = static_cast<PXDCluster*>(key->ReadObj());
        } catch (exception& e) {
          B2WARNING("Key was not a PXDCluster, therefore error message: " << e.what() << "\n Skipping this key...");
          continue;
        }
 
        EXPECT_EQ(retrievedCluster->getSensorID(), aCluster.getSensorID());
      }
      f2.Close();
    }
    if (remove(fNameCluster.c_str()) != 0)
    { B2ERROR("could not delete file " << fNameCluster << "!"); }
    else
    { B2INFO(fNameCluster << " successfully deleted"); }
  }
 
 
 
  TEST_F(SpacePointTest, testRootIOB2Vector3)
  {
    string fNameVec = "demoB2Vector3s.root";
 
    B2Vector3F aVec(1.23, 2.34, 3.45);
 
 
    B2INFO("open root file: " << fNameVec);
    TFile f(fNameVec.c_str(), "recreate");
    f.cd();
    f.WriteObject(&aVec, "myVec3");
    f.Close();
 
    TFile f2(fNameVec.c_str());
    if (f2.IsZombie()) { B2ERROR("file could not be reopened!"); }
    else {
 
      B2Vector3F* retrievedVector;
      f2.GetObject("myVec3", retrievedVector);
      f2.Close();
 
      EXPECT_DOUBLE_EQ(aVec.X(), retrievedVector->X());
      EXPECT_DOUBLE_EQ(aVec.Y(), retrievedVector->Y());
      EXPECT_DOUBLE_EQ(aVec.Z(), retrievedVector->Z());
 
    }
    if (remove(fNameVec.c_str()) != 0)
    { B2ERROR("could not delete file " << fNameVec << "!"); }
    else
    { B2INFO(fNameVec << " successfully deleted"); }
  }
 
 
 
  TEST_F(SpacePointTest, testRootIOSP)
  {
    string fNameSP = "demoSPs.root";
    VxdID aVxdID = VxdID(1, 2, 3);
    VXD::SensorInfoBase sensorInfoBase = createSensorInfo(aVxdID, 2.3, 4.2);
 
 
    PXDCluster aCluster = PXDCluster(aVxdID, 0., 0., 0.1, 0.1, 0, 0, 1, 1, 1, 1, 1, 1);
    EXPECT_EQ(aVxdID, aCluster.getSensorID());
 
    SpacePoint testPoint = SpacePoint(&aCluster, &sensorInfoBase);
    EXPECT_EQ(aVxdID, testPoint.getVxdID());
 
 
    B2INFO("open root file:" << fNameSP);
    TFile f3(fNameSP.c_str(), "recreate");
    f3.cd();
    testPoint.Write();
    B2INFO("closing file:");
    f3.Close();
 
    TFile f4(fNameSP.c_str());
    if (f4.IsZombie()) { B2ERROR("file could not be reopened!"); }
    else {
      SpacePoint* retrievedSpacePoint;
      f4.GetListOfKeys()->Print();
 
      TIter next(f4.GetListOfKeys());
      TKey* key;
      while ((key = (TKey*)next())) {
 
        try {
          retrievedSpacePoint = static_cast<SpacePoint*>(key->ReadObj());
        } catch (exception& e) {
          B2WARNING("Key was not a SpacePoint, therefore error message: " << e.what() << "\n Skipping this key...");
          continue;
        }
 
        EXPECT_EQ(retrievedSpacePoint->getVxdID(), testPoint.getVxdID());
        EXPECT_DOUBLE_EQ(retrievedSpacePoint->getPosition().X(), testPoint.getPosition().X());
        EXPECT_DOUBLE_EQ(retrievedSpacePoint->getPosition().Y(), testPoint.getPosition().Y());
        EXPECT_DOUBLE_EQ(retrievedSpacePoint->getPosition().Z(), testPoint.getPosition().Z());
        EXPECT_FLOAT_EQ(retrievedSpacePoint->getPositionError().X(), testPoint.getPositionError().X());
        EXPECT_FLOAT_EQ(retrievedSpacePoint->getPositionError().Y(), testPoint.getPositionError().Y());
        EXPECT_FLOAT_EQ(retrievedSpacePoint->getPositionError().Z(), testPoint.getPositionError().Z());
        EXPECT_DOUBLE_EQ(retrievedSpacePoint->getNormalizedLocalU(), testPoint.getNormalizedLocalU());
        EXPECT_DOUBLE_EQ(retrievedSpacePoint->getNormalizedLocalV(), testPoint.getNormalizedLocalV());
      }
      f4.Close();
    }
    if (remove(fNameSP.c_str()) != 0)
    { B2ERROR("could not delete file " << fNameSP << "!"); }
    else
    { B2INFO(fNameSP << " successfully deleted"); }
  }
 
 
 
 
  TEST_F(SpacePointTest, testConvertLocalToNormalizedCoordinates)
  {
    VxdID aVxdID = VxdID(1, 1, 1);
    VXD::SensorInfoBase sensorInfoBase = createSensorInfo(aVxdID, 2.3, 4.2);
 
    pair<float, float> sensorCenter = {1.15, 2.1};
 
    pair<float, float> hitLocal05 = {0, 0}; // sensorCenter is at 0, 0 in local coordinates
    pair<float, float> resultNormalized05 = {0.5, 0.5};
 
    pair<float, float> hitLocal001 = {0.023, 0.042};
    hitLocal001.first -= sensorCenter.first;
    hitLocal001.second -= sensorCenter.second;
    pair<float, float> resultNormalized001 = {0.01, 0.01};
 
    pair<float, float> hitLocal088 = {2.024, 3.696};
    hitLocal088.first -= sensorCenter.first;
    hitLocal088.second -= sensorCenter.second;
    pair<float, float> resultNormalized088 = {0.88, 0.88};
 
    pair<float, float> hitLocal001088 = {0.023, 3.696};// asymmetric example verifying that values are not accidentally switched
    hitLocal001088.first -= sensorCenter.first;
    hitLocal001088.second -= sensorCenter.second;
    pair<float, float> resultNormalized001088 = {0.01, 0.88};
 
    pair<float, float> hitLocalMinMax = { -1.16, 500}; // hit lies way beyond sensor edges (first is below lower threshold, second above higher one)
    pair<float, float> resultNormalizedMinMax = {0., 1.};
 
    pair<float, float> hitNormalized05 = SpacePoint::convertLocalToNormalizedCoordinates(hitLocal05, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultNormalized05.first, hitNormalized05.first);
    EXPECT_FLOAT_EQ(resultNormalized05.second, hitNormalized05.second);
 
    pair<float, float> hitNormalized001 = SpacePoint::convertLocalToNormalizedCoordinates(hitLocal001, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultNormalized001.first, hitNormalized001.first);
    EXPECT_NEAR(resultNormalized001.second, hitNormalized001.second, 1. / 100000.); // resolution of better than 1 nm.
 
    pair<float, float> hitNormalized088 = SpacePoint::convertLocalToNormalizedCoordinates(hitLocal088, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultNormalized088.first, hitNormalized088.first);
    EXPECT_FLOAT_EQ(resultNormalized088.second, hitNormalized088.second);
 
    pair<float, float> hitNormalized001088 = SpacePoint::convertLocalToNormalizedCoordinates(hitLocal001088, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultNormalized001088.first, hitNormalized001088.first);
    EXPECT_FLOAT_EQ(resultNormalized001088.second, hitNormalized001088.second);
 
    pair<float, float> hitNormalizedMinMax = SpacePoint::convertLocalToNormalizedCoordinates(hitLocalMinMax, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultNormalizedMinMax.first, hitNormalizedMinMax.first);
    EXPECT_FLOAT_EQ(resultNormalizedMinMax.second, hitNormalizedMinMax.second);
  }
 
 
 
  TEST_F(SpacePointTest, testConvertNormalizedToLocalCoordinates)
  {
    VxdID aVxdID = VxdID(1, 1, 1);
    VXD::SensorInfoBase sensorInfoBase = createSensorInfo(aVxdID, 2.3, 4.2);
 
    pair<float, float> sensorCenter = {1.15, 2.1};
 
    pair<float, float> hitNormalized05 = {0.5, 0.5};
    pair<float, float> resultLocal05 = {0, 0}; // sensorCenter is at 0, 0 in local coordinates
 
    pair<float, float> hitNormalized001 = {0.01, 0.01};
    pair<float, float> resultLocal001 = {0.023, 0.042};
    resultLocal001.first -= sensorCenter.first;
    resultLocal001.second -= sensorCenter.second;
 
    pair<float, float> hitNormalized088 = {0.88, 0.88};
    pair<float, float> resultLocal088 = {2.024, 3.696};
    resultLocal088.first -= sensorCenter.first;
    resultLocal088.second -= sensorCenter.second;
 
    pair<float, float> hitNormalized001088 = {0.01, 0.88};
    pair<float, float> resultLocal001088 = {0.023, 3.696};// asymmetric example verifying that values are not accidentally switched
    resultLocal001088.first -= sensorCenter.first;
    resultLocal001088.second -= sensorCenter.second;
 
    pair<float, float> hitNormalizedMinMax = { -0.1, 4.2}; // hit lies way beyond sensor edges (first is below lower threshold, second above higher one)
    pair<float, float> resultLocalMinMax = { -1.15, 2.1}; // reduced to sensor borders
 
    pair<float, float> hitLocal05 = SpacePoint::convertNormalizedToLocalCoordinates(hitNormalized05, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultLocal05.first, hitLocal05.first);
    EXPECT_FLOAT_EQ(resultLocal05.second, hitLocal05.second);
 
    pair<float, float> hitLocal001 = SpacePoint::convertNormalizedToLocalCoordinates(hitNormalized001, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultLocal001.first, hitLocal001.first);
    EXPECT_FLOAT_EQ(resultLocal001.second, hitLocal001.second);
 
    pair<float, float> hitLocal088 = SpacePoint::convertNormalizedToLocalCoordinates(hitNormalized088, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultLocal088.first, hitLocal088.first);
    EXPECT_FLOAT_EQ(resultLocal088.second, hitLocal088.second);
 
    pair<float, float> hitLocal001088 = SpacePoint::convertNormalizedToLocalCoordinates(hitNormalized001088, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultLocal001088.first, hitLocal001088.first);
    EXPECT_FLOAT_EQ(resultLocal001088.second, hitLocal001088.second);
 
    pair<float, float> hitLocalMinMax = SpacePoint::convertNormalizedToLocalCoordinates(hitNormalizedMinMax, aVxdID, &sensorInfoBase);
    EXPECT_FLOAT_EQ(resultLocalMinMax.first, hitLocalMinMax.first);
    EXPECT_FLOAT_EQ(resultLocalMinMax.second, hitLocalMinMax.second);
  }
  //     static pair<float, float> convertToLocalCoordinates(const pair<float, float>& hitNormalized, VxdID::baseType vxdID, const VXD::SensorInfoBase* aSensorInfo = nullptr);
 
 
 
  TEST_F(SpacePointTest, testGetNClustersAssigned)
  {
    // create a PXD SpacePoint and check if there is one Cluster assigned to it
    VxdID aVxdID = VxdID(1, 1, 1);
    VXD::SensorInfoBase sensorInfoBase = createSensorInfo(aVxdID, 2.3, 4.2);
    PXDCluster aCluster = PXDCluster(aVxdID, 0., 0., 0.1, 0.1, 0, 0, 1, 1, 1, 1, 1, 1);
    SpacePoint testPoint = SpacePoint(&aCluster, &sensorInfoBase);
 
    EXPECT_EQ(testPoint.getNClustersAssigned(), 1);
 
    // create different SVD SpacePoints and check if the number of assigned Clusters is correct
    aVxdID = VxdID(3, 1, 2);
    sensorInfoBase = createSensorInfo(aVxdID, 2.3, 4.2, -1, VXD::SensorInfoBase::SVD);
 
    // create new SVDClusters and fill it with Info getting a Hit which is not at the origin
    // SVDCluster (VxdID sensorID, bool isU, float position, float positionSigma, double clsTime, double clsTimeSigma, float seedCharge, float clsCharge, unsigned short clsSize)
    SVDCluster clusterU1 = SVDCluster(aVxdID, true, -0.23, 0.1, 0.01, 0.001, 1, 1, 1, 1);
    SVDCluster clusterV1 = SVDCluster(aVxdID, false, 0.42, 0.1, 0.01, 0.001, 1, 1, 1, 1);
 
    vector<const SVDCluster*> clusters2d = { &clusterU1, &clusterV1 };
    SpacePoint testPoint2D = SpacePoint(clusters2d, &sensorInfoBase);
    EXPECT_EQ(testPoint2D.getNClustersAssigned(), 2);
 
    vector<const SVDCluster*> clustersU = { &clusterU1 };
    SpacePoint testPoint1DU = SpacePoint(clustersU, &sensorInfoBase);
    EXPECT_EQ(testPoint1DU.getNClustersAssigned(), 1);
 
    vector<const SVDCluster*> clustersV = { &clusterV1 };
    SpacePoint testPoint1DV = SpacePoint(clustersV, &sensorInfoBase);
    EXPECT_EQ(testPoint1DV.getNClustersAssigned(), 1);
  }
 
 
//   TEST_F(SpacePointTest, testGenfitCompatibility)
//   {
//  B2INFO("testGenfitCompatibility: prepare StoreArray-stuff - clusters")
//  // prepare StoreArray-stuff:
//
//  //Clusters
//  StoreArray<PXDCluster> pxdCL("pxdStuff", DataStore::c_Persistent);
//
//
//  StoreArray<SVDCluster> svdCL("svdStuff", DataStore::c_Persistent);
//
//
//
//  B2INFO("testGenfitCompatibility: prepare StoreArray-stuff - SpacePoints including relations")
//  // SpacePoints including relations
//  StoreArray<SpacePoint> sps("spacePoints", DataStore::c_Persistent);
//
//
//
// //   pxdCL.registerRelationTo(sps, DataStore::c_Persistent);
// //   svdCL.registerRelationTo(sps, DataStore::c_Persistent);
//
//
//  B2INFO("testGenfitCompatibility: unique StoreArrayPtr to carry the names of the Cluster-storeArrays")
//  // unique StoreArrayPtr to carry the names of the Cluster-storeArrays:
//  StoreObjPtr<SpacePointMetaInfo> spMI("", DataStore::c_Persistent);
//
//
//
//
//  DataStore::Instance().setInitializeActive(true);
//  pxdCL.registerInDataStore(pxdCL.getName(), DataStore::c_Persistent);
//  svdCL.registerInDataStore(svdCL.getName(), DataStore::c_Persistent);
//  sps.registerInDataStore(sps.getName(), DataStore::c_Persistent);
//  sps.registerRelationTo(pxdCL, DataStore::c_Persistent);
//  sps.registerRelationTo(svdCL, DataStore::c_Persistent);
//  spMI.registerInDataStore("", DataStore::c_Persistent);
//  DataStore::Instance().setInitializeActive(false);
//
//  EXPECT_TRUE(pxdCL.isValid());
//  EXPECT_TRUE(svdCL.isValid());
//  EXPECT_TRUE(sps.isValid());
//
//  spMI.create();
//  EXPECT_TRUE(spMI.isValid());
//
//
//  unsigned int indexOfpxdCL = spMI->addName(pxdCL.getName());
//  unsigned int indexOfsvdCL = spMI->addName(svdCL.getName());
//
//  B2INFO("testGenfitCompatibility: creating 1 PXD and 3 SVD Cluster ")
//  // creating 1 PXD and 3 SVD Cluster
//  VxdID aVxdIDL1 = VxdID(1, 1, 1);
//  VxdID aVxdIDL3 = VxdID(3, 3, 3);
//  VxdID aVxdIDL4 = VxdID(4, 4, 4);
//  VXD::SensorInfoBase sensorInfoBase1 = createSensorInfo(aVxdIDL1, 2.3, 4.2);
//  VXD::SensorInfoBase sensorInfoBase3 = createSensorInfo(aVxdIDL3, 5., 23.42);
//  VXD::SensorInfoBase sensorInfoBase4 = createSensorInfo(aVxdIDL3, 23.42, 42.23);
//
//
//  B2INFO("testGenfitCompatibility: create new PXDCluster, fill it in storeArray, link it with newly created spacePoint")
//  // create new PXDCluster, fill it in storeArray, link it with newly created spacePoint
//  PXDCluster aCluster = PXDCluster(aVxdIDL1, 0., 0., 0.1, 0.1, 0, 0, 1, 1, 1, 1, 1, 1);
//  unsigned int indexOfPxdCluster = pxdCL.getEntries(); // getting the index before adding, since its minus one
//  B2INFO("indexOfPxdCluster: " << indexOfPxdCluster)
//  pxdCL.appendNew(aCluster);
//
//  SpacePoint testPoint = SpacePoint(&aCluster, indexOfPxdCluster, indexOfpxdCL, &sensorInfoBase1);
//  SpacePoint* newSP = sps.appendNew(testPoint);
//  newSP->addRelationTo(pxdCL[indexOfPxdCluster]);
//
//
//  B2INFO("testGenfitCompatibility: create SVDClusters, two of them are on the same sensor")
//  // create SVDClusters, two of them are on the same sensor
//  SVDCluster clusterU1 = SVDCluster(aVxdIDL3, true, -0.23, 0.1, 0.01, 0.001, 1, 1, 1);
//  unsigned int indexOfSvdClusterU1 = svdCL.getEntries();
//  B2INFO("indexOfSvdClusterU1: " << indexOfSvdClusterU1)
//  svdCL.appendNew(clusterU1);
//
//  SVDCluster clusterV1 = SVDCluster(aVxdIDL3, false, 0.42, 0.1, 0.01, 0.001, 1, 1, 1);
//  unsigned int indexOfSvdClusterV1 = svdCL.getEntries();
//  B2INFO("indexOfSvdClusterV1: " << indexOfSvdClusterV1)
//  svdCL.appendNew(clusterV1);
//
//  SpacePoint testPoint2D = SpacePoint({ {&clusterU1, indexOfSvdClusterU1}, {&clusterV1, indexOfSvdClusterV1} }, indexOfsvdCL, &sensorInfoBase3);
//  newSP = sps.appendNew(testPoint2D);
//  newSP->addRelationTo(svdCL[indexOfSvdClusterU1]);
//  newSP->addRelationTo(svdCL[indexOfSvdClusterV1]);
//
//
//  B2INFO("testGenfitCompatibility: create SVDCluster, which is alone on its sensor")
//  // create SVDCluster, which is alone on its sensor
//  SVDCluster clusterU2 = SVDCluster(aVxdIDL4, true, 0.23, 0.1, 0.01, 0.001, 1, 1, 1);
//  unsigned int indexOfSvdClusterU2 = svdCL.getEntries();
//  B2INFO("indexOfSvdClusterU2: " << indexOfSvdClusterU2)
//  svdCL.appendNew(clusterU2);
//  SpacePoint testPoint1D = SpacePoint({ {&clusterU2, indexOfSvdClusterU2} }, indexOfsvdCL, &sensorInfoBase4);
//  newSP = sps.appendNew(testPoint1D);
//  newSP->addRelationTo(svdCL[indexOfSvdClusterU2]);
//
//
//
//  /** Situation so far:
//   * now the mockup is fully prepared.
//   * it contains 2 storeArrays, carrying PXD- and SVDClusters and SpacePoints based on them.
//   * The spacePoints are related to them and have a metaInfo-StoreObjPtr telling them, where to retrieve the clusters again.
//   * This is now used to get genfit-compatible output and fill it in a genfit::Track
//   */
//
//  B2INFO("testGenfitCompatibility: preparing genfit track filled with arbitrary input")
//  // preparing genfit track filled with arbitrary input
//  genfit::AbsTrackRep* trackRep = new genfit::RKTrackRep(211);
// //   ROOT::Math::XYZVector posSeed =
// //   ROOT::Math::XYZVector posSeed =
//  genfit::Track track(trackRep, newSP->getPosition(), ROOT::Math::XYZVector(23., 42., 5.));
//
//  B2INFO("testGenfitCompatibility: feed the track with spacePoints ported to genfit compatible stuff")
//  // feed the track with spacePoints ported to genfit compatible stuff:
//  // is rather complicated since the assignment operator is protected:
//  std::vector<genfit::AbsMeasurement*> hitOutput;
//  for (auto& aSP : sps) {
//    std::vector<genfit::PlanarMeasurement> tempMeasurements = aSP.getGenfitCompatible();
//    for (genfit::PlanarMeasurement& measurement : tempMeasurements) {
//    hitOutput.emplace_back(measurement.clone());
//    }
// //     hitOutput.insert(hitOutput.end(), temp.begin(), temp.end());
//  }
//
//  for (unsigned i = 0; i < hitOutput.size(); i++) {
//    track.insertMeasurement(hitOutput[i]);
//  }
//
//  EXPECT_EQ(track.getNumPoints(), unsigned(pxdCL.getEntries() + svdCL.getEntries()));
//
//  // garbage collection:
//  delete trackRep;
//  for (auto& hit : hitOutput) { delete hit; }
//   }
 
 
 
 
 
 
}  // namespace