1 files changed, 10 insertions, 1 deletions
diff --git a/lcd.c b/lcd.c
index b6d0ece..0ec8e38 100755
--- a/lcd.c
+++ b/lcd.c
@@ -65,6 +65,9 @@ void Lcd_Init() {
     Lcd_Cmd(0x03);
     /////////////////////////////////////////////////////
     Lcd_Cmd(0x02);
+#ifdef VFD
+    Vfd_Set_Brightness(0);  //Set brightness to max
+#endif
     Lcd_Cmd(0x02);
     Lcd_Cmd(0x08);
     Lcd_Cmd(0x00);
@@ -105,6 +108,12 @@ void Lcd_Shift_Left() {
 }
 
 // For some VFD's like Noritake
+
 void Vfd_Set_Brightness(int level) {
-    
+    Lcd_Cmd(0x03);
+    __delay_ms(11);
+    Lcd_Cmd(0x03);
+    /////////////////////////////////////////////////////
+    Lcd_Cmd(0x02);
+    Lcd_Write_Char(level);
 }
 \ No newline at end of file