qiurui
/
rv1126-uboot
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

input: rk8xx pwrkey: use irq to detect key event 

because we support U-Boot system suspend and trap into ATF,
we have to make pwrkey as wakeup source, so that we must
register pmic_int as an irq.

we found reading 'get_timer(0)' will return a large value in
the interrupt routine and I don't find out what happend now,
so I add the 'get_ms()' which reads arm gerneric timer tick
direcly.

we clean all PMIC interrupt status for safety to avoid pmic_int
hold in low level which make PMIC can't respond to interrupt any
more.

Change-Id: I46ff81030696f4672faa9fc81141952e52fd5ba9
Signed-off-by: Joseph Chen <chenjh@rock-chips.com>
This commit is contained in:
Joseph Chen 2017-11-28 18:22:59 +08:00 committed by Kever Yang
parent c315aab89c
commit 3ccaecfa6f
1 changed files with 161 additions and 42 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

203
drivers/input/rk8xx_pwrkey.c
View File

@ -10,9 +10,16 @@
#include <linux/input.h> #include <linux/input.h>
#include <power/pmic.h> #include <power/pmic.h>
#include <power/rk8xx_pmic.h> #include <power/rk8xx_pmic.h>
#include <irq-generic.h>
#include <asm/arch/periph.h>
#include <dm/pinctrl.h>
#define RK816_INT_STS_REG1 0x49 #define RK816_INT_STS_REG1 0x49
#define RK816_INT_MSK_REG1 0x4a #define RK816_INT_MSK_REG1 0x4a
#define RK816_INT_STS_REG2 0x4c
#define RK816_INT_MSK_REG2 0x4d
#define RK816_INT_STS_REG3 0x4e
#define RK816_INT_MSK_REG3 0x4f
#define RK816_PWRON_RISE_INT (1 << 6) #define RK816_PWRON_RISE_INT (1 << 6)
#define RK816_PWRON_FALL_INT (1 << 5) #define RK816_PWRON_FALL_INT (1 << 5)
@ -26,41 +33,156 @@ struct key_data {
u8 int_msk_reg; u8 int_msk_reg;
u8 pwron_rise_int; u8 pwron_rise_int;
u8 pwron_fall_int; u8 pwron_fall_int;
struct reg_data *init_reg;
u32 init_reg_num;
struct reg_data *irq_reg;
u32 irq_reg_num;
uint64_t key_down_t;
uint64_t key_up_t;
}; };
struct reg_data {
u8 reg;
u8 val;
};
static struct reg_data rk816_init_reg[] = {
/* only enable rise/fall interrupt */
{ RK816_INT_MSK_REG1, 0x9f },
{ RK816_INT_MSK_REG2, 0xff },
{ RK816_INT_MSK_REG3, 0xff },
/* clear all interrupt states */
{ RK816_INT_STS_REG1, 0xff },
{ RK816_INT_STS_REG2, 0xff },
{ RK816_INT_STS_REG3, 0xff },
};
static struct reg_data rk816_irq_reg[] = {
/* clear all interrupt states */
{ RK816_INT_STS_REG1, 0xff },
{ RK816_INT_STS_REG2, 0xff },
{ RK816_INT_STS_REG3, 0xff },
};
static struct reg_data rk805_irq_reg[] = {
/* clear all interrupt states */
{ RK805_INT_STS_REG, 0xff },
};
static struct reg_data rk805_init_reg[] = {
/* only enable rise/fall interrupt */
{ RK805_INT_MSK_REG, 0x7e },
/* clear all interrupt states */
{ RK805_INT_STS_REG, 0xff },
};
static inline uint64_t arch_counter_get_cntpct(void)
{
uint64_t cval = 0;
isb();
#ifdef CONFIG_ARM64
asm volatile("mrs %0, cntpct_el0" : "=r" (cval));
#else
asm volatile ("mrrc p15, 0, %Q0, %R0, c14" : "=r" (cval));
#endif
return cval;
}
static uint64_t get_ms(uint64_t base)
{
return (arch_counter_get_cntpct() / 24000UL) - base;
}
static int rk8xx_pwrkey_read(struct udevice *dev) static int rk8xx_pwrkey_read(struct udevice *dev)
{ {
struct key_data *key = dev_get_priv(dev); struct key_data *key = dev_get_priv(dev);
int status = KEY_PRESS_NONE; u32 report = KEY_PRESS_NONE;
int ret, val;
if ((key->key_up_t > key->key_down_t) &&
(key->key_up_t - key->key_down_t) >= KEY_LONG_DOWN_MS) {
debug("%s: long key ms: %llu\n", __func__, key->key_up_t - key->key_down_t);
key->key_up_t = 0;
key->key_down_t = 0;
report = KEY_PRESS_LONG_DOWN;
} else if (key->key_down_t && get_ms(key->key_down_t) >= KEY_LONG_DOWN_MS) {
debug("%s: long key (hold) ms: %llu\n", __func__, key->key_up_t - key->key_down_t);
key->key_up_t = 0;
key->key_down_t = 0;
report = KEY_PRESS_LONG_DOWN;
} else if ((key->key_up_t > key->key_down_t) &&
(key->key_up_t - key->key_down_t) < KEY_LONG_DOWN_MS) {
debug("%s: short key ms: %llu\n", __func__, key->key_up_t - key->key_down_t);
key->key_up_t = 0;
key->key_down_t = 0;
report = KEY_PRESS_DOWN;
} else {
debug("%s: key up: %llu, down: %llu\n", __func__, key->key_up_t, key->key_down_t);
}
return report;
}
static void pwrkey_irq_handler(int irq, void *data)
{
struct udevice *dev = data;
struct key_data *key = dev_get_priv(dev);
int ret, val, i;
/* read status */
val = pmic_reg_read(dev->parent, key->int_sts_reg); val = pmic_reg_read(dev->parent, key->int_sts_reg);
if (val < 0) { if (val < 0) {
printf("%s: i2c read failed, ret=%d\n", __func__, val); printf("%s: i2c read failed, ret=%d\n", __func__, val);
return val; return;
} }
if (val & key->pwron_fall_int) /* fall event */
status = KEY_PRESS_DOWN; if (val & key->pwron_fall_int) {
key->key_down_t = get_ms(0);
printf("%s: key down: %llu ms\n", __func__, key->key_down_t);
}
/* Must check pwron rise behind of fall !! */ /* rise event */
if (val & key->pwron_rise_int) { if (val & key->pwron_rise_int) {
/* Clear fall when detect rise */ key->key_up_t = get_ms(0);
ret = pmic_reg_write(dev->parent, key->int_sts_reg, printf("%s: key up: %llu ms\n", __func__, key->key_up_t);
key->pwron_fall_int | key->pwron_rise_int);
if (ret < 0) {
printf("%s: i2c write failed, ret=%d\n", __func__, val);
return ret;
}
status = KEY_PRESS_UP;
} }
debug("%s: int sts = 0x%x msk = 0x%x\n", /* clear intertup */
__func__, pmic_reg_read(dev->parent, key->int_sts_reg), for (i = 0; i < key->irq_reg_num; i++) {
pmic_reg_read(dev->parent, key->int_msk_reg)); ret = pmic_reg_write(dev->parent,
key->irq_reg[i].reg,
key->irq_reg[i].val);
if (ret < 0) {
printf("%s: i2c write reg 0x%x failed, ret=%d\n",
__func__, key->irq_reg[i].reg, ret);
}
}
}
return status; static int pwrkey_interrupt_init(struct udevice *dev)
{
u32 interrupt[2], phandle;
int irq, ret;
phandle = dev_read_u32_default(dev->parent, "interrupt-parent", -1);
if (phandle < 0) {
printf("failed get 'interrupt-parent', ret=%d\n", phandle);
return phandle;
}
ret = dev_read_u32_array(dev->parent, "interrupts", interrupt, 2);
if (ret) {
printf("failed get 'interrupt', ret=%d\n", ret);
return ret;
}
irq = phandle_gpio_to_irq(phandle, interrupt[0]);
irq_install_handler(irq, pwrkey_irq_handler, dev);
irq_set_irq_type(irq, IRQ_TYPE_EDGE_FALLING);
irq_handler_enable(irq);
return 0;
} }
static const struct dm_key_ops key_ops = { static const struct dm_key_ops key_ops = {
@ -73,7 +195,7 @@ static int rk8xx_pwrkey_probe(struct udevice *dev)
{ {
struct rk8xx_priv *rk8xx = dev_get_priv(dev->parent); struct rk8xx_priv *rk8xx = dev_get_priv(dev->parent);
struct key_data *key = dev_get_priv(dev); struct key_data *key = dev_get_priv(dev);
int ret, val; int ret, i;
switch (rk8xx->variant) { switch (rk8xx->variant) {
case RK805_ID: case RK805_ID:
@ -81,6 +203,10 @@ static int rk8xx_pwrkey_probe(struct udevice *dev)
key->int_msk_reg = RK805_INT_MSK_REG; key->int_msk_reg = RK805_INT_MSK_REG;
key->pwron_rise_int = RK805_PWRON_RISE_INT; key->pwron_rise_int = RK805_PWRON_RISE_INT;
key->pwron_fall_int = RK805_PWRON_FALL_INT; key->pwron_fall_int = RK805_PWRON_FALL_INT;
key->init_reg = rk805_init_reg;
key->init_reg_num = ARRAY_SIZE(rk805_init_reg);
key->irq_reg = rk805_irq_reg;
key->irq_reg_num = ARRAY_SIZE(rk805_irq_reg);
break; break;
case RK816_ID: case RK816_ID:
@ -88,36 +214,29 @@ static int rk8xx_pwrkey_probe(struct udevice *dev)
key->int_msk_reg = RK816_INT_MSK_REG1; key->int_msk_reg = RK816_INT_MSK_REG1;
key->pwron_rise_int = RK816_PWRON_RISE_INT; key->pwron_rise_int = RK816_PWRON_RISE_INT;
key->pwron_fall_int = RK816_PWRON_FALL_INT; key->pwron_fall_int = RK816_PWRON_FALL_INT;
key->init_reg = rk816_init_reg;
key->init_reg_num = ARRAY_SIZE(rk816_init_reg);
key->irq_reg = rk816_irq_reg;
key->irq_reg_num = ARRAY_SIZE(rk816_irq_reg);
break; break;
default: default:
return -EINVAL; return -EINVAL;
} }
/* Clear states */ /* mask and clear intertup */
ret = pmic_reg_write(dev->parent, key->int_sts_reg, for (i = 0; i < key->init_reg_num; i++) {
key->pwron_rise_int | key->pwron_fall_int); ret = pmic_reg_write(dev->parent,
if (ret < 0) { key->init_reg[i].reg,
printf("%s: i2c write failed, ret=%d\n", __func__, ret); key->init_reg[i].val);
return ret; if (ret < 0) {
printf("%s: i2c write reg 0x%x failed, ret=%d\n",
__func__, key->init_reg[i].reg, ret);
return ret;
}
} }
val = pmic_reg_read(dev->parent, key->int_msk_reg); return pwrkey_interrupt_init(dev);
if (val < 0) {
printf("%s: i2c read failed, ret=%d\n", __func__, val);
return val;
}
/* enable fall and rise interrupt */
val = 0xff;
val &= ~(key->pwron_rise_int | key->pwron_fall_int);
ret = pmic_reg_write(dev->parent, key->int_msk_reg, val);
if (ret < 0) {
printf("%s: i2c write failed, ret=%d\n", __func__, val);
return ret;
}
return 0;
} }
U_BOOT_DRIVER(rk8xx_pwrkey) = { U_BOOT_DRIVER(rk8xx_pwrkey) = {