计算两个向量之间的夹角:
向量 V1 = (x1, y1, z1) ,向量 V2 = (x2, y2, z2), 则向量A点乘向量 B:
V1·V2 = x1 * x2 + y1 * y2 + z1 * z2
V1·V2 = |V1||V2|Cosθ
Cosθ = V1·V2 / |V1|/|V2|;
θ = Mathf.Acos(Cosθ); //计算出弧度
θ = θ * Mathf.Rad2Deg;//弧度转角度
计算三点之间构成向量之间的夹角:
vector1,vector2,vector3;
V1=vector2-vector1;
V2 = vector3-vector1;
vector1代表三点之间的原点,得出V1,V2套用上述公式即可。
//计算夹角
public double Angle(Vector3 cen, Vector3 first, Vector3 second)
{
double M_PI = 3.1415926535897931;
double ma_x = first.x - cen.x;
double ma_y = first.y - cen.y;
double ma_z = first.z - cen.z;
double mb_x = second.x - cen.x;
double mb_y = second.y - cen.y;
double mb_z = second.z - cen.z;
double v1 = (ma_x * mb_x) + (ma_y * mb_y) + (ma_z * mb_z);
double ma_val = Math.Sqrt(ma_x * ma_x + ma_y * ma_y + ma_z * ma_z);
double mb_val = Math.Sqrt(mb_x * mb_x + mb_y * mb_y + mb_z * mb_z);
double cosM = v1 / (ma_val * mb_val);
double angleAMB = Math.Acos(cosM) * 180 / M_PI;
return angleAMB;
}