1 files changed, 14 insertions, 0 deletions

diff --git a/firmware/screendump.c b/firmware/screendump.c
index 28c37610af..2916cc1c9f 100644
--- a/firmware/screendump.c
+++ b/firmware/screendump.c
@@ -118,6 +118,9 @@ void screen_dump(void)
 #elif LCD_DEPTH <= 16
     unsigned short *dst, *dst_end;
     unsigned short linebuf[DUMP_BMP_LINESIZE/2];
+#else /* 24bit */
+    unsigned char *dst, *dst_end;
+    unsigned char linebuf[DUMP_BMP_LINESIZE * 3];
 #endif
 
 #if CONFIG_RTC
@@ -227,6 +230,17 @@ void screen_dump(void)
 #endif
             }
             while (dst < dst_end);
+#elif LCD_DEPTH == 24
+            dst_end = dst + LCD_WIDTH*3;
+            src = FBADDR(0, y);
+            do
+            {
+                *dst++ = src->b;
+                *dst++ = src->g;
+                *dst++ = src->r;
+                ++src;
+            }
+            while (dst < dst_end);
 
 #endif /* LCD_DEPTH */
             write(fd, linebuf, DUMP_BMP_LINESIZE);