some fixes in inverse dynamics, PyBullet example comparing explicit pd, stable pd control, position control (constraint)