KalmanFilter.h

/**************************************************************************
 * 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.                  *
 **************************************************************************/
#pragma once
 
#include <tracking/trackingUtilities/filters/base/Filter.dcl.h>
#include <tracking/trackingUtilities/numerics/WithWeight.h>
#include <genfit/MeasuredStateOnPlane.h>
 
#include <vector>
#include <framework/logging/Logger.h>
 
namespace Belle2 {
  template <class AState, class AKalmanStepper>
  class KalmanFilter : public
    TrackingUtilities::Filter<std::pair<const std::vector<TrackingUtilities::WithWeight<const AState*>>, AState*>> {
  public:
    TrackingUtilities::Weight operator()(const std::pair<const std::vector<TrackingUtilities::WithWeight<const AState*>>, AState*>&
                                         pair)
    override
    {
      AState* currentState = pair.second;
 
      B2ASSERT("Can not update with nothing", currentState->mSoPSet());
      genfit::MeasuredStateOnPlane measuredStateOnPlane = currentState->getMeasuredStateOnPlane();
 
      const double chi2 = m_kalmanStepper.kalmanStep(measuredStateOnPlane, *currentState);
 
      currentState->setChi2(chi2);
      currentState->setMeasuredStateOnPlane(measuredStateOnPlane);
 
      return chi2;
    }
 
  private:
    AKalmanStepper m_kalmanStepper;
  };

}