Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 837c8293 authored by Haojian Zhuang's avatar Haojian Zhuang Committed by Samuel Ortiz
Browse files

mfd: 88pm860x: Use irqdomain 



Use irqdomain and allocating interrupts. It's necessary for supporting
DT mode.

Signed-off-by: default avatarHaojian Zhuang <haojian.zhuang@gmail.com>
Signed-off-by: default avatarSamuel Ortiz <sameo@linux.intel.com>
parent 8284328c

drivers/mfd/88pm860x-core.c

+38 −27
Original line number Original line Diff line number Diff line
@@ -15,6 +15,7 @@ 
#include <linux/i2c.h>

#include <linux/i2c.h>

#include <linux/irq.h>

#include <linux/irq.h>

#include <linux/interrupt.h>

#include <linux/interrupt.h>

#include <linux/irqdomain.h>

#include <linux/platform_device.h>

#include <linux/platform_device.h>

#include <linux/regmap.h>

#include <linux/regmap.h>

#include <linux/slab.h>

#include <linux/slab.h>
@@ -520,15 +521,12 @@ static void pm860x_irq_sync_unlock(struct irq_data *data) 




static void pm860x_irq_enable(struct irq_data *data)

static void pm860x_irq_enable(struct irq_data *data)

{

{

	struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);

	pm860x_irqs[data->hwirq].enable = pm860x_irqs[data->hwirq].offs;

	pm860x_irqs[data->irq - chip->irq_base].enable

		= pm860x_irqs[data->irq - chip->irq_base].offs;

}

}





static void pm860x_irq_disable(struct irq_data *data)

static void pm860x_irq_disable(struct irq_data *data)

{

{

	struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);

	pm860x_irqs[data->hwirq].enable = 0;

	pm860x_irqs[data->irq - chip->irq_base].enable = 0;

}

}





static struct irq_chip pm860x_irq_chip = {

static struct irq_chip pm860x_irq_chip = {
@@ -539,6 +537,25 @@ static struct irq_chip pm860x_irq_chip = { 
	.irq_disable	= pm860x_irq_disable,

	.irq_disable	= pm860x_irq_disable,

};

};





static int pm860x_irq_domain_map(struct irq_domain *d, unsigned int virq,

				 irq_hw_number_t hw)

{

	irq_set_chip_data(virq, d->host_data);

	irq_set_chip_and_handler(virq, &pm860x_irq_chip, handle_edge_irq);

	irq_set_nested_thread(virq, 1);

#ifdef CONFIG_ARM

	set_irq_flags(virq, IRQF_VALID);

#else

	irq_set_noprobe(virq);

#endif

	return 0;

}



static struct irq_domain_ops pm860x_irq_domain_ops = {

	.map	= pm860x_irq_domain_map,

	.xlate	= irq_domain_xlate_onetwocell,

};



static int __devinit device_gpadc_init(struct pm860x_chip *chip,

static int __devinit device_gpadc_init(struct pm860x_chip *chip,

				       struct pm860x_platform_data *pdata)

				       struct pm860x_platform_data *pdata)

{

{
@@ -593,13 +610,9 @@ static int __devinit device_irq_init(struct pm860x_chip *chip, 
				: chip->companion;

				: chip->companion;

	unsigned char status_buf[INT_STATUS_NUM];

	unsigned char status_buf[INT_STATUS_NUM];

	unsigned long flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;

	unsigned long flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;

	int i, data, mask, ret = -EINVAL;

	int data, mask, ret = -EINVAL;

	int __irq;

	int nr_irqs, irq_base = -1;



	struct device_node *node = i2c->dev.of_node;

	if (!pdata || !pdata->irq_base) {

		dev_warn(chip->dev, "No interrupt support on IRQ base\n");

		return -EINVAL;

	}





	mask = PM8607_B0_MISC1_INV_INT | PM8607_B0_MISC1_INT_CLEAR

	mask = PM8607_B0_MISC1_INV_INT | PM8607_B0_MISC1_INT_CLEAR

		| PM8607_B0_MISC1_INT_MASK;

		| PM8607_B0_MISC1_INT_MASK;
@@ -639,25 +652,23 @@ static int __devinit device_irq_init(struct pm860x_chip *chip, 
		goto out;

		goto out;





	mutex_init(&chip->irq_lock);

	mutex_init(&chip->irq_lock);

	chip->irq_base = pdata->irq_base;



	if (pdata && pdata->irq_base)

		irq_base = pdata->irq_base;

	nr_irqs = ARRAY_SIZE(pm860x_irqs);

	chip->irq_base = irq_alloc_descs(irq_base, 0, nr_irqs, 0);

	if (chip->irq_base < 0) {

		dev_err(&i2c->dev, "Failed to allocate interrupts, ret:%d\n",

			chip->irq_base);

		ret = -EBUSY;

		goto out;

	}

	irq_domain_add_legacy(node, nr_irqs, chip->irq_base, 0,

			      &pm860x_irq_domain_ops, chip);

	chip->core_irq = i2c->irq;

	chip->core_irq = i2c->irq;

	if (!chip->core_irq)

	if (!chip->core_irq)

		goto out;

		goto out;





	/* register IRQ by genirq */

	for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {

		__irq = i + chip->irq_base;

		irq_set_chip_data(__irq, chip);

		irq_set_chip_and_handler(__irq, &pm860x_irq_chip,

					 handle_edge_irq);

		irq_set_nested_thread(__irq, 1);

#ifdef CONFIG_ARM

		set_irq_flags(__irq, IRQF_VALID);

#else

		irq_set_noprobe(__irq);

#endif

	}



	ret = request_threaded_irq(chip->core_irq, NULL, pm860x_irq, flags | IRQF_ONESHOT,

	ret = request_threaded_irq(chip->core_irq, NULL, pm860x_irq, flags | IRQF_ONESHOT,

				   "88pm860x", chip);

				   "88pm860x", chip);

	if (ret) {

	if (ret) {