Skip to content

Commit 18dd966

Browse files
committed
docs: document sign convention difference between MR and Featherstone in ABA
1 parent b0fa41f commit 18dd966

1 file changed

Lines changed: 3 additions & 0 deletions

File tree

src/ModernRoboticsBook.jl

Lines changed: 3 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -1936,6 +1936,9 @@ function forward_dynamics_aba(
19361936
ci[i] = ad(Vi[i+1]) * Ai[i] * joint_velocities[i]
19371937
Gi = SMatrix{6,6}(spatial_inertias[i])
19381938
IA[i] = Gi
1939+
# Featherstone's velocity-product force is p_A = v ×* (I v), where ×* is the
1940+
# spatial force cross product. In the Modern Robotics convention, ad(V)' gives
1941+
# the *negative* of the force cross product, so we negate: pA = -ad(V)' * G * V.
19391942
pA[i] = -ad(Vi[i+1])' * Gi * Vi[i+1]
19401943
end
19411944

0 commit comments

Comments
 (0)