test: enable PM807 longkey shutdown

ql-kernel/threadx/pmic/pmic.c

@@ -3741,6 +3741,10 @@ extern void chargeManagePhase2Init(void);
 void PMIC_Phase2Init(void)
 {
     INTC_ReturnCode intcStatus;
+	#if !defined(NOT_SUPPORT_PM807)
+	UINT8 longkey_e3;
+	UINT8 longkey_e4;
+	#endif
 
 	PMIC_UART_DEBUG("PMIC_Phase2Init");
 
@@ -3780,6 +3784,22 @@ void PMIC_Phase2Init(void)
         #if !defined(NOT_SUPPORT_PM807)
         case PMIC_807:
             GuilinLite3ClkInit();
+			longkey_e3 = PMIC_READ_REG_BASE(GUILIN_LITE3_RTC_MISC_3_REG);
+			longkey_e4 = PMIC_READ_REG_BASE(GUILIN_LITE3_CLK_32K_SEL_REG);
+			uart_printf("PM807 LONGKEY before: E3=0x%x time=%ds E4=0x%x en1=%d en2=%d\r\n",
+				longkey_e3, (((longkey_e3 >> 4) & 0x0f) + 1), longkey_e4,
+				!!(longkey_e4 & GUILIN_LITE3_LONGKEY_EN1),
+				!!(longkey_e4 & GUILIN_LITE3_LONGKEY_EN2));
+
+			PM812_SET_LONKEY_PRESS_TIME(10);
+			PM812_LONKEY_ENABLE_SET(GUILIN_LITE3_LONGKEY_1, TRUE);
+
+			longkey_e3 = PMIC_READ_REG_BASE(GUILIN_LITE3_RTC_MISC_3_REG);
+			longkey_e4 = PMIC_READ_REG_BASE(GUILIN_LITE3_CLK_32K_SEL_REG);
+			uart_printf("PM807 LONGKEY after: E3=0x%x time=%ds E4=0x%x en1=%d en2=%d\r\n",
+				longkey_e3, (((longkey_e3 >> 4) & 0x0f) + 1), longkey_e4,
+				!!(longkey_e4 & GUILIN_LITE3_LONGKEY_EN1),
+				!!(longkey_e4 & GUILIN_LITE3_LONGKEY_EN2));
     //        GuilinLite3_VBUCK1_Set_FPWM();
             break;
         #endif
@@ -4231,6 +4251,13 @@ UINT8 PM812_GET_LONKEY_PRESS_TIME(void)
     	return (((tmp >> 4) & 0x0f) + 1);
 	}
 	#endif
+	#if !defined(NOT_SUPPORT_PM807)
+	else if(PMIC_IS_PM807())
+	{
+		tmp = PMIC_READ_REG_BASE(GUILIN_LITE3_RTC_MISC_3_REG);
+		return (((tmp >> 4) & 0x0f) + 1);
+	}
+	#endif
 	else
 	{
 		return tmp;
@@ -4241,6 +4268,10 @@ UINT8 PM812_GET_LONKEY_PRESS_TIME(void)
 void PM812_SET_LONKEY_PRESS_TIME(UINT8 sec)
 {
     UINT8 tmp;
+	#if !defined(NOT_SUPPORT_PM807)
+	UINT8 target;
+	UINT8 bit;
+	#endif
 
     #if !defined(NOT_SUPPORT_PM802)
 	if (PMIC_IS_PM802()||PMIC_IS_PM802S())
@@ -4268,6 +4299,30 @@ void PM812_SET_LONKEY_PRESS_TIME(UINT8 sec)
     	PMIC_WRITE_REG_BASE(NINGBO_RTC_MISC_3_REG,(tmp|sec));
 	}
 	#endif
+	#if !defined(NOT_SUPPORT_PM807)
+	else if(PMIC_IS_PM807())
+	{
+		if ((sec < 1) || (sec > 16))
+		{
+			uart_printf("PM807 invalid LONGKEY time: %d\r\n", sec);
+			return;
+		}
+
+		tmp = PMIC_READ_REG_BASE(GUILIN_LITE3_RTC_MISC_3_REG);
+		target = (tmp & 0x0f) | ((sec - 1) << 4);
+
+		/* RTC_MISC_3 may only accept one changed bit per write. */
+		for (bit = 4; bit < 8; bit++)
+		{
+			if ((tmp ^ target) & (1 << bit))
+			{
+				tmp = (tmp & ~(1 << bit)) | (target & (1 << bit));
+				PMIC_WRITE_REG_BASE(GUILIN_LITE3_RTC_MISC_3_REG, tmp);
+				tmp = PMIC_READ_REG_BASE(GUILIN_LITE3_RTC_MISC_3_REG);
+			}
+		}
+	}
+	#endif
 }
 
 void PM812_LONKEY_ENABLE_SET(UINT8 LONGKEY_NUM,BOOL enable)
@@ -4324,6 +4379,22 @@ void PM812_LONKEY_ENABLE_SET(UINT8 LONGKEY_NUM,BOOL enable)
         }
 	}
 	#endif
+	#if !defined(NOT_SUPPORT_PM807)
+	else if(PMIC_IS_PM807())
+	{
+		tmp = PMIC_READ_REG_BASE(GUILIN_LITE3_CLK_32K_SEL_REG);
+		if(LONGKEY_NUM == GUILIN_LITE3_LONGKEY_1)
+		{
+			enable ? (tmp |= GUILIN_LITE3_LONGKEY_EN1) : (tmp &= (~GUILIN_LITE3_LONGKEY_EN1));
+			PMIC_WRITE_REG_BASE(GUILIN_LITE3_CLK_32K_SEL_REG, tmp);
+		}
+		else if(LONGKEY_NUM == GUILIN_LITE3_LONGKEY_2)
+		{
+			enable ? (tmp |= GUILIN_LITE3_LONGKEY_EN2) : (tmp &= (~GUILIN_LITE3_LONGKEY_EN2));
+			PMIC_WRITE_REG_BASE(GUILIN_LITE3_CLK_32K_SEL_REG, tmp);
+		}
+	}
+	#endif
 }
 
 //LONGKEY_NUM: 1/2
@@ -4352,6 +4423,13 @@ BOOL PM812_LONKEY_ENABLE_GET(UINT8 LONGKEY_NUM)
             ((LONGKEY_NUM==NINGBO_LONGKEY_1)?NINGBO_LONGKEY_EN1:NINGBO_LONGKEY_EN2));
 	}
 	#endif
+	#if !defined(NOT_SUPPORT_PM807)
+	else if(PMIC_IS_PM807())
+	{
+		return (PMIC_READ_REG_BASE(GUILIN_LITE3_CLK_32K_SEL_REG) &
+			((LONGKEY_NUM == GUILIN_LITE3_LONGKEY_1) ? GUILIN_LITE3_LONGKEY_EN1 : GUILIN_LITE3_LONGKEY_EN2));
+	}
+	#endif
 	else
 	{
 		PMIC_UART_DEBUG("PM812_LONKEY_ENABLE_GET: it shouldn't reach here, NUM=%d",LONGKEY_NUM);