We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent b0fa41f commit 18dd966Copy full SHA for 18dd966
1 file changed
src/ModernRoboticsBook.jl
@@ -1936,6 +1936,9 @@ function forward_dynamics_aba(
1936
ci[i] = ad(Vi[i+1]) * Ai[i] * joint_velocities[i]
1937
Gi = SMatrix{6,6}(spatial_inertias[i])
1938
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.
1942
pA[i] = -ad(Vi[i+1])' * Gi * Vi[i+1]
1943
end
1944
0 commit comments