439 lines
12 KiB
C
439 lines
12 KiB
C
|
/*
|
||
|
|
* SPDX-License-Identifier: GPL-2.0
|
||
|
|
*
|
||
|
|
* Copyright (c) 2019 MediaTek Inc.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <kpd.h>
|
||
|
|
#include <mt-plat/aee.h>
|
||
|
|
#include <linux/of.h>
|
||
|
|
#include <linux/of_address.h>
|
||
|
|
#include <linux/of_irq.h>
|
||
|
|
#include <mt-plat/mtk_boot_common.h>
|
||
|
|
#ifdef CONFIG_MTK_PMIC_NEW_ARCH
|
||
|
|
#include <mt-plat/upmu_common.h>
|
||
|
|
#endif
|
||
|
|
#ifdef CONFIG_MT_SND_SOC_NEW_ARCH
|
||
|
|
#include <mt_soc_afe_control.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef CONFIG_KPD_PWRKEY_USE_EINT
|
||
|
|
static u8 kpd_pwrkey_state = !KPD_PWRKEY_POLARITY;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static int kpd_show_hw_keycode = 1;
|
||
|
|
#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 bool kpd_sb_enable;
|
||
|
|
|
||
|
|
unsigned int get_boot_mode(void)
|
||
|
|
{
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef CONFIG_MTK_SMARTBOOK_SUPPORT
|
||
|
|
static void sb_kpd_release_keys(struct input_dev *dev)
|
||
|
|
{
|
||
|
|
int code;
|
||
|
|
|
||
|
|
for (code = 0; code <= KEY_MAX; code++) {
|
||
|
|
if (test_bit(code, dev->keybit)) {
|
||
|
|
kpd_print("report release event for sb plug in! keycode:%d\n", code);
|
||
|
|
input_report_key(dev, code, 0);
|
||
|
|
input_sync(dev);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void sb_kpd_enable(void)
|
||
|
|
{
|
||
|
|
kpd_sb_enable = true;
|
||
|
|
kpd_print("sb_kpd_enable performed!\n");
|
||
|
|
mt_reg_sync_writew(0x0, KP_EN);
|
||
|
|
sb_kpd_release_keys(kpd_input_dev);
|
||
|
|
}
|
||
|
|
|
||
|
|
void sb_kpd_disable(void)
|
||
|
|
{
|
||
|
|
kpd_sb_enable = false;
|
||
|
|
kpd_print("sb_kpd_disable performed!\n");
|
||
|
|
mt_reg_sync_writew(0x1, KP_EN);
|
||
|
|
}
|
||
|
|
#else
|
||
|
|
void sb_kpd_enable(void)
|
||
|
|
{
|
||
|
|
kpd_print("sb_kpd_enable empty function for HAL!\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
void sb_kpd_disable(void)
|
||
|
|
{
|
||
|
|
kpd_print("sb_kpd_disable empty function for HAL!\n");
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
|
||
|
|
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_slide_qwerty_init(void)
|
||
|
|
{
|
||
|
|
#if KPD_HAS_SLIDE_QWERTY
|
||
|
|
bool evdev_flag = false;
|
||
|
|
bool power_op = false;
|
||
|
|
struct input_handler *handler;
|
||
|
|
struct input_handle *handle;
|
||
|
|
|
||
|
|
handle = rcu_dereference(dev->grab);
|
||
|
|
if (handle) {
|
||
|
|
handler = handle->handler;
|
||
|
|
if (strcmp(handler->name, "evdev") == 0)
|
||
|
|
return -1;
|
||
|
|
} else {
|
||
|
|
list_for_each_entry_rcu(handle, &dev->h_list, d_node) {
|
||
|
|
handler = handle->handler;
|
||
|
|
if (strcmp(handler->name, "evdev") == 0) {
|
||
|
|
evdev_flag = true;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
if (evdev_flag == false)
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
power_op = powerOn_slidePin_interface();
|
||
|
|
if (!power_op)
|
||
|
|
kpd_print(KPD_SAY "Qwerty slide pin interface power on fail\n");
|
||
|
|
else
|
||
|
|
kpd_print("Qwerty slide pin interface power on success\n");
|
||
|
|
|
||
|
|
mt_eint_set_sens(KPD_SLIDE_EINT, KPD_SLIDE_SENSITIVE);
|
||
|
|
mt_eint_set_hw_debounce(KPD_SLIDE_EINT, KPD_SLIDE_DEBOUNCE);
|
||
|
|
mt_eint_registration(KPD_SLIDE_EINT, true, KPD_SLIDE_POLARITY, kpd_slide_eint_handler, false);
|
||
|
|
|
||
|
|
power_op = powerOff_slidePin_interface();
|
||
|
|
if (!power_op)
|
||
|
|
kpd_print(KPD_SAY "Qwerty slide pin interface power off fail\n");
|
||
|
|
else
|
||
|
|
kpd_print("Qwerty slide pin interface power off success\n");
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
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]);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
static void kpd_factory_mode_handler(void)
|
||
|
|
{
|
||
|
|
int i, j;
|
||
|
|
bool pressed;
|
||
|
|
u16 new_state[KPD_NUM_MEMS], change, mask;
|
||
|
|
u16 hw_keycode, linux_keycode;
|
||
|
|
|
||
|
|
for (i = 0; i < KPD_NUM_MEMS - 1; i++)
|
||
|
|
kpd_keymap_state[i] = 0xffff;
|
||
|
|
if (!kpd_dts_data.kpd_use_extend_type)
|
||
|
|
kpd_keymap_state[KPD_NUM_MEMS - 1] = 0x00ff;
|
||
|
|
else
|
||
|
|
kpd_keymap_state[KPD_NUM_MEMS - 1] = 0xffff;
|
||
|
|
|
||
|
|
kpd_get_keymap_state(new_state);
|
||
|
|
|
||
|
|
for (i = 0; i < KPD_NUM_MEMS; i++) {
|
||
|
|
change = new_state[i] ^ kpd_keymap_state[i];
|
||
|
|
if (!change)
|
||
|
|
continue;
|
||
|
|
|
||
|
|
for (j = 0; j < 16; j++) {
|
||
|
|
mask = 1U << j;
|
||
|
|
if (!(change & mask))
|
||
|
|
continue;
|
||
|
|
|
||
|
|
hw_keycode = (i << 4) + j;
|
||
|
|
|
||
|
|
if (hw_keycode >= KPD_NUM_KEYS)
|
||
|
|
continue;
|
||
|
|
|
||
|
|
/* bit is 1: not pressed, 0: pressed */
|
||
|
|
pressed = !(new_state[i] & mask);
|
||
|
|
if (kpd_show_hw_keycode) {
|
||
|
|
kpd_print(KPD_SAY "(%s) factory_mode HW keycode = %u\n",
|
||
|
|
pressed ? "pressed" : "released", hw_keycode);
|
||
|
|
}
|
||
|
|
|
||
|
|
linux_keycode = kpd_dts_data.kpd_hw_init_map[hw_keycode];
|
||
|
|
if (unlikely(linux_keycode == 0)) {
|
||
|
|
kpd_print("Linux keycode = 0\n");
|
||
|
|
continue;
|
||
|
|
}
|
||
|
|
input_report_key(kpd_input_dev, linux_keycode, pressed);
|
||
|
|
input_sync(kpd_input_dev);
|
||
|
|
kpd_print("factory_mode report Linux keycode = %u\n", linux_keycode);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
memcpy(kpd_keymap_state, new_state, sizeof(new_state));
|
||
|
|
kpd_print("save new keymap state\n");
|
||
|
|
}
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
void kpd_auto_test_for_factorymode(void)
|
||
|
|
{
|
||
|
|
kpd_print("Enter kpd_auto_test_for_factorymode!\n");
|
||
|
|
|
||
|
|
mdelay(1000);
|
||
|
|
|
||
|
|
kpd_factory_mode_handler();
|
||
|
|
kpd_print("begin kpd_auto_test_for_factorymode!\n");
|
||
|
|
#ifdef CONFIG_MTK_PMIC_NEW_ARCH /*for pmic not ready*/
|
||
|
|
if (pmic_get_register_value(PMIC_PWRKEY_DEB) == 1) {
|
||
|
|
kpd_print("power key release\n");
|
||
|
|
/*kpd_pwrkey_pmic_handler(1);*/
|
||
|
|
/*mdelay(time);*/
|
||
|
|
/*kpd_pwrkey_pmic_handler(0);}*/
|
||
|
|
} else {
|
||
|
|
kpd_print("power key press\n");
|
||
|
|
kpd_pwrkey_pmic_handler(1);
|
||
|
|
/*mdelay(time);*/
|
||
|
|
/*kpd_pwrkey_pmic_handler(0);*/
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
#ifdef KPD_PMIC_RSTKEY_MAP
|
||
|
|
if (pmic_get_register_value(PMIC_HOMEKEY_DEB) == 1) {
|
||
|
|
/*kpd_print("home key release\n");*/
|
||
|
|
/*kpd_pmic_rstkey_handler(1);*/
|
||
|
|
/*mdelay(time);*/
|
||
|
|
/*kpd_pmic_rstkey_handler(0);*/
|
||
|
|
} else {
|
||
|
|
kpd_print("home key press\n");
|
||
|
|
kpd_pmic_rstkey_handler(1);
|
||
|
|
/*mdelay(time);*/
|
||
|
|
/*kpd_pmic_rstkey_handler(0);*/
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
void long_press_reboot_function_setting(void)
|
||
|
|
{
|
||
|
|
#ifdef CONFIG_MTK_PMIC_NEW_ARCH /*for pmic not ready*/
|
||
|
|
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
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x01);
|
||
|
|
pmic_set_register_value(PMIC_RG_HOMEKEY_RST_EN, 0x00);
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_TD, CONFIG_KPD_PMIC_LPRST_TD);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef CONFIG_TWOKEY_REBOOT_NORMAL_MODE
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x01);
|
||
|
|
pmic_set_register_value(PMIC_RG_HOMEKEY_RST_EN, 0x01);
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_TD, CONFIG_KPD_PMIC_LPRST_TD);
|
||
|
|
#endif
|
||
|
|
#else
|
||
|
|
kpd_info("disable normal mode LPRST\n");
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x00);
|
||
|
|
pmic_set_register_value(PMIC_RG_HOMEKEY_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_OTHER_MODE
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x01);
|
||
|
|
pmic_set_register_value(PMIC_RG_HOMEKEY_RST_EN, 0x00);
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_TD, CONFIG_KPD_PMIC_LPRST_TD);
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef CONFIG_TWOKEY_REBOOT_OTHER_MODE
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x01);
|
||
|
|
pmic_set_register_value(PMIC_RG_HOMEKEY_RST_EN, 0x01);
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_TD, CONFIG_KPD_PMIC_LPRST_TD);
|
||
|
|
#endif
|
||
|
|
#else
|
||
|
|
kpd_info("disable other mode LPRST\n");
|
||
|
|
pmic_set_register_value(PMIC_RG_PWRKEY_RST_EN, 0x00);
|
||
|
|
pmic_set_register_value(PMIC_RG_HOMEKEY_RST_EN, 0x00);
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
#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];
|
||
|
|
/*kpd_print(KPD_SAY "keymap[%d] = %d\n", i,keymap[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_pmic_rstkey_hal(unsigned long pressed)
|
||
|
|
{
|
||
|
|
if (kpd_dts_data.kpd_sw_rstkey != 0) {
|
||
|
|
if (!kpd_sb_enable) {
|
||
|
|
input_report_key(kpd_input_dev, kpd_dts_data.kpd_sw_rstkey, pressed);
|
||
|
|
input_sync(kpd_input_dev);
|
||
|
|
if (kpd_show_hw_keycode) {
|
||
|
|
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)
|
||
|
|
{
|
||
|
|
#ifdef CONFIG_KPD_PWRKEY_USE_PMIC
|
||
|
|
if (!kpd_sb_enable) {
|
||
|
|
input_report_key(kpd_input_dev, kpd_dts_data.kpd_sw_pwrkey, pressed);
|
||
|
|
input_sync(kpd_input_dev);
|
||
|
|
if (kpd_show_hw_keycode) {
|
||
|
|
kpd_print(KPD_SAY "(%s) HW keycode =%d using PMIC\n",
|
||
|
|
pressed ? "pressed" : "released", kpd_dts_data.kpd_sw_pwrkey);
|
||
|
|
}
|
||
|
|
/* aee_powerkey_notify_press(pressed);*/
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
/***********************************************************************/
|
||
|
|
void kpd_pwrkey_handler_hal(unsigned long data)
|
||
|
|
{
|
||
|
|
#ifdef CONFIG_KPD_PWRKEY_USE_EINT
|
||
|
|
bool pressed;
|
||
|
|
u8 old_state = kpd_pwrkey_state;
|
||
|
|
|
||
|
|
kpd_pwrkey_state = !kpd_pwrkey_state;
|
||
|
|
pressed = (kpd_pwrkey_state == !!KPD_PWRKEY_POLARITY);
|
||
|
|
if (kpd_show_hw_keycode)
|
||
|
|
kpd_print(KPD_SAY "(%s) HW keycode = using EINT\n", pressed ? "pressed" : "released");
|
||
|
|
input_report_key(kpd_input_dev, kpd_dts_data.kpd_sw_pwrkey, pressed);
|
||
|
|
kpd_print("report Linux keycode = %u\n", kpd_dts_data.kpd_sw_pwrkey);
|
||
|
|
input_sync(kpd_input_dev);
|
||
|
|
|
||
|
|
/* for detecting the return to old_state */
|
||
|
|
mt_eint_set_polarity(KPD_PWRKEY_EINT, old_state);
|
||
|
|
mt_eint_unmask(KPD_PWRKEY_EINT);
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
#ifdef CONFIG_MTK_MRDUMP_KEY
|
||
|
|
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;
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
/***********************************************************************/
|
||
|
|
void mt_eint_register(void)
|
||
|
|
{
|
||
|
|
#ifdef CONFIG_MTK_MRDUMP_KEY
|
||
|
|
int ints[2] = {0, 0};
|
||
|
|
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 {
|
||
|
|
of_property_read_u32_array(node, "debounce", ints, ARRAY_SIZE(ints));
|
||
|
|
gpio_set_debounce(ints[0], ints[1]);
|
||
|
|
|
||
|
|
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");
|
||
|
|
}
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
/************************************************************************/
|