37 separating_axes_(separating_axes),
38 contact_velocities_(contact_velocities),
39 dynamic_friction_terms_(dynamic_friction_terms),
40 lambdas_normal_(lambdas_normal),
53 const int constraint_i)
const
55 const int point_i = points_[constraint_i];
56 const float inv_m = params.
inv_mass(geo_i_, point_i);
60 const float dynamic_friction = dynamic_friction_terms_[constraint_i] *
62 const float lambda_normal = lambdas_normal_[constraint_i];
63 const float3 &axis = separating_axes_[constraint_i];
64 const float3 &contact_velocity = contact_velocities_[constraint_i];
65 const float3 &velocity = params.
velocity(geo_i_, point_i) - contact_velocity;
66 const float3 velocity_tangent = velocity -
math::dot(velocity, axis) * axis;
70 const float delta_lambda = std::min(dynamic_friction * lambda_normal, residual / inv_m);
72 lambdas_[constraint_i] += delta_lambda;
73 updater.update_velocity(geo_i_, point_i, -gradient * inv_m * delta_lambda);