fix: Centripetal force for parallel axes shall be null

core-marine-dev · Aug 7, 2024 · 829c837 · 829c837
1 parent d4cce8e
commit 829c837
Show file tree

Hide file tree

Showing 2 changed files with 2 additions and 2 deletions.
diff --git a/source/Point.cpp b/source/Point.cpp
@@ -320,7 +320,7 @@ Point::getCentripetalForce(vec rRef, vec w) const
 {
 	const vec rRel = r - rRef;
 
-	return w.squaredNorm() * (M * rRel);
+	return -M * (w.cross(w.cross(rRel)));
 }
 
 moordyn::error_id

diff --git a/source/Rod.cpp b/source/Rod.cpp
@@ -825,7 +825,7 @@ Rod::getCentripetalForce(vec rRef, vec w) const
 	vec F = vec::Zero();
 	for (unsigned int i = 0; i <= N; i++) {
 		const vec rRel = r[i] - rRef;
-		F += w.squaredNorm() * (M[i] * rRel);
+		F -= M[i] * (w.cross(w.cross(rRel)));
 	}
 	return F;
 }