“…6 illustrates the employed Cartesian impedance controller in each of the two manipulators, which emulates the behavior of a mass-spring-damper system Λ(q)ẍ = KΔx − D ẋ + f ext (7) where, Λ(q) is the Cartesian inertia matrix of the physical system, K and D are stiffness and damping that symmetric, positive-definite matrices; f ext is the total external force, and Δx = x g − x is the distance between the goal and end-effector poses. The damping matrix can be designed to simulate a critical damping system [34]. In this framework, after computing the orthogonal decomposition of K, i.e., K = R KR T 1 , where K is a diagonal matrix, then D = 2 K1/2 and D = R DR T .…”