From 7fae539f14f8dcff6c25ae7eb8bab4d4c4df3081 Mon Sep 17 00:00:00 2001
From: jonny_ji7 <jonny@wwad.de>
Date: Wed, 17 Aug 2022 14:03:15 +0200
Subject: [PATCH] Add vfd driver, Add vfd test via buttons

Add vfd.cpp/hpp with functions to control the VFD via 4 digital pins
Add way to test the vfd via SET button (rotate speed level) and START
button (toggle motor on/off)
---
 main/CMakeLists.txt |  1 +
 main/control.cpp    | 25 +++++++++++++---
 main/control.hpp    |  1 +
 main/vfd.cpp        | 70 +++++++++++++++++++++++++++++++++++++++++++++
 main/vfd.hpp        | 19 ++++++++++++
 5 files changed, 112 insertions(+), 4 deletions(-)
 create mode 100644 main/vfd.cpp
 create mode 100644 main/vfd.hpp

diff --git a/main/CMakeLists.txt b/main/CMakeLists.txt
index c2918bd..2ba0eee 100644
--- a/main/CMakeLists.txt
+++ b/main/CMakeLists.txt
@@ -4,6 +4,7 @@ idf_component_register(
         "config.cpp"
         "control.cpp"
         "buzzer.cpp"
+        "vfd.cpp"
     INCLUDE_DIRS 
         "."
     )
diff --git a/main/control.cpp b/main/control.cpp
index 61bc176..4a0aefb 100644
--- a/main/control.cpp
+++ b/main/control.cpp
@@ -110,6 +110,7 @@ rotary_encoder_info_t encoder; //encoder device/info
 uint8_t count = 0; //count for testing
 uint32_t timestamp_pageSwitched = 0;
 bool page = false; //store page number currently displayed
+bool state = false; //store state of motor
 
                       
            
@@ -153,16 +154,32 @@ void task_control(void *pvParameter)
             display_current_distance(&display, &encoder);
         } else {
             //display counter
-            sprintf(display_buf, "cnt: %02d", count);
+            sprintf(display_buf, "lvl: %02d", count);
             max7219_draw_text_7seg(&display, 0, display_buf);
-            count++;
+            //count++;
         }
 
-        //test button
-        if(SW_START.risingEdge){
+
+        //testing: rotate through speed levels
+        if(SW_SET.risingEdge){
+            //rotate count 0-7
+            if (count >= 7){
+                count = 0;
+            } else {
+                count ++;
+            }
+            //set motor level
+            vfd_setSpeedLevel(count);
             buzzer.beep(1, 100, 100);
         }
 
+
+        //testing: toggle motor state
+        if(SW_START.risingEdge){
+            state = !state;
+            vfd_setState(state);
+            buzzer.beep(1, 500, 100);
+        }
     }
 
 }
diff --git a/main/control.hpp b/main/control.hpp
index 29e1cfb..b097120 100644
--- a/main/control.hpp
+++ b/main/control.hpp
@@ -16,6 +16,7 @@ extern "C"
 #include "config.hpp"
 #include "gpio_evaluateSwitch.hpp"
 #include "buzzer.hpp"
+#include "vfd.hpp"
 
 
 
diff --git a/main/vfd.cpp b/main/vfd.cpp
new file mode 100644
index 0000000..b49f68b
--- /dev/null
+++ b/main/vfd.cpp
@@ -0,0 +1,70 @@
+#include "vfd.hpp"
+
+#define CHECK_BIT(var,pos) (((var)>>(pos)) & 1)
+
+static const char *TAG = "vfd";
+
+
+
+void vfd_setState(bool state){
+    if (state == true) {
+        gpio_set_level(GPIO_VFD_FWD, 1);
+        gpio_set_level(GPIO_RELAY, 1);
+    } else {
+        gpio_set_level(GPIO_VFD_FWD, 0);
+        gpio_set_level(GPIO_RELAY, 0);
+    }
+    ESP_LOGI(TAG, "set state to %i", (int)state);
+}
+
+
+
+void vfd_setSpeedLevel(uint8_t level){
+    //limit to 7
+    if (level > 7) {
+        level = 7;
+    }
+
+    //bit:2  1  0
+    //lvl D0 D1 D2
+    //0   0  0  0
+    //1   0  0  1
+    //2   0  1  0
+    //3   0  1  1
+    //4   1  0  0
+    //5   1  0  1
+    //6   1  1  0
+    //7   1  1  1
+
+    //variables for logging the pin state
+    bool D0, D1, D2;
+
+    //set output state according to corresponding bit state
+    if CHECK_BIT(level, 0) {
+        D2 = true;
+        gpio_set_level(GPIO_VFD_D2, 1);        
+    } else {
+        D2 = false;
+        gpio_set_level(GPIO_VFD_D2, 0);        
+    }
+        
+    if CHECK_BIT(level, 1) {
+        D1 = true;
+        gpio_set_level(GPIO_VFD_D1, 1);        
+    } else {
+        D1 = false;
+        gpio_set_level(GPIO_VFD_D1, 0);        
+    }
+
+    if CHECK_BIT(level, 2) {
+        D0 = true;
+        gpio_set_level(GPIO_VFD_D0, 1);        
+    } else {
+        D0 = false;
+        gpio_set_level(GPIO_VFD_D0, 0);        
+    }
+
+    //log
+    ESP_LOGI(TAG, "Set level to %d", level);
+    ESP_LOGI(TAG, "pin state: D0=%i, D1=%i, D2=%i", (int)D0, (int)D1, (int)D2);
+}
diff --git a/main/vfd.hpp b/main/vfd.hpp
new file mode 100644
index 0000000..8c257d4
--- /dev/null
+++ b/main/vfd.hpp
@@ -0,0 +1,19 @@
+#pragma once
+extern "C"
+{
+#include <stdio.h>
+#include <freertos/FreeRTOS.h>
+#include <freertos/task.h>
+#include "freertos/queue.h"
+#include "esp_system.h"
+#include "esp_log.h"
+}
+
+#include "config.hpp"
+
+
+//function for setting the state (run or stop)
+void vfd_setState(bool state);
+
+//function for setting the speed level (1-7)
+void vfd_setSpeedLevel(uint8_t level = 0);