gpio: ws16c48: Use irqchip template
This makes the driver use the irqchip template to assign properties to the gpio_irq_chip instead of using the explicit call to gpiochip_irqchip_add(). The irqchip is instead added while adding the gpiochip. Also move the IRQ initialization to the special .init_hw() callback. Signed-off-by: Linus Walleij <linus.walleij@linaro.org> Acked-by: William Breathitt Gray <vilhelm.gray@gmail.com> Cc: William Breathitt Gray <vilhelm.gray@gmail.com> Link: https://lore.kernel.org/r/20200722101938.151265-1-linus.walleij@linaro.org
This commit is contained in:
parent
bde8c0e64c
commit
fceb7ab385
|
@ -365,10 +365,25 @@ static const char *ws16c48_names[WS16C48_NGPIO] = {
|
||||||
"Port 5 Bit 4", "Port 5 Bit 5", "Port 5 Bit 6", "Port 5 Bit 7"
|
"Port 5 Bit 4", "Port 5 Bit 5", "Port 5 Bit 6", "Port 5 Bit 7"
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static int ws16c48_irq_init_hw(struct gpio_chip *gc)
|
||||||
|
{
|
||||||
|
struct ws16c48_gpio *const ws16c48gpio = gpiochip_get_data(gc);
|
||||||
|
|
||||||
|
/* Disable IRQ by default */
|
||||||
|
outb(0x80, ws16c48gpio->base + 7);
|
||||||
|
outb(0, ws16c48gpio->base + 8);
|
||||||
|
outb(0, ws16c48gpio->base + 9);
|
||||||
|
outb(0, ws16c48gpio->base + 10);
|
||||||
|
outb(0xC0, ws16c48gpio->base + 7);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static int ws16c48_probe(struct device *dev, unsigned int id)
|
static int ws16c48_probe(struct device *dev, unsigned int id)
|
||||||
{
|
{
|
||||||
struct ws16c48_gpio *ws16c48gpio;
|
struct ws16c48_gpio *ws16c48gpio;
|
||||||
const char *const name = dev_name(dev);
|
const char *const name = dev_name(dev);
|
||||||
|
struct gpio_irq_chip *girq;
|
||||||
int err;
|
int err;
|
||||||
|
|
||||||
ws16c48gpio = devm_kzalloc(dev, sizeof(*ws16c48gpio), GFP_KERNEL);
|
ws16c48gpio = devm_kzalloc(dev, sizeof(*ws16c48gpio), GFP_KERNEL);
|
||||||
|
@ -396,6 +411,16 @@ 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;
|
||||||
ws16c48gpio->base = base[id];
|
ws16c48gpio->base = base[id];
|
||||||
|
|
||||||
|
girq = &ws16c48gpio->chip.irq;
|
||||||
|
girq->chip = &ws16c48_irqchip;
|
||||||
|
/* This will let us handle the parent IRQ in the driver */
|
||||||
|
girq->parent_handler = NULL;
|
||||||
|
girq->num_parents = 0;
|
||||||
|
girq->parents = NULL;
|
||||||
|
girq->default_type = IRQ_TYPE_NONE;
|
||||||
|
girq->handler = handle_edge_irq;
|
||||||
|
girq->init_hw = ws16c48_irq_init_hw;
|
||||||
|
|
||||||
raw_spin_lock_init(&ws16c48gpio->lock);
|
raw_spin_lock_init(&ws16c48gpio->lock);
|
||||||
|
|
||||||
err = devm_gpiochip_add_data(dev, &ws16c48gpio->chip, ws16c48gpio);
|
err = devm_gpiochip_add_data(dev, &ws16c48gpio->chip, ws16c48gpio);
|
||||||
|
@ -404,20 +429,6 @@ static int ws16c48_probe(struct device *dev, unsigned int id)
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Disable IRQ by default */
|
|
||||||
outb(0x80, base[id] + 7);
|
|
||||||
outb(0, base[id] + 8);
|
|
||||||
outb(0, base[id] + 9);
|
|
||||||
outb(0, base[id] + 10);
|
|
||||||
outb(0xC0, base[id] + 7);
|
|
||||||
|
|
||||||
err = gpiochip_irqchip_add(&ws16c48gpio->chip, &ws16c48_irqchip, 0,
|
|
||||||
handle_edge_irq, IRQ_TYPE_NONE);
|
|
||||||
if (err) {
|
|
||||||
dev_err(dev, "Could not add irqchip (%d)\n", err);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
err = devm_request_irq(dev, irq[id], ws16c48_irq_handler, IRQF_SHARED,
|
err = devm_request_irq(dev, irq[id], ws16c48_irq_handler, IRQF_SHARED,
|
||||||
name, ws16c48gpio);
|
name, ws16c48gpio);
|
||||||
if (err) {
|
if (err) {
|
||||||
|
|
Loading…
Reference in New Issue