hollalinux
/
linux-sg2042
mirror of https://github.com/sophgo/linux-riscv.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

irqchip/mvebu-gicp: Use level-triggered MSIs between ICU and GICP 

The ICU and GICP drivers are using an ugly side-band mechanism to
find out about the "clear" doorbell when using level interrupts.

Let's convert it to level-triggered MSIs, which result in a nice
cleanup.

Signed-off-by: Marc Zyngier <marc.zyngier@arm.com>
Signed-off-by: Thomas Gleixner <tglx@linutronix.de>
Tested-by: Miquel Raynal <miquel.raynal@bootlin.com>
Cc: Rob Herring <robh@kernel.org>
Cc: Jason Cooper <jason@lakedaemon.net>
Cc: Ard Biesheuvel <ard.biesheuvel@linaro.org>
Cc: Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
Cc: Thomas Petazzoni <thomas.petazzoni@bootlin.com>
Link: https://lkml.kernel.org/r/20180508121438.11301-4-marc.zyngier@arm.com
This commit is contained in:
Marc Zyngier 2018-05-08 13:14:32 +01:00 committed by Thomas Gleixner
parent 6988e0e0d2
commit 25eaaabb51
3 changed files with 27 additions and 54 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

36
drivers/irqchip/irq-mvebu-gicp.c
View File

