如何在Python中利用3个笛卡尔坐标点转球坐标求解旋转参数？

首先修正你写的球坐标转换函数，里面存在几个明显问题：

• 未导入math模块却用了m别名
• 函数内覆盖了输入参数z，导致变量混乱
• 球坐标的角度命名和常规定义不统一

修正后的函数：

import numpy as np
import math as m

def cart2sph(x, y, z):
    xy_sq = x**2 + y**2
    r = m.sqrt(xy_sq + z**2)
    theta = m.atan2(m.sqrt(xy_sq), z)  # 极角：与z轴的夹角，范围0~π
    phi = m.atan2(y, x)                # 方位角：xy平面内与x轴的夹角，范围-π~π
    return r, theta, phi

但要明确：仅靠球坐标转换无法直接得到旋转参数。你要的x/y/z旋转参数，本质是求「三个点定义的局部坐标系相对于原笛卡尔坐标系的欧拉角」，核心思路是先从三个点构建正交基向量，再推导旋转矩阵，最后转成欧拉角。

步骤1：用三个点构建局部正交坐标系 #

假设三个点的定义是：p1为局部坐标系原点，p2-p1为局部x轴方向，p3用于确定局部y轴所在平面：

# 转numpy数组方便计算
p1 = np.array([x1, y1, z1])
p2 = np.array([x2, y2, z2])
p3 = np.array([x3, y3, z3])

# 局部x轴（归一化）
x_axis = p2 - p1
x_axis /= np.linalg.norm(x_axis)

# 局部y轴：取p3到p1-p2的垂直分量并归一化
vec_p1p3 = p3 - p1
y_axis = vec_p1p3 - np.dot(vec_p1p3, x_axis) * x_axis
y_axis /= np.linalg.norm(y_axis)

# 局部z轴：通过x/y轴叉乘得到右手坐标系
z_axis = np.cross(x_axis, y_axis)
z_axis /= np.linalg.norm(z_axis)

步骤2：构造旋转矩阵 #

旋转矩阵的每一列对应局部坐标系基向量在原坐标系中的分量：

rotation_matrix = np.column_stack([x_axis, y_axis, z_axis])

步骤3：将旋转矩阵转换为欧拉角（x/y/z旋转参数） #

用scipy的工具类可以快速转换，这里用最常用的ZYX顺序（绕z→y→x轴旋转）：

from scipy.spatial.transform import Rotation as R

# 生成旋转对象
rot = R.from_matrix(rotation_matrix)
# 输出欧拉角，单位为度（要弧度就去掉degrees=True）
euler_angles = rot.as_euler('zyx', degrees=True)

# 提取三个轴的旋转参数
rot_z = euler_angles[0]  # 绕z轴旋转角度
rot_y = euler_angles[1]  # 绕y轴旋转角度
rot_x = euler_angles[2]  # 绕x轴旋转角度

补充说明 #

如果你的三个点是刚体上的标记点（而非定义坐标系的原点和坐标轴），则需要用ICP算法或最小二乘法拟合旋转矩阵，但上述方法是三个点定义局部坐标系的常规场景解法。球坐标仅能描述单个点的位置，无法直接推导旋转关系，必须通过构建坐标系完成。

内容的提问来源于stack exchange，提问作者Mr.daq