Helper to compare values with a small tolerance
bool closeEnough(double a, double b, [double tol = 1e-3]) { return (a - b).abs() < tol; }