diff --git a/ql-kernel/threadx/pmic/pmic.c b/ql-kernel/threadx/pmic/pmic.c index 77bfe0a..3b5686c 100644 --- a/ql-kernel/threadx/pmic/pmic.c +++ b/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);