平面c++实现

yhaida

已于 2022-12-21 22:28:59 修改

阅读量127

点赞数

分类专栏：几何计算文章标签：平面

于 2022-12-18 23:28:23 首次发布

本文链接：https://blog.csdn.net/yhaida/article/details/128367313

版权

几何计算专栏收录该内容

7 篇文章 0 订阅

订阅专栏

平面

在这里插入图片描述
平面用垂线（法线）表示

根据 y=vt+a
推出 L(t) = (1,4,-2)·t+ (2,-4,3)

    template <typename coord_type, size_t dim = DIM3>
    class Plane
    {
        Vector3f normal;
        float d = 0.0;

    public:
        Plane(){};

        Plane(Vector3f &_normal, float _constant)
            : normal(_normal), d(_constant)
        {
        }

        Plane(Point3d &_p1, Point3d &_p2, Point3d &_p3)
        {
            Vector3f v12 = _p2 - p1;
            Vector3f v13 = _p3 - p1;

            normal = crossProduct3D(v12, v13);
            d = dotProduct(normal, _p1);
        }
    };

线与平面的交点

在这里插入图片描述

结果： t1=-(n·P)+D

bool Intersection(const Line3d& line, const Planef& plane, Point3d& point)
{
	auto n = plane.getNormal();
	auto D = plane.getD();
	auto d = line.getDir();
	auto p = line.getPoint();

	auto nd = dotProduct(n, d);
	if (!isEqualDouble(nd, ZERO))
	{
		auto t = (-1 * dotProduct(n, p) + D) / nd;
		point.assign(X, p[X] + t * d[X]);
		point.assign(Y, p[Y] + t * d[Y]);
		point.assign(Z, p[Z] + t * d[Z]);
		return true;
	}
	else
		return false;
	return false;
}

两个平面相交

在这里插入图片描述
n为(A,B,C)->法向量，P(x1,y1,z1)这是两平面相交线中任意一点。

那么通式可以表示为R=a·n1+b·n2
在这里插入图片描述

bool Intersection(const Planef& p1, const Planef& p2, Line3d& l)
{
	auto n1 = p1.getNormal();
	auto n2 = p2.getNormal();
	auto d1 = p1.getD();
	auto d2 = p2.getD();

	auto direction = crossProduct3D(n1, n2);

	if (isEqualDouble(direction.magnitude(), ZERO))
		return false;

	auto n1n2 = dotProduct(n1, n2);
	auto n1n2_2 = n1n2 * n1n2;

	auto a = (d2 * n1n2 - d1) / (n1n2_2 - 1);
	auto b = (d1 * n1n2 - d2) / (n1n2_2 - 1);

	auto point = n1 * a + n2 * b;

	l.setPoint(point);
	direction.normalize();
	l.setDirection(direction);
	
	return true;
}