zhyang-dev/openfoam
1
0
Fork 0
mirror of https://develop.openfoam.com/Development/openfoam.git synced 2025-11-28 03:28:01 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

rigidBodySolver: Updated comments

Browse Source
This commit is contained in:
Henry Weller
2016-04-12 22:23:04 +01:00
parent a0170df6c1
commit b66675ed58
1 changed files with 4 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
src/rigidBodyDynamics/rigidBodySolvers/rigidBodySolver/rigidBodySolver.C
View File

@ -64,22 +64,22 @@ void Foam::RBD::rigidBodySolver::correctQuaternionJoints()
if (model_.joints()[i].unitQuaternion()) if (model_.joints()[i].unitQuaternion())
{ {
// Calculate the change in the normalized quaternion axis // Calculate the change in the unit quaternion
vector dv((q().block<vector>(qi) - q0().block<vector>(qi))); vector dv((q().block<vector>(qi) - q0().block<vector>(qi)));
scalar magDv = mag(dv); scalar magDv = mag(dv);
if (magDv > SMALL) if (magDv > SMALL)
{ {
// Calculate the quaternion corresponding to the change // Calculate the unit quaternion corresponding to the change
quaternion dQuat(dv/magDv, cos(magDv), true); quaternion dQuat(dv/magDv, cos(magDv), true);
// Transform the previous time quaternion // Transform the previous time unit quaternion
quaternion quat quaternion quat
( (
normalize(model_.joints()[i].unitQuaternion(q0())*dQuat) normalize(model_.joints()[i].unitQuaternion(q0())*dQuat)
); );
// Update the joint state // Update the joint unit quaternion
model_.joints()[i].unitQuaternion(quat, q()); model_.joints()[i].unitQuaternion(quat, q());
} }
} }