30 const float error_scale,
33 compliances_(compliances),
34 point_indices_(point_indices),
35 pin_rotations_(pin_rotations),
36 error_scale_(error_scale),
43 lambdas_[constraint_i] =
float4(0.0f);
46 template<
typename UpdaterT>
49 const int constraint_i)
const
52 const int point_i = point_indices_[constraint_i];
55 pin_rotations_[constraint_i],
57 float3(std::numeric_limits<float>::infinity()),
60 lambdas_[constraint_i]);
61 lambdas_[constraint_i] +=
result.delta_lambda;
62 updater.update_rotation(geo_i, point_i,
result.offset0);
63 updater.add_residual_error(geo_i,
result.residual_error_squared * error_scale_);
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_
void solve_single(const ConstraintSetParams ¶ms, UpdaterT &updater, const int constraint_i) const
ConstraintColoring color_constraints(LinearAllocator<> &memory) const override
PinRotationConstraintSet(const int geo_i, const Span< int > point_indices, const Span< math::Quaternion > pin_rotations, const Span< float > compliances, const float error_scale, MutableSpan< float4 > lambdas)
void reset_force(const int constraint_i) const
static constexpr StringRefNull debug_name
TemplatedConstraintSet(const int constraints_num, Vector< int > affected_geo_indices)
ConstraintColoring color_constraints__unary(const Span< int > affected_points, LinearAllocator<> &memory)
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)
VecBase< float, 4 > float4
VecBase< float, 3 > float3
static QuaternionBase identity()