KFParticleSIMD.h

Go to the documentation of this file.

//****************************************************************************
//*                   This file is part of PandaRoot.                        *
//*                                                                          *
//*            PandaRoot is distributed under the terms of the               *
//*              GNU General Public License (GPL) version 3,                 *
//*                 copied verbatim in the file "LICENSE".                   *
//*                                                                          *
//*  Copyright (C) 2006 - 2024 FAIR GmbH and copyright holders of PandaRoot  *
//*     The copyright holders are listed in the file "COPYRIGHTHOLDERS".     *
//*               The authors are listed in the file "AUTHORS".              *
//****************************************************************************

//---------------------------------------------------------------------------------
// The KFParticleSIMD class
// .
// @author  S.Gorbunov, I.Kisel
// @version 1.0
// @since   13.05.07
//
// Class to reconstruct and store the decayed particle parameters.
// The method is described in CBM-SOFT note 2007-003,
// ``Reconstruction of decayed particles based on the Kalman filter'',
// http://www.gsi.de/documents/DOC-2007-May-14-1.pdf
//
// This class is ALICE interface to general mathematics in KFParticleBaseSIMD
//
//  -= Copyright &copy ALICE HLT and CBM L1 Groups =-
//_________________________________________________________________________________

//#define NonhomogeneousField
#define HomogeneousField

#ifndef KFPARTICLESIMD_H
#define KFPARTICLESIMD_H

#include "KFParticleBaseSIMD.h"

#ifdef HomogeneousField
class KFPTrack;
class KFPVertex;
#endif

#ifdef NonhomogeneousField
class CbmKFTrackInterface;
class CbmKFVertexInterface;
#include "L1Field.h"
#endif

class KFParticle;

class KFParticleSIMD : public KFParticleBaseSIMD {

 public:
  //*
  //*  INITIALIZATION
  //*

  //* Set magnetic field for all particles
#ifdef HomogeneousField
  static void SetField(fvec Bz);
#endif
#ifdef NonhomogeneousField
  void SetField(const L1FieldRegion &field, bool isOneEntry = 0, const int iVec = 0)
  {
    if (!isOneEntry)
      fField = field;
    else
      fField.SetOneEntry(field, iVec);
  }
#endif
  //* Constructor (empty)

  KFParticleSIMD() : KFParticleBaseSIMD() { ; }

  //* Destructor (empty)

  ~KFParticleSIMD() { ; }

  //* Construction of mother particle by its 2-3-4 daughters

  KFParticleSIMD(const KFParticleSIMD &d1, const KFParticleSIMD &d2, Bool_t gamma = false);

  KFParticleSIMD(const KFParticleSIMD &d1, const KFParticleSIMD &d2, const KFParticleSIMD &d3);

  KFParticleSIMD(const KFParticleSIMD &d1, const KFParticleSIMD &d2, const KFParticleSIMD &d3, const KFParticleSIMD &d4);

  //* Initialisation from "cartesian" coordinates ( X Y Z Px Py Pz )
  //* Parameters, covariance matrix, charge and PID hypothesis should be provided

  void Create(const fvec Param[], const fvec Cov[], fvec Charge, fvec mass /*Int_t PID*/);

#ifdef HomogeneousField
  //* Initialisation from ALICE track, PID hypothesis shoould be provided

  KFParticleSIMD(const KFPTrack &track, Int_t PID);
  KFParticleSIMD(const KFPTrack *track, Int_t PID);
  KFParticleSIMD(KFPTrack *Track[], int NTracks, Int_t *qHypo = nullptr, const Int_t *pdg = nullptr);
  void Create(KFPTrack *Track[], int NTracks, Int_t *qHypo = nullptr, const Int_t *pdg = nullptr);
  KFParticleSIMD(KFPTrack &Track, Int_t *qHypo = nullptr, const Int_t *pdg = nullptr);
  //* Initialisation from VVertex

