Maschinen an/aus auf Externe Taste legen

// This component checks the state of a modal function to decide whether the button
// press needs to turn it on or turn it off. Useful for things that can be set by
// gcode AND panel buttons and avoids having to press the button twice if it has been
// changed by gcode.

component paneltoggle "Toggle state by pressing machine panel button";

pin in bit enable "input changes state only if this pin is TRUE " ;
pin in bit input "TRUE when panel button is pressed" ;
pin in bit status "State of coresponsing system function (e.g. MDI, G91, etc";
pin out bit set "TRUE to set system function";
pin out bit reset "TRUE to reset system function";

param rw u32 debounce = 2 "debounce delay in periods";
option data toggle_data;

function _ nofp;
license "GPL";
;;
int c, d;

typedef struct {
    int debounce_cntr;
    int debounced;
} toggle_data;

FUNCTION(_) {

    if (( debounce < 1 ) || ( debounce > 10000 )) {
    /* set a sane value, we don't want 2 million second delays */
    debounce = 2;
    }
    if ( input && enable ) {
    /* pressed */
    data.debounce_cntr++;
    if ( data.debounce_cntr >= debounce ) {
        data.debounce_cntr = debounce;
        if ( data.debounced == 0 ) {
                if ( status == 0 ) {
                 /* if it's off switch it on */
                set = 1;
                reset = 0;
                }
                else {
                 /* if it's on switch it off */
                set = 0;
                reset = 1;
                }

        }
        data.debounced = 1;
    }
    } else {
        /* not pressed */
        data.debounce_cntr--;
        if ( data.debounce_cntr <= 0 ) {
            data.debounce_cntr = 0;
            data.debounced = 0;
            set = 0;
            reset = 0;
        }
    }
}

#  --- Toggle M8 on/off ---
net machine-is-on     => paneltoggle.m8.enable
net m8-panel            <= hm2_7i76e.0.7i73.0.1.input-03-not     => paneltoggle.m8.input
net m8-is-on             <= halui.flood.is-on  => paneltoggle.m8.status
net m8-set                <= paneltoggle.m8.set           => halui.flood.on
net m8-reset             <= paneltoggle.m8.reset        => halui.flood.off

loadrt paneltoggle names=paneltoggle.machine
addf    paneltoggle.machine              servo-thread

#  --- Toggle Machine on/off ---
setp paneltoggle.machine.enable 1
net machine-on-panel  <= <signal von deinem Taster>   => paneltoggle.machine.input
net machine-is-on     <= halui.machine.is-on          => paneltoggle.machine.status
net machine-on        <= paneltoggle.machine.set      => halui.machine.on
net machine-off       <= paneltoggle.machine.reset    => halui.machine.off