已知空间三点组成的面求该面上某点的Z值

Posted charlee44

tags:

篇首语:本文由小常识网(cha138.com)小编为大家整理,主要介绍了已知空间三点组成的面求该面上某点的Z值相关的知识,希望对你有一定的参考价值。

已知空间三点,那么可以就可以确定空间三点组成的平面。此时可以根据某一点的X值和Y值,来求取该点在平面上的Z值。这个过程对于求三角面片上某点的高程或者权值特别有用,其本身也可以看作一种线性插值。

其算法思路也特别简单,首先算出其三点组成的平面法向量(可参看《已知三点求平面法向量》);然后根据平面法向量(n=(A,B,C))和平面上某点(m=(x0,y0,z0)),有平面的点法式方程:
[ A(X-x0)+B(Y-y0)+C(Z-z0)=0 ]
最后根据欲求点的X、Y值,代入公式解算Z值即可。

具体实现代码如下:

#include<iostream>

using namespace std;

//三维double矢量
struct Vec3d
{
    double x, y, z;

    Vec3d()
    {
        x = 0.0;
        y = 0.0;
        z = 0.0;
    }
    Vec3d(double dx, double dy, double dz)
    {
        x = dx;
        y = dy;
        z = dz;
    }
    void Set(double dx, double dy, double dz)
    {
        x = dx;
        y = dy;
        z = dz;
    }
};

//计算三点成面的法向量
void Cal_Normal_3D(const Vec3d& v1, const Vec3d& v2, const Vec3d& v3, Vec3d &vn)
{
    //v1(n1,n2,n3);
    //平面方程: na * (x – n1) + nb * (y – n2) + nc * (z – n3) = 0 ;
    double na = (v2.y - v1.y)*(v3.z - v1.z) - (v2.z - v1.z)*(v3.y - v1.y);
    double nb = (v2.z - v1.z)*(v3.x - v1.x) - (v2.x - v1.x)*(v3.z - v1.z);
    double nc = (v2.x - v1.x)*(v3.y - v1.y) - (v2.y - v1.y)*(v3.x - v1.x);

    //平面法向量
    vn.Set(na, nb, nc);
}

void CalPlanePointZ(const Vec3d& v1, const Vec3d& v2, const Vec3d& v3, Vec3d& vp)
{
    Vec3d vn;
    Cal_Normal_3D(v1, v2, v3, vn);  

    if (vn.z != 0)              //如果平面平行Z轴
    {
        vp.z = v1.z - (vn.x * (vp.x - v1.x) + vn.y * (vp.y - v1.y)) / vn.z;         //点法式求解
    }   
}

int main()
{
    Vec3d v1(1.0, 5.2, 3.7);
    Vec3d v2(2.8, 3.9, 4.5);
    Vec3d v3(7.6, 8.4, 6.2);
    Vec3d vp;
    v3.x = 5.6;
    v3.y = 6.4;
    v3.z = 0.0;

    CalPlanePointZ(v1, v2, v3, vp);

    return 0;
}

以上是关于已知空间三点组成的面求该面上某点的Z值的主要内容,如果未能解决你的问题,请参考以下文章

已知空间三点求球中心坐标

三个点求圆心

Python 计算三维空间某点距离原点的欧式距离

已知3维空间里刚体上3个点的加速度,如何求刚体上任意点的加速度。最好有公式推导。

已知一个圆经过三点,怎样求圆心坐标啊?

c语言:有4个圆塔,已知圆心和半径,塔以外无建筑物。输入任一点坐标,求该点的建筑高度