From d0af74c7de15e89d17ea4b6c10ffe0bf8d9f5e40 Mon Sep 17 00:00:00 2001
From: LongHairedHacker <sebastian@sebastians-site.de>
Date: Mon, 21 Nov 2016 13:10:14 +0100
Subject: [PATCH] Added timer code for timeouts

---
 software/Arduino/ardusss7.cpp | 13 ++++++++++++-
 1 file changed, 12 insertions(+), 1 deletion(-)

diff --git a/software/Arduino/ardusss7.cpp b/software/Arduino/ardusss7.cpp
index cd13535..9962df9 100644
--- a/software/Arduino/ardusss7.cpp
+++ b/software/Arduino/ardusss7.cpp
@@ -68,4 +68,15 @@ ISR(USART_TXC1_vect) {
 	sss7_process_tx();
 }
 
-//TODO: Setup Timer
+
+void SSS7Wrapper::setupTimer() {
+	TCNT4 = 65535 - 16000;	//Preload for 16000 ticks to overflow
+	TIMSK4 |= (1 << TOIE0);
+	TCCR4B = (1 << CS40);	// Prescaler 1
+}
+
+ISR(TIMER4_OVF_vect) {
+	TCNT4 = 65535 - 16000;	//Preload for 16000 ticks to overflow
+
+	sss7_process_ticks(sss7_timeout_increment);
+}