[PATCH 3/3] irqchip: bcm2836: Move SMP startup code to arch/arm
Phil Elwell
phil at raspberrypi.org
Mon Aug 7 00:47:20 PDT 2017
Hi Stefan,
On 06/08/2017 23:32, Stefan Wahren wrote:
> In order to easily provide SMP for BCM2837 on 32-bit and 64-bit
> the SMP startup code was placed in irq-bcm2836. That's not the
> right approach. So move this code where it belongs.
>
> Signed-off-by: Stefan Wahren <stefan.wahren at i2se.com>
> Fixes: 41f4988cc287 ("irqchip/bcm2836: Add SMP support for the 2836")
> ---
> arch/arm/mach-bcm/Makefile | 3 ++
> arch/arm/mach-bcm/platsmp.c | 35 ++++++++++++++++
> drivers/irqchip/irq-bcm2836.c | 79 +------------------------------------
> include/linux/irqchip/irq-bcm2836.h | 70 ++++++++++++++++++++++++++++++++
> 4 files changed, 110 insertions(+), 77 deletions(-)
> create mode 100644 include/linux/irqchip/irq-bcm2836.h
>
> diff --git a/arch/arm/mach-bcm/Makefile b/arch/arm/mach-bcm/Makefile
> index 980f585..637cd9e 100644
> --- a/arch/arm/mach-bcm/Makefile
> +++ b/arch/arm/mach-bcm/Makefile
> @@ -43,6 +43,9 @@ endif
>
> # BCM2835
> obj-$(CONFIG_ARCH_BCM2835) += board_bcm2835.o
> +ifeq ($(CONFIG_ARCH_BCM2835),y)
> +obj-$(CONFIG_SMP) += platsmp.o
> +endif
>
> # BCM5301X
> obj-$(CONFIG_ARCH_BCM_5301X) += bcm_5301x.o
> diff --git a/arch/arm/mach-bcm/platsmp.c b/arch/arm/mach-bcm/platsmp.c
> index 9e3f275..3fa1a99 100644
> --- a/arch/arm/mach-bcm/platsmp.c
> +++ b/arch/arm/mach-bcm/platsmp.c
> @@ -17,6 +17,7 @@
> #include <linux/errno.h>
> #include <linux/init.h>
> #include <linux/io.h>
> +#include <linux/irqchip/irq-bcm2836.h>
> #include <linux/jiffies.h>
> #include <linux/of.h>
> #include <linux/of_address.h>
> @@ -287,6 +288,35 @@ static int nsp_boot_secondary(unsigned int cpu, struct task_struct *idle)
> return ret;
> }
>
> +static int bcm2836_boot_secondary(unsigned int cpu, struct task_struct *idle)
> +{
> + void __iomem *intc_base;
> + struct device_node *dn;
> + char *name;
> +
> + name = "brcm,bcm2836-l1-intc";
> + dn = of_find_compatible_node(NULL, NULL, name);
> + if (!dn) {
> + pr_err("unable to find intc node\n");
> + return -ENODEV;
> + }
> +
> + intc_base = of_iomap(dn, 0);
> + of_node_put(dn);
> +
> + if (!intc_base) {
> + pr_err("unable to remap intc base register\n");
> + return -ENOMEM;
> + }
> +
> + writel(virt_to_phys(secondary_startup),
> + intc_base + LOCAL_MAILBOX3_SET0 + 16 * cpu);
I was going to upstream the patch to add dsb+sev today, but now the goalposts are
(literally) moving. Should I produce two patchsets - one for before your patch is
appied, and one for after - or will you add the required lines here?:
+ dsb(sy); /* Ensure write has completed before waking the other CPUs */
+ sev();
+
> +
> + iounmap(intc_base);
> +
> + return 0;
> +}
> +
> static const struct smp_operations kona_smp_ops __initconst = {
> .smp_prepare_cpus = bcm_smp_prepare_cpus,
> .smp_boot_secondary = kona_boot_secondary,
> @@ -305,3 +335,8 @@ static const struct smp_operations nsp_smp_ops __initconst = {
> .smp_boot_secondary = nsp_boot_secondary,
> };
> CPU_METHOD_OF_DECLARE(bcm_smp_nsp, "brcm,bcm-nsp-smp", &nsp_smp_ops);
> +
> +static const struct smp_operations bcm2836_smp_ops __initconst = {
> + .smp_boot_secondary = bcm2836_boot_secondary,
> +};
> +CPU_METHOD_OF_DECLARE(bcm_smp_bcm2836, "brcm,bcm2836-smp", &bcm2836_smp_ops);
> diff --git a/drivers/irqchip/irq-bcm2836.c b/drivers/irqchip/irq-bcm2836.c
> index e7463e3..cb4a6f5 100644
> --- a/drivers/irqchip/irq-bcm2836.c
> +++ b/drivers/irqchip/irq-bcm2836.c
> @@ -19,62 +19,9 @@
> #include <linux/of_irq.h>
> #include <linux/irqchip.h>
> #include <linux/irqdomain.h>
> -#include <asm/exception.h>
> -
> -#define LOCAL_CONTROL 0x000
> -#define LOCAL_PRESCALER 0x008
> +#include <linux/irqchip/irq-bcm2836.h>
>
> -/*
> - * The low 2 bits identify the CPU that the GPU IRQ goes to, and the
> - * next 2 bits identify the CPU that the GPU FIQ goes to.
> - */
> -#define LOCAL_GPU_ROUTING 0x00c
> -/* When setting bits 0-3, enables PMU interrupts on that CPU. */
> -#define LOCAL_PM_ROUTING_SET 0x010
> -/* When setting bits 0-3, disables PMU interrupts on that CPU. */
> -#define LOCAL_PM_ROUTING_CLR 0x014
> -/*
> - * The low 4 bits of this are the CPU's timer IRQ enables, and the
> - * next 4 bits are the CPU's timer FIQ enables (which override the IRQ
> - * bits).
> - */
> -#define LOCAL_TIMER_INT_CONTROL0 0x040
> -/*
> - * The low 4 bits of this are the CPU's per-mailbox IRQ enables, and
> - * the next 4 bits are the CPU's per-mailbox FIQ enables (which
> - * override the IRQ bits).
> - */
> -#define LOCAL_MAILBOX_INT_CONTROL0 0x050
> -/*
> - * The CPU's interrupt status register. Bits are defined by the the
> - * LOCAL_IRQ_* bits below.
> - */
> -#define LOCAL_IRQ_PENDING0 0x060
> -/* Same status bits as above, but for FIQ. */
> -#define LOCAL_FIQ_PENDING0 0x070
> -/*
> - * Mailbox write-to-set bits. There are 16 mailboxes, 4 per CPU, and
> - * these bits are organized by mailbox number and then CPU number. We
> - * use mailbox 0 for IPIs. The mailbox's interrupt is raised while
> - * any bit is set.
> - */
> -#define LOCAL_MAILBOX0_SET0 0x080
> -#define LOCAL_MAILBOX3_SET0 0x08c
> -/* Mailbox write-to-clear bits. */
> -#define LOCAL_MAILBOX0_CLR0 0x0c0
> -#define LOCAL_MAILBOX3_CLR0 0x0cc
> -
> -#define LOCAL_IRQ_CNTPSIRQ 0
> -#define LOCAL_IRQ_CNTPNSIRQ 1
> -#define LOCAL_IRQ_CNTHPIRQ 2
> -#define LOCAL_IRQ_CNTVIRQ 3
> -#define LOCAL_IRQ_MAILBOX0 4
> -#define LOCAL_IRQ_MAILBOX1 5
> -#define LOCAL_IRQ_MAILBOX2 6
> -#define LOCAL_IRQ_MAILBOX3 7
> -#define LOCAL_IRQ_GPU_FAST 8
> -#define LOCAL_IRQ_PMU_FAST 9
> -#define LAST_IRQ LOCAL_IRQ_PMU_FAST
> +#include <asm/exception.h>
>
> struct bcm2836_arm_irqchip_intc {
> struct irq_domain *domain;
> @@ -215,24 +162,6 @@ static int bcm2836_cpu_dying(unsigned int cpu)
> cpu);
> return 0;
> }
> -
> -#ifdef CONFIG_ARM
> -static int __init bcm2836_smp_boot_secondary(unsigned int cpu,
> - struct task_struct *idle)
> -{
> - unsigned long secondary_startup_phys =
> - (unsigned long)virt_to_phys((void *)secondary_startup);
> -
> - writel(secondary_startup_phys,
> - intc.base + LOCAL_MAILBOX3_SET0 + 16 * cpu);
> -
> - return 0;
> -}
> -
> -static const struct smp_operations bcm2836_smp_ops __initconst = {
> - .smp_boot_secondary = bcm2836_smp_boot_secondary,
> -};
> -#endif
> #endif
>
> static const struct irq_domain_ops bcm2836_arm_irqchip_intc_ops = {
> @@ -249,10 +178,6 @@ bcm2836_arm_irqchip_smp_init(void)
> bcm2836_cpu_dying);
>
> set_smp_cross_call(bcm2836_arm_irqchip_send_ipi);
> -
> -#ifdef CONFIG_ARM
> - smp_set_ops(&bcm2836_smp_ops);
> -#endif
> #endif
> }
>
> diff --git a/include/linux/irqchip/irq-bcm2836.h b/include/linux/irqchip/irq-bcm2836.h
> new file mode 100644
> index 0000000..218a6e1
> --- /dev/null
> +++ b/include/linux/irqchip/irq-bcm2836.h
> @@ -0,0 +1,70 @@
> +/*
> + * Root interrupt controller for the BCM2836 (Raspberry Pi 2).
> + *
> + * Copyright 2015 Broadcom
> + *
> + * 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.
> + */
> +
> +#define LOCAL_CONTROL 0x000
> +#define LOCAL_PRESCALER 0x008
> +
> +/*
> + * The low 2 bits identify the CPU that the GPU IRQ goes to, and the
> + * next 2 bits identify the CPU that the GPU FIQ goes to.
> + */
> +#define LOCAL_GPU_ROUTING 0x00c
> +/* When setting bits 0-3, enables PMU interrupts on that CPU. */
> +#define LOCAL_PM_ROUTING_SET 0x010
> +/* When setting bits 0-3, disables PMU interrupts on that CPU. */
> +#define LOCAL_PM_ROUTING_CLR 0x014
> +/*
> + * The low 4 bits of this are the CPU's timer IRQ enables, and the
> + * next 4 bits are the CPU's timer FIQ enables (which override the IRQ
> + * bits).
> + */
> +#define LOCAL_TIMER_INT_CONTROL0 0x040
> +/*
> + * The low 4 bits of this are the CPU's per-mailbox IRQ enables, and
> + * the next 4 bits are the CPU's per-mailbox FIQ enables (which
> + * override the IRQ bits).
> + */
> +#define LOCAL_MAILBOX_INT_CONTROL0 0x050
> +/*
> + * The CPU's interrupt status register. Bits are defined by the the
> + * LOCAL_IRQ_* bits below.
> + */
> +#define LOCAL_IRQ_PENDING0 0x060
> +/* Same status bits as above, but for FIQ. */
> +#define LOCAL_FIQ_PENDING0 0x070
> +/*
> + * Mailbox write-to-set bits. There are 16 mailboxes, 4 per CPU, and
> + * these bits are organized by mailbox number and then CPU number. We
> + * use mailbox 0 for IPIs. The mailbox's interrupt is raised while
> + * any bit is set.
> + */
> +#define LOCAL_MAILBOX0_SET0 0x080
> +#define LOCAL_MAILBOX3_SET0 0x08c
> +/* Mailbox write-to-clear bits. */
> +#define LOCAL_MAILBOX0_CLR0 0x0c0
> +#define LOCAL_MAILBOX3_CLR0 0x0cc
> +
> +#define LOCAL_IRQ_CNTPSIRQ 0
> +#define LOCAL_IRQ_CNTPNSIRQ 1
> +#define LOCAL_IRQ_CNTHPIRQ 2
> +#define LOCAL_IRQ_CNTVIRQ 3
> +#define LOCAL_IRQ_MAILBOX0 4
> +#define LOCAL_IRQ_MAILBOX1 5
> +#define LOCAL_IRQ_MAILBOX2 6
> +#define LOCAL_IRQ_MAILBOX3 7
> +#define LOCAL_IRQ_GPU_FAST 8
> +#define LOCAL_IRQ_PMU_FAST 9
> +#define LAST_IRQ LOCAL_IRQ_PMU_FAST
>
Regards,
Phil
More information about the linux-rpi-kernel
mailing list