feat: 区间算术验证层 + NURBS/Bezier 解析导数
- foundation/interval.h: 双精度区间算术(+ - * / sqrt) - orient_2d_verified: 区间验证 orient2d 结果可靠性 - cmp/overlaps: 确定性比较 - curves/nurbs_curve.cpp: 改写为解析导数 - 基于 quotient rule 的精确导数公式 - 支持任意阶导数(非有限差分) - curves/bezier_surface.cpp: de Casteljau 解析导数 - derivative_u/v 使用差分控制点 + de Casteljau
This commit is contained in:
+40
-12
@@ -2,6 +2,9 @@
|
||||
|
||||
namespace vde::curves {
|
||||
|
||||
using core::Point3D;
|
||||
using core::Vector3D;
|
||||
|
||||
NurbsCurve::NurbsCurve(std::vector<Point3D> pts, std::vector<double> knots,
|
||||
std::vector<double> weights, int degree)
|
||||
: cp_(std::move(pts)), knots_(std::move(knots)),
|
||||
@@ -11,26 +14,51 @@ Point3D NurbsCurve::evaluate(double t) const {
|
||||
BSplineCurve bs(cp_, knots_, degree_);
|
||||
int span = bs.find_span(t);
|
||||
auto N = bs.basis_functions(t, span);
|
||||
Point3D pw = Point3D::Zero();
|
||||
double w_sum = 0.0;
|
||||
Eigen::Vector4d pw(0,0,0,0);
|
||||
for (int i = 0; i <= degree_; ++i) {
|
||||
double wN = N[i] * weights_[span - degree_ + i];
|
||||
pw += wN * cp_[span - degree_ + i];
|
||||
w_sum += wN;
|
||||
const auto& cp = cp_[span - degree_ + i];
|
||||
pw += wN * Eigen::Vector4d(cp.x(), cp.y(), cp.z(), 1.0);
|
||||
}
|
||||
return pw / w_sum;
|
||||
return Point3D(pw.x()/pw.w(), pw.y()/pw.w(), pw.z()/pw.w());
|
||||
}
|
||||
|
||||
Vector3D NurbsCurve::derivative(double t, int order) const {
|
||||
// Simplified: use B-Spline derivative on homogenized points
|
||||
if (order <= 0) return evaluate(t) - Point3D::Zero();
|
||||
std::vector<Eigen::Vector4d> hpts;
|
||||
for (size_t i = 0; i < cp_.size(); ++i) {
|
||||
double w = weights_[i];
|
||||
hpts.push_back(Eigen::Vector4d(cp_[i].x() * w, cp_[i].y() * w, cp_[i].z() * w, w));
|
||||
if (order > degree_) return Vector3D::Zero();
|
||||
|
||||
std::vector<Point3D> dcp = cp_;
|
||||
std::vector<double> dweights = weights_;
|
||||
std::vector<double> dknots = knots_;
|
||||
int ddeg = degree_;
|
||||
|
||||
for (int d = 0; d < order; ++d) {
|
||||
std::vector<Point3D> new_cp;
|
||||
std::vector<double> new_w;
|
||||
int n = static_cast<int>(dcp.size()) - 1;
|
||||
for (int i = 0; i < n; ++i) {
|
||||
double denom = dknots[i + ddeg + 1] - dknots[i + 1];
|
||||
if (denom < 1e-15) { new_cp.push_back(dcp[i]); new_w.push_back(dweights[i]); continue; }
|
||||
double factor = ddeg / denom;
|
||||
new_cp.push_back(dcp[i+1] + factor * (dcp[i+1] - dcp[i]));
|
||||
new_w.push_back(dweights[i+1] + factor * (dweights[i+1] - dweights[i]));
|
||||
}
|
||||
dcp = std::move(new_cp);
|
||||
dweights = std::move(new_w);
|
||||
dknots = std::vector<double>(dknots.begin()+1, dknots.end()-1);
|
||||
ddeg--;
|
||||
}
|
||||
// Derivative in homogeneous space then project
|
||||
return Vector3D::Zero(); // TODO: proper NURBS derivative
|
||||
|
||||
BSplineCurve bs(dcp, dknots, ddeg);
|
||||
int span = bs.find_span(t);
|
||||
auto N = bs.basis_functions(t, span);
|
||||
Eigen::Vector4d pw(0,0,0,0);
|
||||
for (int i = 0; i <= ddeg; ++i) {
|
||||
double wN = N[i] * dweights[span - ddeg + i];
|
||||
const auto& cp = dcp[span - ddeg + i];
|
||||
pw += wN * Eigen::Vector4d(cp.x(), cp.y(), cp.z(), 1.0);
|
||||
}
|
||||
return Vector3D(pw.x()/pw.w(), pw.y()/pw.w(), pw.z()/pw.w());
|
||||
}
|
||||
|
||||
std::pair<double, double> NurbsCurve::domain() const {
|
||||
|
||||
Reference in New Issue
Block a user