Application: gvSIG desktop

/* gvSIG. Desktop Geographic Information System.

 *

 * Copyright ? 2007-2015 gvSIG Association

 *

 * 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 2

 * 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, write to the Free Software

 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,

 * MA  02110-1301, USA.

 *

 * For any additional information, do not hesitate to contact us

 * at info AT gvsig.com, or visit our website www.gvsig.com.

 */

package org.gvsig.fmap.geom.jts.primitive.curve.spline;

import com.vividsolutions.jts.geom.Coordinate;

import com.vividsolutions.jts.geom.CoordinateSequence;

import org.gvsig.fmap.geom.Geometry;

import org.gvsig.fmap.geom.jts.MCoordinate;

import org.gvsig.fmap.geom.jts.primitive.curve.line.Line2D;

import org.gvsig.fmap.geom.jts.primitive.curve.spline.AbstractSpline.Spline;

import org.gvsig.fmap.geom.jts.primitive.point.Point2D;

import org.gvsig.fmap.geom.jts.primitive.point.Point3D;

import org.gvsig.fmap.geom.jts.primitive.point.Point3DM;

import org.gvsig.fmap.geom.jts.util.ArrayListCoordinateSequence;

import org.gvsig.fmap.geom.jts.util.JTSUtils;

import org.gvsig.fmap.geom.jts.util.ReadOnlyCoordinates;

import org.gvsig.fmap.geom.primitive.Point;

/**

 * @author fdiaz

 *

 */

public class Spline3DM extends AbstractSpline {

    /**

     * @param subtype

     */

    protected Spline3DM() {

        super(Geometry.SUBTYPES.GEOM3DM);

    }

    /**

    *

    */

    public Spline3DM(Coordinate[] coordinates) {

        this();

        this.coordinates = new ArrayListCoordinateSequence(new ReadOnlyCoordinates(coordinates));

        if (coordinates.length < 1) {

            anyVertex = new Point3DM(0, 0, 0, 0);

        } else {

            Coordinate coordinate = coordinates[0];

            anyVertex = new Point3DM(coordinate.x, coordinate.y, coordinate.z, coordinate.getOrdinate(CoordinateSequence.M));

        }

    }

    /* (non-Javadoc)

     * @see org.gvsig.fmap.geom.primitive.OrientablePrimitive#addVertex(double, double)

     */

    public void addVertex(double x, double y) {

        this.addVertex(new Point3DM(x, y, 0, 0));

        }

    /* (non-Javadoc)

     * @see org.gvsig.fmap.geom.primitive.OrientablePrimitive#addVertex(double, double, double)

     */

    public void addVertex(double x, double y, double z) {

        this.addVertex(new Point3DM(x, y, z, 0));

    }

    /* (non-Javadoc)

     * @see org.gvsig.fmap.geom.Geometry#cloneGeometry()

     */

    public Geometry cloneGeometry() {

        return new Spline3DM((Coordinate[]) coordinates.clone());

    }

    /* (non-Javadoc)

     * @see org.gvsig.fmap.geom.jts.primitive.curve.spline.AbstractSpline#fixPoint(org.gvsig.fmap.geom.primitive.Point)

     */

    @Override

    protected Point fixPoint(Point point) {

        if (point instanceof Point3DM) {

            return point;

        } else if (point instanceof Point3D) {

            return new Point3DM(point.getX(), point.getY(), ((Point3D)point).getZ(), 0);

        } else {

            return new Point3DM(point.getX(), point.getY(), 0, 0);

        }

    }

    /* (non-Javadoc)

     * @see org.gvsig.fmap.geom.jts.primitive.curve.spline.AbstractSpline#getSplineCoordinates()

     */

    @Override

    protected ArrayListCoordinateSequence getSplineCoordinates() {

        ArrayListCoordinateSequence splineCoordinates = new ArrayListCoordinateSequence();

        if (splineCoordinates == null || splineCoordinates.size() == 0) {

            int num = coordinates.size();

            double[] px = new double[num];

            double[] py = new double[num];

            double[] pz = new double[num];

            double[] pm = new double[num];

            for (int i = 0; i < num; i++) {

                Coordinate coord = coordinates.get(i);

                px[i] = coord.x;

                py[i] = coord.y;

                pz[i] = coord.z;

                pm[i] = coord.getOrdinate(CoordinateSequence.M);

            }

            Spline splineX = new Spline(px);

            Spline splineY = new Spline(py);

            Spline splineZ = new Spline(pz);

            Spline splineM = new Spline(pm);

            splineCoordinates.add(coordinates.get(0));

            for (int i = 0; i < coordinates.size() - 1; i++) {

                for (int t = 1; t <= SUBSEGMENTS; t++) {

                    if ((t == SUBSEGMENTS) && (i == (coordinates.size() - 2))) {

                        // We don't calculate the last point to avoid a possible

                        // error precision with floating point numbers.

                        splineCoordinates.add(JTSUtils.createMCoordinate(px[px.length - 1], py[px.length - 1], pz[px.length - 1], pm[px.length - 1]));

                    } else {

                        double x1 = splineX.fn(i, ((double) t) / SUBSEGMENTS);

                        double y1 = splineY.fn(i, ((double) t) / SUBSEGMENTS);

                        double z1 = splineZ.fn(i, ((double) t) / SUBSEGMENTS);

                        double m1 = splineM.fn(i, ((double) t) / SUBSEGMENTS);

                        splineCoordinates.add(JTSUtils.createMCoordinate(x1, y1, z1,m1));

                    }

                }

            }

        }

        return splineCoordinates;

    }

}