Changed commands for motor & servo again