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

Commit d49a0f3f authored by Margarita Olaya's avatar Margarita Olaya Committed by Samuel Ortiz
Browse files

tps65912: irq: add interrupt controller 



This module controls the interrupt handling for the tps65912.
The interrupt sources can be the following:

- GPIO
- PWRON signal
- PWRHOLD signal
- Temperature detection

Signed-off-by: default avatarMargarita Olaya Cabrera <magi@slimlogic.co.uk>
Acked-by: default avatarSamuel Ortiz <sameo@linux.intel.com>
Acked-by: default avatarLiam Girdwood <lrg@ti.com>
Signed-off-by: default avatarSamuel Ortiz <sameo@linux.intel.com>
parent 36e52873

drivers/mfd/Makefile

+1 −1
Original line number Diff line number Diff line
@@ -36,7 +36,7 @@ obj-$(CONFIG_MFD_WM8994) += wm8994-core.o wm8994-irq.o 
obj-$(CONFIG_TPS6105X)		+= tps6105x.o

obj-$(CONFIG_TPS65010)		+= tps65010.o

obj-$(CONFIG_TPS6507X)		+= tps6507x.o

tps65912-objs                   := tps65912-core.o

tps65912-objs                   := tps65912-core.o tps65912-irq.o

obj-$(CONFIG_MFD_TPS65912)	+= tps65912.o

obj-$(CONFIG_MFD_TPS65912_I2C)	+= tps65912-i2c.o

obj-$(CONFIG_MFD_TPS65912_SPI)  += tps65912-spi.o

drivers/mfd/tps65912-core.c

+13 −0
Original line number Diff line number Diff line
@@ -124,8 +124,16 @@ EXPORT_SYMBOL_GPL(tps65912_reg_write); 
int tps65912_device_init(struct tps65912 *tps65912)

