Rtch/Lephisto
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

[Add] Angular effects on collision with static objects.

Browse Source
This commit is contained in:
Rtch90 2018-04-10 19:56:13 +01:00
parent f546c292db
commit 33838c7590
1 changed files with 13 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

16
src/space.cpp
View File

@ -379,15 +379,25 @@ static void hitCallback(CollisionContact* c) {
hitNormal = c->normal; hitNormal = c->normal;
} }
const double coeff_rest = 0.5;
const vector3d vel = mover->GetVelocity(); const vector3d vel = mover->GetVelocity();
vector3d reflect = vel - (hitNormal * vector3d::Dot(vel, hitNormal) * 2.0f); vector3d reflect = vel - (hitNormal * vector3d::Dot(vel, hitNormal) * 2.0f);
/* Dampen a little. */
reflect = reflect * 0.5;
/* Step back. */ /* Step back. */
mover->UndoTimestep(); mover->UndoTimestep();
/* and set altered velocity. */ /* and set altered velocity. */
mover->SetVelocity(reflect); mover->SetVelocity(reflect * coeff_rest);
/* Angular effects. */
const double invMass1 = 1.0 / mover->GetMass();
const vector3d hitPos1 = c->pos - mover->GetPosition();
const double j = (-(1+coeff_rest) * (vector3d::Dot(mover->GetVelocity(), c->normal))) /
(invMass1 +
(vector3d::Dot(c->normal, vector3d::Cross(vector3d::Cross(hitPos1, c->normal) * (1.0/mover->GetAngularInertia()), hitPos1)))
);
mover->SetAngVelocity(mover->GetAngVelocity() - vector3d::Cross(hitPos1, (j*c->normal))*(1.0/mover->GetAngularInertia()));
} }
} }