提交 7726d4c3 编写于 作者: L Linus Torvalds

Merge tag 'gpio-fixes-for-v6.0-rc4' of git://git.kernel.org/pub/scm/linux/kernel/git/brgl/linux

Pull gpio fixes from Bartosz Golaszewski:
 "A a set of fixes from the GPIO subsystem.

  Most are small driver fixes except the realtek-otto driver patch which
  is pretty big but addresses a significant flaw that can cause the CPU
  to stay infinitely busy on uncleared ISR on some platforms.

  Summary:
   - MAINTAINERS update
   - fix resource leaks in gpio-mockup and gpio-pxa
   - add missing locking in gpio-pca953x
   - use 32-bit I/O in gpio-realtek-otto
   - make irq_chip structures immutable in four more drivers"

* tag 'gpio-fixes-for-v6.0-rc4' of git://git.kernel.org/pub/scm/linux/kernel/git/brgl/linux:
  gpio: ws16c48: Make irq_chip immutable
  gpio: 104-idio-16: Make irq_chip immutable
  gpio: 104-idi-48: Make irq_chip immutable
  gpio: 104-dio-48e: Make irq_chip immutable
  gpio: realtek-otto: switch to 32-bit I/O
  gpio: pca953x: Add mutex_lock for regcache sync in PM
  gpio: mockup: remove gpio debugfs when remove device
  gpio: pxa: use devres for the clock struct
  MAINTAINERS: rectify entry for XILINX GPIO DRIVER
