Contributors: 3
Author Tokens Token Proportion Commits Commit Proportion
Yixun Lan 1783 96.17% 2 33.33%
Bartosz Golaszewski 63 3.40% 2 33.33%
Vivian Wang 8 0.43% 2 33.33%
Total 1854 6 


// SPDX-License-Identifier: GPL-2.0 OR MIT
/*
 * Copyright (C) 2023-2025 SpacemiT (Hangzhou) Technology Co. Ltd
 * Copyright (C) 2025 Yixun Lan <dlan@gentoo.org>
 */

#include <linux/clk.h>
#include <linux/gpio/driver.h>
#include <linux/gpio/generic.h>
#include <linux/init.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/irq.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/seq_file.h>

#define SPACEMIT_NR_BANKS		4
#define SPACEMIT_NR_GPIOS_PER_BANK	32

#define to_spacemit_gpio_bank(x) container_of((x), struct spacemit_gpio_bank, gc)
#define to_spacemit_gpio_regs(gb) ((gb)->sg->data->offsets)

enum spacemit_gpio_registers {
	SPACEMIT_GPLR,		/* port level - R */
	SPACEMIT_GPDR,		/* port direction - R/W */
	SPACEMIT_GPSR,		/* port set - W */
	SPACEMIT_GPCR,		/* port clear - W */
	SPACEMIT_GRER,		/* port rising edge R/W */
	SPACEMIT_GFER,		/* port falling edge R/W */
	SPACEMIT_GEDR,		/* edge detect status - R/W1C */
	SPACEMIT_GSDR,		/* (set) direction - W */
	SPACEMIT_GCDR,		/* (clear) direction - W */
	SPACEMIT_GSRER,		/* (set) rising edge detect enable - W */
	SPACEMIT_GCRER,		/* (clear) rising edge detect enable - W */
	SPACEMIT_GSFER,		/* (set) falling edge detect enable - W */
	SPACEMIT_GCFER,		/* (clear) falling edge detect enable - W */
	SPACEMIT_GAPMASK,	/* interrupt mask , 0 disable, 1 enable - R/W */
	SPACEMIT_GCPMASK,	/* interrupt mask for K3 */
};

struct spacemit_gpio;

struct spacemit_gpio_data {
	const unsigned int *offsets;
	u32 bank_offsets[SPACEMIT_NR_BANKS];
};

struct spacemit_gpio_bank {
	struct gpio_generic_chip chip;
	struct spacemit_gpio *sg;
	void __iomem *base;
	u32 irq_mask;
	u32 irq_rising_edge;
	u32 irq_falling_edge;
};

struct spacemit_gpio {
	struct device *dev;
	const struct spacemit_gpio_data *data;
	struct spacemit_gpio_bank sgb[SPACEMIT_NR_BANKS];
};

static u32 spacemit_gpio_read(struct spacemit_gpio_bank *gb,
			      enum spacemit_gpio_registers reg)
{
	return readl(gb->base + to_spacemit_gpio_regs(gb)[reg]);
}

static void spacemit_gpio_write(struct spacemit_gpio_bank *gb,
				enum spacemit_gpio_registers reg, u32 val)
{
	writel(val, gb->base + to_spacemit_gpio_regs(gb)[reg]);
}

static u32 spacemit_gpio_bank_index(struct spacemit_gpio_bank *gb)
{
	return (u32)(gb - gb->sg->sgb);
}

static irqreturn_t spacemit_gpio_irq_handler(int irq, void *dev_id)
{
	struct spacemit_gpio_bank *gb = dev_id;
	unsigned long pending;
	u32 n, gedr;

	gedr = spacemit_gpio_read(gb, SPACEMIT_GEDR);
	if (!gedr)
		return IRQ_NONE;
	spacemit_gpio_write(gb, SPACEMIT_GEDR, gedr);

	pending = gedr & gb->irq_mask;
	if (!pending)
		return IRQ_NONE;

	for_each_set_bit(n, &pending, BITS_PER_LONG)
		handle_nested_irq(irq_find_mapping(gb->chip.gc.irq.domain, n));

	return IRQ_HANDLED;
}

