brintos

brintos / linux-shallow public Read only

0
0
Text · 10.3 KiB · d9b228b Raw
389 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * Copyright (C) 2018 Spreadtrum Communications Inc.4 * Copyright (C) 2018 Linaro Ltd.5 */6 7#include <linux/gpio/driver.h>8#include <linux/interrupt.h>9#include <linux/kernel.h>10#include <linux/module.h>11#include <linux/of.h>12#include <linux/platform_device.h>13#include <linux/regmap.h>14 15/* EIC registers definition */16#define SPRD_PMIC_EIC_DATA		0x017#define SPRD_PMIC_EIC_DMSK		0x418#define SPRD_PMIC_EIC_IEV		0x1419#define SPRD_PMIC_EIC_IE		0x1820#define SPRD_PMIC_EIC_RIS		0x1c21#define SPRD_PMIC_EIC_MIS		0x2022#define SPRD_PMIC_EIC_IC		0x2423#define SPRD_PMIC_EIC_TRIG		0x2824#define SPRD_PMIC_EIC_CTRL0		0x4025 26/*27 * The PMIC EIC controller only has one bank, and each bank now can contain28 * 16 EICs.29 */30#define SPRD_PMIC_EIC_PER_BANK_NR	1631#define SPRD_PMIC_EIC_NR		SPRD_PMIC_EIC_PER_BANK_NR32#define SPRD_PMIC_EIC_DATA_MASK		GENMASK(15, 0)33#define SPRD_PMIC_EIC_BIT(x)		((x) & (SPRD_PMIC_EIC_PER_BANK_NR - 1))34#define SPRD_PMIC_EIC_DBNC_MASK		GENMASK(11, 0)35 36/*37 * These registers are modified under the irq bus lock and cached to avoid38 * unnecessary writes in bus_sync_unlock.39 */40enum {41	REG_IEV,42	REG_IE,43	REG_TRIG,44	CACHE_NR_REGS45};46 47/**48 * struct sprd_pmic_eic - PMIC EIC controller49 * @chip: the gpio_chip structure.50 * @map:  the regmap from the parent device.51 * @offset: the EIC controller's offset address of the PMIC.52 * @reg: the array to cache the EIC registers.53 * @buslock: for bus lock/sync and unlock.54 * @irq: the interrupt number of the PMIC EIC conteroller.55 */56struct sprd_pmic_eic {57	struct gpio_chip chip;58	struct regmap *map;59	u32 offset;60	u8 reg[CACHE_NR_REGS];61	struct mutex buslock;62	int irq;63};64 65static void sprd_pmic_eic_update(struct gpio_chip *chip, unsigned int offset,66				 u16 reg, unsigned int val)67{68	struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip);69	u32 shift = SPRD_PMIC_EIC_BIT(offset);70 71	regmap_update_bits(pmic_eic->map, pmic_eic->offset + reg,72			   BIT(shift), val << shift);73}74 75static int sprd_pmic_eic_read(struct gpio_chip *chip, unsigned int offset,76			      u16 reg)77{78	struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip);79	u32 value;80	int ret;81 82	ret = regmap_read(pmic_eic->map, pmic_eic->offset + reg, &value);83	if (ret)84		return ret;85 86	return !!(value & BIT(SPRD_PMIC_EIC_BIT(offset)));87}88 89static int sprd_pmic_eic_request(struct gpio_chip *chip, unsigned int offset)90{91	sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_DMSK, 1);92	return 0;93}94 95static void sprd_pmic_eic_free(struct gpio_chip *chip, unsigned int offset)96{97	sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_DMSK, 0);98}99 100static int sprd_pmic_eic_get(struct gpio_chip *chip, unsigned int offset)101{102	return sprd_pmic_eic_read(chip, offset, SPRD_PMIC_EIC_DATA);103}104 105static int sprd_pmic_eic_direction_input(struct gpio_chip *chip,106					 unsigned int offset)107{108	/* EICs are always input, nothing need to do here. */109	return 0;110}111 112static void sprd_pmic_eic_set(struct gpio_chip *chip, unsigned int offset,113			      int value)114{115	/* EICs are always input, nothing need to do here. */116}117 118static int sprd_pmic_eic_set_debounce(struct gpio_chip *chip,119				      unsigned int offset,120				      unsigned int debounce)121{122	struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip);123	u32 reg, value;124	int ret;125 126	reg = SPRD_PMIC_EIC_CTRL0 + SPRD_PMIC_EIC_BIT(offset) * 0x4;127	ret = regmap_read(pmic_eic->map, pmic_eic->offset + reg, &value);128	if (ret)129		return ret;130 131	value &= ~SPRD_PMIC_EIC_DBNC_MASK;132	value |= (debounce / 1000) & SPRD_PMIC_EIC_DBNC_MASK;133	return regmap_write(pmic_eic->map, pmic_eic->offset + reg, value);134}135 136static int sprd_pmic_eic_set_config(struct gpio_chip *chip, unsigned int offset,137				    unsigned long config)138{139	unsigned long param = pinconf_to_config_param(config);140	u32 arg = pinconf_to_config_argument(config);141 142	if (param == PIN_CONFIG_INPUT_DEBOUNCE)143		return sprd_pmic_eic_set_debounce(chip, offset, arg);144 145	return -ENOTSUPP;146}147 148static void sprd_pmic_eic_irq_mask(struct irq_data *data)149{150	struct gpio_chip *chip = irq_data_get_irq_chip_data(data);151	struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip);152	u32 offset = irqd_to_hwirq(data);153 154	pmic_eic->reg[REG_IE] &= ~BIT(offset);155	pmic_eic->reg[REG_TRIG] &= ~BIT(offset);156 157	gpiochip_disable_irq(chip, offset);158}159 160static void sprd_pmic_eic_irq_unmask(struct irq_data *data)161{162	struct gpio_chip *chip = irq_data_get_irq_chip_data(data);163	struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip);164	u32 offset = irqd_to_hwirq(data);165 166	gpiochip_enable_irq(chip, offset);167 168	pmic_eic->reg[REG_IE] |= BIT(offset);169	pmic_eic->reg[REG_TRIG] |= BIT(offset);170}171 172static int sprd_pmic_eic_irq_set_type(struct irq_data *data,173				      unsigned int flow_type)174{175	struct gpio_chip *chip = irq_data_get_irq_chip_data(data);176	struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip);177	u32 offset = irqd_to_hwirq(data);178 179	switch (flow_type) {180	case IRQ_TYPE_LEVEL_HIGH:181		pmic_eic->reg[REG_IEV] |= BIT(offset);182		break;183	case IRQ_TYPE_LEVEL_LOW:184		pmic_eic->reg[REG_IEV] &= ~BIT(offset);185		break;186	case IRQ_TYPE_EDGE_RISING:187	case IRQ_TYPE_EDGE_FALLING:188	case IRQ_TYPE_EDGE_BOTH:189		/*190		 * Will set the trigger level according to current EIC level191		 * in irq_bus_sync_unlock() interface, so here nothing to do.192		 */193		break;194	default:195		return -ENOTSUPP;196	}197 198	return 0;199}200 201static void sprd_pmic_eic_bus_lock(struct irq_data *data)202{203	struct gpio_chip *chip = irq_data_get_irq_chip_data(data);204	struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip);205 206	mutex_lock(&pmic_eic->buslock);207}208 209static void sprd_pmic_eic_bus_sync_unlock(struct irq_data *data)210{211	struct gpio_chip *chip = irq_data_get_irq_chip_data(data);212	struct sprd_pmic_eic *pmic_eic = gpiochip_get_data(chip);213	u32 trigger = irqd_get_trigger_type(data);214	u32 offset = irqd_to_hwirq(data);215	int state;216 217	/* Set irq type */218	if (trigger & IRQ_TYPE_EDGE_BOTH) {219		state = sprd_pmic_eic_get(chip, offset);220		if (state)221			sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV, 0);222		else223			sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV, 1);224	} else {225		sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV,226				     !!(pmic_eic->reg[REG_IEV] & BIT(offset)));227	}228 229	/* Set irq unmask */230	sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IE,231			     !!(pmic_eic->reg[REG_IE] & BIT(offset)));232	/* Generate trigger start pulse for debounce EIC */233	sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_TRIG,234			     !!(pmic_eic->reg[REG_TRIG] & BIT(offset)));235 236	mutex_unlock(&pmic_eic->buslock);237}238 239static void sprd_pmic_eic_toggle_trigger(struct gpio_chip *chip,240					 unsigned int irq, unsigned int offset)241{242	u32 trigger = irq_get_trigger_type(irq);243	int state, post_state;244 245	if (!(trigger & IRQ_TYPE_EDGE_BOTH))246		return;247 248	state = sprd_pmic_eic_get(chip, offset);249retry:250	if (state)251		sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV, 0);252	else253		sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IEV, 1);254 255	post_state = sprd_pmic_eic_get(chip, offset);256	if (state != post_state) {257		dev_warn(chip->parent, "PMIC EIC level was changed.\n");258		state = post_state;259		goto retry;260	}261 262	/* Set irq unmask */263	sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_IE, 1);264	/* Generate trigger start pulse for debounce EIC */265	sprd_pmic_eic_update(chip, offset, SPRD_PMIC_EIC_TRIG, 1);266}267 268static irqreturn_t sprd_pmic_eic_irq_handler(int irq, void *data)269{270	struct sprd_pmic_eic *pmic_eic = data;271	struct gpio_chip *chip = &pmic_eic->chip;272	unsigned long status;273	u32 n, girq, val;274	int ret;275 276	ret = regmap_read(pmic_eic->map, pmic_eic->offset + SPRD_PMIC_EIC_MIS,277			  &val);278	if (ret)279		return IRQ_RETVAL(ret);280 281	status = val & SPRD_PMIC_EIC_DATA_MASK;282 283	for_each_set_bit(n, &status, chip->ngpio) {284		/* Clear the interrupt */285		sprd_pmic_eic_update(chip, n, SPRD_PMIC_EIC_IC, 1);286 287		girq = irq_find_mapping(chip->irq.domain, n);288		handle_nested_irq(girq);289 290		/*291		 * The PMIC EIC can only support level trigger, so we can292		 * toggle the level trigger to emulate the edge trigger.293		 */294		sprd_pmic_eic_toggle_trigger(chip, girq, n);295	}296 297	return IRQ_HANDLED;298}299 300static const struct irq_chip pmic_eic_irq_chip = {301	.name			= "sprd-pmic-eic",302	.irq_mask		= sprd_pmic_eic_irq_mask,303	.irq_unmask		= sprd_pmic_eic_irq_unmask,304	.irq_set_type		= sprd_pmic_eic_irq_set_type,305	.irq_bus_lock		= sprd_pmic_eic_bus_lock,306	.irq_bus_sync_unlock	= sprd_pmic_eic_bus_sync_unlock,307	.flags			= IRQCHIP_SKIP_SET_WAKE | IRQCHIP_IMMUTABLE,308	GPIOCHIP_IRQ_RESOURCE_HELPERS,309};310 311static int sprd_pmic_eic_probe(struct platform_device *pdev)312{313	struct gpio_irq_chip *irq;314	struct sprd_pmic_eic *pmic_eic;315	int ret;316 317	pmic_eic = devm_kzalloc(&pdev->dev, sizeof(*pmic_eic), GFP_KERNEL);318	if (!pmic_eic)319		return -ENOMEM;320 321	mutex_init(&pmic_eic->buslock);322 323	pmic_eic->irq = platform_get_irq(pdev, 0);324	if (pmic_eic->irq < 0)325		return pmic_eic->irq;326 327	pmic_eic->map = dev_get_regmap(pdev->dev.parent, NULL);328	if (!pmic_eic->map)329		return -ENODEV;330 331	ret = of_property_read_u32(pdev->dev.of_node, "reg", &pmic_eic->offset);332	if (ret) {333		dev_err(&pdev->dev, "Failed to get PMIC EIC base address.\n");334		return ret;335	}336 337	ret = devm_request_threaded_irq(&pdev->dev, pmic_eic->irq, NULL,338					sprd_pmic_eic_irq_handler,339					IRQF_ONESHOT | IRQF_NO_SUSPEND,340					dev_name(&pdev->dev), pmic_eic);341	if (ret) {342		dev_err(&pdev->dev, "Failed to request PMIC EIC IRQ.\n");343		return ret;344	}345 346	pmic_eic->chip.label = dev_name(&pdev->dev);347	pmic_eic->chip.ngpio = SPRD_PMIC_EIC_NR;348	pmic_eic->chip.base = -1;349	pmic_eic->chip.parent = &pdev->dev;350	pmic_eic->chip.direction_input = sprd_pmic_eic_direction_input;351	pmic_eic->chip.request = sprd_pmic_eic_request;352	pmic_eic->chip.free = sprd_pmic_eic_free;353	pmic_eic->chip.set_config = sprd_pmic_eic_set_config;354	pmic_eic->chip.set = sprd_pmic_eic_set;355	pmic_eic->chip.get = sprd_pmic_eic_get;356	pmic_eic->chip.can_sleep = true;357 358	irq = &pmic_eic->chip.irq;359	gpio_irq_chip_set_chip(irq, &pmic_eic_irq_chip);360	irq->threaded = true;361 362	ret = devm_gpiochip_add_data(&pdev->dev, &pmic_eic->chip, pmic_eic);363	if (ret < 0) {364		dev_err(&pdev->dev, "Could not register gpiochip %d.\n", ret);365		return ret;366	}367 368	return 0;369}370 371static const struct of_device_id sprd_pmic_eic_of_match[] = {372	{ .compatible = "sprd,sc2731-eic", },373	{ /* end of list */ }374};375MODULE_DEVICE_TABLE(of, sprd_pmic_eic_of_match);376 377static struct platform_driver sprd_pmic_eic_driver = {378	.probe = sprd_pmic_eic_probe,379	.driver = {380		.name = "sprd-pmic-eic",381		.of_match_table	= sprd_pmic_eic_of_match,382	},383};384 385module_platform_driver(sprd_pmic_eic_driver);386 387MODULE_DESCRIPTION("Spreadtrum PMIC EIC driver");388MODULE_LICENSE("GPL v2");389