...@@ -22307,7 +22307,7 @@ M: Shubhrajyoti Datta <shubhrajyoti.datta@xilinx.com> ...@@ -22307,7 +22307,7 @@ M: Shubhrajyoti Datta <shubhrajyoti.datta@xilinx.com>
R: Srinivas Neeli <srinivas.neeli@xilinx.com> R: Srinivas Neeli <srinivas.neeli@xilinx.com>
R: Michal Simek <michal.simek@xilinx.com> R: Michal Simek <michal.simek@xilinx.com>
S: Maintained S: Maintained
F: Documentation/devicetree/bindings/gpio/gpio-xilinx.txt F: Documentation/devicetree/bindings/gpio/xlnx,gpio-xilinx.yaml
F: Documentation/devicetree/bindings/gpio/gpio-zynq.yaml F: Documentation/devicetree/bindings/gpio/gpio-zynq.yaml
F: drivers/gpio/gpio-xilinx.c F: drivers/gpio/gpio-xilinx.c
F: drivers/gpio/gpio-zynq.c F: drivers/gpio/gpio-zynq.c
......
...@@ -164,6 +164,7 @@ static void dio48e_irq_mask(struct irq_data *data) ...@@ -164,6 +164,7 @@ static void dio48e_irq_mask(struct irq_data *data)
dio48egpio->irq_mask &= ~BIT(0); dio48egpio->irq_mask &= ~BIT(0);
else else
dio48egpio->irq_mask &= ~BIT(1); dio48egpio->irq_mask &= ~BIT(1);
gpiochip_disable_irq(chip, offset);
if (!dio48egpio->irq_mask) if (!dio48egpio->irq_mask)
/* disable interrupts */ /* disable interrupts */
...@@ -191,6 +192,7 @@ static void dio48e_irq_unmask(struct irq_data *data) ...@@ -191,6 +192,7 @@ static void dio48e_irq_unmask(struct irq_data *data)
iowrite8(0x00, &dio48egpio->reg->enable_interrupt); iowrite8(0x00, &dio48egpio->reg->enable_interrupt);
} }
gpiochip_enable_irq(chip, offset);
if (offset == 19) if (offset == 19)
dio48egpio->irq_mask |= BIT(0); dio48egpio->irq_mask |= BIT(0);
else else
...@@ -213,12 +215,14 @@ static int dio48e_irq_set_type(struct irq_data *data, unsigned int flow_type) ...@@ -213,12 +215,14 @@ static int dio48e_irq_set_type(struct irq_data *data, unsigned int flow_type)
return 0; return 0;
} }
static struct irq_chip dio48e_irqchip = { static const struct irq_chip dio48e_irqchip = {
.name = "104-dio-48e", .name = "104-dio-48e",
.irq_ack = dio48e_irq_ack, .irq_ack = dio48e_irq_ack,
.irq_mask = dio48e_irq_mask, .irq_mask = dio48e_irq_mask,
.irq_unmask = dio48e_irq_unmask, .irq_unmask = dio48e_irq_unmask,
.irq_set_type = dio48e_irq_set_type .irq_set_type = dio48e_irq_set_type,
.flags = IRQCHIP_IMMUTABLE,
GPIOCHIP_IRQ_RESOURCE_HELPERS,
}; };
static irqreturn_t dio48e_irq_handler(int irq, void *dev_id) static irqreturn_t dio48e_irq_handler(int irq, void *dev_id)
...@@ -322,7 +326,7 @@ static int dio48e_probe(struct device *dev, unsigned int id) ...@@ -322,7 +326,7 @@ static int dio48e_probe(struct device *dev, unsigned int id)
dio48egpio->chip.set_multiple = dio48e_gpio_set_multiple; dio48egpio->chip.set_multiple = dio48e_gpio_set_multiple;
girq = &dio48egpio->chip.irq; girq = &dio48egpio->chip.irq;
girq->chip = &dio48e_irqchip; gpio_irq_chip_set_chip(girq, &dio48e_irqchip);
/* This will let us handle the parent IRQ in the driver */ /* This will let us handle the parent IRQ in the driver */
girq->parent_handler = NULL; girq->parent_handler = NULL;
girq->num_parents = 0; girq->num_parents = 0;
......
...@@ -113,6 +113,7 @@ static void idi_48_irq_mask(struct irq_data *data) ...@@ -113,6 +113,7 @@ static void idi_48_irq_mask(struct irq_data *data)
spin_lock_irqsave(&idi48gpio->lock, flags); spin_lock_irqsave(&idi48gpio->lock, flags);
idi48gpio->irq_mask[boundary] &= ~mask; idi48gpio->irq_mask[boundary] &= ~mask;
gpiochip_disable_irq(chip, offset);
/* Exit early if there are still input lines with IRQ unmasked */ /* Exit early if there are still input lines with IRQ unmasked */
if (idi48gpio->irq_mask[boundary]) if (idi48gpio->irq_mask[boundary])
...@@ -140,6 +141,7 @@ static void idi_48_irq_unmask(struct irq_data *data) ...@@ -140,6 +141,7 @@ static void idi_48_irq_unmask(struct irq_data *data)
prev_irq_mask = idi48gpio->irq_mask[boundary]; prev_irq_mask = idi48gpio->irq_mask[boundary];
gpiochip_enable_irq(chip, offset);
idi48gpio->irq_mask[boundary] |= mask; idi48gpio->irq_mask[boundary] |= mask;
/* Exit early if IRQ was already unmasked for this boundary */ /* Exit early if IRQ was already unmasked for this boundary */
...@@ -164,12 +166,14 @@ static int idi_48_irq_set_type(struct irq_data *data, unsigned int flow_type) ...@@ -164,12 +166,14 @@ static int idi_48_irq_set_type(struct irq_data *data, unsigned int flow_type)
return 0; return 0;
} }
static struct irq_chip idi_48_irqchip = { static const struct irq_chip idi_48_irqchip = {
.name = "104-idi-48", .name = "104-idi-48",
.irq_ack = idi_48_irq_ack, .irq_ack = idi_48_irq_ack,
.irq_mask = idi_48_irq_mask, .irq_mask = idi_48_irq_mask,
.irq_unmask = idi_48_irq_unmask, .irq_unmask = idi_48_irq_unmask,
.irq_set_type = idi_48_irq_set_type .irq_set_type = idi_48_irq_set_type,
.flags = IRQCHIP_IMMUTABLE,
GPIOCHIP_IRQ_RESOURCE_HELPERS,
}; };
static irqreturn_t idi_48_irq_handler(int irq, void *dev_id) static irqreturn_t idi_48_irq_handler(int irq, void *dev_id)
...@@ -267,7 +271,7 @@ static int idi_48_probe(struct device *dev, unsigned int id) ...@@ -267,7 +271,7 @@ static int idi_48_probe(struct device *dev, unsigned int id)
idi48gpio->chip.get_multiple = idi_48_gpio_get_multiple; idi48gpio->chip.get_multiple = idi_48_gpio_get_multiple;
girq = &idi48gpio->chip.irq; girq = &idi48gpio->chip.irq;
girq->chip = &idi_48_irqchip; gpio_irq_chip_set_chip(girq, &idi_48_irqchip);
/* This will let us handle the parent IRQ in the driver */ /* This will let us handle the parent IRQ in the driver */
girq->parent_handler = NULL; girq->parent_handler = NULL;
girq->num_parents = 0; girq->num_parents = 0;
......
...@@ -174,10 +174,11 @@ static void idio_16_irq_mask(struct irq_data *data) ...@@ -174,10 +174,11 @@ static void idio_16_irq_mask(struct irq_data *data)
{ {
struct gpio_chip *chip = irq_data_get_irq_chip_data(data); struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip);
const unsigned long mask = BIT(irqd_to_hwirq(data)); const unsigned long offset = irqd_to_hwirq(data);
unsigned long flags; unsigned long flags;
idio16gpio->irq_mask &= ~mask; idio16gpio->irq_mask &= ~BIT(offset);
gpiochip_disable_irq(chip, offset);
if (!idio16gpio->irq_mask) { if (!idio16gpio->irq_mask) {
raw_spin_lock_irqsave(&idio16gpio->lock, flags); raw_spin_lock_irqsave(&idio16gpio->lock, flags);
...@@ -192,11 +193,12 @@ static void idio_16_irq_unmask(struct irq_data *data) ...@@ -192,11 +193,12 @@ static void idio_16_irq_unmask(struct irq_data *data)
{ {
struct gpio_chip *chip = irq_data_get_irq_chip_data(data); struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip); struct idio_16_gpio *const idio16gpio = gpiochip_get_data(chip);
const unsigned long mask = BIT(irqd_to_hwirq(data)); const unsigned long offset = irqd_to_hwirq(data);
const unsigned long prev_irq_mask = idio16gpio->irq_mask; const unsigned long prev_irq_mask = idio16gpio->irq_mask;
unsigned long flags; unsigned long flags;
idio16gpio->irq_mask |= mask; gpiochip_enable_irq(chip, offset);
idio16gpio->irq_mask |= BIT(offset);
if (!prev_irq_mask) { if (!prev_irq_mask) {
raw_spin_lock_irqsave(&idio16gpio->lock, flags); raw_spin_lock_irqsave(&idio16gpio->lock, flags);
...@@ -217,12 +219,14 @@ static int idio_16_irq_set_type(struct irq_data *data, unsigned int flow_type) ...@@ -217,12 +219,14 @@ static int idio_16_irq_set_type(struct irq_data *data, unsigned int flow_type)
return 0; return 0;
} }
static struct irq_chip idio_16_irqchip = { static const struct irq_chip idio_16_irqchip = {
.name = "104-idio-16", .name = "104-idio-16",
.irq_ack = idio_16_irq_ack, .irq_ack = idio_16_irq_ack,
.irq_mask = idio_16_irq_mask, .irq_mask = idio_16_irq_mask,
.irq_unmask = idio_16_irq_unmask, .irq_unmask = idio_16_irq_unmask,
.irq_set_type = idio_16_irq_set_type .irq_set_type = idio_16_irq_set_type,
.flags = IRQCHIP_IMMUTABLE,
GPIOCHIP_IRQ_RESOURCE_HELPERS,
}; };
static irqreturn_t idio_16_irq_handler(int irq, void *dev_id) static irqreturn_t idio_16_irq_handler(int irq, void *dev_id)
...@@ -299,7 +303,7 @@ static int idio_16_probe(struct device *dev, unsigned int id) ...@@ -299,7 +303,7 @@ static int idio_16_probe(struct device *dev, unsigned int id)
idio16gpio->out_state = 0xFFFF; idio16gpio->out_state = 0xFFFF;
girq = &idio16gpio->chip.irq; girq = &idio16gpio->chip.irq;
girq->chip = &idio_16_irqchip; gpio_irq_chip_set_chip(girq, &idio_16_irqchip);
/* This will let us handle the parent IRQ in the driver */ /* This will let us handle the parent IRQ in the driver */
girq->parent_handler = NULL; girq->parent_handler = NULL;
girq->num_parents = 0; girq->num_parents = 0;
......
...@@ -373,6 +373,13 @@ static void gpio_mockup_debugfs_setup(struct device *dev, ...@@ -373,6 +373,13 @@ static void gpio_mockup_debugfs_setup(struct device *dev,
} }
} }
static void gpio_mockup_debugfs_cleanup(void *data)
{
struct gpio_mockup_chip *chip = data;
debugfs_remove_recursive(chip->dbg_dir);
}
static void gpio_mockup_dispose_mappings(void *data) static void gpio_mockup_dispose_mappings(void *data)
{ {
struct gpio_mockup_chip *chip = data; struct gpio_mockup_chip *chip = data;
...@@ -455,7 +462,7 @@ static int gpio_mockup_probe(struct platform_device *pdev) ...@@ -455,7 +462,7 @@ static int gpio_mockup_probe(struct platform_device *pdev)
gpio_mockup_debugfs_setup(dev, chip); gpio_mockup_debugfs_setup(dev, chip);
return 0; return devm_add_action_or_reset(dev, gpio_mockup_debugfs_cleanup, chip);
} }
static const struct of_device_id gpio_mockup_of_match[] = { static const struct of_device_id gpio_mockup_of_match[] = {
......
...@@ -1175,7 +1175,9 @@ static int pca953x_suspend(struct device *dev) ...@@ -1175,7 +1175,9 @@ static int pca953x_suspend(struct device *dev)
{ {
struct pca953x_chip *chip = dev_get_drvdata(dev); struct pca953x_chip *chip = dev_get_drvdata(dev);
mutex_lock(&chip->i2c_lock);
regcache_cache_only(chip->regmap, true); regcache_cache_only(chip->regmap, true);
mutex_unlock(&chip->i2c_lock);
if (atomic_read(&chip->wakeup_path)) if (atomic_read(&chip->wakeup_path))
device_set_wakeup_path(dev); device_set_wakeup_path(dev);
...@@ -1198,13 +1200,17 @@ static int pca953x_resume(struct device *dev) ...@@ -1198,13 +1200,17 @@ static int pca953x_resume(struct device *dev)
} }
} }
mutex_lock(&chip->i2c_lock);
regcache_cache_only(chip->regmap, false); regcache_cache_only(chip->regmap, false);
regcache_mark_dirty(chip->regmap); regcache_mark_dirty(chip->regmap);
ret = pca953x_regcache_sync(dev); ret = pca953x_regcache_sync(dev);
if (ret) if (ret) {
mutex_unlock(&chip->i2c_lock);
return ret; return ret;
}
ret = regcache_sync(chip->regmap); ret = regcache_sync(chip->regmap);
mutex_unlock(&chip->i2c_lock);
if (ret) { if (ret) {
dev_err(dev, "Failed to restore register map: %d\n", ret); dev_err(dev, "Failed to restore register map: %d\n", ret);
return ret; return ret;
......
...@@ -661,24 +661,17 @@ static int pxa_gpio_probe(struct platform_device *pdev) ...@@ -661,24 +661,17 @@ static int pxa_gpio_probe(struct platform_device *pdev)
if (IS_ERR(gpio_reg_base)) if (IS_ERR(gpio_reg_base))
return PTR_ERR(gpio_reg_base); return PTR_ERR(gpio_reg_base);
clk = clk_get(&pdev->dev, NULL); clk = devm_clk_get_enabled(&pdev->dev, NULL);
if (IS_ERR(clk)) { if (IS_ERR(clk)) {
dev_err(&pdev->dev, "Error %ld to get gpio clock\n", dev_err(&pdev->dev, "Error %ld to get gpio clock\n",
PTR_ERR(clk)); PTR_ERR(clk));
return PTR_ERR(clk); return PTR_ERR(clk);
} }
ret = clk_prepare_enable(clk);
if (ret) {
clk_put(clk);
return ret;
}
/* Initialize GPIO chips */ /* Initialize GPIO chips */
ret = pxa_init_gpio_chip(pchip, pxa_last_gpio + 1, gpio_reg_base); ret = pxa_init_gpio_chip(pchip, pxa_last_gpio + 1, gpio_reg_base);
if (ret) { if (ret)
clk_put(clk);
return ret; return ret;
}
/* clear all GPIO edge detects */ /* clear all GPIO edge detects */
for_each_gpio_bank(gpio, c, pchip) { for_each_gpio_bank(gpio, c, pchip) {
......
...@@ -46,10 +46,20 @@ ...@@ -46,10 +46,20 @@
* @lock: Lock for accessing the IRQ registers and values * @lock: Lock for accessing the IRQ registers and values
* @intr_mask: Mask for interrupts lines * @intr_mask: Mask for interrupts lines
* @intr_type: Interrupt type selection * @intr_type: Interrupt type selection
* @bank_read: Read a bank setting as a single 32-bit value
* @bank_write: Write a bank setting as a single 32-bit value
* @imr_line_pos: Bit shift of an IRQ line's IMR value.
*
* The DIR, DATA, and ISR registers consist of four 8-bit port values, packed
* into a single 32-bit register. Use @bank_read (@bank_write) to get (assign)
* a value from (to) these registers. The IMR register consists of four 16-bit
* port values, packed into two 32-bit registers. Use @imr_line_pos to get the
* bit shift of the 2-bit field for a line's IMR settings. Shifts larger than
* 32 overflow into the second register.
* *
* Because the interrupt mask register (IMR) combines the function of IRQ type * Because the interrupt mask register (IMR) combines the function of IRQ type
* selection and masking, two extra values are stored. @intr_mask is used to * selection and masking, two extra values are stored. @intr_mask is used to
* mask/unmask the interrupts for a GPIO port, and @intr_type is used to store * mask/unmask the interrupts for a GPIO line, and @intr_type is used to store
* the selected interrupt types. The logical AND of these values is written to * the selected interrupt types. The logical AND of these values is written to
* IMR on changes. * IMR on changes.
*/ */
...@@ -59,10 +69,11 @@ struct realtek_gpio_ctrl { ...@@ -59,10 +69,11 @@ struct realtek_gpio_ctrl {
void __iomem *cpumask_base; void __iomem *cpumask_base;
struct cpumask cpu_irq_maskable; struct cpumask cpu_irq_maskable;
raw_spinlock_t lock; raw_spinlock_t lock;
u16 intr_mask[REALTEK_GPIO_PORTS_PER_BANK]; u8 intr_mask[REALTEK_GPIO_MAX];
u16 intr_type[REALTEK_GPIO_PORTS_PER_BANK]; u8 intr_type[REALTEK_GPIO_MAX];
unsigned int (*port_offset_u8)(unsigned int port); u32 (*bank_read)(void __iomem *reg);
unsigned int (*port_offset_u16)(unsigned int port); void (*bank_write)(void __iomem *reg, u32 value);
unsigned int (*line_imr_pos)(unsigned int line);
}; };
/* Expand with more flags as devices with other quirks are added */ /* Expand with more flags as devices with other quirks are added */
...@@ -101,14 +112,22 @@ static struct realtek_gpio_ctrl *irq_data_to_ctrl(struct irq_data *data) ...@@ -101,14 +112,22 @@ static struct realtek_gpio_ctrl *irq_data_to_ctrl(struct irq_data *data)
* port. The two interrupt mask registers store two bits per GPIO, so use u16 * port. The two interrupt mask registers store two bits per GPIO, so use u16
* values. * values.
*/ */
static unsigned int realtek_gpio_port_offset_u8(unsigned int port) static u32 realtek_gpio_bank_read_swapped(void __iomem *reg)
{ {
return port; return ioread32be(reg);
} }
static unsigned int realtek_gpio_port_offset_u16(unsigned int port) static void realtek_gpio_bank_write_swapped(void __iomem *reg, u32 value)
{ {
return 2 * port; iowrite32be(value, reg);
}
static unsigned int realtek_gpio_line_imr_pos_swapped(unsigned int line)
{
unsigned int port_pin = line % 8;
unsigned int port = line / 8;
return 2 * (8 * (port ^ 1) + port_pin);
} }
/* /*
...@@ -119,66 +138,67 @@ static unsigned int realtek_gpio_port_offset_u16(unsigned int port) ...@@ -119,66 +138,67 @@ static unsigned int realtek_gpio_port_offset_u16(unsigned int port)
* per GPIO, so use u16 values. The first register contains ports 1 and 0, the * per GPIO, so use u16 values. The first register contains ports 1 and 0, the
* second ports 3 and 2. * second ports 3 and 2.
*/ */
static unsigned int realtek_gpio_port_offset_u8_rev(unsigned int port) static u32 realtek_gpio_bank_read(void __iomem *reg)
{ {
return 3 - port; return ioread32(reg);
} }
static unsigned int realtek_gpio_port_offset_u16_rev(unsigned int port) static void realtek_gpio_bank_write(void __iomem *reg, u32 value)
{ {
return 2 * (port ^ 1); iowrite32(value, reg);
} }
static void realtek_gpio_write_imr(struct realtek_gpio_ctrl *ctrl, static unsigned int realtek_gpio_line_imr_pos(unsigned int line)
unsigned int port, u16 irq_type, u16 irq_mask)
{ {
iowrite16(irq_type & irq_mask, return 2 * line;
ctrl->base + REALTEK_GPIO_REG_IMR + ctrl->port_offset_u16(port));
} }
static void realtek_gpio_clear_isr(struct realtek_gpio_ctrl *ctrl, static void realtek_gpio_clear_isr(struct realtek_gpio_ctrl *ctrl, u32 mask)
unsigned int port, u8 mask)
{ {
iowrite8(mask, ctrl->base + REALTEK_GPIO_REG_ISR + ctrl->port_offset_u8(port)); ctrl->bank_write(ctrl->base + REALTEK_GPIO_REG_ISR, mask);
} }
static u8 realtek_gpio_read_isr(struct realtek_gpio_ctrl *ctrl, unsigned int port) static u32 realtek_gpio_read_isr(struct realtek_gpio_ctrl *ctrl)
{ {
return ioread8(ctrl->base + REALTEK_GPIO_REG_ISR + ctrl->port_offset_u8(port)); return ctrl->bank_read(ctrl->base + REALTEK_GPIO_REG_ISR);
} }
/* Set the rising and falling edge mask bits for a GPIO port pin */ /* Set the rising and falling edge mask bits for a GPIO pin */
static u16 realtek_gpio_imr_bits(unsigned int pin, u16 value) static void realtek_gpio_update_line_imr(struct realtek_gpio_ctrl *ctrl, unsigned int line)
{ {
return (value & REALTEK_GPIO_IMR_LINE_MASK) << 2 * pin; void __iomem *reg = ctrl->base + REALTEK_GPIO_REG_IMR;
unsigned int line_shift = ctrl->line_imr_pos(line);
unsigned int shift = line_shift % 32;
u32 irq_type = ctrl->intr_type[line];
u32 irq_mask = ctrl->intr_mask[line];
u32 reg_val;
reg += 4 * (line_shift / 32);
reg_val = ioread32(reg);
reg_val &= ~(REALTEK_GPIO_IMR_LINE_MASK << shift);
reg_val |= (irq_type & irq_mask & REALTEK_GPIO_IMR_LINE_MASK) << shift;
iowrite32(reg_val, reg);
} }
static void realtek_gpio_irq_ack(struct irq_data *data) static void realtek_gpio_irq_ack(struct irq_data *data)
{ {
struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data); struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data);
irq_hw_number_t line = irqd_to_hwirq(data); irq_hw_number_t line = irqd_to_hwirq(data);
unsigned int port = line / 8;
unsigned int port_pin = line % 8;
realtek_gpio_clear_isr(ctrl, port, BIT(port_pin)); realtek_gpio_clear_isr(ctrl, BIT(line));
} }
static void realtek_gpio_irq_unmask(struct irq_data *data) static void realtek_gpio_irq_unmask(struct irq_data *data)
{ {
struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data); struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data);
unsigned int line = irqd_to_hwirq(data); unsigned int line = irqd_to_hwirq(data);
unsigned int port = line / 8;
unsigned int port_pin = line % 8;
unsigned long flags; unsigned long flags;
u16 m;
gpiochip_enable_irq(&ctrl->gc, line); gpiochip_enable_irq(&ctrl->gc, line);
raw_spin_lock_irqsave(&ctrl->lock, flags); raw_spin_lock_irqsave(&ctrl->lock, flags);
m = ctrl->intr_mask[port]; ctrl->intr_mask[line] = REALTEK_GPIO_IMR_LINE_MASK;
m |= realtek_gpio_imr_bits(port_pin, REALTEK_GPIO_IMR_LINE_MASK); realtek_gpio_update_line_imr(ctrl, line);
ctrl->intr_mask[port] = m;
realtek_gpio_write_imr(ctrl, port, ctrl->intr_type[port], m);
raw_spin_unlock_irqrestore(&ctrl->lock, flags); raw_spin_unlock_irqrestore(&ctrl->lock, flags);
} }
...@@ -186,16 +206,11 @@ static void realtek_gpio_irq_mask(struct irq_data *data) ...@@ -186,16 +206,11 @@ static void realtek_gpio_irq_mask(struct irq_data *data)
{ {
struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data); struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data);
unsigned int line = irqd_to_hwirq(data); unsigned int line = irqd_to_hwirq(data);
unsigned int port = line / 8;
unsigned int port_pin = line % 8;
unsigned long flags; unsigned long flags;
u16 m;
raw_spin_lock_irqsave(&ctrl->lock, flags); raw_spin_lock_irqsave(&ctrl->lock, flags);
m = ctrl->intr_mask[port]; ctrl->intr_mask[line] = 0;
m &= ~realtek_gpio_imr_bits(port_pin, REALTEK_GPIO_IMR_LINE_MASK); realtek_gpio_update_line_imr(ctrl, line);
ctrl->intr_mask[port] = m;
realtek_gpio_write_imr(ctrl, port, ctrl->intr_type[port], m);
raw_spin_unlock_irqrestore(&ctrl->lock, flags); raw_spin_unlock_irqrestore(&ctrl->lock, flags);
gpiochip_disable_irq(&ctrl->gc, line); gpiochip_disable_irq(&ctrl->gc, line);
...@@ -205,10 +220,8 @@ static int realtek_gpio_irq_set_type(struct irq_data *data, unsigned int flow_ty ...@@ -205,10 +220,8 @@ static int realtek_gpio_irq_set_type(struct irq_data *data, unsigned int flow_ty
{ {
struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data); struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data);
unsigned int line = irqd_to_hwirq(data); unsigned int line = irqd_to_hwirq(data);
unsigned int port = line / 8;
unsigned int port_pin = line % 8;
unsigned long flags; unsigned long flags;
u16 type, t; u8 type;
switch (flow_type & IRQ_TYPE_SENSE_MASK) { switch (flow_type & IRQ_TYPE_SENSE_MASK) {
case IRQ_TYPE_EDGE_FALLING: case IRQ_TYPE_EDGE_FALLING:
...@@ -227,11 +240,8 @@ static int realtek_gpio_irq_set_type(struct irq_data *data, unsigned int flow_ty ...@@ -227,11 +240,8 @@ static int realtek_gpio_irq_set_type(struct irq_data *data, unsigned int flow_ty
irq_set_handler_locked(data, handle_edge_irq); irq_set_handler_locked(data, handle_edge_irq);
raw_spin_lock_irqsave(&ctrl->lock, flags); raw_spin_lock_irqsave(&ctrl->lock, flags);
t = ctrl->intr_type[port]; ctrl->intr_type[line] = type;
t &= ~realtek_gpio_imr_bits(port_pin, REALTEK_GPIO_IMR_LINE_MASK); realtek_gpio_update_line_imr(ctrl, line);
t |= realtek_gpio_imr_bits(port_pin, type);
ctrl->intr_type[port] = t;
realtek_gpio_write_imr(ctrl, port, t, ctrl->intr_mask[port]);
raw_spin_unlock_irqrestore(&ctrl->lock, flags); raw_spin_unlock_irqrestore(&ctrl->lock, flags);
return 0; return 0;
...@@ -242,28 +252,21 @@ static void realtek_gpio_irq_handler(struct irq_desc *desc) ...@@ -242,28 +252,21 @@ static void realtek_gpio_irq_handler(struct irq_desc *desc)
struct gpio_chip *gc = irq_desc_get_handler_data(desc); struct gpio_chip *gc = irq_desc_get_handler_data(desc);
struct realtek_gpio_ctrl *ctrl = gpiochip_get_data(gc); struct realtek_gpio_ctrl *ctrl = gpiochip_get_data(gc);
struct irq_chip *irq_chip = irq_desc_get_chip(desc); struct irq_chip *irq_chip = irq_desc_get_chip(desc);
unsigned int lines_done;
unsigned int port_pin_count;
unsigned long status; unsigned long status;
int offset; int offset;
chained_irq_enter(irq_chip, desc); chained_irq_enter(irq_chip, desc);
for (lines_done = 0; lines_done < gc->ngpio; lines_done += 8) { status = realtek_gpio_read_isr(ctrl);
status = realtek_gpio_read_isr(ctrl, lines_done / 8); for_each_set_bit(offset, &status, gc->ngpio)
port_pin_count = min(gc->ngpio - lines_done, 8U); generic_handle_domain_irq(gc->irq.domain, offset);
for_each_set_bit(offset, &status, port_pin_count)
generic_handle_domain_irq(gc->irq.domain, offset + lines_done);
}
chained_irq_exit(irq_chip, desc); chained_irq_exit(irq_chip, desc);
} }
static inline void __iomem *realtek_gpio_irq_cpu_mask(struct realtek_gpio_ctrl *ctrl, static inline void __iomem *realtek_gpio_irq_cpu_mask(struct realtek_gpio_ctrl *ctrl, int cpu)
unsigned int port, int cpu)
{ {
return ctrl->cpumask_base + ctrl->port_offset_u8(port) + return ctrl->cpumask_base + REALTEK_GPIO_PORTS_PER_BANK * cpu;
REALTEK_GPIO_PORTS_PER_BANK * cpu;
} }
static int realtek_gpio_irq_set_affinity(struct irq_data *data, static int realtek_gpio_irq_set_affinity(struct irq_data *data,
...@@ -271,12 +274,10 @@ static int realtek_gpio_irq_set_affinity(struct irq_data *data, ...@@ -271,12 +274,10 @@ static int realtek_gpio_irq_set_affinity(struct irq_data *data,
{ {
struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data); struct realtek_gpio_ctrl *ctrl = irq_data_to_ctrl(data);
unsigned int line = irqd_to_hwirq(data); unsigned int line = irqd_to_hwirq(data);
unsigned int port = line / 8;
unsigned int port_pin = line % 8;
void __iomem *irq_cpu_mask; void __iomem *irq_cpu_mask;
unsigned long flags; unsigned long flags;
int cpu; int cpu;
u8 v; u32 v;
if (!ctrl->cpumask_base) if (!ctrl->cpumask_base)
return -ENXIO; return -ENXIO;
...@@ -284,15 +285,15 @@ static int realtek_gpio_irq_set_affinity(struct irq_data *data, ...@@ -284,15 +285,15 @@ static int realtek_gpio_irq_set_affinity(struct irq_data *data,
raw_spin_lock_irqsave(&ctrl->lock, flags); raw_spin_lock_irqsave(&ctrl->lock, flags);
for_each_cpu(cpu, &ctrl->cpu_irq_maskable) { for_each_cpu(cpu, &ctrl->cpu_irq_maskable) {
irq_cpu_mask = realtek_gpio_irq_cpu_mask(ctrl, port, cpu); irq_cpu_mask = realtek_gpio_irq_cpu_mask(ctrl, cpu);
v = ioread8(irq_cpu_mask); v = ctrl->bank_read(irq_cpu_mask);
if (cpumask_test_cpu(cpu, dest)) if (cpumask_test_cpu(cpu, dest))
v |= BIT(port_pin); v |= BIT(line);
else else
v &= ~BIT(port_pin); v &= ~BIT(line);
iowrite8(v, irq_cpu_mask); ctrl->bank_write(irq_cpu_mask, v);
} }
raw_spin_unlock_irqrestore(&ctrl->lock, flags); raw_spin_unlock_irqrestore(&ctrl->lock, flags);
...@@ -305,16 +306,17 @@ static int realtek_gpio_irq_set_affinity(struct irq_data *data, ...@@ -305,16 +306,17 @@ static int realtek_gpio_irq_set_affinity(struct irq_data *data,
static int realtek_gpio_irq_init(struct gpio_chip *gc) static int realtek_gpio_irq_init(struct gpio_chip *gc)
{ {
struct realtek_gpio_ctrl *ctrl = gpiochip_get_data(gc); struct realtek_gpio_ctrl *ctrl = gpiochip_get_data(gc);
unsigned int port; u32 mask_all = GENMASK(gc->ngpio - 1, 0);
unsigned int line;
int cpu; int cpu;
for (port = 0; (port * 8) < gc->ngpio; port++) { for (line = 0; line < gc->ngpio; line++)
realtek_gpio_write_imr(ctrl, port, 0, 0); realtek_gpio_update_line_imr(ctrl, line);
realtek_gpio_clear_isr(ctrl, port, GENMASK(7, 0));
for_each_cpu(cpu, &ctrl->cpu_irq_maskable) realtek_gpio_clear_isr(ctrl, mask_all);
iowrite8(GENMASK(7, 0), realtek_gpio_irq_cpu_mask(ctrl, port, cpu));
} for_each_cpu(cpu, &ctrl->cpu_irq_maskable)
ctrl->bank_write(realtek_gpio_irq_cpu_mask(ctrl, cpu), mask_all);
return 0; return 0;
} }
...@@ -387,12 +389,14 @@ static int realtek_gpio_probe(struct platform_device *pdev) ...@@ -387,12 +389,14 @@ static int realtek_gpio_probe(struct platform_device *pdev)
if (dev_flags & GPIO_PORTS_REVERSED) { if (dev_flags & GPIO_PORTS_REVERSED) {
bgpio_flags = 0; bgpio_flags = 0;
ctrl->port_offset_u8 = realtek_gpio_port_offset_u8_rev; ctrl->bank_read = realtek_gpio_bank_read;
ctrl->port_offset_u16 = realtek_gpio_port_offset_u16_rev; ctrl->bank_write = realtek_gpio_bank_write;
ctrl->line_imr_pos = realtek_gpio_line_imr_pos;
} else { } else {
bgpio_flags = BGPIOF_BIG_ENDIAN_BYTE_ORDER; bgpio_flags = BGPIOF_BIG_ENDIAN_BYTE_ORDER;
ctrl->port_offset_u8 = realtek_gpio_port_offset_u8; ctrl->bank_read = realtek_gpio_bank_read_swapped;
ctrl->port_offset_u16 = realtek_gpio_port_offset_u16; ctrl->bank_write = realtek_gpio_bank_write_swapped;
ctrl->line_imr_pos = realtek_gpio_line_imr_pos_swapped;
} }
err = bgpio_init(&ctrl->gc, dev, 4, err = bgpio_init(&ctrl->gc, dev, 4,
......
...@@ -265,6 +265,7 @@ static void ws16c48_irq_mask(struct irq_data *data) ...@@ -265,6 +265,7 @@ static void ws16c48_irq_mask(struct irq_data *data)
raw_spin_lock_irqsave(&ws16c48gpio->lock, flags); raw_spin_lock_irqsave(&ws16c48gpio->lock, flags);
ws16c48gpio->irq_mask &= ~mask; ws16c48gpio->irq_mask &= ~mask;
gpiochip_disable_irq(chip, offset);
port_state = ws16c48gpio->irq_mask >> (8 * port); port_state = ws16c48gpio->irq_mask >> (8 * port);
/* Select Register Page 2; Unlock all I/O ports */ /* Select Register Page 2; Unlock all I/O ports */
...@@ -295,6 +296,7 @@ static void ws16c48_irq_unmask(struct irq_data *data) ...@@ -295,6 +296,7 @@ static void ws16c48_irq_unmask(struct irq_data *data)
raw_spin_lock_irqsave(&ws16c48gpio->lock, flags); raw_spin_lock_irqsave(&ws16c48gpio->lock, flags);
gpiochip_enable_irq(chip, offset);
ws16c48gpio->irq_mask |= mask; ws16c48gpio->irq_mask |= mask;
port_state = ws16c48gpio->irq_mask >> (8 * port); port_state = ws16c48gpio->irq_mask >> (8 * port);
...@@ -356,12 +358,14 @@ static int ws16c48_irq_set_type(struct irq_data *data, unsigned flow_type) ...@@ -356,12 +358,14 @@ static int ws16c48_irq_set_type(struct irq_data *data, unsigned flow_type)
return 0; return 0;
} }
static struct irq_chip ws16c48_irqchip = { static const struct irq_chip ws16c48_irqchip = {
.name = "ws16c48", .name = "ws16c48",
.irq_ack = ws16c48_irq_ack, .irq_ack = ws16c48_irq_ack,
.irq_mask = ws16c48_irq_mask, .irq_mask = ws16c48_irq_mask,
.irq_unmask = ws16c48_irq_unmask, .irq_unmask = ws16c48_irq_unmask,
.irq_set_type = ws16c48_irq_set_type .irq_set_type = ws16c48_irq_set_type,
.flags = IRQCHIP_IMMUTABLE,
GPIOCHIP_IRQ_RESOURCE_HELPERS,
}; };
static irqreturn_t ws16c48_irq_handler(int irq, void *dev_id) static irqreturn_t ws16c48_irq_handler(int irq, void *dev_id)
...@@ -463,7 +467,7 @@ static int ws16c48_probe(struct device *dev, unsigned int id) ...@@ -463,7 +467,7 @@ static int ws16c48_probe(struct device *dev, unsigned int id)
ws16c48gpio->chip.set_multiple = ws16c48_gpio_set_multiple; ws16c48gpio->chip.set_multiple = ws16c48_gpio_set_multiple;
girq = &ws16c48gpio->chip.irq; girq = &ws16c48gpio->chip.irq;
girq->chip = &ws16c48_irqchip; gpio_irq_chip_set_chip(girq, &ws16c48_irqchip);
/* This will let us handle the parent IRQ in the driver */ /* This will let us handle the parent IRQ in the driver */
girq->parent_handler = NULL; girq->parent_handler = NULL;
girq->num_parents = 0; girq->num_parents = 0;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册