static void spacemit_gpio_irq_ack(struct irq_data *d)
{
	struct spacemit_gpio_bank *gb = irq_data_get_irq_chip_data(d);

	spacemit_gpio_write(gb, SPACEMIT_GEDR, BIT(irqd_to_hwirq(d)));
}

static void spacemit_gpio_irq_mask(struct irq_data *d)
{
	struct spacemit_gpio_bank *gb = irq_data_get_irq_chip_data(d);
	u32 bit = BIT(irqd_to_hwirq(d));

	gb->irq_mask &= ~bit;
	spacemit_gpio_write(gb, SPACEMIT_GAPMASK, gb->irq_mask);

	if (bit & gb->irq_rising_edge)
		spacemit_gpio_write(gb, SPACEMIT_GCRER, bit);

	if (bit & gb->irq_falling_edge)
		spacemit_gpio_write(gb, SPACEMIT_GCFER, bit);
}

static void spacemit_gpio_irq_unmask(struct irq_data *d)
{
	struct spacemit_gpio_bank *gb = irq_data_get_irq_chip_data(d);
	u32 bit = BIT(irqd_to_hwirq(d));

	gb->irq_mask |= bit;

	if (bit & gb->irq_rising_edge)
		spacemit_gpio_write(gb, SPACEMIT_GSRER, bit);

	if (bit & gb->irq_falling_edge)
		spacemit_gpio_write(gb, SPACEMIT_GSFER, bit);

	spacemit_gpio_write(gb, SPACEMIT_GAPMASK, gb->irq_mask);
}

static int spacemit_gpio_irq_set_type(struct irq_data *d, unsigned int type)
{
	struct spacemit_gpio_bank *gb = irq_data_get_irq_chip_data(d);
	u32 bit = BIT(irqd_to_hwirq(d));

	if (type & IRQ_TYPE_EDGE_RISING) {
		gb->irq_rising_edge |= bit;
		spacemit_gpio_write(gb, SPACEMIT_GSRER, bit);
	} else {
		gb->irq_rising_edge &= ~bit;
		spacemit_gpio_write(gb, SPACEMIT_GCRER, bit);
	}

	if (type & IRQ_TYPE_EDGE_FALLING) {
		gb->irq_falling_edge |= bit;
		spacemit_gpio_write(gb, SPACEMIT_GSFER, bit);
	} else {
		gb->irq_falling_edge &= ~bit;
		spacemit_gpio_write(gb, SPACEMIT_GCFER, bit);
	}

	return 0;
}

static void spacemit_gpio_irq_print_chip(struct irq_data *data, struct seq_file *p)
{
	struct spacemit_gpio_bank *gb = irq_data_get_irq_chip_data(data);

	seq_printf(p, "%s-%d", dev_name(gb->chip.gc.parent), spacemit_gpio_bank_index(gb));
}

static struct irq_chip spacemit_gpio_chip = {
	.name		= "k1-gpio-irqchip",
	.irq_ack	= spacemit_gpio_irq_ack,
	.irq_mask	= spacemit_gpio_irq_mask,
	.irq_unmask	= spacemit_gpio_irq_unmask,
	.irq_set_type	= spacemit_gpio_irq_set_type,
	.irq_print_chip	= spacemit_gpio_irq_print_chip,
	.flags		= IRQCHIP_IMMUTABLE | IRQCHIP_SKIP_SET_WAKE,
	GPIOCHIP_IRQ_RESOURCE_HELPERS,
};

