Fix the issues with the tool definition

It seems that currently there is an issue with how tools are defined for a robot in the toolbox. For instance, the tool is not taken into consideration when calculating the Jacobian, neither it is plotted.