LineTest

/*
 * Licensed to the Apache Software Foundation (ASF) under one or more
 * contributor license agreements.  See the NOTICE file distributed with
 * this work for additional information regarding copyright ownership.
 * The ASF licenses this file to You under the Apache License, Version 2.0
 * (the "License"); you may not use this file except in compliance with
 * the License.  You may obtain a copy of the License at
 *
 *      https://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 */

/*
 * This is not the original file distributed by the Apache Software Foundation
 * It has been modified by the Hipparchus project
 */
package org.hipparchus.geometry.euclidean.twod;

import org.hipparchus.exception.MathIllegalArgumentException;
import org.hipparchus.geometry.euclidean.oned.Euclidean1D;
import org.hipparchus.geometry.euclidean.oned.OrientedPoint;
import org.hipparchus.geometry.euclidean.oned.SubOrientedPoint;
import org.hipparchus.geometry.euclidean.oned.Vector1D;
import org.hipparchus.geometry.partitioning.Transform;
import org.hipparchus.util.FastMath;
import org.hipparchus.util.MathUtils;
import org.junit.jupiter.api.Test;

import static org.junit.jupiter.api.Assertions.assertEquals;
import static org.junit.jupiter.api.Assertions.assertFalse;
import static org.junit.jupiter.api.Assertions.assertTrue;

class LineTest {

    @Test
    void testContains() {
        Line l = new Line(new Vector2D(0, 1), new Vector2D(1, 2), 1.0e-10);
        assertTrue(l.contains(new Vector2D(0, 1)));
        assertTrue(l.contains(new Vector2D(1, 2)));
        assertTrue(l.contains(new Vector2D(7, 8)));
        assertFalse(l.contains(new Vector2D(8, 7)));
    }

    @Test
    void testAbscissa() {
        Line l = new Line(new Vector2D(2, 1), new Vector2D(-2, -2), 1.0e-10);
        assertEquals(0.0,
                            (l.toSubSpace(new Vector2D(-3,  4))).getX(),
                            1.0e-10);
        assertEquals(0.0,
                            (l.toSubSpace(new Vector2D( 3, -4))).getX(),
                            1.0e-10);
        assertEquals(-5.0,
                            (l.toSubSpace(new Vector2D( 7, -1))).getX(),
                            1.0e-10);
        assertEquals( 5.0,
                             (l.toSubSpace(new Vector2D(-1, -7))).getX(),
                             1.0e-10);
    }

    @Test
    void testOffset() {
        Line l = new Line(new Vector2D(2, 1), new Vector2D(-2, -2), 1.0e-10);
        assertEquals(-5.0, l.getOffset(new Vector2D(5, -3)), 1.0e-10);
        assertEquals(+5.0, l.getOffset(new Vector2D(-5, 2)), 1.0e-10);
    }

    @Test
    void testDistance() {
        Line l = new Line(new Vector2D(2, 1), new Vector2D(-2, -2), 1.0e-10);
        assertEquals(+5.0, l.distance(new Vector2D(5, -3)), 1.0e-10);
        assertEquals(+5.0, l.distance(new Vector2D(-5, 2)), 1.0e-10);
    }

    @Test
    void testPointAt() {
        Line l = new Line(new Vector2D(2, 1), new Vector2D(-2, -2), 1.0e-10);
        for (double a = -2.0; a < 2.0; a += 0.2) {
            Vector1D pA = new Vector1D(a);
            Vector2D point = l.toSpace(pA);
            assertEquals(a, (l.toSubSpace(point)).getX(), 1.0e-10);
            assertEquals(0.0, l.getOffset(point),   1.0e-10);
            for (double o = -2.0; o < 2.0; o += 0.2) {
                point = l.getPointAt(pA, o);
                assertEquals(a, (l.toSubSpace(point)).getX(), 1.0e-10);
                assertEquals(o, l.getOffset(point),   1.0e-10);
            }
        }
    }

    @Test
    void testOriginOffset() {
        Line l1 = new Line(new Vector2D(0, 1), new Vector2D(1, 2), 1.0e-10);
        assertEquals(FastMath.sqrt(0.5), l1.getOriginOffset(), 1.0e-10);
        Line l2 = new Line(new Vector2D(1, 2), new Vector2D(0, 1), 1.0e-10);
        assertEquals(-FastMath.sqrt(0.5), l2.getOriginOffset(), 1.0e-10);
    }

