Joint space impedance control