ICODE-ADC/lammps
4
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Improved the way body inertia moments are checked if they are zero when updating body quaterions in fix rigid/nve

Browse Source
This commit is contained in:
Trung Nguyen
2020-05-23 23:52:00 -05:00
parent 5e3fe19756
commit 093f981719
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/math_extra.cpp
View File

@ -258,8 +258,8 @@ void no_squish_rotate(int k, double *p, double *q, double *inertia,
// obtain phi, cosines and sines
phi = p[0]*kq[0] + p[1]*kq[1] + p[2]*kq[2] + p[3]*kq[3];
if (fabs(inertia[k-1]) < 1e-6) phi *= 0.0;
else phi /= 4.0 * inertia[k-1];
phi /= (4.0 * inertia[k-1]);
if (!std::isfinite(phi)) phi = 0.0;
c_phi = cos(dt * phi);
s_phi = sin(dt * phi);