Presently driver expects irq_gpio pin in platform data and maps it to irq itself. But we can also directly specify the interrupt in DT or platform file. Signed-off-by: Yadwinder Singh Brar <yadi.brar@samsung.com> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
		
			
				
	
	
		
			319 lines
		
	
	
	
		
			8.8 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			319 lines
		
	
	
	
		
			8.8 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * max77686-irq.c - Interrupt controller support for MAX77686
 | 
						|
 *
 | 
						|
 * Copyright (C) 2012 Samsung Electronics Co.Ltd
 | 
						|
 * Chiwoong Byun <woong.byun@samsung.com>
 | 
						|
 *
 | 
						|
 * 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 program is distributed in the hope that it will be useful,
 | 
						|
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
						|
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
						|
 * GNU General Public License for more details.
 | 
						|
 *
 | 
						|
 * You should have received a copy of the GNU General Public License
 | 
						|
 * along with this program; if not, write to the Free Software
 | 
						|
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 | 
						|
 *
 | 
						|
 * This driver is based on max8997-irq.c
 | 
						|
 */
 | 
						|
 | 
						|
#include <linux/err.h>
 | 
						|
#include <linux/irq.h>
 | 
						|
#include <linux/interrupt.h>
 | 
						|
#include <linux/gpio.h>
 | 
						|
#include <linux/mfd/max77686.h>
 | 
						|
#include <linux/mfd/max77686-private.h>
 | 
						|
#include <linux/irqdomain.h>
 | 
						|
#include <linux/regmap.h>
 | 
						|
 | 
						|
enum {
 | 
						|
	MAX77686_DEBUG_IRQ_INFO = 1 << 0,
 | 
						|
	MAX77686_DEBUG_IRQ_MASK = 1 << 1,
 | 
						|
	MAX77686_DEBUG_IRQ_INT = 1 << 2,
 | 
						|
};
 | 
						|
 | 
						|
static int debug_mask = 0;
 | 
						|
module_param(debug_mask, int, 0);
 | 
						|
MODULE_PARM_DESC(debug_mask, "Set debug_mask : 0x0=off 0x1=IRQ_INFO  0x2=IRQ_MASK 0x4=IRQ_INI)");
 | 
						|
 | 
						|
static const u8 max77686_mask_reg[] = {
 | 
						|
	[PMIC_INT1] = MAX77686_REG_INT1MSK,
 | 
						|
	[PMIC_INT2] = MAX77686_REG_INT2MSK,
 | 
						|
	[RTC_INT] = MAX77686_RTC_INTM,
 | 
						|
};
 | 
						|
 | 
						|
static struct regmap *max77686_get_regmap(struct max77686_dev *max77686,
 | 
						|
				enum max77686_irq_source src)
 | 
						|
{
 | 
						|
	switch (src) {
 | 
						|
	case PMIC_INT1 ... PMIC_INT2:
 | 
						|
		return max77686->regmap;
 | 
						|
	case RTC_INT:
 | 
						|
		return max77686->rtc_regmap;
 | 
						|
	default:
 | 
						|
		return ERR_PTR(-EINVAL);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
struct max77686_irq_data {
 | 
						|
	int mask;
 | 
						|
	enum max77686_irq_source group;
 | 
						|
};
 | 
						|
 | 
						|
#define DECLARE_IRQ(idx, _group, _mask)		\
 | 
						|
	[(idx)] = { .group = (_group), .mask = (_mask) }
 | 
						|
static const struct max77686_irq_data max77686_irqs[] = {
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_PWRONF,	PMIC_INT1, 1 << 0),
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_PWRONR,	PMIC_INT1, 1 << 1),
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_JIGONBF,	PMIC_INT1, 1 << 2),
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_JIGONBR,	PMIC_INT1, 1 << 3),
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_ACOKBF,	PMIC_INT1, 1 << 4),
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_ACOKBR,	PMIC_INT1, 1 << 5),
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_ONKEY1S,	PMIC_INT1, 1 << 6),
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_MRSTB,		PMIC_INT1, 1 << 7),
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_140C,		PMIC_INT2, 1 << 0),
 | 
						|
	DECLARE_IRQ(MAX77686_PMICIRQ_120C,		PMIC_INT2, 1 << 1),
 | 
						|
	DECLARE_IRQ(MAX77686_RTCIRQ_RTC60S,		RTC_INT, 1 << 0),
 | 
						|
	DECLARE_IRQ(MAX77686_RTCIRQ_RTCA1,		RTC_INT, 1 << 1),
 | 
						|
	DECLARE_IRQ(MAX77686_RTCIRQ_RTCA2,		RTC_INT, 1 << 2),
 | 
						|
	DECLARE_IRQ(MAX77686_RTCIRQ_SMPL,		RTC_INT, 1 << 3),
 | 
						|
	DECLARE_IRQ(MAX77686_RTCIRQ_RTC1S,		RTC_INT, 1 << 4),
 | 
						|
	DECLARE_IRQ(MAX77686_RTCIRQ_WTSR,		RTC_INT, 1 << 5),
 | 
						|
};
 | 
						|
 | 
						|