  KFParticleSIMD(const KFPVertex &vertex);
#endif

#ifdef NonhomogeneousField
  KFParticleSIMD(CbmKFTrackInterface *Track[], int NTracks, Int_t *qHypo = 0, const Int_t *pdg = 0);
  KFParticleSIMD(CbmKFTrackInterface &Track, Int_t *qHypo = 0, const Int_t *pdg = 0);
  KFParticleSIMD(CbmKFVertexInterface &vertex);
  void Create(CbmKFTrackInterface *Track[], int NTracks, Int_t *qHypo = 0, const Int_t *pdg = 0);
#endif
  KFParticleSIMD(KFParticle *part[], const int nPart = 0);
  KFParticleSIMD(KFParticle &part);

  //* Initialise covariance matrix and set current parameters to 0.0

  void Initialize();

  //* Set decay vertex parameters for linearisation

  void SetVtxGuess(fvec x, fvec y, fvec z);

  //*
  //*  ACCESSORS
  //*

  //* Simple accessors

  fvec GetX() const;    //* x of current position
  fvec GetY() const;    //* y of current position
  fvec GetZ() const;    //* z of current position
  fvec GetPx() const;   //* x-compoment of 3-momentum
  fvec GetPy() const;   //* y-compoment of 3-momentum
  fvec GetPz() const;   //* z-compoment of 3-momentum
  fvec GetE() const;    //* energy
  fvec GetS() const;    //* decay length / momentum
  fvec GetQ() const;    //* charge
  fvec GetChi2() const; //* chi^2
  fvec GetNDF() const;  //* Number of Degrees of Freedom

  Bool_t GetAtProductionVertex() const { return fAtProductionVertex; }

  const fvec &X() const { return fP[0]; }
  const fvec &Y() const { return fP[1]; }
  const fvec &Z() const { return fP[2]; }
  const fvec &Px() const { return fP[3]; }
  const fvec &Py() const { return fP[4]; }
  const fvec &Pz() const { return fP[5]; }
  const fvec &E() const { return fP[6]; }
  const fvec &S() const { return fP[7]; }
  const fvec &Q() const { return fQ; }
  const fvec &Chi2() const { return fChi2; }
  const fvec &NDF() const { return fNDF; }

  fvec GetParameter(int i) const;
  fvec GetCovariance(int i) const;
  fvec GetCovariance(int i, int j) const;

  //* Accessors with calculations, value returned w/o error flag

  fvec GetP() const;             //* momentum
  fvec GetPt() const;            //* transverse momentum
  fvec GetEta() const;           //* pseudorapidity
  fvec GetPhi() const;           //* phi
  fvec GetMomentum() const;      //* momentum (same as GetP() )
  fvec GetMass() const;          //* mass
  fvec GetDecayLength() const;   //* decay length
  fvec GetDecayLengthXY() const; //* decay length in XY
  fvec GetLifeTime() const;      //* life time
  fvec GetR() const;             //* distance to the origin

  //* Accessors to estimated errors

  fvec GetErrX() const;             //* x of current position
  fvec GetErrY() const;             //* y of current position
  fvec GetErrZ() const;             //* z of current position
  fvec GetErrPx() const;            //* x-compoment of 3-momentum
  fvec GetErrPy() const;            //* y-compoment of 3-momentum
  fvec GetErrPz() const;            //* z-compoment of 3-momentum
  fvec GetErrE() const;             //* energy
  fvec GetErrS() const;             //* decay length / momentum
  fvec GetErrP() const;             //* momentum
  fvec GetErrPt() const;            //* transverse momentum
  fvec GetErrEta() const;           //* pseudorapidity
  fvec GetErrPhi() const;           //* phi
  fvec GetErrMomentum() const;      //* momentum
  fvec GetErrMass() const;          //* mass
  fvec GetErrDecayLength() const;   //* decay length
  fvec GetErrDecayLengthXY() const; //* decay length in XY
  fvec GetErrLifeTime() const;      //* life time
  fvec GetErrR() const;             //* distance to the origin

  //* Accessors with calculations( &value, &estimated sigma )
  //* error flag returned (0 means no error during calculations)

