The idea is have the world frame the same as the one defined for id31. Also all the actuators should actuate in the positive direction of the axes