298 lines
7.5 KiB
C
298 lines
7.5 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_LONG_POWERKEY_LOG_STORE
|
||
|
|
#include <log_store_kernel.h>
|
||
|
|
#include <linux/kthread.h>
|
||
|
|
#include <uapi/linux/sched/types.h>
|
||
|
|
struct timer_list long_press_dump_timer;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#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 && kpd_dts_data.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]);
|
||
|
|
#ifdef CONFIG_LONG_POWERKEY_LOG_STORE
|
||
|
|
init_timer(&long_press_dump_timer);
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
|
||
|
|
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);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef CONFIG_LONG_POWERKEY_LOG_STORE
|
||
|
|
DECLARE_WAIT_QUEUE_HEAD(dump_log_wait);
|
||
|
|
bool long_press_key;
|
||
|
|
bool dump_thread;
|
||
|
|
|
||
|
|
static int dump_last_log(void *arg)
|
||
|
|
{
|
||
|
|
int ret;
|
||
|
|
/* unsigned long flags; */
|
||
|
|
struct sched_param param = {
|
||
|
|
.sched_priority = 99
|
||
|
|
};
|
||
|
|
|
||
|
|
dump_thread = true;
|
||
|
|
sched_setscheduler(current, SCHED_FIFO, ¶m);
|
||
|
|
ret = wait_event_interruptible_timeout(dump_log_wait,
|
||
|
|
dump_thread == false, HZ*10);
|
||
|
|
if (ret > 0 && long_press_key)
|
||
|
|
log_store_to_emmc();
|
||
|
|
else
|
||
|
|
pr_notice("log_store timeout or powerkey release.\n");
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void long_press_dump(unsigned long pressed)
|
||
|
|
{
|
||
|
|
|
||
|
|
pr_notice("log_store long press power key.\n");
|
||
|
|
long_press_key = true;
|
||
|
|
dump_thread = false;
|
||
|
|
wake_up_interruptible(&dump_log_wait);
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
void kpd_pmic_pwrkey_hal(unsigned long pressed)
|
||
|
|
{
|
||
|
|
#ifdef CONFIG_LONG_POWERKEY_LOG_STORE
|
||
|
|
struct task_struct *hd_thread;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
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);
|
||
|
|
#ifdef CONFIG_LONG_POWERKEY_LOG_STORE
|
||
|
|
if (pressed) {
|
||
|
|
long_press_dump_timer.expires = jiffies + 6*HZ;
|
||
|
|
long_press_dump_timer.data = (unsigned long)pressed;
|
||
|
|
long_press_dump_timer.function = long_press_dump;
|
||
|
|
if (!timer_pending(&long_press_dump_timer)) {
|
||
|
|
add_timer(&long_press_dump_timer);
|
||
|
|
hd_thread = kthread_create(dump_last_log,
|
||
|
|
NULL, "dump_log");
|
||
|
|
if (hd_thread != NULL)
|
||
|
|
wake_up_process(hd_thread);
|
||
|
|
}
|
||
|
|
} else {
|
||
|
|
long_press_key = false;
|
||
|
|
dump_thread = false;
|
||
|
|
wake_up_interruptible(&dump_log_wait);
|
||
|
|
del_timer_sync(&long_press_dump_timer);
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
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");
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/**********************************************************************/
|