  fvec GetP(fvec &P, fvec &SigmaP) const;             //* momentum
  fvec GetPt(fvec &Pt, fvec &SigmaPt) const;          //* transverse momentum
  fvec GetEta(fvec &Eta, fvec &SigmaEta) const;       //* pseudorapidity
  fvec GetPhi(fvec &Phi, fvec &SigmaPhi) const;       //* phi
  fvec GetMomentum(fvec &P, fvec &SigmaP) const;      //* momentum
  fvec GetMass(fvec &M, fvec &SigmaM) const;          //* mass
  fvec GetDecayLength(fvec &L, fvec &SigmaL) const;   //* decay length
  fvec GetDecayLengthXY(fvec &L, fvec &SigmaL) const; //* decay length in XY
  fvec GetLifeTime(fvec &T, fvec &SigmaT) const;      //* life time
  fvec GetR(fvec &R, fvec &SigmaR) const;             //* R

  //*
  //*  MODIFIERS
  //*

  fvec &X();
  fvec &Y();
  fvec &Z();
  fvec &Px();
  fvec &Py();
  fvec &Pz();
  fvec &E();
  fvec &S();
  fvec &Q();
  fvec &Chi2();
  fvec &NDF();

  fvec &Parameter(int i);
  fvec &Covariance(int i);
  fvec &Covariance(int i, int j);
  fvec *Parameters();
  fvec *CovarianceMatrix();

  void GetKFParticle(KFParticle &Part, int iPart = 0);
  void GetKFParticle(KFParticle *Part, int nPart = 0);

  //*
  //* CONSTRUCTION OF THE PARTICLE BY ITS DAUGHTERS AND MOTHER
  //* USING THE KALMAN FILTER METHOD
  //*

  //* Add daughter to the particle

  void AddDaughter(const KFParticleSIMD &Daughter);

  //* Add daughter via += operator: ex.{ D0; D0+=Pion; D0+= Kaon; }

  void operator+=(const KFParticleSIMD &Daughter);

  //* Set production vertex

  void SetProductionVertex(const KFParticleSIMD &Vtx);

  //* Set mass constraint

  void SetMassConstraint(fvec Mass, fvec SigmaMass = 0);

  //* Set no decay length for resonances

  void SetNoDecayLength();

  //* Everything in one go

  void Construct(const KFParticleSIMD *vDaughters[], int nDaughters, const KFParticleSIMD *ProdVtx = nullptr, Float_t Mass = -1, Bool_t IsConstrained = 0, Bool_t isAtVtxGuess = 0);

  //*
  //*                   TRANSPORT
  //*
  //*  ( main transportation parameter is S = SignedPath/Momentum )
  //*  ( parameters of decay & production vertices are stored locally )
  //*

  //* Transport the particle to its decay vertex

  void TransportToDecayVertex();

  //* Transport the particle to its production vertex

  void TransportToProductionVertex();

  //* Transport the particle close to xyz[] point

  void TransportToPoint(const fvec xyz[]);

  //* Transport the particle close to VVertex
#ifdef HomogeneousField
  void TransportToVertex(const KFPVertex &v);
#endif
  //* Transport the particle close to another particle p

  void TransportToParticle(const KFParticleSIMD &p);

  //* Transport the particle on dS parameter (SignedPath/Momentum)

  void TransportToDS(fvec dS);

  //* Get dS to a certain space point

  fvec GetDStoPoint(const fvec xyz[]) const;

  //* Get dS to other particle p (dSp for particle p also returned)

  void GetDStoParticle(const KFParticleSIMD &p, fvec &DS, fvec &DSp) const;

  //* Get dS to other particle p in XY-plane

  void GetDStoParticleXY(const KFParticleBaseSIMD &p, fvec &DS, fvec &DSp) const;

  //*
  //* OTHER UTILITIES
  //*

  //* Calculate distance from another object [cm]

  fvec GetDistanceFromVertex(const fvec vtx[]) const;
  fvec GetDistanceFromVertex(const KFParticleSIMD &Vtx) const;
#ifdef HomogeneousField
  fvec GetDistanceFromVertex(const KFPVertex &Vtx) const;
#endif
  fvec GetDistanceFromParticle(const KFParticleSIMD &p) const;

  //* Calculate sqrt(Chi2/ndf) deviation from another object
  //* ( v = [xyz]-vertex, Cv=[Cxx,Cxy,Cyy,Cxz,Cyz,Czz]-covariance matrix )

