add direction change on layer finish

2022-04-04 15:26:14 +02:00
parent 22a8b37713
commit eb680bac89
1 changed files with 18 additions and 0 deletions
--- 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) {