“…Subsequently, the coordinates of points B i , C i , D i , E i , and F i , i = 1, 2, 3, are calculated according to (19) 2, 3, are defined in the MATLAB environment using the Multi-Parametric Toolbox [50], which implements computational geometry functions. This toolbox is also used to easily implement the QP that calculates the Euclidean distance between any two segments by setting δ = 14 mm, chosen based on the Agile Wrist SPM prototype geometry given in Section IV-B.…”