Fix friction collision

This commit is contained in:
Nikita Lisitsa 2020-11-29 14:33:35 +03:00
parent fd5b61f6a1
commit 28b676b002

View file

@ -473,7 +473,7 @@ namespace psemek::phys2d
float q = geom::length(J - n * geom::dot(J, n));
if (q > mu * geom::dot(J, n))
{
float k = (mu * (1.f + e) * geom::dot(J1, n)) / (q - mu * geom::dot(n, J2 - J1));
float k = (mu * (1.f + e) * geom::dot(J1, n)) / (geom::length(J2 - n * geom::dot(J2, n)) - mu * geom::dot(n, J2 - J1));
J = (1.f + e) * J1 + k * (J2 - J1);
}