covariancePlaneFit.h

/*
 Copyright (C) 2014 Nicolas Mellado <nmellado0@gmail.com>
 Copyright (C) 2015 Gael Guennebaud <gael.guennebaud@inria.fr>
 
 This Source Code Form is subject to the terms of the Mozilla Public
 License, v. 2.0. If a copy of the MPL was not distributed with this
 file, You can obtain one at http://mozilla.org/MPL/2.0/.
*/
 
#pragma once
#include "../../defines.h"
#include "../concepts.h"
 
#include "../primitive/plane.h"  // used to define CovariancePlaneFit
#include "../tools/mean.h"       // used to define CovariancePlaneFit
#include "../tools/covariance.h" // used to define CovariancePlaneFit
 
#include <Eigen/Eigenvalues>
 
#define COVARIANCE_PLANE_FIT_REQUIREMENTS ProvidesPlane<T>
#define COVARIANCE_PLANE_DER_REQUIREMENTS ProvidesPlane<T>&& Is3D<DataPoint>
 
namespace Ponca
{
 
    template <class DataPoint, class _NFilter, typename T>
        requires COVARIANCE_PLANE_FIT_REQUIREMENTS
    class CovariancePlaneFitImpl : public T
    {
        PONCA_FITTING_DECLARE_DEFAULT_TYPES
        PONCA_FITTING_DECLARE_MATRIX_TYPE
    public:
        PONCA_EXPLICIT_CAST_OPERATORS(CovariancePlaneFitImpl, covariancePlaneFit)
        PONCA_EXPLICIT_CAST_OPERATORS(CovariancePlaneFitImpl, tangentPlaneBasis)
        PONCA_FITTING_DECLARE_FINALIZE
        PONCA_FITTING_IS_SIGNED(false)
 
        /**************************************************************************/
        /* Results                                                                */
        /**************************************************************************/
 
        PONCA_MULTIARCH inline VectorType worldToTangentPlane(const VectorType& _q,
                                                              bool _isPositionVector = true) const;
 
        PONCA_MULTIARCH inline VectorType tangentPlaneToWorld(const VectorType& _q,
                                                              bool _isPositionVector = true) const;
    }; // class CovariancePlaneFitImpl
 
    template <class DataPoint, class _NFilter, typename T>
    using CovariancePlaneFit = CovariancePlaneFitImpl<
        DataPoint, _NFilter,
        CovarianceBase<DataPoint, _NFilter, MeanPosition<DataPoint, _NFilter, Plane<DataPoint, _NFilter, T>>>>;
 
    template <class DataPoint, class _NFilter, int DiffType, typename T>
        requires COVARIANCE_PLANE_DER_REQUIREMENTS
    class CovariancePlaneDerImpl : public T
    {
        PONCA_FITTING_DECLARE_DEFAULT_TYPES
        PONCA_FITTING_DECLARE_MATRIX_TYPE
        PONCA_FITTING_DECLARE_DEFAULT_DER_TYPES
    private:
        VectorArray m_dNormal{VectorArray::Zero()}; 
        ScalarArray m_dDist{ScalarArray::Zero()};   
    public:
        PONCA_EXPLICIT_CAST_OPERATORS_DER(CovariancePlaneDerImpl, covariancePlaneDer)
        PONCA_EXPLICIT_CAST_OPERATORS_DER(CovariancePlaneDerImpl, implicitPrimitiveDer)
 
        PONCA_MULTIARCH FIT_RESULT finalize();
 
        /**************************************************************************/
        /* Use results                                                            */
        /**************************************************************************/
 
        // \brief Returns the derivatives of the scalar field at the evaluation point
        PONCA_MULTIARCH [[nodiscard]] inline ScalarArray dPotential() const { return m_dDist; }
 
        PONCA_MULTIARCH [[nodiscard]] inline VectorArray dNormal() const { return m_dNormal; }
 
    }; // class CovariancePlaneDer
 
    template <class DataPoint, class _NFilter, int DiffType, typename T>
    using CovariancePlaneDer = CovariancePlaneDerImpl<
        DataPoint, _NFilter, DiffType,
        CovarianceDer<DataPoint, _NFilter, DiffType, MeanPositionDer<DataPoint, _NFilter, DiffType, T>>>;
 
#include "covariancePlaneFit.hpp"
 
} // namespace Ponca