1 files changed, 8 insertions, 3 deletions

diff --git a/firmware/target/coldfire/iaudio/x5/lcd-x5.c b/firmware/target/coldfire/iaudio/x5/lcd-x5.c
index 75ec2462be..1adcf6aaea 100755
--- a/firmware/target/coldfire/iaudio/x5/lcd-x5.c
+++ b/firmware/target/coldfire/iaudio/x5/lcd-x5.c
@@ -38,8 +38,8 @@ static bool display_on=false; /* is the display turned on? */
 /* register defines for the Renesas HD66773R */
 #define R_HORIZ_RAM_ADDR_POS    0x16
 #define R_VERT_RAM_ADDR_POS     0x17
-#define R_RAM_ADDR_SET  0x21
-#define R_WRITE_DATA_2_GRAM 0x22
+#define R_RAM_ADDR_SET          0x21
+#define R_WRITE_DATA_2_GRAM     0x22
 
 /*****************************************************
 The table below was generated by the following script:
@@ -139,7 +139,12 @@ inline void lcd_write_data(const unsigned short* p_bytes, int count)
 
 void lcd_set_contrast(int val)
 {
-    (void)val;
+    if (val >= 15) // val must'nt be 15 or 31
+     ++val; 
+    if (val > 30)
+      return;
+
+    lcd_write_reg(0x0e, 0x201e + (val << 8));
 }
 
 void lcd_set_invert_display(bool yesno)