Copter: rework control switch debouncing