Test to control in torque the icub joints - View it on GitHub