From 0378d53456011b5e8ee57fcd7a3af7b7064ecbf9 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Bart=C5=82omiej=20Przemys=C5=82aw=20Pluta?=
 <noreply.git@mx.bartlomiejpluta.com>
Date: Sun, 8 Nov 2020 13:02:08 +0100
Subject: [PATCH] Create library for software timers and enable it

---
 main.c   |  3 ++-
 ptimer.c | 23 +++++++++++++++++++++++
 ptimer.h | 10 ++++++++++
 3 files changed, 35 insertions(+), 1 deletion(-)
 create mode 100644 ptimer.c
 create mode 100644 ptimer.h

diff --git a/main.c b/main.c
index 0c1242a..ddb911f 100644
--- a/main.c
+++ b/main.c
@@ -1,6 +1,6 @@
 #include <avr/io.h>
 #include <avr/interrupt.h>
-#include <util/delay.h>
+#include "ptimer.h"
 #include "i2c.h"
 #include "rtc.h"
 #include "led.h"
@@ -11,6 +11,7 @@
 
 int main() 
 {
+  ptimer_init();
   i2c_init(I2C_BITRATE); 
   rtc_int0_init();
   led_init();
diff --git a/ptimer.c b/ptimer.c
new file mode 100644
index 0000000..f3b4e70
--- /dev/null
+++ b/ptimer.c
@@ -0,0 +1,23 @@
+#include <avr/io.h>
+#include <avr/interrupt.h>
+#include "ptimer.h"
+
+volatile uint16_t timers[TIMERS_COUNT];
+
+void ptimer_init(void)
+{
+  for(uint8_t i=0; i<TIMERS_COUNT; ++i) timers[i] = 0;
+
+  TCCR2 |= (1<<WGM21); // CTC Mode
+	TCCR2 |= (1<<CS22) | (1<<CS21) | (1<<CS20); // Prescaler 1024
+	OCR2 = 78; // ~100Hz
+	TIMSK |= (1<<OCIE2); // Enable CTC interruptions
+}
+
+ISR(TIMER2_COMP_vect)
+{
+  for(uint8_t i=0; i<TIMERS_COUNT; ++i)
+  {
+    if(timers[i]) --timers[i];
+  }  
+}
\ No newline at end of file
diff --git a/ptimer.h b/ptimer.h
new file mode 100644
index 0000000..d22e284
--- /dev/null
+++ b/ptimer.h
@@ -0,0 +1,10 @@
+#ifndef __PTIMER_H__
+#define __PTIMER_H__
+
+#define TIMERS_COUNT 0
+
+extern volatile uint16_t timers[TIMERS_COUNT];
+
+void ptimer_init(void);
+
+#endif
\ No newline at end of file