Add computation of body radius

  The radius of a body is an upper bound of the maximum distance between the
  points of the body and the origin of the joint.