  fvec GetDeviationFromVertex(const fvec v[], const fvec Cv[] = 0) const;
  fvec GetDeviationFromVertex(const KFParticleSIMD &Vtx) const;
#ifdef HomogeneousField
  fvec GetDeviationFromVertex(const KFPVertex &Vtx) const;
#endif
  fvec GetDeviationFromParticle(const KFParticleSIMD &p) const;

  //* Calculate distance from another object [cm] in XY-plane

  fvec GetDistanceFromVertexXY(const fvec vtx[], fvec &val, fvec &err) const;
  fvec GetDistanceFromVertexXY(const fvec vtx[], const fvec Cv[], fvec &val, fvec &err) const;
  fvec GetDistanceFromVertexXY(const KFParticleSIMD &Vtx, fvec &val, fvec &err) const;
#ifdef HomogeneousField
  fvec GetDistanceFromVertexXY(const KFPVertex &Vtx, fvec &val, fvec &err) const;
#endif

  fvec GetDistanceFromVertexXY(const fvec vtx[]) const;
  fvec GetDistanceFromVertexXY(const KFParticleSIMD &Vtx) const;
#ifdef HomogeneousField
  fvec GetDistanceFromVertexXY(const KFPVertex &Vtx) const;
#endif
  fvec GetDistanceFromParticleXY(const KFParticleSIMD &p) const;

  //* Calculate sqrt(Chi2/ndf) deviation from another object in XY plane
  //* ( v = [xyz]-vertex, Cv=[Cxx,Cxy,Cyy,Cxz,Cyz,Czz]-covariance matrix )

  fvec GetDeviationFromVertexXY(const fvec v[], const fvec Cv[] = 0) const;
  fvec GetDeviationFromVertexXY(const KFParticleSIMD &Vtx) const;
#ifdef HomogeneousField
  fvec GetDeviationFromVertexXY(const KFPVertex &Vtx) const;
#endif
  fvec GetDeviationFromParticleXY(const KFParticleSIMD &p) const;

  //* Calculate opennig angle between two particles

  fvec GetAngle(const KFParticleSIMD &p) const;
  fvec GetAngleXY(const KFParticleSIMD &p) const;
  fvec GetAngleRZ(const KFParticleSIMD &p) const;

  //* Subtract the particle from the vertex

  void SubtractFromVertex(KFParticleSIMD &v) const;
  void SubtractFromParticle(KFParticleSIMD &v) const;

  //* Special method for creating gammas

  void ConstructGamma(const KFParticleSIMD &daughter1, const KFParticleSIMD &daughter2);

  // * Pseudo Proper Time of decay = (r*pt) / |pt| * M/|pt|
  // @primVertex - primary vertex
  // @mass - mass of the mother particle (in the case of "Hb -> JPsi" it would be JPsi mass)
  // @*timeErr2 - squared error of the decay time. If timeErr2 = 0 it isn't calculated
  fvec GetPseudoProperDecayTime(const KFParticleSIMD &primVertex, const fvec &mass, fvec *timeErr2 = 0) const;

  void GetFieldValue(const fvec xyz[], fvec B[]) const;

 protected:
  //*
  //*  INTERNAL STUFF
  //*

  //* Method to access ALICE field
#ifdef HomogeneousField
  static fvec GetFieldAlice();
#endif
  //* Other methods required by the abstract KFParticleBaseSIMD class

  void GetDStoParticle(const KFParticleBaseSIMD &p, fvec &DS, fvec &DSp) const;
  void Transport(fvec dS, fvec P[], fvec C[]) const;
  static void GetExternalTrackParam(const KFParticleBaseSIMD &p, Double_t X[fvecLen], Double_t Alpha[fvecLen], Double_t P[5][fvecLen]);

  // void GetDStoParticleALICE( const KFParticleBaseSIMD &p, fvec &DS, fvec &DS1 ) const;

 private:
#ifdef HomogeneousField
  static fvec fgBz; //* Bz compoment of the magnetic field
#endif
#ifdef NonhomogeneousField
  L1FieldRegion fField;
#endif
};

//---------------------------------------------------------------------
//
//     Inline implementation of the KFParticleSIMD methods
//
//---------------------------------------------------------------------

