39 point_pairs_(point_pairs),
40 separating_axes_(separating_axes),
41 contact_velocities_(contact_velocities),
42 dynamic_friction_terms_(dynamic_friction_terms),
43 lambdas_normal_(lambdas_normal),
44 point_mix_factors_(point_mix_factors),
57 const int constraint_i)
const
59 const int2 point_pair = point_pairs_[constraint_i];
60 const float segment_factor = point_mix_factors_[constraint_i];
63 const float inv_m0 = params.
inv_mass(geo_i_, point_pair[0]);
64 const float inv_m1 = params.
inv_mass(geo_i_, point_pair[1]);
65 const float weight0 = (1.0f - segment_factor) * inv_m0;
66 const float weight1 = segment_factor * inv_m1;
70 const float dynamic_friction = dynamic_friction_terms_[constraint_i] *
72 const float lambda_normal = lambdas_normal_[constraint_i];
73 const float3 &axis = separating_axes_[constraint_i];
74 const float3 &contact_velocity = contact_velocities_[constraint_i];
76 params.
velocity(geo_i_, point_pair[1]),
79 const float3 velocity_tangent = velocity -
math::dot(velocity, axis) * axis;
82 const float delta_lambda = std::min(dynamic_friction * lambda_normal,
83 residual / (weight0 + weight1));
85 lambdas_[constraint_i] += delta_lambda;
86 updater.update_velocity(geo_i_, point_pair[0], -weight0 * gradient * delta_lambda);
87 updater.update_velocity(geo_i_, point_pair[1], -weight1 * gradient * delta_lambda);