The goal of this issue is to integrate the computeDistance function into the Model class within the robot_model module. This enhancement will enable the calculation of a distance matrix between any two links, denoted as link (i) and link (j).