|
@@ -1092,6 +1092,7 @@ static int byt_pin_config_get(struct pinctrl_dev *pctl_dev, unsigned int offset,
|
|
|
enum pin_config_param param = pinconf_to_config_param(*config);
|
|
|
void __iomem *conf_reg = byt_gpio_reg(vg, offset, BYT_CONF0_REG);
|
|
|
void __iomem *val_reg = byt_gpio_reg(vg, offset, BYT_VAL_REG);
|
|
|
+ void __iomem *db_reg = byt_gpio_reg(vg, offset, BYT_DEBOUNCE_REG);
|
|
|
unsigned long flags;
|
|
|
u32 conf, pull, val, debounce;
|
|
|
u16 arg = 0;
|
|
@@ -1128,7 +1129,7 @@ static int byt_pin_config_get(struct pinctrl_dev *pctl_dev, unsigned int offset,
|
|
|
return -EINVAL;
|
|
|
|
|
|
raw_spin_lock_irqsave(&vg->lock, flags);
|
|
|
- debounce = readl(byt_gpio_reg(vg, offset, BYT_DEBOUNCE_REG));
|
|
|
+ debounce = readl(db_reg);
|
|
|
raw_spin_unlock_irqrestore(&vg->lock, flags);
|
|
|
|
|
|
switch (debounce & BYT_DEBOUNCE_PULSE_MASK) {
|
|
@@ -1176,6 +1177,7 @@ static int byt_pin_config_set(struct pinctrl_dev *pctl_dev,
|
|
|
unsigned int param, arg;
|
|
|
void __iomem *conf_reg = byt_gpio_reg(vg, offset, BYT_CONF0_REG);
|
|
|
void __iomem *val_reg = byt_gpio_reg(vg, offset, BYT_VAL_REG);
|
|
|
+ void __iomem *db_reg = byt_gpio_reg(vg, offset, BYT_DEBOUNCE_REG);
|
|
|
unsigned long flags;
|
|
|
u32 conf, val, debounce;
|
|
|
int i, ret = 0;
|
|
@@ -1238,36 +1240,40 @@ static int byt_pin_config_set(struct pinctrl_dev *pctl_dev,
|
|
|
|
|
|
break;
|
|
|
case PIN_CONFIG_INPUT_DEBOUNCE:
|
|
|
- debounce = readl(byt_gpio_reg(vg, offset,
|
|
|
- BYT_DEBOUNCE_REG));
|
|
|
- conf &= ~BYT_DEBOUNCE_PULSE_MASK;
|
|
|
+ debounce = readl(db_reg);
|
|
|
+ debounce &= ~BYT_DEBOUNCE_PULSE_MASK;
|
|
|
|
|
|
switch (arg) {
|
|
|
+ case 0:
|
|
|
+ conf &= BYT_DEBOUNCE_EN;
|
|
|
+ break;
|
|
|
case 375:
|
|
|
- conf |= BYT_DEBOUNCE_PULSE_375US;
|
|
|
+ debounce |= BYT_DEBOUNCE_PULSE_375US;
|
|
|
break;
|
|
|
case 750:
|
|
|
- conf |= BYT_DEBOUNCE_PULSE_750US;
|
|
|
+ debounce |= BYT_DEBOUNCE_PULSE_750US;
|
|
|
break;
|
|
|
case 1500:
|
|
|
- conf |= BYT_DEBOUNCE_PULSE_1500US;
|
|
|
+ debounce |= BYT_DEBOUNCE_PULSE_1500US;
|
|
|
break;
|
|
|
case 3000:
|
|
|
- conf |= BYT_DEBOUNCE_PULSE_3MS;
|
|
|
+ debounce |= BYT_DEBOUNCE_PULSE_3MS;
|
|
|
break;
|
|
|
case 6000:
|
|
|
- conf |= BYT_DEBOUNCE_PULSE_6MS;
|
|
|
+ debounce |= BYT_DEBOUNCE_PULSE_6MS;
|
|
|
break;
|
|
|
case 12000:
|
|
|
- conf |= BYT_DEBOUNCE_PULSE_12MS;
|
|
|
+ debounce |= BYT_DEBOUNCE_PULSE_12MS;
|
|
|
break;
|
|
|
case 24000:
|
|
|
- conf |= BYT_DEBOUNCE_PULSE_24MS;
|
|
|
+ debounce |= BYT_DEBOUNCE_PULSE_24MS;
|
|
|
break;
|
|
|
default:
|
|
|
ret = -EINVAL;
|
|
|
}
|
|
|
|
|
|
+ if (!ret)
|
|
|
+ writel(debounce, db_reg);
|
|
|
break;
|
|
|
default:
|
|
|
ret = -ENOTSUPP;
|
|
@@ -1617,6 +1623,8 @@ static void byt_gpio_irq_handler(struct irq_desc *desc)
|
|
|
|
|
|
static void byt_gpio_irq_init_hw(struct byt_gpio *vg)
|
|
|
{
|
|
|
+ struct gpio_chip *gc = &vg->chip;
|
|
|
+ struct device *dev = &vg->pdev->dev;
|
|
|
void __iomem *reg;
|
|
|
u32 base, value;
|
|
|
int i;
|
|
@@ -1638,10 +1646,12 @@ static void byt_gpio_irq_init_hw(struct byt_gpio *vg)
|
|
|
}
|
|
|
|
|
|
value = readl(reg);
|
|
|
- if ((value & BYT_PIN_MUX) == byt_get_gpio_mux(vg, i) &&
|
|
|
- !(value & BYT_DIRECT_IRQ_EN)) {
|
|
|
+ if (value & BYT_DIRECT_IRQ_EN) {
|
|
|
+ clear_bit(i, gc->irq_valid_mask);
|
|
|
+ dev_dbg(dev, "excluding GPIO %d from IRQ domain\n", i);
|
|
|
+ } else if ((value & BYT_PIN_MUX) == byt_get_gpio_mux(vg, i)) {
|
|
|
byt_gpio_clear_triggering(vg, i);
|
|
|
- dev_dbg(&vg->pdev->dev, "disabling GPIO %d\n", i);
|
|
|
+ dev_dbg(dev, "disabling GPIO %d\n", i);
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -1680,6 +1690,7 @@ static int byt_gpio_probe(struct byt_gpio *vg)
|
|
|
gc->can_sleep = false;
|
|
|
gc->parent = &vg->pdev->dev;
|
|
|
gc->ngpio = vg->soc_data->npins;
|
|
|
+ gc->irq_need_valid_mask = true;
|
|
|
|
|
|
#ifdef CONFIG_PM_SLEEP
|
|
|
vg->saved_context = devm_kcalloc(&vg->pdev->dev, gc->ngpio,
|