static void max77686_irq_lock(struct irq_data *data)
 | 
						|
{
 | 
						|
	struct max77686_dev *max77686 = irq_get_chip_data(data->irq);
 | 
						|
 | 
						|
	if (debug_mask & MAX77686_DEBUG_IRQ_MASK)
 | 
						|
		pr_info("%s\n", __func__);
 | 
						|
 | 
						|
	mutex_lock(&max77686->irqlock);
 | 
						|
}
 | 
						|
 | 
						|
static void max77686_irq_sync_unlock(struct irq_data *data)
 | 
						|
{
 | 
						|
	struct max77686_dev *max77686 = irq_get_chip_data(data->irq);
 | 
						|
	int i;
 | 
						|
 | 
						|
	for (i = 0; i < MAX77686_IRQ_GROUP_NR; i++) {
 | 
						|
		u8 mask_reg = max77686_mask_reg[i];
 | 
						|
		struct regmap *map = max77686_get_regmap(max77686, i);
 | 
						|
 | 
						|
		if (debug_mask & MAX77686_DEBUG_IRQ_MASK)
 | 
						|
			pr_debug("%s: mask_reg[%d]=0x%x, cur=0x%x\n",
 | 
						|
			__func__, i, mask_reg, max77686->irq_masks_cur[i]);
 | 
						|
 | 
						|
		if (mask_reg == MAX77686_REG_INVALID ||
 | 
						|
				IS_ERR_OR_NULL(map))
 | 
						|
			continue;
 | 
						|
 | 
						|
		max77686->irq_masks_cache[i] = max77686->irq_masks_cur[i];
 | 
						|
 | 
						|
		regmap_write(map, max77686_mask_reg[i],
 | 
						|
				max77686->irq_masks_cur[i]);
 | 
						|
	}
 | 
						|
 | 
						|
	mutex_unlock(&max77686->irqlock);
 | 
						|
}
 | 
						|
 | 
						|
static const inline struct max77686_irq_data *to_max77686_irq(int irq)
 | 
						|
{
 | 
						|
	struct irq_data *data = irq_get_irq_data(irq);
 | 
						|
	return &max77686_irqs[data->hwirq];
 | 
						|
}
 | 
						|
 | 
						|
static void max77686_irq_mask(struct irq_data *data)
 | 
						|
{
 | 
						|
	struct max77686_dev *max77686 = irq_get_chip_data(data->irq);
 | 
						|
	const struct max77686_irq_data *irq_data = to_max77686_irq(data->irq);
 | 
						|
 | 
						|
	max77686->irq_masks_cur[irq_data->group] |= irq_data->mask;
 | 
						|
 | 
						|
	if (debug_mask & MAX77686_DEBUG_IRQ_MASK)
 | 
						|
		pr_info("%s: group=%d, cur=0x%x\n",
 | 
						|
			__func__, irq_data->group,
 | 
						|
			max77686->irq_masks_cur[irq_data->group]);
 | 
						|
}
 | 
						|
 | 
						|
