Electronic spindle gearbox

component ebox "electronic gearbox component";
licence "GPL";

pin in bit spindle-on-in;
pin out bit spindle-on-out;
pin in float spindle-speed;
pin out bit relay1;
pin out bit relay2;
pin out bit relay3;

function _;

;;

FUNCTION(_){
static int timer;
static double last_speed = -100;

if (timer > 0){
    timer -= 1;
    spindle_on_out = 0;
} else {
    spindle_on_out = spindle_on_in;
}

 // Only do anything if the spindle speed has changed

if ( absf(spindle_speed - last_speed) < 50) return;

if (spindle_speed >= 2500){
    relay1 = 0;
    relay 2 = 0;
    relay 3 = 1;
    spindle_on_out = 0;
    timer = 2000;
} else if (spindle_speed < 1200) {
    relay1 = 1;
    relay 2 = 0;
    relay 3 = 0;
    spindle_on_out = 0;
    timer = 2000;
} else {
    relay1 = 0;
    relay 2 = 1;
    relay 3 = 0;
    spindle_on_out = 0;
    timer = 2000;
}
}