您的位置:首页 > 编程语言 > C语言/C++

【C\C++】空间中求一点到两点所构成的直线的距离

2016-07-27 09:11 447 查看
最近在做叶面重建的工作,构建叶面TIN的算法中会用到3维中点到直线的距离方程,一开始以为像二维一样有公式之类的,后来找了一下没有找到,就写了一个函数,分享一下

double dis_3D(Point a,Point b,Point s){
double ab=sqrt(pow((a.X-b.X),2.0)+pow((a.Y-b.Y),2.0)+pow((a.Z-b.Z),2.0));
double as=sqrt(pow((a.X-s.X),2.0)+pow((a.Y-s.Y),2.0)+pow((a.Z-s.Z),2.0));
double bs=sqrt(pow((s.X-b.X),2.0)+pow((s.Y-b.Y),2.0)+pow((s.Z-b.Z),2.0));

double cos_A=(pow(as,2.0)+pow(ab,2.0)-pow(bs,2.0))/(2*ab*as);
double sin_A=sqrt(1-pow(cos_A,2.0));
return as*sin_A;
}


基本数学原理就是用余弦定理求出夹角,再求正弦值,然后求出高,

即点到线的距离。
内容来自用户分享和网络整理,不保证内容的准确性,如有侵权内容,可联系管理员处理 点击这里给我发消息
标签: