已知3点,求平面方程,点到面的距离

//已知3点,求平面方程
BOOL CGe::PanelEquationFromThreePt(CPoint3dArray ptArr,
                                   double &a,double &b,double &c,double &d)
{

    CPoint3d p1,p2,p3;

    if(ptArr.GetSize() < 3)
    {
        return FALSE;
    }
    p1 = ptArr[0];
    p2 = ptArr[1];
    p3 = ptArr[2];
   
    a = ( (p2.y-p1.y)*(p3.z-p1.z)-(p2.z-p1.z)*(p3.y-p1.y) );
    b = ( (p2.z-p1.z)*(p3.x-p1.x)-(p2.x-p1.x)*(p3.z-p1.z) );
    c = ( (p2.x-p1.x)*(p3.y-p1.y)-(p2.y-p1.y)*(p3.x-p1.x) );
    d = ( 0-(a*p1.x+b*p1.y+c*p1.z) );

    return TRUE;
}

//点到面的距离,设点坐标为P(x, y, z),平面方程为ax+by+cz+d=0。
double CGe::DistPt2Panel(    double x,double y,double z,
                            double a,double b,double c,double d)
{
    return    fabs(a*x+b*y+c*z+d) / sqrt(a*a+b*b+c*c);
}

评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值