#ifdef HomogeneousField
inline void KFParticleSIMD::SetField(fvec Bz)
{
  fgBz = Bz;
}
#endif

inline KFParticleSIMD::KFParticleSIMD(const KFParticleSIMD &d1, const KFParticleSIMD &d2, const KFParticleSIMD &d3)
{
  KFParticleSIMD mother;
  mother += d1;
  mother += d2;
  mother += d3;
  *this = mother;
}

inline KFParticleSIMD::KFParticleSIMD(const KFParticleSIMD &d1, const KFParticleSIMD &d2, const KFParticleSIMD &d3, const KFParticleSIMD &d4)
{
  KFParticleSIMD mother;
  mother += d1;
  mother += d2;
  mother += d3;
  mother += d4;
  *this = mother;
}

inline void KFParticleSIMD::Initialize()
{
  KFParticleBaseSIMD::Initialize();
}

inline void KFParticleSIMD::SetVtxGuess(fvec x, fvec y, fvec z)
{
  KFParticleBaseSIMD::SetVtxGuess(x, y, z);
}

inline fvec KFParticleSIMD::GetX() const
{
  return KFParticleBaseSIMD::GetX();
}

inline fvec KFParticleSIMD::GetY() const
{
  return KFParticleBaseSIMD::GetY();
}

inline fvec KFParticleSIMD::GetZ() const
{
  return KFParticleBaseSIMD::GetZ();
}

inline fvec KFParticleSIMD::GetPx() const
{
  return KFParticleBaseSIMD::GetPx();
}

inline fvec KFParticleSIMD::GetPy() const
{
  return KFParticleBaseSIMD::GetPy();
}

inline fvec KFParticleSIMD::GetPz() const
{
  return KFParticleBaseSIMD::GetPz();
}

inline fvec KFParticleSIMD::GetE() const
{
  return KFParticleBaseSIMD::GetE();
}

inline fvec KFParticleSIMD::GetS() const
{
  return KFParticleBaseSIMD::GetS();
}

inline fvec KFParticleSIMD::GetQ() const
{
  return KFParticleBaseSIMD::GetQ();
}

inline fvec KFParticleSIMD::GetChi2() const
{
  return KFParticleBaseSIMD::GetChi2();
}

inline fvec KFParticleSIMD::GetNDF() const
{
  return KFParticleBaseSIMD::GetNDF();
}

inline fvec KFParticleSIMD::GetParameter(int i) const
{
  return KFParticleBaseSIMD::GetParameter(i);
}

inline fvec KFParticleSIMD::GetCovariance(int i) const
{
  return KFParticleBaseSIMD::GetCovariance(i);
}

inline fvec KFParticleSIMD::GetCovariance(int i, int j) const
{
  return KFParticleBaseSIMD::GetCovariance(i, j);
}

