Minor change to debug print
Add transformation of force/torque sensors measurements to frame attached at the center of mass of the link hosting the sensor.