add: image

frame/src/display/EPD_7in5_V2.cpp

@@ -0,0 +1,69 @@
+#include "EPD_7in5_V2.hpp"
+
+#include <EPD_7in5_V2.h>
+
+namespace frame::display
+{
+    constexpr uint32_t mWidth  = EPD_7IN5_V2_WIDTH;
+    constexpr uint32_t mHeight = EPD_7IN5_V2_HEIGHT;
+
+    EPD_7in5_V2::EPD_7in5_V2()
+        : IDisplay("EPD_7in5_V2", {mWidth, mHeight})
+    {
+    }
+
+    EPD_7in5_V2::~EPD_7in5_V2()
+    {
+        Sleep();
+    }
+
+    bool EPD_7in5_V2::Init()
+    {
+        return EPD_7IN5_V2_Init() == 0;
+    }
+
+    void EPD_7in5_V2::Clear(Color color)
+    {
+        if(color == Color::WHITE)
+        {
+            EPD_7IN5_V2_Clear()
+        } else
+        {
+            EPD_7IN5_V2_ClearBlack();
+        }
+    }
+
+    void EPD_7in5_V2::Display(Image const& image)
+    {
+        constexpr auto bytes_width = mWidth / 8;
+        std::vector<uint8_t> data(bytes_with * mHeight);
+
+        uint8_t bit_counter;
+
+        for(auto y = 0; y < mHeight; ++y)
+        {
+            for(auto x = 0; x < bytes_width; ++x)
+            {
+                uint8_t byte = 0;
+                for(auto bit = 0; bit < 8; ++bit)
+                {
+                    if(image.at(x * 8 + bit, y) > 265 / 2)
+                    {
+                        byte ^= 1;
+                    }
+                    byte << 1;
+                }
+
+                data[bytes_width * y + x] = byte;
+            }
+        }
+
+        EPD_7IN5_V2_Display(data.data());
+    }
+
+    void EPD_7in5_V2::Sleep()
+    {
+        EPD_7IN5_V2_Sleep();
+    }
+
+} // namespace frame::display