Blender V5.3
GEO_xpbd_constraint_rod_bend_twist.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
10
11namespace blender::xpbd {
12
14class RodBendAndTwistConstraintSet : public TemplatedConstraintSet<RodBendAndTwistConstraintSet> {
15 private:
17 IndexRange curves_range_;
18 OffsetIndices<int> points_by_curve_;
19
21 Span<math::Quaternion> rest_rotations_;
22
24 Span<float> compliances_;
25
26 /* Scale factor for residual error. */
27 float error_scale_;
28
29 MutableSpan<float4> lambdas_;
30
31 public:
32 static constexpr StringRefNull debug_name = "Rod Bend and Twist";
33
35 const IndexRange curves_range,
36 const OffsetIndices<int> points_by_curve,
37 const Span<math::Quaternion> rest_rotations,
38 const Span<float> compliances,
39 const float error_scale,
40 MutableSpan<float4> lambdas)
41 : TemplatedConstraintSet<RodBendAndTwistConstraintSet>(curves_range.size(), {geo_i}),
42 curves_range_(curves_range),
43 points_by_curve_(points_by_curve),
44 rest_rotations_(rest_rotations),
45 compliances_(compliances),
46 error_scale_(error_scale),
47 lambdas_(lambdas)
48 {
49 }
50
51 void reset_force(const int constraint_i) const
52 {
53 const int curve_i = curves_range_[constraint_i];
54 const IndexRange points = points_by_curve_[curve_i];
55 lambdas_.slice(points).fill(float4(0.0f));
56 }
57
58 template<typename UpdaterT>
60 UpdaterT &updater,
61 const int constraint_i) const
62 {
63 const int curve_i = curves_range_[constraint_i];
64 const IndexRange points = points_by_curve_[curve_i];
65 const int geo_i = affected_geo_indices_[0];
66 const int first_point_i_in_constraint_set = points_by_curve_[curves_range_.first()].first();
67
68 /* Could implement bilateral interleaving ordering for better stability. */
69 /* Note that the last segment does not have this constraint, because the rotation of the last
70 * point in the rod is meaningless.*/
71 for (const int point_i0 : points.drop_back(2)) {
72 const int point_i1 = point_i0 + 1;
73 const float compliance = compliances_[point_i0 - first_point_i_in_constraint_set];
75 params.rotation(geo_i, point_i0),
76 params.rotation(geo_i, point_i1),
77 params.moment_of_inertia(geo_i, point_i0),
78 params.moment_of_inertia(geo_i, point_i1),
79 rest_rotations_[point_i0],
80 compliance * params.compliance_term_factor,
81 lambdas_[point_i0]);
82 lambdas_[point_i0] += result.delta_lambda;
83 updater.update_rotation(geo_i, point_i0, result.offset0);
84 updater.update_rotation(geo_i, point_i1, result.offset1);
85 updater.add_residual_error(geo_i, result.residual_error_squared * error_scale_);
86 }
87 }
88
93};
94
95} // namespace blender::xpbd
constexpr IndexRange drop_back(int64_t n) const
constexpr IndexRange slice(int64_t start, int64_t size) const
const T & first() const
const math::Quaternion & rotation(int geo_i, int point_i) const
float3 moment_of_inertia(int geo_i, int point_i) const
ConstraintColoring color_constraints(LinearAllocator<> &) const override
void solve_single(const ConstraintSetParams &params, UpdaterT &updater, const int constraint_i) const
RodBendAndTwistConstraintSet(const int geo_i, const IndexRange curves_range, const OffsetIndices< int > points_by_curve, const Span< math::Quaternion > rest_rotations, const Span< float > compliances, const float error_scale, MutableSpan< float4 > lambdas)
TemplatedConstraintSet(const int constraints_num, Vector< int > affected_geo_indices)
AlignRotationsConstraintResult evaluate_align_rotations_constraint(const math::Quaternion &r0, const math::Quaternion &r1, const float3 &inertia0, const float3 &inertia1, const math::Quaternion &rest_rotation, const float compliance_term, const float4 &lambda_prev)
ConstraintColoring color_constraints__all_independent(const int constraints_num)
VecBase< float, 4 > float4