/*---------------------------------------------------------------------------*\
  =========                 |
  \\      /  F ield         | OpenFOAM: The Open Source CFD Toolbox
   \\    /   O peration     |
    \\  /    A nd           | Copyright held by original author
     \\/     M anipulation  |
-------------------------------------------------------------------------------
License
    This file is part of OpenFOAM.

    OpenFOAM 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 2 of the License, or (at your
    option) any later version.

    OpenFOAM 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 OpenFOAM; if not, write to the Free Software Foundation,
    Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA

Description
    polyLineEdge class : defines a curvedEdge in terms of a series of
    straight line segments

\*---------------------------------------------------------------------------*/

#include "error.H"

#include "polyLine.H"

// * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * //

namespace Foam
{

// * * * * * * * * * * * * * Private Member Functions  * * * * * * * * * * * //

// calcDistances generates the distances_ lookup table (cumulative
// distance along the line) from the individual vectors to the points

void polyLine::calcDistances()
{
    distances_[0] = 0.0;

    for (label i=1; i<distances_.size(); i++)
    {
        distances_[i] =
            mag(controlPoints_[i] - controlPoints_[i-1])
          + distances_[i-1];
    }

    lineLength_ = distances_[distances_.size()-1];

    for (label i=1; i<distances_.size(); i++)
    {
        distances_[i] /= lineLength_;
    }
}


// * * * * * * * * * * * * * * * * Constructors  * * * * * * * * * * * * * * //

polyLine::polyLine(const pointField& ps)
:
    controlPoints_(ps),
    distances_(ps.size())
{
    if (ps.size())
    {
        calcDistances();
    }
}


// * * * * * * * * * * * * * * * Member Functions  * * * * * * * * * * * * * //

vector polyLine::position(const scalar lambda) const
{
    // check range of lambda

    if (lambda < 0 || lambda > 1)
    {
        FatalErrorIn("polyLine::position(const scalar)")
            << "Parameter out of range, "
            << "lambda = " << lambda
            << abort(FatalError);
    }

    // Quick calc of endpoints

    if (lambda < SMALL)
    {
        return controlPoints_[0];
    }
    else if (lambda > 1 - SMALL)
    {
        return controlPoints_[controlPoints_.size()-1];
    }


    // search table of cumulative distance to find which linesegment we
    // are on

    label i(0);
    do
    {
        i++;
    } while (distances_[i] < lambda);

    i--;               // we overshot!

    // construct position vector
    scalar offsetDist =
        (lambda - distances_[i])
       /(distances_[i+1] - distances_[i]);

    vector offsetV = controlPoints_[i+1] - controlPoints_[i];

    return controlPoints_[i] + offsetDist*offsetV;
}


scalar polyLine::length() const
{
    return lineLength_;
}


// * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * * //

} // End namespace Foam

// ************************************************************************* //