WB_Linear.java

/**
 * 
 */
package wblut.geom;

import wblut.WB_Epsilon;

// TODO: Auto-generated Javadoc
/**
 * The Class WB_Linear.
 *
 * @author Frederik Vanhoutte, W:Blut
 */
public abstract class WB_Linear {
	/** Origin of line. */
	protected WB_Point3d	origin;

	/** Direction of line. */
	protected WB_Vector3d	direction;

	/**
	 * Instantiates a new w b_ linear.
	 */
	public WB_Linear() {
		origin = new WB_Point3d();
		direction = new WB_Vector3d(1, 0, 0);
	}

	/**
	 * Instantiates a new w b_ linear.
	 *
	 * @param o the o
	 * @param d the d
	 */
	public WB_Linear(final WB_Point3d o, final WB_Vector3d d) {
		origin = o.get();
		direction = d.get();
		direction.normalize();
	}

	/**
	 * Instantiates a new w b_ linear.
	 *
	 * @param p1 the p1
	 * @param p2 the p2
	 */
	public WB_Linear(final WB_Point3d p1, final WB_Point3d p2) {
		origin = p1.get();
		direction = p2.subToVector(p1);
		direction.normalize();
	}

	/**
	 * Sets the.
	 *
	 * @param o the o
	 * @param d the d
	 */
	public void set(final WB_Point3d o, final WB_Vector3d d) {
		origin.set(o);
		direction.set(d);
		direction.normalize();
	}

	/**
	 * Sets the.
	 *
	 * @param p1 the p1
	 * @param p2 the p2
	 */
	public void set(final WB_Point3d p1, final WB_Point3d p2) {
		origin.set(p1);
		direction.set(p2.subToVector(p1));
		direction.normalize();
	}

	/**
	 * Instantiates a new w b_ linear.
	 *
	 * @param o the o
	 * @param d the d
	 * @param copy the copy
	 */
	public WB_Linear(final WB_Point3d o, final WB_Vector3d d, final boolean copy) {
		if (copy) {
			origin = o.get();
			direction = d.get();
		} else {

			direction = d;
		}

		direction.normalize();
	}

	/**
	 * Instantiates a new w b_ linear.
	 *
	 * @param p1 the p1
	 * @param p2 the p2
	 * @param copy the copy
	 */
	public WB_Linear(final WB_Point3d p1, final WB_Point3d p2, final boolean copy) {
		if (copy) {
			origin = p1.get();

		} else {
			origin = p1;

		}
		direction = p2.subToVector(p1);
		direction.normalize();
	}

	/**
	 * Sets the no copy.
	 *
	 * @param o the o
	 * @param d the d
	 */
	public void setNoCopy(final WB_Point3d o, final WB_Vector3d d) {
		origin = o;
		direction = d;
		direction.normalize();
	}

	/**
	 * Sets the no copy.
	 *
	 * @param p1 the p1
	 * @param p2 the p2
	 */
	public void setNoCopy(final WB_Point3d p1, final WB_Point3d p2) {
		origin = p1;
		direction.set(p2.subToVector(p1));
		direction.normalize();
	}

	/**
	 * Get point along line.
	 *
	 * @param t distance from origin
	 * @return point
	 */
	public WB_Point3d getPoint(final double t) {
		final WB_Point3d result = new WB_Point3d(direction);
		result.scale(t);
		result.moveBy(origin);
		return result;
	}

	/**
	 * Get point along line and store it in provided WB_Point.
	 *
	 * @param t distance from origin
	 * @param p WB_Point to store result in
	 * @return the point into
	 */
	public void getPointInto(final double t, final WB_Point3d p) {
		p.moveTo(direction);
		p.scale(t);
		p.moveBy(origin);
	}

	/**
	 * Get origin.
	 *
	 * @return origin
	 */
	public WB_Point3d getOrigin() {
		return origin;
	}

	/**
	 * Get direction.
	 *
	 * @return direction
	 */
	public WB_Vector3d getDirection() {
		return direction;
	}

	/**
	 * Gets the normal.
	 *
	 * @return the normal
	 */
	public WB_Normal3d getNormal() {

		WB_Normal3d n = new WB_Normal3d(0, 0, 1);
		n = n.cross(direction);
		final double d = n.normalize();
		if (WB_Epsilon.isZero(d)) {
			n = new WB_Normal3d(1, 0, 0);
		}
		return n;
	}
}