Add computed-torque, impedance, and joint PD control

[kmolan]

Add inverse-dynamics (computed-torque) tracking and Cartesian impedance control, plus high-stiffness joint-space PD position tracking for position-controlled hardware.

Done when: the controllers track a reference trajectory in a test.

Depends on #32

[kmolan]

on it