Minor updates in sixDOF classes
This commit is contained in:
parent
b2625b60a5
commit
c02eac8fcb
3 changed files with 13 additions and 12 deletions
|
@ -79,7 +79,7 @@ Foam::dimensionedVector Foam::geometricSixDOF::A
|
|||
// Force in global coordinate system
|
||||
force()
|
||||
// Force in local coordinate system
|
||||
+ (dimensionedTensor("R_T", dimless, R.T()) & forceRelative())
|
||||
+ (R.T() & forceRelative())
|
||||
// Spring force in global coordinate system
|
||||
- (linSpringCoeffs() & xR)
|
||||
// Damping force in global coordinate system
|
||||
|
|
|
@ -60,20 +60,21 @@ Foam::dimensionedVector Foam::quaternionSixDOF::A
|
|||
const HamiltonRodriguezRot& rotation
|
||||
) const
|
||||
{
|
||||
// Fix the global force for global rotation constraints
|
||||
dimensionedVector fAbs = this->force();
|
||||
// Fix the total force in global coordinate system
|
||||
dimensionedVector fAbs =
|
||||
// Force in global coordinate system
|
||||
force()
|
||||
// Force in local coordinate system
|
||||
+ (rotation.invR() & forceRelative())
|
||||
// Spring force in global coordinate system
|
||||
- (linSpringCoeffs() & xR)
|
||||
// Damping force in global coordinate system
|
||||
- (linDampingCoeffs() & uR);
|
||||
|
||||
// Constrain translation
|
||||
constrainTranslation(fAbs.value());
|
||||
|
||||
return
|
||||
(
|
||||
- (linSpringCoeffs() & xR) // spring
|
||||
- (linDampingCoeffs() & uR) // damping
|
||||
+ fAbs
|
||||
// To absolute
|
||||
+ (rotation.invR() & forceRelative())
|
||||
)/mass();
|
||||
return fAbs/mass();
|
||||
}
|
||||
|
||||
|
||||
|
|
|
@ -109,7 +109,7 @@ class quaternionSixDOF
|
|||
//- Fixed yaw (rotation around z)
|
||||
Switch fixedYaw_;
|
||||
|
||||
//- Restraints in referent coordinate system
|
||||
//- Constraints in referent coordinate system
|
||||
Switch referentMotionConstraints_;
|
||||
|
||||
//- Rotation of referent coordinate system
|
||||
|
|
Reference in a new issue