static bool spacemit_of_node_instance_match(struct gpio_chip *gc, unsigned int i)
{
	struct spacemit_gpio_bank *gb = gpiochip_get_data(gc);
	struct spacemit_gpio *sg = gb->sg;

	if (i >= SPACEMIT_NR_BANKS)
		return false;

	return (gc == &sg->sgb[i].chip.gc);
}

static int spacemit_gpio_add_bank(struct spacemit_gpio *sg,
				  void __iomem *regs,
				  int index, int irq)
{
	struct spacemit_gpio_bank *gb = &sg->sgb[index];
	struct gpio_generic_chip_config config;
	struct gpio_chip *gc = &gb->chip.gc;
	struct device *dev = sg->dev;
	struct gpio_irq_chip *girq;
	void __iomem *dat, *set, *clr, *dirout;
	int ret;

	gb->base = regs + sg->data->bank_offsets[index];
	gb->sg = sg;

	dat	= gb->base + to_spacemit_gpio_regs(gb)[SPACEMIT_GPLR];
	set	= gb->base + to_spacemit_gpio_regs(gb)[SPACEMIT_GPSR];
	clr	= gb->base + to_spacemit_gpio_regs(gb)[SPACEMIT_GPCR];
	dirout	= gb->base + to_spacemit_gpio_regs(gb)[SPACEMIT_GPDR];

	config = (struct gpio_generic_chip_config) {
		.dev = dev,
		.sz = 4,
		.dat = dat,
		.set = set,
		.clr = clr,
		.dirout = dirout,
		.flags = GPIO_GENERIC_UNREADABLE_REG_SET,
	};

	/* This registers 32 GPIO lines per bank */
	ret = gpio_generic_chip_init(&gb->chip, &config);
	if (ret)
		return dev_err_probe(dev, ret, "failed to init gpio chip\n");

	gc->label		= dev_name(dev);
	gc->request		= gpiochip_generic_request;
	gc->free		= gpiochip_generic_free;
	gc->ngpio		= SPACEMIT_NR_GPIOS_PER_BANK;
	gc->base		= -1;
	gc->of_gpio_n_cells	= 3;
	gc->of_node_instance_match = spacemit_of_node_instance_match;

	girq			= &gc->irq;
	girq->threaded		= true;
	girq->handler		= handle_simple_irq;

	gpio_irq_chip_set_chip(girq, &spacemit_gpio_chip);

	/* Disable Interrupt */
	spacemit_gpio_write(gb, SPACEMIT_GAPMASK, 0);
	/* Disable Edge Detection Settings */
	spacemit_gpio_write(gb, SPACEMIT_GRER, 0x0);
	spacemit_gpio_write(gb, SPACEMIT_GFER, 0x0);
	/* Clear Interrupt */
	spacemit_gpio_write(gb, SPACEMIT_GCRER, 0xffffffff);
	spacemit_gpio_write(gb, SPACEMIT_GCFER, 0xffffffff);

	ret = devm_request_threaded_irq(dev, irq, NULL,
					spacemit_gpio_irq_handler,
					IRQF_ONESHOT | IRQF_SHARED,
					gb->chip.gc.label, gb);
	if (ret < 0)
		return dev_err_probe(dev, ret, "failed to register IRQ\n");

	ret = devm_gpiochip_add_data(dev, gc, gb);
	if (ret)
		return ret;

	/* Distuingish IRQ domain, for selecting threecells mode */
	irq_domain_update_bus_token(girq->domain, DOMAIN_BUS_WIRED);

	return 0;
}

