ParameterVectorUtil.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/trackFindingCDC/numerics/ParameterVector.h>
 
#include <tracking/trackFindingCDC/numerics/EigenView.h>
 
#include <type_traits>
 
namespace Belle2 {
  namespace TrackFindingCDC {

    struct ParameterVectorUtil {

      template <class AParameterVector, int I = 0, int N = 0>
      static AParameterVector getSub(const ParameterVector<N>& par)
      {
        constexpr const int M =
          std::remove_reference_t<decltype(mapToEigen(AParameterVector()))>::RowsAtCompileTime;
        return par.template block<M, 1>(I, 0);
      }

      template <int N1, int N2>
      static ParameterVector < N1 + N2 > stack(const ParameterVector<N1>& upperPar,
                                               const ParameterVector<N2>& lowerPar)
      {
        ParameterVector < N1 + N2 > result;
        mapToEigen(result) << mapToEigen(upperPar), mapToEigen(lowerPar);
        return result;
      }
    };
  }
}