Changes to speed commands
 / Added function to set FW e ROT speeds