Blender V5.3
GEO_xpbd_constraint_distance.hh
Go to the documentation of this file.
1/* SPDX-FileCopyrightText: 2026 Blender Authors
2 *
3 * SPDX-License-Identifier: GPL-2.0-or-later */
4
5#pragma once
6
9
10namespace blender::xpbd {
11
18
20 const float3 &p1,
21 const float inv_m0,
22 const float inv_m1,
23 const float rest_distance,
24 const float compliance_term,
25 const float lambda_prev)
26{
27 if (inv_m0 == 0.0f && inv_m1 == 0.0f) {
28 return {};
29 }
30
31 const float3 p_diff = p1 - p0;
32 float length;
33 const float3 normalized_dir = math::normalize_and_get_length(p_diff, length);
34 const float length_diff = length - rest_distance;
35 const float error_squared = math::square(length_diff + compliance_term * lambda_prev);
36 const float delta_lambda = (-length_diff - compliance_term * lambda_prev) /
37 (inv_m0 + inv_m1 + compliance_term);
38
39 const float3 offset0 = -delta_lambda * inv_m0 * normalized_dir;
40 const float3 offset1 = delta_lambda * inv_m1 * normalized_dir;
41
42 return {delta_lambda, offset0, offset1, error_squared};
43}
44
45class DistanceConstraintSet : public TemplatedConstraintSet<DistanceConstraintSet> {
46 private:
48 Span<int2> point_pairs_;
49 Span<float> distances_;
50 Span<float> compliances_;
51 /* Scale factor for residual error. */
52 float error_scale_;
53 MutableSpan<float> lambdas_;
54
55 public:
56 static constexpr StringRefNull debug_name = "Distance Constraint";
57
58 DistanceConstraintSet(const int geo_i,
59 const Span<int2> point_pairs,
60 const Span<float> distances,
61 const Span<float> compliances,
62 const float error_scale,
63 MutableSpan<float> lambdas)
64 : TemplatedConstraintSet<DistanceConstraintSet>(point_pairs.size(), {geo_i}),
65 point_pairs_(point_pairs),
66 distances_(distances),
67 compliances_(compliances),
68 error_scale_(error_scale),
69 lambdas_(lambdas)
70 {
71 }
72
73 void reset_force(const int constraint_i) const
74 {
75 lambdas_[constraint_i] = 0.0f;
76 }
77
78 template<typename UpdaterT>
80 UpdaterT &updater,
81 const int constraint_i) const
82 {
83 const int geo_i = affected_geo_indices_[0];
84 const int2 &point_pair = point_pairs_[constraint_i];
85 const int point_i0 = point_pair[0];
86 const int point_i1 = point_pair[1];
88 params.position(geo_i, point_i0),
89 params.position(geo_i, point_i1),
90 params.inv_mass(geo_i, point_i0),
91 params.inv_mass(geo_i, point_i1),
92 distances_[constraint_i],
93 compliances_[constraint_i] * params.compliance_term_factor,
94 lambdas_[constraint_i]);
95 lambdas_[constraint_i] += result.delta_lambda;
96 updater.update_position(geo_i, point_i0, result.offset0);
97 updater.update_position(geo_i, point_i1, result.offset1);
98 updater.add_residual_error(geo_i, result.residual_error_squared * error_scale_);
99 }
100
102 {
103 return color_constraints__binary(point_pairs_, memory);
104 }
105};
106
107} // namespace blender::xpbd
const float3 & position(int geo_i, int point_i) const
float inv_mass(int geo_i, int point_i) const
void reset_force(const int constraint_i) const
void solve_single(const ConstraintSetParams &params, UpdaterT &updater, const int constraint_i) const
DistanceConstraintSet(const int geo_i, const Span< int2 > point_pairs, const Span< float > distances, const Span< float > compliances, const float error_scale, MutableSpan< float > lambdas)
ConstraintColoring color_constraints(LinearAllocator<> &memory) const override
TemplatedConstraintSet(const int constraints_num, Vector< int > affected_geo_indices)
float length(VecOp< float, D >) RET
QuaternionBase< T > normalize_and_get_length(const QuaternionBase< T > &q, T &out_length)
T square(const T &a)
ConstraintColoring color_constraints__binary(const Span< int2 > affected_points, LinearAllocator<> &memory)
DistanceConstraintResult evaluate_distance_constraint(const float3 &p0, const float3 &p1, const float inv_m0, const float inv_m1, const float rest_distance, const float compliance_term, const float lambda_prev)
VecBase< int32_t, 2 > int2
VecBase< float, 3 > float3