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 in global coordinate system
|
||||||
force()
|
force()
|
||||||
// Force in local coordinate system
|
// Force in local coordinate system
|
||||||
+ (dimensionedTensor("R_T", dimless, R.T()) & forceRelative())
|
+ (R.T() & forceRelative())
|
||||||
// Spring force in global coordinate system
|
// Spring force in global coordinate system
|
||||||
- (linSpringCoeffs() & xR)
|
- (linSpringCoeffs() & xR)
|
||||||
// Damping force in global coordinate system
|
// Damping force in global coordinate system
|
||||||
|
|
|
@ -60,20 +60,21 @@ Foam::dimensionedVector Foam::quaternionSixDOF::A
|
||||||
const HamiltonRodriguezRot& rotation
|
const HamiltonRodriguezRot& rotation
|
||||||
) const
|
) const
|
||||||
{
|
{
|
||||||
// Fix the global force for global rotation constraints
|
// Fix the total force in global coordinate system
|
||||||
dimensionedVector fAbs = this->force();
|
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
|
// Constrain translation
|
||||||
constrainTranslation(fAbs.value());
|
constrainTranslation(fAbs.value());
|
||||||
|
|
||||||
return
|
return fAbs/mass();
|
||||||
(
|
|
||||||
- (linSpringCoeffs() & xR) // spring
|
|
||||||
- (linDampingCoeffs() & uR) // damping
|
|
||||||
+ fAbs
|
|
||||||
// To absolute
|
|
||||||
+ (rotation.invR() & forceRelative())
|
|
||||||
)/mass();
|
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
|
@ -109,7 +109,7 @@ class quaternionSixDOF
|
||||||
//- Fixed yaw (rotation around z)
|
//- Fixed yaw (rotation around z)
|
||||||
Switch fixedYaw_;
|
Switch fixedYaw_;
|
||||||
|
|
||||||
//- Restraints in referent coordinate system
|
//- Constraints in referent coordinate system
|
||||||
Switch referentMotionConstraints_;
|
Switch referentMotionConstraints_;
|
||||||
|
|
||||||
//- Rotation of referent coordinate system
|
//- Rotation of referent coordinate system
|
||||||
|
|
Reference in a new issue