@ -19,8 +19,6 @@
#include <dt-bindings/interrupt-controller/arm-gic.h> #include <dt-bindings/interrupt-controller/arm-gic.h>
#include "irq-mvebu-gicp.h"
#define GICP_SETSPI_NSR_OFFSET 0x0 #define GICP_SETSPI_NSR_OFFSET 0x0
#define GICP_CLRSPI_NSR_OFFSET 0x8 #define GICP_CLRSPI_NSR_OFFSET 0x8
@ -55,34 +53,18 @@ static int gicp_idx_to_spi(struct mvebu_gicp *gicp, int idx)
return -EINVAL; return -EINVAL;
} }
int mvebu_gicp_get_doorbells(struct device_node *dn, phys_addr_t *setspi,
phys_addr_t *clrspi)
{
struct platform_device *pdev;
struct mvebu_gicp *gicp;
pdev = of_find_device_by_node(dn);
if (!pdev)
return -ENODEV;
gicp = platform_get_drvdata(pdev);
if (!gicp)
return -ENODEV;
*setspi = gicp->res->start + GICP_SETSPI_NSR_OFFSET;
*clrspi = gicp->res->start + GICP_CLRSPI_NSR_OFFSET;
return 0;
}
static void gicp_compose_msi_msg(struct irq_data *data, struct msi_msg *msg) static void gicp_compose_msi_msg(struct irq_data *data, struct msi_msg *msg)
{ {
struct mvebu_gicp *gicp = data->chip_data; struct mvebu_gicp *gicp = data->chip_data;
phys_addr_t setspi = gicp->res->start + GICP_SETSPI_NSR_OFFSET; phys_addr_t setspi = gicp->res->start + GICP_SETSPI_NSR_OFFSET;
phys_addr_t clrspi = gicp->res->start + GICP_CLRSPI_NSR_OFFSET;
msg->data = data->hwirq; msg[0].data = data->hwirq;
msg->address_lo = lower_32_bits(setspi); msg[0].address_lo = lower_32_bits(setspi);
msg->address_hi = upper_32_bits(setspi); msg[0].address_hi = upper_32_bits(setspi);
msg[1].data = data->hwirq;
msg[1].address_lo = lower_32_bits(clrspi);
msg[1].address_hi = upper_32_bits(clrspi);
} }
static struct irq_chip gicp_irq_chip = { static struct irq_chip gicp_irq_chip = {
@ -170,13 +152,15 @@ static const struct irq_domain_ops gicp_domain_ops = {
static struct irq_chip gicp_msi_irq_chip = { static struct irq_chip gicp_msi_irq_chip = {
.name = "GICP", .name = "GICP",
.irq_set_type = irq_chip_set_type_parent, .irq_set_type = irq_chip_set_type_parent,
.flags = IRQCHIP_SUPPORTS_LEVEL_MSI,
}; };
static struct msi_domain_ops gicp_msi_ops = { static struct msi_domain_ops gicp_msi_ops = {
}; };
static struct msi_domain_info gicp_msi_domain_info = { static struct msi_domain_info gicp_msi_domain_info = {
.flags = (MSI_FLAG_USE_DEF_DOM_OPS | MSI_FLAG_USE_DEF_CHIP_OPS), .flags = (MSI_FLAG_USE_DEF_DOM_OPS | MSI_FLAG_USE_DEF_CHIP_OPS |
MSI_FLAG_LEVEL_CAPABLE),
.ops = &gicp_msi_ops, .ops = &gicp_msi_ops,
.chip = &gicp_msi_irq_chip, .chip = &gicp_msi_irq_chip,
}; };

12
drivers/irqchip/irq-mvebu-gicp.h
View File

@ -1,12 +0,0 @@
/* SPDX-License-Identifier: GPL-2.0 */
#ifndef __MVEBU_GICP_H__
#define __MVEBU_GICP_H__
#include <linux/types.h>
struct device_node;
int mvebu_gicp_get_doorbells(struct device_node *dn, phys_addr_t *setspi,
phys_addr_t *clrspi);
#endif /* __MVEBU_GICP_H__ */

33
drivers/irqchip/irq-mvebu-icu.c
View File

@ -21,8 +21,6 @@
#include <dt-bindings/interrupt-controller/mvebu-icu.h> #include <dt-bindings/interrupt-controller/mvebu-icu.h>
#include "irq-mvebu-gicp.h"
/* ICU registers */ /* ICU registers */
#define ICU_SETSPI_NSR_AL 0x10 #define ICU_SETSPI_NSR_AL 0x10
#define ICU_SETSPI_NSR_AH 0x14 #define ICU_SETSPI_NSR_AH 0x14
@ -43,6 +41,7 @@ struct mvebu_icu {
void __iomem *base; void __iomem *base;
struct irq_domain *domain; struct irq_domain *domain;
struct device *dev; struct device *dev;
atomic_t initialized;
}; };
struct mvebu_icu_irq_data { struct mvebu_icu_irq_data {
@ -51,6 +50,18 @@ struct mvebu_icu_irq_data {
unsigned int type; unsigned int type;
}; };
static void mvebu_icu_init(struct mvebu_icu *icu, struct msi_msg *msg)
{
if (atomic_cmpxchg(&icu->initialized, false, true))
return;
/* Set Clear/Set ICU SPI message address in AP */
writel_relaxed(msg[0].address_hi, icu->base + ICU_SETSPI_NSR_AH);
writel_relaxed(msg[0].address_lo, icu->base + ICU_SETSPI_NSR_AL);
writel_relaxed(msg[1].address_hi, icu->base + ICU_CLRSPI_NSR_AH);
writel_relaxed(msg[1].address_lo, icu->base + ICU_CLRSPI_NSR_AL);
}
static void mvebu_icu_write_msg(struct msi_desc *desc, struct msi_msg *msg) static void mvebu_icu_write_msg(struct msi_desc *desc, struct msi_msg *msg)
{ {
struct irq_data *d = irq_get_irq_data(desc->irq); struct irq_data *d = irq_get_irq_data(desc->irq);
@ -59,6 +70,8 @@ static void mvebu_icu_write_msg(struct msi_desc *desc, struct msi_msg *msg)
unsigned int icu_int; unsigned int icu_int;
if (msg->address_lo || msg->address_hi) { if (msg->address_lo || msg->address_hi) {
/* One off initialization */
mvebu_icu_init(icu, msg);
/* Configure the ICU with irq number & type */ /* Configure the ICU with irq number & type */
icu_int = msg->data | ICU_INT_ENABLE; icu_int = msg->data | ICU_INT_ENABLE;
if (icu_irqd->type & IRQ_TYPE_EDGE_RISING) if (icu_irqd->type & IRQ_TYPE_EDGE_RISING)
@ -197,9 +210,7 @@ static int mvebu_icu_probe(struct platform_device *pdev)
struct device_node *node = pdev->dev.of_node; struct device_node *node = pdev->dev.of_node;
struct device_node *gicp_dn; struct device_node *gicp_dn;
struct resource *res; struct resource *res;
phys_addr_t setspi, clrspi; int i;
u32 i, icu_int;
int ret;
icu = devm_kzalloc(&pdev->dev, sizeof(struct mvebu_icu), icu = devm_kzalloc(&pdev->dev, sizeof(struct mvebu_icu),
GFP_KERNEL); GFP_KERNEL);
@ -242,22 +253,12 @@ static int mvebu_icu_probe(struct platform_device *pdev)
if (!gicp_dn) if (!gicp_dn)
return -ENODEV; return -ENODEV;
ret = mvebu_gicp_get_doorbells(gicp_dn, &setspi, &clrspi);
if (ret)
return ret;
/* Set Clear/Set ICU SPI message address in AP */
writel_relaxed(upper_32_bits(setspi), icu->base + ICU_SETSPI_NSR_AH);
writel_relaxed(lower_32_bits(setspi), icu->base + ICU_SETSPI_NSR_AL);
writel_relaxed(upper_32_bits(clrspi), icu->base + ICU_CLRSPI_NSR_AH);
writel_relaxed(lower_32_bits(clrspi), icu->base + ICU_CLRSPI_NSR_AL);
/* /*
* Clean all ICU interrupts with type SPI_NSR, required to * Clean all ICU interrupts with type SPI_NSR, required to
* avoid unpredictable SPI assignments done by firmware. * avoid unpredictable SPI assignments done by firmware.
*/ */
for (i = 0 ; i < ICU_MAX_IRQS ; i++) { for (i = 0 ; i < ICU_MAX_IRQS ; i++) {
icu_int = readl(icu->base + ICU_INT_CFG(i)); u32 icu_int = readl_relaxed(icu->base + ICU_INT_CFG(i));
if ((icu_int >> ICU_GROUP_SHIFT) == ICU_GRP_NSR) if ((icu_int >> ICU_GROUP_SHIFT) == ICU_GRP_NSR)
writel_relaxed(0x0, icu->base + ICU_INT_CFG(i)); writel_relaxed(0x0, icu->base + ICU_INT_CFG(i));
} }