3 files changed, 35 insertions, 5 deletions

diff --git a/firmware/export/config-mrobe500.h b/firmware/export/config-mrobe500.h
index 25699bd005..08f8ba07e8 100644
--- a/firmware/export/config-mrobe500.h
+++ b/firmware/export/config-mrobe500.h
@@ -44,6 +44,8 @@
 /* define this if you want album art for this target */
 //#define HAVE_ALBUMART
 
+#define HAVE_LCD_MODES LCD_MODE_RGB565 | LCD_MODE_YUV | LCD_MODE_PAL256
+
 /* define this if you have access to the quickscreen */
 #define HAVE_QUICKSCREEN
 
diff --git a/firmware/export/lcd.h b/firmware/export/lcd.h
index e34fac5d31..4f35927353 100644
--- a/firmware/export/lcd.h
+++ b/firmware/export/lcd.h
@@ -92,6 +92,13 @@ typedef unsigned long fb_data;
 typedef unsigned char fb_data;
 #endif
 
+#if defined(HAVE_LCD_MODES)
+void lcd_set_mode(int mode);
+#define LCD_MODE_RGB565 0x00000001
+#define LCD_MODE_YUV    0x00000002
+#define LCD_MODE_PAL256 0x00000004
+#endif
+
 /* common functions */
 extern void lcd_write_command(int byte);
 extern void lcd_write_command_e(int cmd, int data);
diff --git a/firmware/target/arm/tms320dm320/mrobe-500/lcd-mr500.c b/firmware/target/arm/tms320dm320/mrobe-500/lcd-mr500.c
index 0357b469d9..3fa8a7e6c1 100644
--- a/firmware/target/arm/tms320dm320/mrobe-500/lcd-mr500.c
+++ b/firmware/target/arm/tms320dm320/mrobe-500/lcd-mr500.c
@@ -256,6 +256,7 @@ void lcd_update(void)
 {
     if (!lcd_on)
         return;
+        
 #if CONFIG_ORIENTATION == SCREEN_PORTRAIT
     lcd_copy_buffer_rect((fb_data *)FRAME, &lcd_framebuffer[0][0],
                          LCD_WIDTH*LCD_HEIGHT, 1);
@@ -264,6 +265,30 @@ void lcd_update(void)
 #endif
 }
 
+#if defined(HAVE_LCD_MODES)
+void lcd_set_mode(int mode)
+{
+        if(mode==LCD_MODE_YUV)
+        {
+                /* Turn off the RGB buffer and enable the YUV buffer */
+                IO_OSD_OSDWINMD0&=~(0x01);
+                IO_OSD_VIDWINMD|=0x01;
+                memset16(FRAME, 0x0080, LCD_WIDTH*LCD_HEIGHT);
+        }
+        else if(mode==LCD_MODE_RGB565)
+        {
+                /* Turn on the RGB window and the YUV window off (This should probably be
+         * made into a function).
+         */
+        IO_OSD_OSDWINMD0|=0x01;
+                IO_OSD_VIDWINMD&=~(0x01);
+        }
+        else if(mode==LCD_MODE_PAL256)
+        {
+        }
+}
+#endif
+        
 void lcd_blit_yuv(unsigned char * const src[3],
                   int src_x, int src_y, int stride,
                   int x, int y, int width, 
@@ -280,13 +305,9 @@ void lcd_blit_yuv(unsigned char * const src[3],
     unsigned char const * yuv_src[3];
     off_t z;
 
-        /* Turn off the RGB buffer and enable the YUV buffer */
-        IO_OSD_OSDWINMD0&=~(0x01);
-        IO_OSD_VIDWINMD|=0x01;
-
     if (!lcd_on)
         return;
-        
+        
     /* y has to be at multiple of 2 or else it will mess up the HW (interleaving) */
     y &= ~1;