{

	struct tps65912_board *pmic_plat_data = tps65912->dev->platform_data;

	struct tps65912_platform_data *init_data;

	int ret, dcdc_avs, value;



	init_data = kzalloc(sizeof(struct tps65912_platform_data), GFP_KERNEL);

	if (init_data == NULL)

		return -ENOMEM;



	init_data->irq = pmic_plat_data->irq;

	init_data->irq_base = pmic_plat_data->irq;



	mutex_init(&tps65912->io_mutex);

	dev_set_drvdata(tps65912->dev, tps65912);
@@ -145,9 +153,14 @@ int tps65912_device_init(struct tps65912 *tps65912) 
	if (ret < 0)

		goto err;



	ret = tps65912_irq_init(tps65912, init_data->irq, init_data);

	if (ret < 0)

		goto err;



	return ret;



err:

	kfree(init_data);

	mfd_remove_devices(tps65912->dev);

	kfree(tps65912);

	return ret;

drivers/mfd/tps65912-irq.c

0 → 100644
+224 −0
Original line number Diff line number Diff line 
/*

 * tps65912-irq.c  --  TI TPS6591x

 *

 * Copyright 2011 Texas Instruments Inc.

 *

 * Author: Margarita Olaya <magi@slimlogic.co.uk>

 *

 *  This program is free software; you can redistribute it and/or modify it

 *  under  the terms of the GNU General  Public License as published by the

 *  Free Software Foundation;  either version 2 of the License, or (at your

 *  option) any later version.

 *

 * This driver is based on wm8350 implementation.

 */



#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/init.h>

#include <linux/bug.h>

#include <linux/device.h>

#include <linux/interrupt.h>

#include <linux/irq.h>

#include <linux/gpio.h>

#include <linux/mfd/tps65912.h>



static inline int irq_to_tps65912_irq(struct tps65912 *tps65912,

							int irq)

{

	return irq - tps65912->irq_base;

}



/*

 * This is a threaded IRQ handler so can access I2C/SPI.  Since the

 * IRQ handler explicitly clears the IRQ it handles the IRQ line

 * will be reasserted and the physical IRQ will be handled again if

 * another interrupt is asserted while we run - in the normal course

 * of events this is a rare occurrence so we save I2C/SPI reads. We're

 * also assuming that it's rare to get lots of interrupts firing

 * simultaneously so try to minimise I/O.

 */

static irqreturn_t tps65912_irq(int irq, void *irq_data)

{

	struct tps65912 *tps65912 = irq_data;

	u32 irq_sts;

	u32 irq_mask;

	u8 reg;

	int i;





	tps65912->read(tps65912, TPS65912_INT_STS, 1, &reg);

	irq_sts = reg;

	tps65912->read(tps65912, TPS65912_INT_STS2, 1, &reg);

	irq_sts |= reg << 8;

	tps65912->read(tps65912, TPS65912_INT_STS3, 1, &reg);

	irq_sts |= reg << 16;

	tps65912->read(tps65912, TPS65912_INT_STS4, 1, &reg);

	irq_sts |= reg << 24;



	tps65912->read(tps65912, TPS65912_INT_MSK, 1, &reg);

	irq_mask = reg;

	tps65912->read(tps65912, TPS65912_INT_MSK2, 1, &reg);

	irq_mask |= reg << 8;

	tps65912->read(tps65912, TPS65912_INT_MSK3, 1, &reg);

	irq_mask |= reg << 16;

	tps65912->read(tps65912, TPS65912_INT_MSK4, 1, &reg);

	irq_mask |= reg << 24;



	irq_sts &= ~irq_mask;

	if (!irq_sts)

		return IRQ_NONE;



	for (i = 0; i < tps65912->irq_num; i++) {

		if (!(irq_sts & (1 << i)))

			continue;



		handle_nested_irq(tps65912->irq_base + i);

	}



	/* Write the STS register back to clear IRQs we handled */

	reg = irq_sts & 0xFF;

	irq_sts >>= 8;

	if (reg)

		tps65912->write(tps65912, TPS65912_INT_STS, 1, &reg);

	reg = irq_sts & 0xFF;

	irq_sts >>= 8;

	if (reg)

		tps65912->write(tps65912, TPS65912_INT_STS2, 1, &reg);

	reg = irq_sts & 0xFF;

	irq_sts >>= 8;

	if (reg)

		tps65912->write(tps65912, TPS65912_INT_STS3, 1, &reg);

	reg = irq_sts & 0xFF;

	if (reg)

		tps65912->write(tps65912, TPS65912_INT_STS4, 1, &reg);



	return IRQ_HANDLED;

}



static void tps65912_irq_lock(struct irq_data *data)

{

	struct tps65912 *tps65912 = irq_data_get_irq_chip_data(data);



	mutex_lock(&tps65912->irq_lock);

}



static void tps65912_irq_sync_unlock(struct irq_data *data)

{

	struct tps65912 *tps65912 = irq_data_get_irq_chip_data(data);

	u32 reg_mask;

	u8 reg;



	tps65912->read(tps65912, TPS65912_INT_MSK, 1, &reg);

	reg_mask = reg;

	tps65912->read(tps65912, TPS65912_INT_MSK2, 1, &reg);

	reg_mask |= reg << 8;

	tps65912->read(tps65912, TPS65912_INT_MSK3, 1, &reg);

	reg_mask |= reg << 16;

	tps65912->read(tps65912, TPS65912_INT_MSK4, 1, &reg);

	reg_mask |= reg << 24;



	if (tps65912->irq_mask != reg_mask) {

		reg = tps65912->irq_mask & 0xFF;

		tps65912->write(tps65912, TPS65912_INT_MSK, 1, &reg);

		reg = tps65912->irq_mask >> 8 & 0xFF;

		tps65912->write(tps65912, TPS65912_INT_MSK2, 1, &reg);

		reg = tps65912->irq_mask >> 16 & 0xFF;

		tps65912->write(tps65912, TPS65912_INT_MSK3, 1, &reg);

		reg = tps65912->irq_mask >> 24 & 0xFF;

		tps65912->write(tps65912, TPS65912_INT_MSK4, 1, &reg);

	}



	mutex_unlock(&tps65912->irq_lock);

}



static void tps65912_irq_enable(struct irq_data *data)

{

	struct tps65912 *tps65912 = irq_data_get_irq_chip_data(data);



	tps65912->irq_mask &= ~(1 << irq_to_tps65912_irq(tps65912, data->irq));

}



static void tps65912_irq_disable(struct irq_data *data)

{

	struct tps65912 *tps65912 = irq_data_get_irq_chip_data(data);



	tps65912->irq_mask |= (1 << irq_to_tps65912_irq(tps65912, data->irq));

}



static struct irq_chip tps65912_irq_chip = {

	.name = "tps65912",

	.irq_bus_lock = tps65912_irq_lock,

	.irq_bus_sync_unlock = tps65912_irq_sync_unlock,

	.irq_disable = tps65912_irq_disable,

	.irq_enable = tps65912_irq_enable,

};



int tps65912_irq_init(struct tps65912 *tps65912, int irq,

			    struct tps65912_platform_data *pdata)

{

	int ret, cur_irq;

	int flags = IRQF_ONESHOT;

	u8 reg;



	if (!irq) {

		dev_warn(tps65912->dev, "No interrupt support, no core IRQ\n");

		return 0;

	}



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

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

		return 0;

	}



	/* Clear unattended interrupts */

	tps65912->read(tps65912, TPS65912_INT_STS, 1, &reg);

	tps65912->write(tps65912, TPS65912_INT_STS, 1, &reg);

	tps65912->read(tps65912, TPS65912_INT_STS2, 1, &reg);

	tps65912->write(tps65912, TPS65912_INT_STS2, 1, &reg);

	tps65912->read(tps65912, TPS65912_INT_STS3, 1, &reg);

	tps65912->write(tps65912, TPS65912_INT_STS3, 1, &reg);

	tps65912->read(tps65912, TPS65912_INT_STS4, 1, &reg);

	tps65912->write(tps65912, TPS65912_INT_STS4, 1, &reg);



	/* Mask top level interrupts */

	tps65912->irq_mask = 0xFFFFFFFF;



	mutex_init(&tps65912->irq_lock);

	tps65912->chip_irq = irq;

	tps65912->irq_base = pdata->irq_base;



	tps65912->irq_num = TPS65912_NUM_IRQ;



	/* Register with genirq */

	for (cur_irq = tps65912->irq_base;

	     cur_irq < tps65912->irq_num + tps65912->irq_base;

	     cur_irq++) {

		irq_set_chip_data(cur_irq, tps65912);

		irq_set_chip_and_handler(cur_irq, &tps65912_irq_chip,

					 handle_edge_irq);

		irq_set_nested_thread(cur_irq, 1);

		/* ARM needs us to explicitly flag the IRQ as valid

		 * and will set them noprobe when we do so. */

#ifdef CONFIG_ARM

		set_irq_flags(cur_irq, IRQF_VALID);

#else

		irq_set_noprobe(cur_irq);

#endif

	}



	ret = request_threaded_irq(irq, NULL, tps65912_irq, flags,

				   "tps65912", tps65912);



	irq_set_irq_type(irq, IRQ_TYPE_LEVEL_LOW);

	if (ret != 0)

		dev_err(tps65912->dev, "Failed to request IRQ: %d\n", ret);



	return ret;

}



int tps65912_irq_exit(struct tps65912 *tps65912)

{

	free_irq(tps65912->chip_irq, tps65912);

	return 0;

}

include/linux/mfd/tps65912.h

+5 −0
Original line number Diff line number Diff line
@@ -273,6 +273,8 @@ struct tps65912_board { 
	int is_dcdc2_avs;

	int is_dcdc3_avs;

	int is_dcdc4_avs;

	int irq;

	int irq_base;

	struct regulator_init_data *tps65912_pmic_init_data;

};
@@ -306,6 +308,7 @@ struct tps65912 { 
};



struct tps65912_platform_data {

	int irq;

	int irq_base;

};
@@ -317,5 +320,7 @@ int tps65912_reg_read(struct tps65912 *tps65912, u8 reg); 
int tps65912_reg_write(struct tps65912 *tps65912, u8 reg, u8 val);

int tps65912_device_init(struct tps65912 *tps65912);

void tps65912_device_exit(struct tps65912 *tps65912);

int tps65912_irq_init(struct tps65912 *tps65912, int irq,

			struct tps65912_platform_data *pdata);



#endif /*  __LINUX_MFD_TPS65912_H */