/*
    Scan Tailor - Interactive post-processing tool for scanned pages.
    Copyright (C)  Joseph Artsimovich <joseph.artsimovich@gmail.com>

    This program is free software: you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation, either version 3 of the License, or
    (at your option) any later version.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
*/

#include "ToLineProjector.h"
#include <stdexcept>
#include <string>
#include <limits>
#include <cmath>

ToLineProjector::ToLineProjector(QLineF const& line)
    :   m_origin(line.p1()),
        m_vec(line.p2() - line.p1()),
        m_mat(m_vec)
{
    using namespace std;

    // At*A*x = At*b
    double const AtA = m_mat.dot(m_mat);

    if (abs(AtA) > numeric_limits<double>::epsilon()) {
        // x = (At*A)-1 * At
        m_mat /= AtA;
    } else {
        m_mat[0] = 0;
        m_mat[1] = 0;
    }
}

double
ToLineProjector::projectionScalar(QPointF const& pt) const
{
    Vec2d const b(pt - m_origin);
    return m_mat.dot(b);
}

QPointF
ToLineProjector::projectionPoint(QPointF const& pt) const
{
    return m_origin + m_vec * projectionScalar(pt);
}

QPointF
ToLineProjector::projectionVector(QPointF const& pt) const
{
    return projectionPoint(pt) - pt;
}

double
ToLineProjector::projectionDist(QPointF const& pt) const
{
    return sqrt(projectionSqDist(pt));
}

double
ToLineProjector::projectionSqDist(QPointF const& pt) const
{
    return Vec2d(projectionPoint(pt) - pt).squaredNorm();
}
