Quadrics.hpp

#pragma once
 
#include <wmtk/Types.hpp>
 
namespace wmtk::components::topological_offset {
 
class Quadrics
{
public:
    Quadrics(const double a, const double b, const double c, const double d);
 
    Quadrics(const Vector3d& p0, const Vector3d& n);
 
    Quadrics(const Eigen::Ref<const Matrix4d>& matrix);
 
    Quadrics(const Quadrics& other) = default;
 
    Quadrics& operator+=(const Quadrics& other);
    Quadrics operator+(const Quadrics& other) const;
    Quadrics operator*(const double scalar) const;
    Quadrics& operator*=(const double scalar);
 
    Vector3d solve(const Eigen::Ref<const Vector3d>& p, double svd_threshold = 1e-2) const;
 
    double squared_distance_to_optimum(
        const Eigen::Ref<const Vector3d>& p,
        double svd_threshold = 1e-2) const;
 
private:
    Matrix4d m_matrix = Matrix4d::Zero();
};
 
} // namespace wmtk::components::topological_offset