mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2025-08-24 21:13:24 +00:00
irqchip/sg2042-msi: Add the Sophgo SG2044 MSI interrupt controller
Add support for Sophgo SG2044 MSI interrupt controller. Signed-off-by: Inochi Amaoto <inochiama@gmail.com> Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Tested-by: Chen Wang <wangchen20@iscas.ac.cn> # SG2042 Reviewed-by: Chen Wang <unicorn_wang@outlook.com> Link: https://lore.kernel.org/all/20250413224922.69719-5-inochiama@gmail.com
This commit is contained in:
parent
bad2094e3b
commit
e96b93a97c
@ -94,6 +94,35 @@ static const struct irq_chip sg2042_msi_middle_irq_chip = {
|
||||
.irq_compose_msi_msg = sg2042_msi_irq_compose_msi_msg,
|
||||
};
|
||||
|
||||
static void sg2044_msi_irq_ack(struct irq_data *d)
|
||||
{
|
||||
struct sg204x_msi_chipdata *data = irq_data_get_irq_chip_data(d);
|
||||
|
||||
writel(0, (u32 *)data->reg_clr + d->hwirq);
|
||||
irq_chip_ack_parent(d);
|
||||
}
|
||||
|
||||
static void sg2044_msi_irq_compose_msi_msg(struct irq_data *d, struct msi_msg *msg)
|
||||
{
|
||||
struct sg204x_msi_chipdata *data = irq_data_get_irq_chip_data(d);
|
||||
phys_addr_t doorbell = data->doorbell_addr + 4 * (d->hwirq / 32);
|
||||
|
||||
msg->address_lo = lower_32_bits(doorbell);
|
||||
msg->address_hi = upper_32_bits(doorbell);
|
||||
msg->data = d->hwirq % 32;
|
||||
}
|
||||
|
||||
static struct irq_chip sg2044_msi_middle_irq_chip = {
|
||||
.name = "SG2044 MSI",
|
||||
.irq_ack = sg2044_msi_irq_ack,
|
||||
.irq_mask = irq_chip_mask_parent,
|
||||
.irq_unmask = irq_chip_unmask_parent,
|
||||
#ifdef CONFIG_SMP
|
||||
.irq_set_affinity = irq_chip_set_affinity_parent,
|
||||
#endif
|
||||
.irq_compose_msi_msg = sg2044_msi_irq_compose_msi_msg,
|
||||
};
|
||||
|
||||
static int sg204x_msi_parent_domain_alloc(struct irq_domain *domain, unsigned int virq, int hwirq)
|
||||
{
|
||||
struct sg204x_msi_chipdata *data = domain->host_data;
|
||||
@ -132,13 +161,11 @@ static int sg204x_msi_middle_domain_alloc(struct irq_domain *domain, unsigned in
|
||||
irq_domain_set_hwirq_and_chip(domain, virq + i, hwirq + i,
|
||||
data->chip_info->irqchip, data);
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_hwirq:
|
||||
sg204x_msi_free_hwirq(data, hwirq, nr_irqs);
|
||||
irq_domain_free_irqs_parent(domain, virq, i);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
@ -172,6 +199,22 @@ static const struct msi_parent_ops sg2042_msi_parent_ops = {
|
||||
.init_dev_msi_info = msi_lib_init_dev_msi_info,
|
||||
};
|
||||
|
||||
#define SG2044_MSI_FLAGS_REQUIRED (MSI_FLAG_USE_DEF_DOM_OPS | \
|
||||
MSI_FLAG_USE_DEF_CHIP_OPS)
|
||||
|
||||
#define SG2044_MSI_FLAGS_SUPPORTED (MSI_GENERIC_FLAGS_MASK | \
|
||||
MSI_FLAG_PCI_MSIX)
|
||||
|
||||
static const struct msi_parent_ops sg2044_msi_parent_ops = {
|
||||
.required_flags = SG2044_MSI_FLAGS_REQUIRED,
|
||||
.supported_flags = SG2044_MSI_FLAGS_SUPPORTED,
|
||||
.chip_flags = MSI_CHIP_FLAG_SET_EOI | MSI_CHIP_FLAG_SET_ACK,
|
||||
.bus_select_mask = MATCH_PCI_MSI,
|
||||
.bus_select_token = DOMAIN_BUS_NEXUS,
|
||||
.prefix = "SG2044-",
|
||||
.init_dev_msi_info = msi_lib_init_dev_msi_info,
|
||||
};
|
||||
|
||||
static int sg204x_msi_init_domains(struct sg204x_msi_chipdata *data,
|
||||
struct irq_domain *plic_domain, struct device *dev)
|
||||
{
|
||||
@ -265,8 +308,14 @@ static const struct sg204x_msi_chip_info sg2042_chip_info = {
|
||||
.parent_ops = &sg2042_msi_parent_ops,
|
||||
};
|
||||
|
||||
static const struct sg204x_msi_chip_info sg2044_chip_info = {
|
||||
.irqchip = &sg2044_msi_middle_irq_chip,
|
||||
.parent_ops = &sg2044_msi_parent_ops,
|
||||
};
|
||||
|
||||
static const struct of_device_id sg2042_msi_of_match[] = {
|
||||
{ .compatible = "sophgo,sg2042-msi", .data = &sg2042_chip_info },
|
||||
{ .compatible = "sophgo,sg2044-msi", .data = &sg2044_chip_info },
|
||||
{ }
|
||||
};
|
||||
|
||||
|
Loading…
Reference in New Issue
Block a user