define_plane()

int define_plane	(	POINTARRAY *	pa,
		PLANE3D *	pl
	)

Definition at line 1173 of file measures3d.c.

References FP_IS_ZERO, get_3dcross_product(), get_3dvector_from_points(), getPoint3dz_p(), POINTARRAY::npoints, PLANE3D::pop, PLANE3D::pv, VECTOR3D::x, POINT3DZ::x, VECTOR3D::y, POINT3DZ::y, VECTOR3D::z, and POINT3DZ::z.

Referenced by lw_dist3d_line_poly(), lw_dist3d_point_poly(), and lw_dist3d_poly_poly().

{
        const uint32_t POL_BREAKS = 3;
        uint32_t unique_points = pa->npoints - 1;
        uint32_t i;

        /* Calculate the average point */
        pl->pop.x = 0.0;
        pl->pop.y = 0.0;
        pl->pop.z = 0.0;
        for (i = 0; i < unique_points; i++)
        {
                POINT3DZ p;
                getPoint3dz_p(pa, i, &p);
                pl->pop.x += p.x;
                pl->pop.y += p.y;
                pl->pop.z += p.z;
        }

        pl->pop.x /= unique_points;
        pl->pop.y /= unique_points;
        pl->pop.z /= unique_points;

        pl->pv.x = 0.0;
        pl->pv.y = 0.0;
        pl->pv.z = 0.0;
        for (i = 0; i < POL_BREAKS; i++)
        {
                POINT3DZ point1, point2;
                VECTOR3D v1, v2, vp;
                uint32_t n1, n2;
                n1 = i * unique_points / POL_BREAKS;
                n2 = n1 + unique_points / POL_BREAKS; /* May overflow back to the first / last point */

                if (n1 == n2)
                        continue;

                getPoint3dz_p(pa, n1, &point1);
                if (!get_3dvector_from_points(&pl->pop, &point1, &v1))
                        continue;

                getPoint3dz_p(pa, n2, &point2);
                if (!get_3dvector_from_points(&pl->pop, &point2, &v2))
                        continue;

                if (get_3dcross_product(&v1, &v2, &vp))
                {
                        /* If the cross product isn't zero these 3 points aren't collinear
                         * We divide by its lengthsq to normalize the additions */
                        double vl = vp.x * vp.x + vp.y * vp.y + vp.z * vp.z;
                        pl->pv.x += vp.x / vl;
                        pl->pv.y += vp.y / vl;
                        pl->pv.z += vp.z / vl;
                }
        }

        return (!FP_IS_ZERO(pl->pv.x) || !FP_IS_ZERO(pl->pv.y) || !FP_IS_ZERO(pl->pv.z));
}

Here is the call graph for this function:

Here is the caller graph for this function: