PID joint-space torque controller

[dmsj]

Simple version, based on the Franka examples - does not track desired trajectories OR is unstable

1. better sys-id to estimate link masses, inertias, stiction, etc...
2. analyze controller for stability based on measured properties
3. determine gains / torque limits for safe operation