230 lines
5.9 KiB
C
230 lines
5.9 KiB
C
|
/*
|
||
|
* SPDX-License-Identifier: GPL-2.0
|
||
|
*
|
||
|
* Copyright (c) 2019 MediaTek Inc.
|
||
|
*/
|
||
|
|
||
|
#include <linux/of.h>
|
||
|
#include <linux/of_address.h>
|
||
|
#include <linux/of_irq.h>
|
||
|
#ifdef CONFIG_MTK_PMIC_NEW_ARCH
|
||
|
#include <mt-plat/upmu_common.h>
|
||
|
#endif
|
||
|
#include <kpd.h>
|
||
|
#include <hal_kpd.h>
|
||
|
#include <mt-plat/mtk_boot_common.h>
|
||
|
|
||
|
#ifdef CONFIG_MTK_PMIC_NEW_ARCH /*for pmic not ready*/
|
||
|
static int kpd_enable_lprst = 1;
|
||
|
#endif
|
||
|
static u16 kpd_keymap_state[KPD_NUM_MEMS] = {
|
||
|
0xffff, 0xffff, 0xffff, 0xffff, 0x00ff
|
||
|
};
|
||
|
|
||
|
static void enable_kpd(int enable)
|
||
|
{
|
||
|
if (enable == 1) {
|
||
|
mt_reg_sync_writew((u16) (enable), KP_EN);
|
||
|
kpd_print("KEYPAD is enabled\n");
|
||
|
} else if (enable == 0) {
|
||
|
mt_reg_sync_writew((u16) (enable), KP_EN);
|
||
|
kpd_print("KEYPAD is disabled\n");
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void kpd_get_keymap_state(u16 state[])
|
||
|
{
|
||
|
state[0] = readw(KP_MEM1);
|
||
|
state[1] = readw(KP_MEM2);
|
||
|
state[2] = readw(KP_MEM3);
|
||
|
state[3] = readw(KP_MEM4);
|
||
|
state[4] = readw(KP_MEM5);
|
||
|
kpd_print(KPD_SAY "register = %x %x %x %x %x\n",
|
||
|
state[0], state[1], state[2], state[3], state[4]);
|
||
|
|
||
|
}
|
||
|
|
||
|
/********************************************************************/
|
||
|
void long_press_reboot_function_setting(void)
|
||
|
{
|
||
|
#ifdef CONFIG_MTK_PMIC_NEW_ARCH /*for pmic not ready*/
|
||
|
/* unlock PMIC protect key */
|
||
|
pmic_set_register_value(PMIC_RG_CPS_W_KEY, 0x4729);
|
||
|
if (kpd_enable_lprst && get_boot_mode() == NORMAL_BOOT) {
|
||
|
kpd_info("Normal Boot long press reboot selection\n");
|
||
|
|
||
|
#ifdef CONFIG_KPD_PMIC_LPRST_TD
|
||
|
kpd_info("Enable normal mode LPRST\n");
|
||
|
#ifdef CONFIG_ONEKEY_REBOOT_NORMAL_MODE
|
||
|
/*POWERKEY*/
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_KEY_MODE, 0x00);
|
||
|
#elif defined(CONFIG_TWOKEY_REBOOT_NORMAL_MODE)
|
||
|
/*PWRKEY + HOMEKEY*/
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_KEY_MODE, 0x01);
|
||
|
#endif
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_TD,
|
||
|
CONFIG_KPD_PMIC_LPRST_TD);
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x01);
|
||
|
#else
|
||
|
kpd_info("disable normal mode LPRST\n");
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x00);
|
||
|
#endif
|
||
|
} else {
|
||
|
kpd_info("Other Boot Mode long press reboot selection\n");
|
||
|
|
||
|
#ifdef CONFIG_KPD_PMIC_LPRST_TD
|
||
|
kpd_info("Enable other mode LPRST\n");
|
||
|
|
||
|
#ifdef CONFIG_ONEKEY_REBOOT_NORMAL_MODE
|
||
|
/*POWERKEY*/
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_KEY_MODE, 0x00);
|
||
|
#elif defined(CONFIG_TWOKEY_REBOOT_NORMAL_MODE)
|
||
|
/*PWRKEY + HOMEKEY*/
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_KEY_MODE, 0x01);
|
||
|
#endif
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_TD,
|
||
|
CONFIG_KPD_PMIC_LPRST_TD);
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x01);
|
||
|
#else
|
||
|
kpd_info("disable normal mode LPRST\n");
|
||
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x00);
|
||
|
#endif
|
||
|
|
||
|
}
|
||
|
/* lock PMIC protect key */
|
||
|
pmic_set_register_value(PMIC_RG_CPS_W_KEY, 0);
|
||
|
#endif
|
||
|
}
|
||
|
|
||
|
/* FM@suspend */
|
||
|
bool __attribute__ ((weak)) ConditionEnterSuspend(void)
|
||
|
{
|
||
|
return true;
|
||
|
}
|
||
|
|
||
|
/********************************************************************/
|
||
|
void kpd_wakeup_src_setting(int enable)
|
||
|
{
|
||
|
int is_fm_radio_playing = 0;
|
||
|
|
||
|
/* If FM is playing, keep keypad as wakeup source */
|
||
|
if (ConditionEnterSuspend() == true)
|
||
|
is_fm_radio_playing = 0;
|
||
|
else
|
||
|
is_fm_radio_playing = 1;
|
||
|
|
||
|
if (is_fm_radio_playing == 0) {
|
||
|
if (enable == 1) {
|
||
|
kpd_print("enable kpd work!\n");
|
||
|
enable_kpd(1);
|
||
|
} else {
|
||
|
kpd_print("disable kpd work!\n");
|
||
|
enable_kpd(0);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/********************************************************************/
|
||
|
void kpd_init_keymap(u32 keymap[])
|
||
|
{
|
||
|
int i = 0;
|
||
|
|
||
|
if (kpd_dts_data.kpd_use_extend_type)
|
||
|
kpd_keymap_state[4] = 0xffff;
|
||
|
for (i = 0; i < KPD_NUM_KEYS; i++)
|
||
|
keymap[i] = kpd_dts_data.kpd_hw_init_map[i];
|
||
|
}
|
||
|
|
||
|
void kpd_init_keymap_state(u16 keymap_state[])
|
||
|
{
|
||
|
int i = 0;
|
||
|
|
||
|
for (i = 0; i < KPD_NUM_MEMS; i++)
|
||
|
keymap_state[i] = kpd_keymap_state[i];
|
||
|
kpd_info("init_keymap_state done: %x %x %x %x %x!\n",
|
||
|
keymap_state[0], keymap_state[1], keymap_state[2],
|
||
|
keymap_state[3], keymap_state[4]);
|
||
|
}
|
||
|
|
||
|
/********************************************************************/
|
||
|
|
||
|
void kpd_set_debounce(u16 val)
|
||
|
{
|
||
|
mt_reg_sync_writew((u16) (val & KPD_DEBOUNCE_MASK), KP_DEBOUNCE);
|
||
|
}
|
||
|
|
||
|
|
||
|
void kpd_double_key_enable(int en)
|
||
|
{
|
||
|
u16 tmp;
|
||
|
|
||
|
tmp = *(u16 *)KP_SEL;
|
||
|
if (en != 0)
|
||
|
writew((u16) (tmp | KPD_DOUBLE_KEY_MASK), KP_SEL);
|
||
|
else
|
||
|
writew((u16) (tmp & ~KPD_DOUBLE_KEY_MASK), KP_SEL);
|
||
|
}
|
||
|
|
||
|
/********************************************************************/
|
||
|
void kpd_pmic_rstkey_hal(unsigned long pressed)
|
||
|
{
|
||
|
if (kpd_dts_data.kpd_sw_rstkey != 0) {
|
||
|
input_report_key(kpd_input_dev, kpd_dts_data.kpd_sw_rstkey,
|
||
|
pressed);
|
||
|
input_sync(kpd_input_dev);
|
||
|
kpd_print(KPD_SAY "(%s) HW keycode =%d using PMIC\n",
|
||
|
pressed ? "pressed" : "released",
|
||
|
kpd_dts_data.kpd_sw_rstkey);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
void kpd_pmic_pwrkey_hal(unsigned long pressed)
|
||
|
{
|
||
|
input_report_key(kpd_input_dev, kpd_dts_data.kpd_sw_pwrkey, pressed);
|
||
|
input_sync(kpd_input_dev);
|
||
|
kpd_print(KPD_SAY "(%s) HW keycode =%d using PMIC\n",
|
||
|
pressed ? "pressed" : "released", kpd_dts_data.kpd_sw_pwrkey);
|
||
|
}
|
||
|
|
||
|
static int mrdump_eint_state;
|
||
|
static int mrdump_ext_rst_irq;
|
||
|
static irqreturn_t mrdump_rst_eint_handler(int irq, void *data)
|
||
|
{
|
||
|
/* bool pressed; */
|
||
|
|
||
|
if (mrdump_eint_state == 0) {
|
||
|
irq_set_irq_type(mrdump_ext_rst_irq, IRQ_TYPE_LEVEL_HIGH);
|
||
|
mrdump_eint_state = 1;
|
||
|
} else {
|
||
|
irq_set_irq_type(mrdump_ext_rst_irq, IRQ_TYPE_LEVEL_LOW);
|
||
|
mrdump_eint_state = 0;
|
||
|
}
|
||
|
|
||
|
input_report_key(kpd_input_dev, KEY_RESTART, mrdump_eint_state);
|
||
|
input_sync(kpd_input_dev);
|
||
|
|
||
|
return IRQ_HANDLED;
|
||
|
}
|
||
|
/**********************************************************************/
|
||
|
void mt_eint_register(void)
|
||
|
{
|
||
|
int ret;
|
||
|
struct device_node *node;
|
||
|
|
||
|
/* register EINT handler for MRDUMP_EXT_RST key */
|
||
|
node = of_find_compatible_node(NULL, NULL,
|
||
|
"mediatek, mrdump_ext_rst-eint");
|
||
|
if (!node)
|
||
|
kpd_print("can't find compatible node\n");
|
||
|
else {
|
||
|
mrdump_ext_rst_irq = irq_of_parse_and_map(node, 0);
|
||
|
ret = request_irq(mrdump_ext_rst_irq, mrdump_rst_eint_handler,
|
||
|
IRQF_TRIGGER_NONE, "mrdump_ext_rst-eint",
|
||
|
NULL);
|
||
|
if (ret > 0)
|
||
|
kpd_print("EINT IRQ LINE NOT AVAILABLE\n");
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/**********************************************************************/
|