1 files changed, 26 insertions, 1 deletions

diff --git a/src/main.c b/src/main.c
index 3ecfa71..f2ffa5b 100644
--- a/src/main.c
+++ b/src/main.c
@@ -30,6 +30,16 @@ console_talk(Device *d, u8 b0, u8 w) {
     }
 }
 
+static void
+docolors(Device *d) {
+        for(size_t i = 0; i < 4; ++i) {
+                u8 r = ((d->dat[0x8 + i / 2] >> (!(i % 2) << 2)) & 0x0f) * 0x11;
+                u8 g = ((d->dat[0xa + i / 2] >> (!(i % 2) << 2)) & 0x0f) * 0x11;
+                u8 b = ((d->dat[0xc + i / 2] >> (!(i % 2) << 2)) & 0x0f) * 0x11;
+                palette[i] = (b << 16) | (g << 8) | r;
+        }
+}
+
 void
 system_talk(Device *d, u8 b0, u8 w) {
     // uart_puts("system_talk\n");
@@ -46,7 +56,7 @@ system_talk(Device *d, u8 b0, u8 w) {
                 case 0xf: d->u->ram.ptr = 0x0000; break;
                 }
                 if(b0 > 0x7 && b0 < 0xe) {
-                        // docolors(d); TODO
+                        docolors(d);
         }
         }
     (void)b0;
@@ -155,5 +165,20 @@ void main(void) {
     while(1) {
         // Echo input to standard output.
         uxn_eval(&u, mempeek16(devscreen->dat, 0));
+
+        // DEBUG: testing fb drawing.
+        u32 lines = SCREEN_WIDTH * SCREEN_HEIGHT / 4;
+        for (size_t i = 0; i < lines; i++) {
+            framebuffer[i] = palette[0];
+        }
+        for (size_t i = lines; i < lines * 2; i++) {
+            framebuffer[i] = palette[1];
+        }
+        for (size_t i = lines * 2; i < lines * 3; i++) {
+            framebuffer[i] = palette[2];
+        }
+        for (size_t i = lines * 3; i < lines * 4; i++) {
+            framebuffer[i] = palette[3];
+        }
     }
 }