static int spacemit_gpio_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct spacemit_gpio *sg;
	struct clk *core_clk, *bus_clk;
	void __iomem *regs;
	int i, irq, ret;

	sg = devm_kzalloc(dev, sizeof(*sg), GFP_KERNEL);
	if (!sg)
		return -ENOMEM;

	sg->data = of_device_get_match_data(dev);
	if (!sg->data)
		return dev_err_probe(dev, -EINVAL, "No available compatible data.");

	regs = devm_platform_ioremap_resource(pdev, 0);
	if (IS_ERR(regs))
		return PTR_ERR(regs);

	irq = platform_get_irq(pdev, 0);
	if (irq < 0)
		return irq;

	sg->dev	= dev;

	core_clk = devm_clk_get_enabled(dev, "core");
	if (IS_ERR(core_clk))
		return dev_err_probe(dev, PTR_ERR(core_clk), "failed to get clock\n");

	bus_clk = devm_clk_get_enabled(dev, "bus");
	if (IS_ERR(bus_clk))
		return dev_err_probe(dev, PTR_ERR(bus_clk), "failed to get bus clock\n");

	for (i = 0; i < SPACEMIT_NR_BANKS; i++) {
		ret = spacemit_gpio_add_bank(sg, regs, i, irq);
		if (ret)
			return ret;
	}

	return 0;
}

static const unsigned int spacemit_gpio_k1_offsets[] = {
	[SPACEMIT_GPLR] = 0x00,
	[SPACEMIT_GPDR] = 0x0c,
	[SPACEMIT_GPSR] = 0x18,
	[SPACEMIT_GPCR] = 0x24,
	[SPACEMIT_GRER] = 0x30,
	[SPACEMIT_GFER] = 0x3c,
	[SPACEMIT_GEDR] = 0x48,
	[SPACEMIT_GSDR] = 0x54,
	[SPACEMIT_GCDR] = 0x60,
	[SPACEMIT_GSRER] = 0x6c,
	[SPACEMIT_GCRER] = 0x78,
	[SPACEMIT_GSFER] = 0x84,
	[SPACEMIT_GCFER] = 0x90,
	[SPACEMIT_GAPMASK] = 0x9c,
	[SPACEMIT_GCPMASK] = 0xA8,
};

static const unsigned int spacemit_gpio_k3_offsets[] = {
	[SPACEMIT_GPLR] = 0x0,
	[SPACEMIT_GPDR] = 0x4,
	[SPACEMIT_GPSR] = 0x8,
	[SPACEMIT_GPCR] = 0xc,
	[SPACEMIT_GRER] = 0x10,
	[SPACEMIT_GFER] = 0x14,
	[SPACEMIT_GEDR] = 0x18,
	[SPACEMIT_GSDR] = 0x1c,
	[SPACEMIT_GCDR] = 0x20,
	[SPACEMIT_GSRER] = 0x24,
	[SPACEMIT_GCRER] = 0x28,
	[SPACEMIT_GSFER] = 0x2c,
	[SPACEMIT_GCFER] = 0x30,
	[SPACEMIT_GAPMASK] = 0x34,
	[SPACEMIT_GCPMASK] = 0x38,
};

static const struct spacemit_gpio_data k1_gpio_data = {
	.offsets = spacemit_gpio_k1_offsets,
	.bank_offsets = { 0x0, 0x4, 0x8, 0x100 },
};

static const struct spacemit_gpio_data k3_gpio_data = {
	.offsets = spacemit_gpio_k3_offsets,
	.bank_offsets = { 0x0, 0x40, 0x80, 0x100 },
};

static const struct of_device_id spacemit_gpio_dt_ids[] = {
	{ .compatible = "spacemit,k1-gpio", .data = &k1_gpio_data },
	{ .compatible = "spacemit,k3-gpio", .data = &k3_gpio_data },
	{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, spacemit_gpio_dt_ids);

static struct platform_driver spacemit_gpio_driver = {
	.probe		= spacemit_gpio_probe,
	.driver		= {
		.name	= "spacemit-gpio",
		.of_match_table = spacemit_gpio_dt_ids,
	},
};
module_platform_driver(spacemit_gpio_driver);

MODULE_AUTHOR("Yixun Lan <dlan@gentoo.org>");
MODULE_DESCRIPTION("GPIO driver for SpacemiT K1/K3 SoC");
MODULE_LICENSE("GPL");