39 const float error_scale,
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),
53 const int curve_i = curves_range_[constraint_i];
54 const IndexRange points = points_by_curve_[curve_i];
58 template<
typename UpdaterT>
61 const int constraint_i)
const
63 const int curve_i = curves_range_[constraint_i];
64 const IndexRange points = points_by_curve_[curve_i];
66 const int first_point_i_in_constraint_set = points_by_curve_[curves_range_.first()].
first();
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];
79 rest_rotations_[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_);
constexpr IndexRange drop_back(int64_t n) const
constexpr IndexRange slice(int64_t start, int64_t size) const
const math::Quaternion & rotation(int geo_i, int point_i) const
float3 moment_of_inertia(int geo_i, int point_i) const
float compliance_term_factor
Vector< int > affected_geo_indices_
ConstraintColoring color_constraints(LinearAllocator<> &) const override
static constexpr StringRefNull debug_name
void reset_force(const int constraint_i) const
void solve_single(const ConstraintSetParams ¶ms, 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