Add the possibility to publish the velocity and the effort of the robot.