From f590396e0cd7498f23e942ff05b77f5fe294f1e4 Mon Sep 17 00:00:00 2001
From: Eggert Jung <eggert.s.jung@wischhof13.de>
Date: Mon, 21 Feb 2022 05:29:09 +0100
Subject: [PATCH] add files for spooling motion

---
 main.c  |  2 ++
 spule.c | 30 ++++++++++++++++++++++++++++++
 spule.h |  7 +++++++
 3 files changed, 39 insertions(+)
 create mode 100644 spule.c
 create mode 100644 spule.h

diff --git a/main.c b/main.c
index 7214538..d8d6b53 100644
--- a/main.c
+++ b/main.c
@@ -23,6 +23,7 @@
 #include "kraftsensor.h"
 #include "taenzer.h"
 #include "abzug.h"
+#include "spule.h"
 
 Client mqtt_client;
 
@@ -199,6 +200,7 @@ int main()
         do_notaus();
         do_abzug();
         do_taenzer();
+        do_spule();
 
 #if PLC_MQTT_ENABLED
         ioHelperSetBit(outStates, LED_BUS_OK, 1);
diff --git a/spule.c b/spule.c
new file mode 100644
index 0000000..5de7743
--- /dev/null
+++ b/spule.c
@@ -0,0 +1,30 @@
+#include <avr/io.h>
+#include "avrIOhelper/io-helper.h"
+
+void timer5_init()
+{
+    TCCR5A |= (1<<COM5C1);
+    TCCR5B |= _BV(WGM53);
+
+    ICR5 = 500;
+    OCR5C = 250;
+
+    DDRL |= 1 << 5;
+}
+
+void do_spule(){
+    if (read_Input(BTN_WICKELN_EIN, RISING)) {
+        TCCR5B |= _BV(CS51); //TURN ON
+    }
+    if (read_Input(BTN_WICKELN_AUS, RISING)) {
+        TCCR5B &= ~(_BV(CS51));
+    }
+    if (read_Input(BTN_TAENZER_START, RISING)) {
+        ICR5-=15;
+        OCR5C = ICR5/2;
+    }
+    if (read_Input(BTN_SPULENWECHSEL, RISING)) {
+        ICR5+=15;
+        OCR5C = ICR5/2;
+    }
+}
diff --git a/spule.h b/spule.h
new file mode 100644
index 0000000..f76406b
--- /dev/null
+++ b/spule.h
@@ -0,0 +1,7 @@
+#ifndef _SPULE_H_
+#define _SPULE_H_
+
+void timer5_init(void);
+void do_spule(void);
+
+#endif