static void max77686_irq_unmask(struct irq_data *data)
 | 
						|
{
 | 
						|
	struct max77686_dev *max77686 = irq_get_chip_data(data->irq);
 | 
						|
	const struct max77686_irq_data *irq_data = to_max77686_irq(data->irq);
 | 
						|
 | 
						|
	max77686->irq_masks_cur[irq_data->group] &= ~irq_data->mask;
 | 
						|
 | 
						|
	if (debug_mask & MAX77686_DEBUG_IRQ_MASK)
 | 
						|
		pr_info("%s: group=%d, cur=0x%x\n",
 | 
						|
			__func__, irq_data->group,
 | 
						|
			max77686->irq_masks_cur[irq_data->group]);
 | 
						|
}
 | 
						|
 | 
						|
static struct irq_chip max77686_irq_chip = {
 | 
						|
	.name			= "max77686",
 | 
						|
	.irq_bus_lock		= max77686_irq_lock,
 | 
						|
	.irq_bus_sync_unlock	= max77686_irq_sync_unlock,
 | 
						|
	.irq_mask		= max77686_irq_mask,
 | 
						|
	.irq_unmask		= max77686_irq_unmask,
 | 
						|
};
 | 
						|
 | 
						|
static irqreturn_t max77686_irq_thread(int irq, void *data)
 | 
						|
{
 | 
						|
	struct max77686_dev *max77686 = data;
 | 
						|
	unsigned int irq_reg[MAX77686_IRQ_GROUP_NR] = {};
 | 
						|
	unsigned int irq_src;
 | 
						|
	int ret;
 | 
						|
	int i, cur_irq;
 | 
						|
 | 
						|
	ret = regmap_read(max77686->regmap,  MAX77686_REG_INTSRC, &irq_src);
 | 
						|
	if (ret < 0) {
 | 
						|
		dev_err(max77686->dev, "Failed to read interrupt source: %d\n",
 | 
						|
				ret);
 | 
						|
		return IRQ_NONE;
 | 
						|
	}
 | 
						|
 | 
						|
	if (debug_mask & MAX77686_DEBUG_IRQ_INT)
 | 
						|
		pr_info("%s: irq_src=0x%x\n", __func__, irq_src);
 | 
						|
 | 
						|
	if (irq_src == MAX77686_IRQSRC_PMIC) {
 | 
						|
		ret = regmap_bulk_read(max77686->regmap,
 | 
						|
					 MAX77686_REG_INT1, irq_reg, 2);
 | 
						|
		if (ret < 0) {
 | 
						|
			dev_err(max77686->dev, "Failed to read interrupt source: %d\n",
 | 
						|
					ret);
 | 
						|
			return IRQ_NONE;
 | 
						|
		}
 | 
						|
 | 
						|
		if (debug_mask & MAX77686_DEBUG_IRQ_INT)
 | 
						|
			pr_info("%s: int1=0x%x, int2=0x%x\n", __func__,
 | 
						|
				 irq_reg[PMIC_INT1], irq_reg[PMIC_INT2]);
 | 
						|
	}
 | 
						|
 | 
						|
	if (irq_src & MAX77686_IRQSRC_RTC) {
 | 
						|
		ret = regmap_read(max77686->rtc_regmap,
 | 
						|
					MAX77686_RTC_INT, &irq_reg[RTC_INT]);
 | 
						|
		if (ret < 0) {
 | 
						|
			dev_err(max77686->dev, "Failed to read interrupt source: %d\n",
 | 
						|
					ret);
 | 
						|
			return IRQ_NONE;
 | 
						|
		}
 | 
						|
 | 
						|
		if (debug_mask & MAX77686_DEBUG_IRQ_INT)
 | 
						|
			pr_info("%s: rtc int=0x%x\n", __func__,
 | 
						|
							 irq_reg[RTC_INT]);
 | 
						|
 | 
						|
	}
 | 
						|
 | 
						|
	for (i = 0; i < MAX77686_IRQ_GROUP_NR; i++)
 | 
						|
		irq_reg[i] &= ~max77686->irq_masks_cur[i];
 | 
						|
 | 
						|
	for (i = 0; i < MAX77686_IRQ_NR; i++) {
 | 
						|
		if (irq_reg[max77686_irqs[i].group] & max77686_irqs[i].mask) {
 | 
						|
			cur_irq = irq_find_mapping(max77686->irq_domain, i);
 | 
						|
			if (cur_irq)
 | 
						|
				handle_nested_irq(cur_irq);
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	return IRQ_HANDLED;
 | 
						|
}
 | 
						|
 | 
						|
static int max77686_irq_domain_map(struct irq_domain *d, unsigned int irq,
 | 
						|
					irq_hw_number_t hw)
 | 
						|
{
 | 
						|
	struct max77686_dev *max77686 = d->host_data;
 | 
						|
 | 
						|
	irq_set_chip_data(irq, max77686);
 | 
						|
	irq_set_chip_and_handler(irq, &max77686_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
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static struct irq_domain_ops max77686_irq_domain_ops = {
 | 
						|
	.map = max77686_irq_domain_map,
 | 
						|
};
 | 
						|
 | 
						|
int max77686_irq_init(struct max77686_dev *max77686)
 | 
						|
{
 | 
						|
	struct irq_domain *domain;
 | 
						|
	int i;
 | 
						|
	int ret;
 | 
						|
	int val;
 | 
						|
	struct regmap *map;
 | 
						|
 | 
						|
	mutex_init(&max77686->irqlock);
 | 
						|
 | 
						|
	if (max77686->irq_gpio && !max77686->irq) {
 | 
						|
		max77686->irq = gpio_to_irq(max77686->irq_gpio);
 | 
						|
 | 
						|
		if (debug_mask & MAX77686_DEBUG_IRQ_INT) {
 | 
						|
			ret = gpio_request(max77686->irq_gpio, "pmic_irq");
 | 
						|
			if (ret < 0) {
 | 
						|
				dev_err(max77686->dev,
 | 
						|
					"Failed to request gpio %d with ret:"
 | 
						|
					"%d\n",	max77686->irq_gpio, ret);
 | 
						|
				return IRQ_NONE;
 | 
						|
			}
 | 
						|
 | 
						|
			gpio_direction_input(max77686->irq_gpio);
 | 
						|
			val = gpio_get_value(max77686->irq_gpio);
 | 
						|
			gpio_free(max77686->irq_gpio);
 | 
						|
			pr_info("%s: gpio_irq=%x\n", __func__, val);
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	if (!max77686->irq) {
 | 
						|
		dev_err(max77686->dev, "irq is not specified\n");
 | 
						|
		return -ENODEV;
 | 
						|
	}
 | 
						|
 | 
						|
	/* Mask individual interrupt sources */
 | 
						|
	for (i = 0; i < MAX77686_IRQ_GROUP_NR; i++) {
 | 
						|
		max77686->irq_masks_cur[i] = 0xff;
 | 
						|
		max77686->irq_masks_cache[i] = 0xff;
 | 
						|
		map = max77686_get_regmap(max77686, i);
 | 
						|
 | 
						|
		if (IS_ERR_OR_NULL(map))
 | 
						|
			continue;
 | 
						|
		if (max77686_mask_reg[i] == MAX77686_REG_INVALID)
 | 
						|
			continue;
 | 
						|
 | 
						|
		regmap_write(map, max77686_mask_reg[i], 0xff);
 | 
						|
	}
 | 
						|
	domain = irq_domain_add_linear(NULL, MAX77686_IRQ_NR,
 | 
						|
					&max77686_irq_domain_ops, max77686);
 | 
						|
	if (!domain) {
 | 
						|
		dev_err(max77686->dev, "could not create irq domain\n");
 | 
						|
		return -ENODEV;
 | 
						|
	}
 | 
						|
	max77686->irq_domain = domain;
 | 
						|
 | 
						|
	ret = request_threaded_irq(max77686->irq, NULL, max77686_irq_thread,
 | 
						|
				   IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
 | 
						|
				   "max77686-irq", max77686);
 | 
						|
 | 
						|
	if (ret)
 | 
						|
		dev_err(max77686->dev, "Failed to request IRQ %d: %d\n",
 | 
						|
			max77686->irq, ret);
 | 
						|
 | 
						|
 | 
						|
	if (debug_mask & MAX77686_DEBUG_IRQ_INFO)
 | 
						|
		pr_info("%s-\n", __func__);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
void max77686_irq_exit(struct max77686_dev *max77686)
 | 
						|
{
 | 
						|
	if (max77686->irq)
 | 
						|
		free_irq(max77686->irq, max77686);
 | 
						|
}
 |