    @Test
    void testParallel() {
        Line l1 = new Line(new Vector2D(0, 1), new Vector2D(1, 2), 1.0e-10);
        Line l2 = new Line(new Vector2D(2, 2), new Vector2D(3, 3), 1.0e-10);
        assertTrue(l1.isParallelTo(l2));
        Line l3 = new Line(new Vector2D(1, 0), new Vector2D(0.5, -0.5), 1.0e-10);
        assertTrue(l1.isParallelTo(l3));
        Line l4 = new Line(new Vector2D(1, 0), new Vector2D(0.5, -0.51), 1.0e-10);
        assertFalse(l1.isParallelTo(l4));
    }

    @Test
    void testTransform() throws MathIllegalArgumentException {

        Line l1 = new Line(new Vector2D(1.0 ,1.0), new Vector2D(4.0 ,1.0), 1.0e-10);
        Transform<Euclidean2D, Vector2D, Line, SubLine, Euclidean1D, Vector1D, OrientedPoint, SubOrientedPoint> t1 =
            Line.getTransform(0.0, 0.5, -1.0, 0.0, 1.0, 1.5);
        assertEquals(MathUtils.SEMI_PI, t1.apply(l1).getAngle(), 1.0e-10);

        Line l2 = new Line(new Vector2D(0.0, 0.0), new Vector2D(1.0, 1.0), 1.0e-10);
        Transform<Euclidean2D, Vector2D, Line, SubLine, Euclidean1D, Vector1D, OrientedPoint, SubOrientedPoint> t2 =
            Line.getTransform(0.0, 0.5, -1.0, 0.0, 1.0, 1.5);
        assertEquals(FastMath.atan2(1.0, -2.0), t2.apply(l2).getAngle(), 1.0e-10);

    }

    @Test
    void testIntersection() {
        Line    l1 = new Line(new Vector2D( 0, 1), new Vector2D(1, 2), 1.0e-10);
        Line    l2 = new Line(new Vector2D(-1, 2), new Vector2D(2, 1), 1.0e-10);
        Vector2D p  = l1.intersection(l2);
        assertEquals(0.5, p.getX(), 1.0e-10);
        assertEquals(1.5, p.getY(), 1.0e-10);
    }

    @Test
    public void testMove() {
        Line    line = new Line(new Vector2D( 0, 1), new Vector2D(1, 2), 1.0e-10);
        assertTrue(line.emptyHyperplane().isEmpty());
        assertEquals( 0.0, line.getOffset(new Vector2D(-1, 0)), 1.0e-10);
        assertEquals( 1.0, line.getOffset(line.moveToOffset(new Vector2D(-1, 0),  1.0)), 1.0e-10);
        assertEquals(-2.0, line.getOffset(line.moveToOffset(new Vector2D(-1, 0), -2.0)), 1.0e-10);
    }

    @Test
    public void testTranslate() {
        Line    line = new Line(new Vector2D( 0, 1), new Vector2D(1, 2), 1.0e-10);
        assertEquals(FastMath.sqrt(0.5), line.getOffset(Vector2D.ZERO), 1.0e-10);
        line.translateToPoint(Vector2D.ZERO);
        assertEquals(0.0, line.getOffset(Vector2D.ZERO), 1.0e-10);
    }

    @Test
    public void testSetAngle() {
        Vector2D p1 = new Vector2D(0, 1);
        Vector2D p2 = new Vector2D(1, 2);
        Line    line = new Line(p1, p2, 1.0e-10);
        assertEquals(0.0, line.getOffset(p1), 1.0e-10);
        assertEquals(0.0, line.getOffset(p2), 1.0e-10);
        assertEquals(FastMath.sqrt(0.5), line.getOffset(Vector2D.ZERO), 1.0e-10);

        line.setAngle(0.0);
        // changing the angle does not change the offset
        assertEquals(FastMath.sqrt(0.5), line.getOffset(Vector2D.ZERO), 1.0e-10);

        // first point is not on the line anymore
        assertEquals(FastMath.sqrt(0.5) - 1.0, line.getOffset(p1), 1.0e-10);

    }

    @Test
    public void testSetOriginOffset() {
        Vector2D p1 = new Vector2D(0, 1);
        Vector2D p2 = new Vector2D(1, 2);
        Line    line = new Line(p1, p2, 1.0e-10);
        assertEquals(0.0, line.getOffset(p1), 1.0e-10);
        assertEquals(0.0, line.getOffset(p2), 1.0e-10);
        assertEquals(FastMath.sqrt(0.5), line.getOffset(Vector2D.ZERO), 1.0e-10);

        line.setOriginOffset(0.0);
        // changing the origin offset does not change the angle
        assertEquals(FastMath.PI / 4, line.getAngle(), 1.0e-10);
        assertEquals(0, line.getOffset(Vector2D.ZERO), 1.0e-10);

        // first point is not on the line anymore
        assertEquals(-FastMath.sqrt(0.5), line.getOffset(p1), 1.0e-10);

    }

}