inline fvec KFParticleSIMD::GetP() const
{
  fvec par, err;
  fvec mask = KFParticleBaseSIMD::GetMomentum(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetPt() const
{
  fvec par, err;
  fvec mask = KFParticleBaseSIMD::GetPt(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetEta() const
{
  fvec par, err;
  fvec mask = KFParticleBaseSIMD::GetEta(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetPhi() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetPhi(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetMomentum() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetMomentum(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetMass() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetMass(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetDecayLength() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetDecayLength(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetDecayLengthXY() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetDecayLengthXY(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetLifeTime() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetLifeTime(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetR() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetR(par, err);
  return ((!mask) & par);
}

inline fvec KFParticleSIMD::GetErrX() const
{
  return sqrt(fabs(GetCovariance(0, 0)));
}

inline fvec KFParticleSIMD::GetErrY() const
{
  return sqrt(fabs(GetCovariance(1, 1)));
}

inline fvec KFParticleSIMD::GetErrZ() const
{
  return sqrt(fabs(GetCovariance(2, 2)));
}

inline fvec KFParticleSIMD::GetErrPx() const
{
  return sqrt(fabs(GetCovariance(3, 3)));
}

inline fvec KFParticleSIMD::GetErrPy() const
{
  return sqrt(fabs(GetCovariance(4, 4)));
}

inline fvec KFParticleSIMD::GetErrPz() const
{
  return sqrt(fabs(GetCovariance(5, 5)));
}

inline fvec KFParticleSIMD::GetErrE() const
{
  return sqrt(fabs(GetCovariance(6, 6)));
}

inline fvec KFParticleSIMD::GetErrS() const
{
  return sqrt(fabs(GetCovariance(7, 7)));
}

inline fvec KFParticleSIMD::GetErrP() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetMomentum(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetErrPt() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetPt(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetErrEta() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetEta(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetErrPhi() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetPhi(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetErrMomentum() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetMomentum(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetErrMass() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetMass(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetErrDecayLength() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetDecayLength(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetErrDecayLengthXY() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetDecayLengthXY(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetErrLifeTime() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetLifeTime(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetErrR() const
{
  fvec par, err;
  fvec mask = KFParticleSIMD::GetR(par, err);
  fvec ret(1.e10);
  ret = (mask & ret) + ((!mask) & err);
  return ret;
}

inline fvec KFParticleSIMD::GetP(fvec &P, fvec &SigmaP) const
{
  return KFParticleBaseSIMD::GetMomentum(P, SigmaP);
}

inline fvec KFParticleSIMD::GetPt(fvec &Pt, fvec &SigmaPt) const
{
  return KFParticleBaseSIMD::GetPt(Pt, SigmaPt);
}

inline fvec KFParticleSIMD::GetEta(fvec &Eta, fvec &SigmaEta) const
{
  return KFParticleBaseSIMD::GetEta(Eta, SigmaEta);
}

inline fvec KFParticleSIMD::GetPhi(fvec &Phi, fvec &SigmaPhi) const
{
  return KFParticleBaseSIMD::GetPhi(Phi, SigmaPhi);
}

inline fvec KFParticleSIMD::GetMomentum(fvec &P, fvec &SigmaP) const
{
  return KFParticleBaseSIMD::GetMomentum(P, SigmaP);
}

inline fvec KFParticleSIMD::GetMass(fvec &M, fvec &SigmaM) const
{
  return KFParticleBaseSIMD::GetMass(M, SigmaM);
}

inline fvec KFParticleSIMD::GetDecayLength(fvec &L, fvec &SigmaL) const
{
  return KFParticleBaseSIMD::GetDecayLength(L, SigmaL);
}

inline fvec KFParticleSIMD::GetDecayLengthXY(fvec &L, fvec &SigmaL) const
{
  return KFParticleBaseSIMD::GetDecayLengthXY(L, SigmaL);
}

inline fvec KFParticleSIMD::GetLifeTime(fvec &T, fvec &SigmaT) const
{
  return KFParticleBaseSIMD::GetLifeTime(T, SigmaT);
}

inline fvec KFParticleSIMD::GetR(fvec &R, fvec &SigmaR) const
{
  return KFParticleBaseSIMD::GetR(R, SigmaR);
}

inline fvec &KFParticleSIMD::X()
{
  return KFParticleBaseSIMD::X();
}

inline fvec &KFParticleSIMD::Y()
{
  return KFParticleBaseSIMD::Y();
}

inline fvec &KFParticleSIMD::Z()
{
  return KFParticleBaseSIMD::Z();
}

inline fvec &KFParticleSIMD::Px()
{
  return KFParticleBaseSIMD::Px();
}

inline fvec &KFParticleSIMD::Py()
{
  return KFParticleBaseSIMD::Py();
}

inline fvec &KFParticleSIMD::Pz()
{
  return KFParticleBaseSIMD::Pz();
}

inline fvec &KFParticleSIMD::E()
{
  return KFParticleBaseSIMD::E();
}

inline fvec &KFParticleSIMD::S()
{
  return KFParticleBaseSIMD::S();
}

inline fvec &KFParticleSIMD::Q()
{
  return KFParticleBaseSIMD::Q();
}

inline fvec &KFParticleSIMD::Chi2()
{
  return KFParticleBaseSIMD::Chi2();
}

inline fvec &KFParticleSIMD::NDF()
{
  return KFParticleBaseSIMD::NDF();
}

inline fvec &KFParticleSIMD::Parameter(int i)
{
  return KFParticleBaseSIMD::Parameter(i);
}

inline fvec &KFParticleSIMD::Covariance(int i)
{
  return KFParticleBaseSIMD::Covariance(i);
}

inline fvec &KFParticleSIMD::Covariance(int i, int j)
{
  return KFParticleBaseSIMD::Covariance(i, j);
}

inline fvec *KFParticleSIMD::Parameters()
{
  return fP;
}

inline fvec *KFParticleSIMD::CovarianceMatrix()
{
  return fC;
}

inline void KFParticleSIMD::operator+=(const KFParticleSIMD &Daughter)
{
  KFParticleBaseSIMD::operator+=(Daughter);
}

inline void KFParticleSIMD::AddDaughter(const KFParticleSIMD &Daughter)
{
  KFParticleBaseSIMD::AddDaughter(Daughter);
}

inline void KFParticleSIMD::SetProductionVertex(const KFParticleSIMD &Vtx)
{
  KFParticleBaseSIMD::SetProductionVertex(Vtx);
}

inline void KFParticleSIMD::SetMassConstraint(fvec Mass, fvec SigmaMass)
{
  KFParticleBaseSIMD::SetMassConstraint(Mass, SigmaMass);
}

inline void KFParticleSIMD::SetNoDecayLength()
{
  KFParticleBaseSIMD::SetNoDecayLength();
}

inline void KFParticleSIMD::Construct(const KFParticleSIMD *vDaughters[], int nDaughters, const KFParticleSIMD *ProdVtx, Float_t Mass, Bool_t IsConstrained, Bool_t isAtVtxGuess)
{
  KFParticleBaseSIMD::Construct((const KFParticleBaseSIMD **)vDaughters, nDaughters, (const KFParticleBaseSIMD *)ProdVtx, Mass, IsConstrained, isAtVtxGuess);

#ifdef NonhomogeneousField
  // calculate a field region for the constructed particle
  L1FieldValue field[3];
  fvec zField[3] = {0, fP[2] / 2, fP[2]};

  for (int iPoint = 0; iPoint < 3; iPoint++) {
    for (int iD = 0; iD < nDaughters; ++iD) {
      L1FieldValue b = const_cast<KFParticleSIMD *>(vDaughters[iD])->fField.Get(zField[iPoint]);
      field[iPoint].x += b.x;
      field[iPoint].y += b.y;
      field[iPoint].z += b.z;
    }
    field[iPoint].x /= nDaughters;
    field[iPoint].y /= nDaughters;
    field[iPoint].z /= nDaughters;
  }

  fField.Set(field[2], zField[2], field[1], zField[1], field[0], zField[0]);
#endif
}

inline void KFParticleSIMD::TransportToDecayVertex()
{
  KFParticleBaseSIMD::TransportToDecayVertex();
}

inline void KFParticleSIMD::TransportToProductionVertex()
{
  KFParticleBaseSIMD::TransportToProductionVertex();
}

inline void KFParticleSIMD::TransportToPoint(const fvec xyz[])
{
  TransportToDS(GetDStoPoint(xyz));
}
#ifdef HomogeneousField
inline void KFParticleSIMD::TransportToVertex(const KFPVertex &v)
{
  TransportToPoint(KFParticleSIMD(v).fP);
}
#endif
inline void KFParticleSIMD::TransportToParticle(const KFParticleSIMD &p)
{
  fvec dS, dSp;
  GetDStoParticle(p, dS, dSp);
  TransportToDS(dS);
}

inline void KFParticleSIMD::TransportToDS(fvec dS)
{
  KFParticleBaseSIMD::TransportToDS(dS);
}

inline fvec KFParticleSIMD::GetDStoPoint(const fvec xyz[]) const
{
#ifdef HomogeneousField
  return KFParticleBaseSIMD::GetDStoPointBz(GetFieldAlice(), xyz);
#endif
#ifdef NonhomogeneousField
  return KFParticleBaseSIMD::GetDStoPointCBM(xyz);
#endif
}

inline void KFParticleSIMD::GetDStoParticle(const KFParticleSIMD &p, fvec &DS, fvec &DSp) const
{
  GetDStoParticleXY(p, DS, DSp);
}

inline fvec KFParticleSIMD::GetDistanceFromVertex(const fvec vtx[]) const
{
  return KFParticleBaseSIMD::GetDistanceFromVertex(vtx);
}

inline fvec KFParticleSIMD::GetDeviationFromVertex(const fvec v[], const fvec Cv[]) const
{
  return KFParticleBaseSIMD::GetDeviationFromVertex(v, Cv);
}

inline fvec KFParticleSIMD::GetDistanceFromVertex(const KFParticleSIMD &Vtx) const
{
  return KFParticleBaseSIMD::GetDistanceFromVertex(Vtx);
}

inline fvec KFParticleSIMD::GetDeviationFromVertex(const KFParticleSIMD &Vtx) const
{
  return KFParticleBaseSIMD::GetDeviationFromVertex(Vtx);
}
#ifdef HomogeneousField
inline fvec KFParticleSIMD::GetDistanceFromVertex(const KFPVertex &Vtx) const
{
  return GetDistanceFromVertex(KFParticleSIMD(Vtx));
}

inline fvec KFParticleSIMD::GetDeviationFromVertex(const KFPVertex &Vtx) const
{
  return GetDeviationFromVertex(KFParticleSIMD(Vtx));
}
#endif
inline fvec KFParticleSIMD::GetDistanceFromParticle(const KFParticleSIMD &p) const
{
  return KFParticleBaseSIMD::GetDistanceFromParticle(p);
}

inline fvec KFParticleSIMD::GetDeviationFromParticle(const KFParticleSIMD &p) const
{
  return KFParticleBaseSIMD::GetDeviationFromParticle(p);
}

inline void KFParticleSIMD::SubtractFromVertex(KFParticleSIMD &v) const
{
  KFParticleBaseSIMD::SubtractFromVertex(v);
}

inline void KFParticleSIMD::SubtractFromParticle(KFParticleSIMD &v) const
{
  KFParticleBaseSIMD::SubtractFromParticle(v);
}

#ifdef HomogeneousField
inline fvec KFParticleSIMD::GetFieldAlice()
{
  return fgBz;
}
#endif

#ifdef HomogeneousField
inline void KFParticleSIMD::GetFieldValue(const fvec * /*xyz*/, fvec B[]) const
{
  B[0] = B[1] = 0;
  B[2] = GetFieldAlice();
}
#endif

#ifdef NonhomogeneousField
inline void KFParticleSIMD::GetFieldValue(const fvec xyz[], fvec B[]) const
{
  L1FieldValue mB = const_cast<L1FieldRegion &>(fField).Get(xyz[2]);
  B[0] = mB.x;
  B[1] = mB.y;
  B[2] = mB.z;
}
#endif

inline void KFParticleSIMD::GetDStoParticle(const KFParticleBaseSIMD &p, fvec &DS, fvec &DSp) const
{
  GetDStoParticleXY(p, DS, DSp);
}

inline void KFParticleSIMD::GetDStoParticleXY(const KFParticleBaseSIMD &p, fvec &DS, fvec &DSp) const
{
#ifdef HomogeneousField
  KFParticleBaseSIMD::GetDStoParticleBz(GetFieldAlice(), p, DS, DSp);
#endif
#ifdef NonhomogeneousField
  KFParticleBaseSIMD::GetDStoParticleCBM(p, DS, DSp);
#endif
  // GetDStoParticleALICE( p, DS, DSp ) ;
}

inline void KFParticleSIMD::Transport(fvec dS, fvec P[], fvec C[]) const
{
#ifdef HomogeneousField
  KFParticleBaseSIMD::TransportBz(GetFieldAlice(), dS, P, C);
#endif
#ifdef NonhomogeneousField
  KFParticleBaseSIMD::TransportCBM(dS, P, C);
#endif
}

inline void KFParticleSIMD::ConstructGamma(const KFParticleSIMD &daughter1, const KFParticleSIMD &daughter2)
{
#ifdef HomogeneousField
  KFParticleBaseSIMD::ConstructGammaBz(daughter1, daughter2, GetFieldAlice());
#endif
}

#endif