From eb680bac897523d62016410b46ace55ea936b1ce Mon Sep 17 00:00:00 2001
From: Eggert Jung <eggert.s.jung@wischhof13.de>
Date: Mon, 4 Apr 2022 15:26:14 +0200
Subject: [PATCH] add direction change on layer finish

---
 spule.c | 18 ++++++++++++++++++
 1 file changed, 18 insertions(+)

diff --git a/spule.c b/spule.c
index 02b4771..2d2948f 100644
--- a/spule.c
+++ b/spule.c
@@ -82,6 +82,24 @@ void do_spule(){
 }
 
 ISR(TIMER1_OVF_vect) {
+    if(ioHelperReadBit(outStates, MOTOR_TRANS_DIR)){
+        spule_trans_pos -= 1;
+        if(spule_trans_homed && spule_trans_pos <= 0){
+            //TCCR1B &= ~(_BV(CS11));
+            //TIMSK5 |= 1<<TOIE5;
+            printf("front stop\n");
+            set_Output(MOTOR_TRANS_DIR, 0); // direction: back
+        }
+    }
+    else{
+        spule_trans_pos += 1;
+        if(spule_trans_pos >= 85000){
+            //TCCR1B &= ~(_BV(CS11));
+            //TIMSK5 |= 1<<TOIE5;
+            printf("end stop\n");
+            set_Output(MOTOR_TRANS_DIR, 1); // direction: front
+        }
+    }
 }
 
 ISR(TIMER5_OVF_vect) {