From d84d9f45201b5359ff768757626e0bfe653c8dbb Mon Sep 17 00:00:00 2001
From: Pete Favelle <pete@fsquared.co.uk>
Date: Tue, 31 Jan 2023 12:57:35 +0000
Subject: [PATCH] Added PEN_RGB332 support

---
 libraries/galactic_unicorn/galactic_unicorn.cpp | 15 +++++++++++++++
 1 file changed, 15 insertions(+)

diff --git a/libraries/galactic_unicorn/galactic_unicorn.cpp b/libraries/galactic_unicorn/galactic_unicorn.cpp
index d17de6f1..189f8f8a 100644
--- a/libraries/galactic_unicorn/galactic_unicorn.cpp
+++ b/libraries/galactic_unicorn/galactic_unicorn.cpp
@@ -557,6 +557,21 @@ namespace pimoroni {
           uint8_t b = (col & 0b0000000000011111) << 3;
           p++;
 
+          set_pixel(x, y, r, g, b);
+        }
+      }
+      else if(graphics->pen_type == PicoGraphics::PEN_RGB332) {
+        uint8_t *p = (uint8_t *)graphics->frame_buffer;
+        for(size_t j = 0; j < 53 * 11; j++) {
+          int x = j % 53;
+          int y = j / 53;
+
+          uint8_t col = *p;
+          uint8_t r = (col & 0b11100000);
+          uint8_t g = (col & 0b00011100) << 3;
+          uint8_t b = (col & 0b00000011) << 6;
+          p++;
+
           set_pixel(x, y, r, g, b);
         }
       }