“…1) Inner joint position control the diagonal elements of K p,c has been imposed equal to 0.25 1/s; K p = diag([1000, 1500, 1500, 1500, 400, 200, 150]) Nm/rad has been imposed; K d = diag( [32,40,30,45,20,20,10]) Nms/rad has been imposed; K i = diag( [15,15,20,40,40,30,40]) Nm/(s rad) has been imposed; friction compensation as in [49] have been implemented. K p , K d , and K i have been optimized as in [41].…”