Merge pull request #2690 from adafruit/qualia_ornament

Adding code and UF2 for the qualia ornament

Author: BlitzCityDIY

Qualia/Qualia_S3_OrnamentVideoPlayer/.none.test.only

@@ -0,0 +1,210 @@
+// SPDX-FileCopyrightText: 2023 Limor Fried for Adafruit Industries
+//
+// SPDX-License-Identifier: MIT
+
+/*******************************************************************************
+ * ESP32_JPEG Wrapper Class
+ *
+ * Dependent libraries:
+ * ESP32_JPEG: https://github.com/esp-arduino-libs/ESP32_JPEG.git
+ ******************************************************************************/
+#pragma once
+
+#if defined(ESP32)
+
+#define READ_BUFFER_SIZE 1024
+#define MAXOUTPUTSIZE (MAX_BUFFERED_PIXELS / 16 / 16)
+
+#include <FS.h>
+
+#include <ESP32_JPEG_Library.h>
+
+class MjpegClass
+{
+public:
+  bool setup(
+      Stream *input, uint8_t *mjpeg_buf,
+      uint16_t *output_buf, size_t output_buf_size, bool useBigEndian)
+  {
+    _input = input;
+    _mjpeg_buf = mjpeg_buf;
+    _output_buf = (uint8_t *)output_buf;
+    _output_buf_size = output_buf_size;
+    _useBigEndian = useBigEndian;
+    _inputindex = 0;
+
+    if (!_read_buf)
+    {
+      _read_buf = (uint8_t *)malloc(READ_BUFFER_SIZE);
+    }
+
+    if (!_read_buf)
+    {
+      return false;
+    }
+
+    return true;
+  }
+
+  bool readMjpegBuf()
+  {
+    if (_inputindex == 0)
+    {
+      _buf_read = _input->readBytes(_read_buf, READ_BUFFER_SIZE);
+      _inputindex += _buf_read;
+    }
+    _mjpeg_buf_offset = 0;
+    int i = 0;
+    bool found_FFD8 = false;
+    while ((_buf_read > 0) && (!found_FFD8))
+    {
+      i = 0;
+      while ((i < _buf_read) && (!found_FFD8))
+      {
+        if ((_read_buf[i] == 0xFF) && (_read_buf[i + 1] == 0xD8)) // JPEG header
+        {
+          // Serial.printf("Found FFD8 at: %d.\n", i);
+          found_FFD8 = true;
+        }
+        ++i;
+      }
+      if (found_FFD8)
+      {
+        --i;
+      }
+      else
+      {
+        _buf_read = _input->readBytes(_read_buf, READ_BUFFER_SIZE);
+      }
+    }
+    uint8_t *_p = _read_buf + i;
+    _buf_read -= i;
+    bool found_FFD9 = false;
+    if (_buf_read > 0)
+    {
+      i = 3;
+      while ((_buf_read > 0) && (!found_FFD9))
+      {
+        if ((_mjpeg_buf_offset > 0) && (_mjpeg_buf[_mjpeg_buf_offset - 1] == 0xFF) && (_p[0] == 0xD9)) // JPEG trailer
+        {
+          // Serial.printf("Found FFD9 at: %d.\n", i);
+          found_FFD9 = true;
+        }
+        else
+        {
+          while ((i < _buf_read) && (!found_FFD9))
+          {
+            if ((_p[i] == 0xFF) && (_p[i + 1] == 0xD9)) // JPEG trailer
+            {
+              found_FFD9 = true;
+              ++i;
+            }
+            ++i;
+          }
+        }
+
+        // Serial.printf("i: %d\n", i);
+        memcpy(_mjpeg_buf + _mjpeg_buf_offset, _p, i);
+        _mjpeg_buf_offset += i;
+        size_t o = _buf_read - i;
+        if (o > 0)
+        {
+          // Serial.printf("o: %d\n", o);
+          memcpy(_read_buf, _p + i, o);
+          _buf_read = _input->readBytes(_read_buf + o, READ_BUFFER_SIZE - o);
+          _p = _read_buf;
+          _inputindex += _buf_read;
+          _buf_read += o;
+          // Serial.printf("_buf_read: %d\n", _buf_read);
+        }
+        else
+        {
+          _buf_read = _input->readBytes(_read_buf, READ_BUFFER_SIZE);
+          _p = _read_buf;
+          _inputindex += _buf_read;
+        }
+        i = 0;
+      }
+      if (found_FFD9)
+      {
+        return true;
+      }
+    }
+
+    return false;
+  }
+
+  bool decodeJpg()
+  {
+    _remain = _mjpeg_buf_offset;
+
+    // Generate default configuration
+    jpeg_dec_config_t config = {
+        .output_type = JPEG_RAW_TYPE_RGB565_BE,
+        .rotate = JPEG_ROTATE_0D,
+    };
+    // Create jpeg_dec
+    _jpeg_dec = jpeg_dec_open(&config);
+
+    // Create io_callback handle
+    _jpeg_io = (jpeg_dec_io_t *)calloc(1, sizeof(jpeg_dec_io_t));
+
+    // Create out_info handle
+    _out_info = (jpeg_dec_header_info_t *)calloc(1, sizeof(jpeg_dec_header_info_t));
+
+    // Set input buffer and buffer len to io_callback
+    _jpeg_io->inbuf = _mjpeg_buf;
+    _jpeg_io->inbuf_len = _remain;
+
+    jpeg_dec_parse_header(_jpeg_dec, _jpeg_io, _out_info);
+
+    _w = _out_info->width;
+    _h = _out_info->height;
+
+    if ((_w * _h * 2) > _output_buf_size)
+    {
+      return false;
+    }
+    _jpeg_io->outbuf = _output_buf;
+
+    jpeg_dec_process(_jpeg_dec, _jpeg_io);
+    jpeg_dec_close(_jpeg_dec);
+
+    free(_jpeg_io);
+    free(_out_info);
+
+    return true;
+  }
+
+  int16_t getWidth()
+  {
+    return _w;
+  }
+
+  int16_t getHeight()
+  {
+    return _h;
+  }
+
+private:
+  Stream *_input;
+  uint8_t *_mjpeg_buf;
+  uint8_t *_output_buf;
+  size_t _output_buf_size;
+  bool _useBigEndian;
+
+  uint8_t *_read_buf;
+  int32_t _mjpeg_buf_offset = 0;
+
+  jpeg_dec_handle_t *_jpeg_dec;
+  jpeg_dec_io_t *_jpeg_io;
+  jpeg_dec_header_info_t *_out_info;
+
+  int16_t _w = 0, _h = 0;
+
+  int32_t _inputindex = 0;
+  int32_t _buf_read;
+  int32_t _remain = 0;
+};
+
+#endif // defined(ESP32)