NxRLab / ModernRobotics

Modern Robotics: Mechanics, Planning, and Control Code Library --- The primary purpose of the provided software is to be easy to read and educational, reinforcing the concepts in the book. The code is optimized neither for efficiency nor robustness.
http://modernrobotics.org/
MIT License
1.9k stars 807 forks source link

Impedance control algorithm implement #53

Closed ghost closed 1 year ago

ghost commented 1 year ago

In 11.7.1 section, Impedance equation $\tau = J^T(\theta)(\hat{\Lambda}(\theta)\ddot{x}+\hat{\eta}(\theta,\dot{x}) - (M\ddot{x}+B\dot{x} + Kx))$ is actually means $\tau = J^T(\theta)(\hat{\Lambda}(\theta)\ddot{x}+\hat{\eta}(\theta,\dot{x}) + (M(\ddot{x_d} - \ddot{x} )+B(\dot{x_d} - \dot{x}) + K(x_d - x)))$?