Add header file for vector conversion macros
First implementation of torques estimation (still missing transfor from force/torque sensor to link's com frame, conversion of IMU measurements to base's frame, filtering of joints' positions).