Geometrically consistent impedance control for dual-robot manipulation