如何在MATLAB中实现类似OpenGL/Unity的LookAt函数？

需求背景 #

有两个4x4齐次变换帧A和T：A随时间移动，T保持位置静止，仅通过旋转让T始终朝向A，效果等价于OpenGL/Unity中的LookAt函数。需要生成对应的旋转矩阵，将其与T的齐次矩阵相乘，得到朝向A的新帧（以A从[0,0,0]移动到[1,2,-1]为例）。

现有尝试及问题 #

尝试通过计算向量叉积得到旋转轴、余弦定理求旋转角，再用罗德里格斯公式生成旋转矩阵，但该方法仅在A沿X、Z轴移动时有效，且存在向量共线时叉积为零的异常情况。

MATLAB代码如下：

TA = (T.POSITION - A.POSITION);       % Vectors
TB = (T.POSITION - B.POSITION);   
AB = (A.POSITION - B.POSITION);

RotationAngle = acos( (TA^2 + TB^2 - AB^2)/(2*TA*TB))
RotationAxis = cross(TA,TB)
RotationAxis_Normalized = RotationAxis/norm(RotationAxis);

AxisTemp = VecToso3(RotationAxis_Normalized);
RotMat= eye(3,3) + (sin(RotationAngle)*AxisTemp) + ((1-cos(RotationAngle))*(AxisTemp^2));      % Rodrigues rotation

updated_target_config =  T.TRANSFORM * CreateTransform(RotMat); % Multiply T by the rotation matrix so it looks at B

更优实现方法：直接构建正交基旋转矩阵 #

直接通过构建T的目标姿态正交基来生成旋转矩阵，避免罗德里格斯公式的特殊情况限制，适用于所有位置场景。具体步骤如下：

核心思路 #

1. 提取T的固定位置$T_{pos}$（从T的齐次变换矩阵中提取平移分量），获取A的当前位置$A_{pos}$
2. 计算视线向量并归一化，确保方向指向A
3. 基于参考上方向构建正交的右、上向量，形成标准正交基
4. 将正交基转换为3x3旋转矩阵，再嵌入4x4齐次矩阵完成更新

MATLAB实现代码 #

% 提取T的固定位置和当前A的位置
T_pos = T.TRANSFORM(1:3, 4);
A_pos = A.POSITION; % 或从A的齐次矩阵提取：A.TRANSFORM(1:3,4)

% 1. 计算归一化视线向量（指向A）
forward_vec = A_pos - T_pos;
forward_vec = forward_vec / norm(forward_vec);

% 2. 参考上方向（可根据你的坐标系调整，这里用世界Y轴）
up_ref = [0, 1, 0]';

% 3. 计算右向量并归一化
right_vec = cross(forward_vec, up_ref);
right_vec = right_vec / norm(right_vec);

% 4. 计算正交的上向量（修正参考上方向，确保与视线、右向量正交）
up_vec = cross(right_vec, forward_vec);
up_vec = up_vec / norm(up_vec);

% 5. 构建3x3旋转矩阵（列向量为T的X、Y、Z轴）
% 注意：这里的轴定义需匹配你的齐次矩阵约定，若T的Z轴为视线方向，旋转矩阵列依次为right, up, forward
rot_mat = [right_vec, up_vec, forward_vec];

% 6. 生成4x4齐次变换矩阵（位置保持T的原始位置）
lookat_transform = eye(4);
lookat_transform(1:3, 1:3) = rot_mat;
lookat_transform(1:3, 4) = T_pos;

% 更新T的姿态：直接替换为新的齐次矩阵（或按你的逻辑相乘，需注意矩阵乘法顺序）
updated_target_config = lookat_transform;

关键说明 #

• 该方法无需处理旋转轴为零的特殊情况，对A的任意移动路径都有效
• 若你的坐标系中视线方向为Z轴反方向（如OpenGL的右手坐标系），只需将forward_vec取反即可：forward_vec = T_pos - A_pos;
• 矩阵乘法顺序需注意：若你的CreateTransform函数是将旋转矩阵作为左乘项，需调整为updated_target_config = CreateTransform(rot_mat) * T.TRANSFORM;（需根据齐次矩阵的变换顺序约定确认）

内容的提问来源于stack exchange，提问作者Osz