Java method (using Minecraft vectors) to detect a point in cone

Utils.java

	/**
	 * Checks if  point is contained within a cone in 3D space
	 *
	 * @param start tip of the cone
	 * @param normDirection normalized (length==1) vector, direction of cone
	 * @param radius radius at the end of the cone
	 * @param length length of the cone
	 * @param truncationLength optional lenght at which the cone is truncated (flat tip)
	 * @param relativePoint point to be checked, relative to {@code start}
	 */
	public static boolean isPointInCone(Vec3d start, Vec3d normDirection, double radius, double length, float truncationLength, Vec3d relativePoint)
	{
		double projectedDist = relativePoint.dotProduct(normDirection); //Orthogonal projection, establishing point's distance on cone direction vector
		if(projectedDist<truncationLength || projectedDist>length) //If projected distance is before truncation or beyond length, point not contained
			return false;

		double radiusAtDist = projectedDist/length * radius; //Radius of the cone at the projected distance
		Vec3d orthVec = relativePoint.subtract(normDirection.scale(projectedDist)); //Orthogonal vector between point and cone direction

		return orthVec.lengthSquared()<(radiusAtDist*radiusAtDist); //Check if Vector's length is shorter than radius -> point in cone
	}