pangtao22/spatial_impedance

Spatial Impedance Simulations

Using Drake, this repo implements and compares two rotational stiffness definitions:

• LinearBushingRollPitchYaw,
• Axis-Angle/Quaternion with a 3x3 rotational stiffness matrix, as defined in chapter 3.3 of Natale's book.