Fixed bug: joints names were published as q1,q2,q3... now URDF name is used.