Function gc_wait_on_input

FluidNC/src/GCode.cpp:2047–2082

overloaded(Ts...) -> overloaded<Ts...>;

static Error gc_wait_on_input(bool is_digital, objnum_t input_number, WaitOnInputMode mode, float timeout) {
    // TODO - only Immediate read mode is supported
    if (mode == WaitOnInputMode::Immediate) {
        float result;
        if (is_digital) {
            if (input_number >= MaxUserDigitalPin) {
                return Error::PParamMaxExceeded;
            }
            auto& pin = config->_userInputs->digitalInput[input_number];
            if (pin.undefined()) {
                log_error(pin.legend() << " is not defined");
                return Error::PParamMaxExceeded;
            }
            result = (float)pin.get();
            set_numbered_param(5399, result);
            log_debug("M66: " << pin.legend() << " result=" << result);
        } else {
            if (input_number >= MaxUserAnalogPin) {
                return Error::PParamMaxExceeded;
            }
            auto& pin = config->_userInputs->analogInput[input_number];
            if (pin.undefined()) {
                log_error(pin.legend() << " is not defined");
                return Error::PParamMaxExceeded;
            }
            result = (float)pin.get();
            set_numbered_param(5399, result);
            log_debug("M66: " << pin.legend() << " result=" << result);
        }

        return Error::Ok;
    }

    // TODO - implement rest of modes
    return Error::GcodeValueWordInvalid;
}