如何判断3D空间点是否在横竖FOV不同的相机视场内？含代码问题

问题根源分析 #

• 未判断目标点是否在相机前方：原代码仅通过角度范围判断，忽略点在相机后方的情况，导致误判
• 角度计算逻辑混乱：直接将相机姿态角（pitch/yaw）与点的角度相加，坐标系转换逻辑错误，无法正确反映点相对于相机的方位
• 未处理滚转：原逻辑基于固定X/Y轴角度，没有考虑相机滚转后坐标系的旋转

修正思路与实现 #

核心步骤 #

1. 过滤后方区域：通过向量点积判断目标点是否在相机前半空间，直接排除后方物体
2. 转换到相机局部坐标系：利用相机的正交归一化轴向量（前向、右向、上向），将世界空间的方向向量转换到相机局部空间，自动处理滚转姿态
3. FOV范围判断：利用FOV半角的正切值，通过向量分量的比值判断是否在视场内，避免角度计算的精度问题

修正后代码示例 #

#include <cmath>
#include <limits>

#define DEG_TO_RAD (M_PI / 180.0f)

struct Vector3 {
    float x, y, z;

    Vector3 operator-(const Vector3& other) const {
        return {x - other.x, y - other.y, z - other.z};
    }

    float Dot(const Vector3& other) const {
        return x * other.x + y * other.y + z * other.z;
    }

    float LengthSq() const {
        return x*x + y*y + z*z;
    }
};

class Camera {
private:
    Vector3 m_world_view; // 相机世界位置
    Vector3 m_forward;    // 相机前向向量（归一化）
    Vector3 m_right;      // 相机右向向量（归一化）
    Vector3 m_up;         // 相机上向向量（归一化）
    float m_fov_h;        // 水平FOV（角度值）
    float m_fov_v;        // 垂直FOV（角度值）
    // 相机初始化时需正确计算三个轴向量（包含roll姿态）

public:
    bool InView(const Vector3 &objpos);
};

bool Camera::InView(const Vector3 &objpos)
{
    // 计算相机到目标的方向向量
    Vector3 dir = objpos - m_world_view;
    const float dist_sq = dir.LengthSq();
    if (dist_sq < std::numeric_limits<float>::epsilon()) {
        return true; // 点与相机重合，视为在视场内
    }

    // 过滤相机后方的点：前向向量与方向向量点积<=0表示在后方
    if (dir.Dot(m_forward) <= 0.0f) {
        return false;
    }

    // 将方向向量转换到相机局部坐标系
    const float local_x = dir.Dot(m_right);
    const float local_y = dir.Dot(m_up);
    const float local_z = dir.Dot(m_forward); // 已确保为正

    // 计算FOV半角的正切值（转弧度后计算）
    const float half_fov_h_rad = m_fov_h * 0.5f * DEG_TO_RAD;
    const float half_fov_v_rad = m_fov_v * 0.5f * DEG_TO_RAD;
    const float tan_half_h = std::tan(half_fov_h_rad);
    const float tan_half_v = std::tan(half_fov_v_rad);

    // 判断水平方向是否在FOV内
    if (std::fabs(local_x) > local_z * tan_half_h) {
        return false;
    }

    // 判断垂直方向是否在FOV内
    if (std::fabs(local_y) > local_z * tan_half_v) {
        return false;
    }

    return true;
}

关键说明 #

• 相机轴向量：需确保m_forward、m_right、m_up是正交归一化的，可通过相机的pitch/yaw/roll计算得到，滚转姿态直接体现在轴向量的旋转中
• 前向判断：点积大于0表示目标在相机前半空间，彻底避免后方物体误判
• FOV判断逻辑：利用tan(半FOV)作为阈值，通过|局部x|/局部z <= tan(半水平FOV)判断水平范围，垂直方向同理，无需计算角度，效率更高且无精度歧义
• 滚转处理：由于已将目标向量转换到相机局部坐标系，滚转带来的坐标系旋转已被自动抵消，无需额外处理

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