format and clean lcd codes

Ubiquitous/Nuttx_Fusion_XiUOS/aiit_board/xidatong-riscv64/src/k210_lcd.c

@@ -25,10 +25,10 @@
 
 #include "k210_fpioa.h"
 #include "k210_gpiohs.h"
+#include "k210_lcd.h"
 #include "nuttx/arch.h"
 #include "nuttx/lcd/lt768.h"
 #include "nuttx/lcd/lt768_lib.h"
-#include "nuttx/lcd/k210_lcd.h"
 #ifdef CONFIG_LCD_LCDDRV_SPIIF
 #include "nuttx/lcd/lcddrv_spiif.h"
 #endif
@@ -72,6 +72,46 @@ void lcd_backlight_init(bool enable)
     k210_gpiohs_set_value(FPIOA_LCD_BL, enable);
 }
 
+// LCD reset
+void lcd_hw_reset(void)
+{
+    lcd_set_pin(FPIOA_LCD_NRST, GPIO_PV_LOW);
+    up_mdelay(200);
+    lcd_set_pin(FPIOA_LCD_NRST, GPIO_PV_HIGH);
+}
+
+// check LCD reset status
+void lcd_sys_check(void)
+{
+    uint8_t val = 0;
+
+    while(1)
+    {
+        if((LCD_StatusRead() & 0x02) == 0x00)
+        {
+            //for MCU speed too quick
+            up_mdelay(1);
+            LCD_CmdWrite(0x01);
+            up_mdelay(1);
+            val = LCD_DataRead();
+            syslog(LOG_NOTICE, "LCD mdelay 1 [%x]\r\n", val);
+            //check PLL register
+            if((val & 0x80) == 0x80)
+            {
+                break;
+            }
+            else
+            {
+                syslog(LOG_NOTICE, "LCD mdelay 2 [%x]\r\n", val);
+                up_mdelay(2);
+                LCD_CmdWrite(0x01);
+                up_mdelay(1);
+                LCD_DataWrite(0x80);
+            }
+        }
+    }
+}
+
 #ifdef CONFIG_LCD_LCDDRV_SPIIF
 int spiif_backlight(FAR struct lcddrv_lcd_s *lcd, int level)
 {
@@ -164,6 +204,14 @@ void lcd_drv_init(void)
     uint8_t PwmControl = 100;
 
     lcd_pin_init();
+
+    lcd_hw_reset();
+    //delay for LT768 power on
+    up_mdelay(100);
+
+    // check reset ok?
+    lcd_sys_check();
+
     lt768_init();
     Select_SFI_Dual_Mode0();
 

Ubiquitous/Nuttx_Fusion_XiUOS/aiit_board/xidatong-riscv64/src/lcd_demo.c

@@ -33,7 +33,7 @@
 #include "nuttx/arch.h"
 #include "nuttx/lcd/lt768.h"
 #include "nuttx/lcd/lt768_lib.h"
-#include "nuttx/lcd/k210_lcd.h"
+#include "k210_lcd.h"
 
 void LcdDemo(void)
 {