import numpy as np def calculate_distance(w2c1: np.ndarray, w2c2: np.ndarray) -> float: ''' 计算两个相机之间的距离 Args: w2c1: 相机1的世界坐标到相机坐标变换矩阵 w2c2: 相机2的世界坐标到相机坐标变换矩阵 Returns: float: 两个相机之间的距离 ''' return np.linalg.norm(w2c1[:3, 3] - w2c2[:3, 3])