Basic buzzer framework

2017-10-28 19:35:06 +02:00
parent d29f76fa7c
commit 74cb084017
4 changed files with 21 additions and 17 deletions
--- a/txbuzzer.cpp
+++ b/txbuzzer.cpp
@@ -0,0 +1,48 @@
+#include "Arduino.h"
+#include "txbuzzer.h"
+
+void buzzerProcess(uint8_t pin, uint32_t timestamp, BuzzerState_t *buzzer)
+{
+
+    if (!buzzer->enabled)
+    {
+        digitalWrite(pin, LOW);
+        return;
+    }
+
+    if (timestamp > buzzer->updateTime)
+    {
+
+        int8_t currentPattern = buzzer->pattern[buzzer->mode][buzzer->element];
+
+        if (currentPattern == PATTERN_CYCLE_OFF)
+        {
+            digitalWrite(pin, LOW);
+        }
+        else if (currentPattern == PATTERN_CYCLE_ON)
+        {
+            digitalWrite(pin, HIGH);
+        }
+        else if (currentPattern == PATTERN_CYCLE_IGNORE || currentPattern == buzzer->tick)
+        {
+
+            if (currentPattern != PATTERN_CYCLE_IGNORE)
+            {
+                digitalWrite(pin, !digitalRead(pin));
+            }
+
+            buzzer->element++;
+            if (buzzer->element == PATTERN_ELEMENT_NUMBER)
+            {
+                buzzer->element = 0;
+            }
+        }
+
+        buzzer->tick++;
+        if (buzzer->tick >= buzzer->patternMaxTick)
+        {
+            buzzer->tick = 0;
+        }
+        buzzer->updateTime = timestamp + buzzer->patternTickPerdiod;
+    }
+};