c++计算两个三维向量之间的夹角

计算p1p0与p2p0之间的夹角,结果返回 0 至 π 之间的计算结果,单位为弧度,在函数库中角度均以弧度来表示

c++计算两个三维向量之间的夹角_第1张图片

//计算角度
			Pnt3 p1p0 = p1p2[0].Co3d() - p0.Co3d();
			Pnt3 p1p02 = p1p0.Normalize();
			Pnt3 p2p0 = p1p2[1].Co3d() - p0.Co3d();
			Pnt3 p2p02 = p2p0.Normalize();

			
			float anglep1p0p2 = acos(p1p02.dotmultiple(p2p02));//返回 0 至 π 之间的计算结果,单位为弧度,在函数库中角度均以弧度来表示
			

同时,cos值也可以按照如下计算

float a = (p1p2[0].Co3d()-p1p2[1].Co3d()).GetLength();
float b = p2p0.GetLength();
float c = p1p0.GetLength();
float cosa = (b*b+c*c-a*a)/(2.0*b*c);

注意使用点积的反cos函数求角度的时候,一定要对所有向量进行归一化,若不归一化将会得到错误的结果。

你可能感兴趣的:(c++)