swift - 如何计算 3D 空间中相机方向的两点之间的角度

Question

我目前面临的问题是我想计算从相机位置到目标位置的角度(以弧度为单位)。但是，此计算还需要考虑相机的航向。

例如，当相机背对物体时，函数应返回 π。到目前为止，我编写的函数大部分时间都有效。然而，当用户靠近 X 轴和 Z 轴时，箭头不再指向目标，而是稍微指向左侧或右侧，具体取决于您处于正还是负 X 和 Z 空间。

目前，我不确定为什么我的功能不起作用。我对此行为的唯一解释是万向节锁。但是我不太确定如何使用四元数实现相同的函数。

我还在这篇文章中附上了一些照片，问题更加清楚了。

这是我现在正在使用的功能:

 func getAngle() -> Float {
    guard let pointOfView = self.sceneView.session.currentFrame else { return 0.0  }
    let cameraPosition =  pointOfView.camera.transform.columns.3

    let heading =  getUserVector()
    let distance = SCNVector3Make(TargetPosition.x - cameraPosition.x ,TargetPosition.y - cameraPosition.y - TargetPosition.y,TargetPosition.z - cameraPosition.z)

    let heading_scalar = sqrtf(heading.x * heading.x + heading.z * heading.z)
    let distance_scalar = sqrtf(distance.z * distance.z + distance.z * distance.z)

    let x = ((heading.x * distance.x) + (heading.z * distance.z) / (heading_scalar * distance_scalar))

    let theta = acos(max(min(x, 1), -1))

    if theta < 0.35 {
        return 0
    }

    if (heading.x * (distance.z / distance_scalar) - heading.z * (distance.x/distance_scalar)) > 0{
        return theta
    }
    else{
        return -theta
    }

}


func getUserVector() -> (SCNVector3) { // (direction)
    if let frame = self.sceneView.session.currentFrame {
        let mat = SCNMatrix4(frame.camera.transform) // 4x4 transform matrix describing camera in world space
        let dir = SCNVector3(-1 * mat.m31, -1 * mat.m32, -1 * mat.m33) // orientation of camera in world space
         print(mat)
        return dir

    }
    return SCNVector3(0, 0, -1)
}

请考虑下图作为示例。右上角的箭头应该笔直向上，以沿着线到达中心对象，但它却稍微指向左侧。当我与 z 轴对齐时，与 x 轴对齐时会发生相同的行为。

Answer 1

我找到了问题的答案，解决方案是将物体转换为相机的视角，然后简单地使用atan2来获取相机和物体之间的角度，希望这篇文章对 future 的读者有所帮助!

func getAngle() -> Float {
    guard let pointOfView = self.sceneView.session.currentFrame else { return 0.0  }
    let cameraPosition =  pointOfView.camera.transform
    let targetPosition = simd_float4x4(targetNode.transform)
    let newTransform =  simd_mul(cameraPosition.inverse, targetPosition).columns.3
    let theta = atan2(newTransform.z, newTransform.y)
    return theta + (Float.pi / 2)

}