RKCartesianDistance.h

Go to the documentation of this file.

#ifndef RKCartesianDistance_H
#define RKCartesianDistance_H
 
#include "FWCore/Utilities/interface/Visibility.h"
#include "DataFormats/GeometryVector/interface/Basic3DVector.h"
#include "RKDistance.h"
#include "RKSmallVector.h"
#include "CartesianStateAdaptor.h"
 
#include <cmath>
 
 
class dso_internal RKCartesianDistance final : public RKDistance<double, 6> {
public:
  typedef double Scalar;
  typedef RKSmallVector<double, 6> Vector;
 
  ~RKCartesianDistance() override {}
 
  Scalar operator()(const Vector& rka, const Vector& rkb, const Scalar& s) const override {
    CartesianStateAdaptor a(rka), b(rkb);
 
    return (a.position() - b.position()).mag() + (a.momentum() - b.momentum()).mag() / b.momentum().mag();
  }
};
 
#endif