UAS: some cleanup for setManualControlCommands and set idle rate to 5Hz instead of 2.5Hz