Spatial impedance control of redundant manipulators