- Added the joints speed and the Rad/Deg conversion for cmd