add vibration motor

Author: thijstriemstra

VibrationMotor_PCF8574/VibrationMotor_PCF8574.cpp

@@ -0,0 +1,40 @@
+/*  Copyright (c) 2021, Collab
+ *  All rights reserved
+*/
+
+#include "VibrationMotor_PCF8574.h"
+
+VibrationMotor_PCF8574::VibrationMotor_PCF8574(
+  int switch_pin,
+  MultiPlexer_PCF8574* pcf,
+  unsigned int period
+) {
+  _switchPin = switch_pin;
+  _expander = pcf;
+  _period = period;
+}
+
+void VibrationMotor_PCF8574::begin() {
+  disable();
+}
+
+void VibrationMotor_PCF8574::loop() {
+  if (_enabled) {
+    if ((millis() - _enablePoint) >= _period) {
+      disable();
+    }
+  }
+}
+
+void VibrationMotor_PCF8574::enable() {
+  _enabled = true;
+  _enablePoint = millis();
+
+  _expander->digitalWrite(_switchPin, HIGH);
+}
+
+void VibrationMotor_PCF8574::disable() {
+  _enabled = false;
+
+  _expander->digitalWrite(_switchPin, LOW);
+}

VibrationMotor_PCF8574/VibrationMotor_PCF8574.h

@@ -0,0 +1,32 @@
+/*  Copyright (c) 2021, Collab
+ *  All rights reserved
+*/
+#ifndef VibrationMotor_PCF8574_h
+#define VibrationMotor_PCF8574_h
+
+#include <Arduino.h>
+#include <MultiPlexer_PCF8574.h>
+
+class VibrationMotor_PCF8574
+{
+  public:
+    VibrationMotor_PCF8574(
+      int switch_pin,
+      MultiPlexer_PCF8574* pcf,
+      unsigned int period = 250
+    );
+    void begin();
+    void loop();
+    void enable();
+    void disable();
+
+  private:
+    unsigned int _period;
+    unsigned int _enablePoint;
+    int _switchPin;
+    bool _enabled = false;
+
+    MultiPlexer_PCF8574* _expander;
+};
+
+#endif