3D点转2D投影异常：输出未归一至(-1,1)范围求助

看起来你的核心问题是投影公式错误，并且缺少了从像素坐标到标准化设备坐标（NDC，即(-1,1)范围、屏幕中心为原点）的转换步骤，另外样本中的点还存在相机空间深度为负的问题。下面一步步拆解问题并给出修复方案：

问题分析 #

你的代码存在几个关键错误：

1. 混淆了相机位置与内参主点：投影公式中错误地使用了cameraPosition，相机位置已经通过cameraPose.inverse()转换到相机空间时被考虑了，相机空间的点原点就是相机光心，不需要再减去相机位置。
2. 缺少NDC归一化步骤：你当前计算的是错误的坐标值，没有将其转换到(-1,1)的归一化范围。
3. 未处理相机后方的点：样本中相机空间点的z值为负（-2083.82），说明点在相机后方，这种点无法正常投影到相机前方的图像上，会导致计算结果异常。

修复步骤与代码示例 #

1. 确认相机内参与图像尺寸 #

首先确保你的CameraIntrinsics包含主点坐标（principalPoint.x/principalPoint.y，即图像中心的像素坐标），同时需要获取图像的width和height（用于归一化）。

2. 修正投影与归一化代码 #

std::vector<Ogre::Vector2> projectedFeaturePoints;
Core::CameraIntrinsics cameraIntrinsics = Core::EnvironmentInformation::getSingleton()->getCameraIntrinsics();
// 获取图像尺寸（假设可以通过这个接口获取，根据你的实际环境调整）
Ogre::Vector2 imageSize = Core::EnvironmentInformation::getSingleton()->getImageSize();
float width = imageSize.x;
float height = imageSize.y;

for (int i = 0; i < out.numberofpoints; i++) {
    // 构造世界空间3D点
    Ogre::Vector4 worldPt(
        out.pointlist[i],
        out.pointlist[3*i + 1],
        out.pointlist[3*i + 2],
        1.0f
    );

    // 世界点转换到相机空间
    Ogre::Vector4 cameraPt = cameraPose.inverse() * worldPt;
    float X = cameraPt.x;
    float Y = cameraPt.y;
    float Z = cameraPt.z;

    // 跳过相机后方的点（Z<=0，说明点在相机视野外）
    if (Z <= 0) {
        // 可以根据需求添加无效标记，比如push_back(Ogre::Vector2(NAN, NAN))
        continue;
    }

    // 相机空间投影到图像像素坐标
    float u = (cameraIntrinsics.focalLength.x * X / Z) + cameraIntrinsics.principalPoint.x;
    float v = (cameraIntrinsics.focalLength.y * Y / Z) + cameraIntrinsics.principalPoint.y;

    // 像素坐标转换为NDC（归一化到(-1,1)，屏幕中心为原点）
    // 注意：图像坐标系y轴向下，NDC y轴向上，所以需要翻转
    float ndcX = 2.0f * (u / width) - 1.0f;
    float ndcY = 1.0f - 2.0f * (v / height);

    projectedFeaturePoints.push_back(Ogre::Vector2(ndcX, ndcY));
}

3. 样本点的异常解释 #

你的样本中cameraPt.z = -2083.82，这意味着该3D点在相机的后方（Ogre相机默认z轴指向前方），这种点不在相机的有效视野内，直接投影会得到错误的结果。你需要检查：

• 相机的姿态是否正确（是否朝向点所在的方向）
• cameraPose矩阵的定义是否正确（是否是世界到相机的变换矩阵）

关键概念补充 #

• 相机空间：原点在相机光心，z轴指向相机前方，只有z>0的点才会出现在相机视野中。
• NDC归一化：将像素坐标转换为以屏幕中心为原点，x/y范围均为(-1,1)的坐标，这是图形学中常见的标准化坐标格式。

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