Testing the use of externally applied endpoint forces/torques in the Dynamics class.
Description
Added tests of jacobian at multiple points in TestForwardKinematics. Added tests of endpoint forces/torques in TestDynamics. Compared results against the sum of dynamics without endpoint forces/torques and the jacobian transpose times endpoint forces/torques. In order to perform this test, added to ForwardKinematics the ToolBodyJacobian, which is expressed in the frame at the tool instead of in the world frame. Also added to Dynamics class access to the tool jacobians.
What to focus on
- put content here.
Reviewers
Resources
Issues
What issues does this fix?
- Fixes #issue-number
Edited by Amy Blank