From eed90c55e67d2b13e3f3067374d32fc26917494c Mon Sep 17 00:00:00 2001
From: "D.R.racer" <drracer@drracer.eu>
Date: Thu, 8 Sep 2022 11:37:19 +0200
Subject: [PATCH] Implement Idler moves via registers

---
 src/registers.cpp | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/src/registers.cpp b/src/registers.cpp
index 106c4dd..aa7ab72 100644
--- a/src/registers.cpp
+++ b/src/registers.cpp
@@ -221,7 +221,7 @@ static const RegisterRec registers[] /*PROGMEM*/ = {
     // 0x1c Set/Get Idler slot RW
     RegisterRec(
         []() -> uint16_t { return mi::idler.Slot(); },
-        // [](uint16_t d) { mi::idler.MoveToSlot(d); }, // @@TODO can be theoretically done as well
+        [](uint16_t d) { d >= config::toolCount ? mi::idler.Disengage() : mi::idler.Engage(d); },
         1),
 
 };