三维空间中三点之间的夹角

20

我有3个点,包含X、Y、Z坐标:

var A = {x: 100, y: 100, z: 80},
    B = {x: 100, y: 175, z: 80},
    C = {x: 100, y: 100, z: 120};

这些坐标是来自于一个3D CSS变换的像素值。 我如何获取向量BA和BC之间的角度? 提供一个数学公式即可,如果有JavaScript代码则更好。 谢谢。

enter image description here


1
http://en.wikipedia.org/wiki/Law_of_cosines - Bart
请看链接:https://dev59.com/zFHTa4cB1Zd3GeqPUcVz#4144216。 - tafa
我知道我必须对向量进行归一化,但不知道如何操作。 - Mircea
将一个向量除以它的长度。而它的长度就是其各个分量平方根的总和。 - Bart
这张图片指向了正确的角度吗? - Kodak
你如何在三维变换后找到坐标? - pery mimon
4个回答

39

伪代码中,向量BA(称其为v1)表示为:

v1 = {A.x - B.x, A.y - B.y, A.z - B.z}

同样地,向量BC(记作v2)为:

v2 = {C.x - B.x, C.y - B.y, C.z - B.z}
v1v2的点积是它们之间夹角余弦值的函数(乘以它们长度的乘积进行了缩放)。因此,首先对v1v2进行归一化处理:
v1mag = sqrt(v1.x * v1.x + v1.y * v1.y + v1.z * v1.z)
v1norm = {v1.x / v1mag, v1.y / v1mag, v1.z / v1mag}

v2mag = sqrt(v2.x * v2.x + v2.y * v2.y + v2.z * v2.z)
v2norm = {v2.x / v2mag, v2.y / v2mag, v2.z / v2mag}

然后计算点积:

res = v1norm.x * v2norm.x + v1norm.y * v2norm.y + v1norm.z * v2norm.z

最后,恢复角度:

angle = acos(res)

很好,让我把它写成Javascript代码。 - Mircea
@Mircea,你有这个结果的JSFiddle吗? - y_nk
1
@y_nk 抱歉没有fiddle,但是可以看一下http://typefolly.com/interaction/,应该会在里面。 - Mircea
1
@ Roger Rowland:是的,基本上是一样的东西。我之前没有仔细注意到就来打扰你真是太傻了! :) - Snehasish Karmakar
1
@y_nk 这是它的要点,用Javascript编码:https://gist.github.com/andfaulkner/c4ad12a72d29bcd653eb4b8cca2ae476 - Andrew Faulkner
显示剩余11条评论

6
double GetAngleABC( double* a, double* b, double* c )
{
    double ab[3] = { b[0] - a[0], b[1] - a[1], b[2] - a[2] };
    double bc[3] = { c[0] - b[0], c[1] - b[1], c[2] - b[2]  };

    double abVec = sqrt(ab[0] * ab[0] + ab[1] * ab[1] + ab[2] * ab[2]);
    double bcVec = sqrt(bc[0] * bc[0] + bc[1] * bc[1] + bc[2] * bc[2]);

    double abNorm[3] = {ab[0] / abVec, ab[1] / abVec, ab[2] / abVec};
    double bcNorm[3] = {bc[0] / bcVec, bc[1] / bcVec, bc[2] / bcVec};

    double res = abNorm[0] * bcNorm[0] + abNorm[1] * bcNorm[1] + abNorm[2] * bcNorm[2];

    return acos(res)*180.0/ 3.141592653589793;
}


double a[] = {1, 0, 0};

double b[] = {0, 0, 0};

double c[] = {0, 1, 0};

std::cout<< "The angle of ABC is " << GetAngleABC(a,b,c)<< "º " << std::endl;

这段代码是可行的。我注意到一个危险的情况:你假设double*的长度总是三,而没有检查它。当用户/编码者传递不同长度的数组时,这段代码将产生异常,但你没有处理异常。这只是一个吹毛求疵的事情,因为代码可以工作,但我更喜欢使用try/catch异常处理来处理任何数组操作(或类似操作,包括任何具有长度/大小的集合,如向量),并且我更喜欢确认数组/容器的长度/大小是否符合函数的期望(这里是3)。点赞。 - StephenDonaldHuffPhD

2
@Roger Swift中的算法
func SCNVector3Angle(start: SCNVector3, mid: SCNVector3, end: SCNVector3) -> Double {
    let v1 = (start - mid)
    let v2 = (end - mid)
    let v1norm = v1.normalized()
    let v2norm = v2.normalized()

    let res = v1norm.x * v2norm.x + v1norm.y * v2norm.y + v1norm.z * v2norm.z
    let angle: Double = Double(GLKMathRadiansToDegrees(acos(res)))
    return angle
}

/**
* Subtracts two SCNVector3 vectors and returns the result as a new SCNVector3.
*/
func - (left: SCNVector3, right: SCNVector3) -> SCNVector3 {
    return SCNVector3Make(left.x - right.x, left.y - right.y, left.z - right.z)
}

extension SCNVector3
{
    /**
    * Returns the length (magnitude) of the vector described by the SCNVector3
    */
    func length() -> Float {
        return sqrtf(x*x + y*y + z*z)
    }

    /**
    * Normalizes the vector described by the SCNVector3 to length 1.0 and returns
    * the result as a new SCNVector3.
    */
    func normalized() -> SCNVector3 {
        return self / length()
    }
}

2
同样的python代码(以度数输出):
import numpy as np
import math 
import time

def angle_2p_3d(a, b, c):       

    v1 = np.array([ a[0] - b[0], a[1] - b[1], a[2] - b[2] ])
    v2 = np.array([ c[0] - b[0], c[1] - b[1], c[2] - b[2] ])

    v1mag = np.sqrt([ v1[0] * v1[0] + v1[1] * v1[1] + v1[2] * v1[2] ])
    v1norm = np.array([ v1[0] / v1mag, v1[1] / v1mag, v1[2] / v1mag ])

    v2mag = np.sqrt(v2[0] * v2[0] + v2[1] * v2[1] + v2[2] * v2[2])
    v2norm = np.array([ v2[0] / v2mag, v2[1] / v2mag, v2[2] / v2mag ])
    res = v1norm[0] * v2norm[0] + v1norm[1] * v2norm[1] + v1norm[2] * v2norm[2]
    angle_rad = np.arccos(res)

    return math.degrees(angle_rad)


p1 = np.array([1,0,0])
p2 = np.array([0,0,0])
p3 = np.array([0,0,1])

start = time.time()
angle= angle_2p_3d(p1, p2, p3)
end = time.time()

print("angle: ", angle)
print("elapsed in: ", end - start)

输出:

角度:90.0

用时:8.392333984375e-05


网页内容由stack overflow 提供, 点击上面的
可以查看英文原文,
原文链接