Vector3d相等判定容差问题及线段交点匹配失败修复咨询

问题场景 #

我用tolerance=1e-10的is_same函数判断3D向量是否相等，定义了lineSegments结构体表示线段，通过参数方程(e1-s1)*k1+s1 = (e2-s2)*k2+s2求解两线段交点，但处理特定线段时出现验证失败的情况：

相关代码 #

判断向量相等的函数：

bool is_same(const vector3d& x, const vector3d& y) {
  auto delta = x-y;
  return delta.length() < 1e-10;
}

线段结构体定义：

struct lineSegments {
   vector3d s, e; // s: 起点, e: 终点
};

测试用线段：

auto l1 = lineSegments{
    {639482584.0, 2115435624.0, 0},    // s1
    {1658825857.0, 1245760131.0, 0}};  // e1
auto l2 = lineSegments{
    {1764535160.0, 1562640819.0, 0},   // s2
    {1658825857.0, 1245760131.0, 0}};  // e2

问题现象 #

求解得到k1=1.0000000000000011、k2=0.99999999999999989，计算出的交点与端点P{1658825857.0, 1245760131.0, 0}的delta长度为4.76837158203125E-07，超过1e-10，导致is_same验证失败。想知道如何修复这个问题，是否应该改用小长度向量验证？

修复方案 #

1. 改用绝对+相对容差结合的判断逻辑 #

你的坐标是1e9量级，而double类型的有效位数约15-17位，此时1e9数值的最小可表示增量约为1e-6，固定的1e-10绝对容差完全不适用。调整is_same函数，同时考虑绝对误差和相对误差：

#include <algorithm> // 用于std::max

bool is_same(const vector3d& x, const vector3d& y) {
    const double abs_tol = 1e-6; // 匹配坐标量级的绝对容差
    const double rel_tol = 1e-9; // 相对误差比例
    auto delta = x - y;
    double delta_len = delta.length();
    // 满足任一条件即判定相等
    return delta_len < abs_tol || 
           delta_len < rel_tol * std::max(x.length(), y.length());
}

2. 针对交点计算的特殊场景优化 #

当k值接近0或1时（即交点接近线段端点），直接复用线段的端点作为交点，避免浮点计算的累积误差：

// 求解得到k1和k2后
const double k_tol = 1e-8; // 针对k值的容差
vector3d intersection;

if (std::abs(k1 - 1.0) < k_tol) {
    intersection = l1.e;
} else if (std::abs(k1) < k_tol) {
    intersection = l1.s;
} else if (std::abs(k2 - 1.0) < k_tol) {
    intersection = l2.e;
} else if (std::abs(k2) < k_tol) {
    intersection = l2.s;
} else {
    intersection = (l1.e - l1.s) * k1 + l1.s;
}

这种方式直接用已知的端点值，完全规避了计算偏差。

3. 逐分量判断误差，避免平方根运算 #

计算向量长度会引入平方根运算，可能额外放大误差。可以直接比较每个分量的绝对误差：

bool is_same(const vector3d& x, const vector3d& y) {
    const double tol = 1e-6; // 根据坐标量级调整
    return std::abs(x.x - y.x) < tol &&
           std::abs(x.y - y.y) < tol &&
           std::abs(x.z - y.z) < tol;
}

这种方式更高效，也更直观。

关于"小长度向量验证"的解答 #

如果是指用线段方向向量的长度来缩放容差，本质和相对容差的思路一致。比如可以用线段的长度作为基准调整阈值：

bool is_same(const vector3d& x, const vector3d& y, const double segment_len) {
    const double rel_tol = 1e-9;
    auto delta = x - y;
    return delta.length() < rel_tol * segment_len;
}

但单独使用相对容差在线段长度极小时可能失效，结合绝对容差会更鲁棒。

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