如何基于Aruco标记位姿计算固定尺寸矩形虚拟面其余顶点坐标

OpenCV没有提供直接生成共面固定尺寸矩形顶点的专用函数，但借助ArUco模块自带的位姿估计能力和点投影函数，只需要少量代码就能实现需求，不需要复杂的姿态换算。

核心实现逻辑 #

你需要的虚拟工作面和ArUco标记处于同一平面（桌面），因此所有顶点在ArUco标记的局部坐标系下的坐标是固定值，只需要通过位姿变换把这些局部坐标投影到像素平面即可，不需要手动推导旋转角度。

注意：OpenCV ArUco模块默认的标记局部坐标系原点在标记几何中心，x轴沿标记水平向右、y轴沿标记竖直向下、z轴垂直标记平面指向相机，标记所在平面对应z=0。

具体实现步骤 #

1. 获取标记位姿
   调用cv2.aruco.estimatePoseSingleMarkers()函数，传入检测到的ArUco角点、标记实际物理边长、你标定得到的相机内参矩阵和畸变系数，即可得到标记相对于相机的旋转向量rvec和平移向量tvec。
2. 定义矩形顶点的局部坐标
   以你需要的0.3m宽、0.1m高工作面为例，先计算作为矩形起点的标记左上角在局部坐标系下的坐标：如果标记边长为marker_size（单位和你标定用的单位一致，比如米），标记左上角的局部坐标为(-marker_size/2, -marker_size/2, 0)，剩余三个顶点的局部坐标可以直接按固定边长写出：
   • 右上角：(-marker_size/2 + 0.3, -marker_size/2, 0)
   • 右下角：(-marker_size/2 + 0.3, -marker_size/2 + 0.1, 0)
   • 左下角：(-marker_size/2, -marker_size/2 + 0.1, 0)
3. 投影到像素平面
   直接调用OpenCV自带的cv2.projectPoints()函数，传入上面定义的四个局部坐标点、rvec、tvec、相机内参、畸变系数，就能直接得到四个顶点在画面上的像素坐标，按顺序连线即可画出和标记姿态对齐的固定尺寸虚拟工作面。

核心代码参考 #

import cv2
import numpy as np

# ===== 你已有的标定参数 =====
camera_matrix = np.load("camera_matrix.npy")  # 标定得到的3x3内参矩阵
dist_coeffs = np.load("dist_coeffs.npy")      # 标定得到的畸变系数
marker_size = 0.05  # 你用的ArUco标记实际边长，单位：米
rect_w = 0.3        # 工作面宽度，单位：米
rect_h = 0.1        # 工作面高度，单位：米

# ===== 检测到ArUco后的处理逻辑 =====
# 假设corners是检测到的目标标记的四个角点
# rvec, tvec, _ = cv2.aruco.estimatePoseSingleMarkers([corners], marker_size, camera_matrix, dist_coeffs)
# rvec = rvec[0][0]
# tvec = tvec[0][0]

# 定义四个顶点在标记局部坐标系的坐标
rect_points_local = np.array([
    [-marker_size/2, -marker_size/2, 0],
    [-marker_size/2 + rect_w, -marker_size/2, 0],
    [-marker_size/2 + rect_w, -marker_size/2 + rect_h, 0],
    [-marker_size/2, -marker_size/2 + rect_h, 0]
], dtype=np.float64)

# 投影得到像素坐标
rect_points_pixel, _ = cv2.projectPoints(
    rect_points_local,
    rvec,
    tvec,
    camera_matrix,
    dist_coeffs
)
# rect_points_pixel 即为四个顶点的像素坐标，可直接用于绘制

其他说明 #

• 不建议直接在2D像素平面通过透视拉伸画矩形：只要相机不是正对标记，这种方式得到的矩形物理尺寸就会存在偏差，必须通过3D点投影的方式实现才能保证尺寸精度。
• 如果你需要获取顶点的三维坐标，只需要把rvec通过cv2.Rodrigues()转为旋转矩阵rot_mat，通过公式 P_camera = rot_mat @ P_local + tvec 即可算出点在相机坐标系下的三维坐标，不需要额外依赖。

实现效果参考：

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