Center of mass position and Jacobian
computes
the center of mass position of the robot model at the specified joint
configuration, relative to the base frame.com
= centerOfMass(robot
,configuration
)
[
also
returns the center of mass Jacobian, which relates the center of mass
velocity to the joint velocities.com
,comJac
]
= centerOfMass(robot
,configuration
)
gravityTorque
| massMatrix
| rigidBodyTree
| velocityProduct