cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

platsmp-realview.c (2417B)

      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * Copyright (C) 2015 Linus Walleij
      4 */
      5#include <linux/smp.h>
      6#include <linux/io.h>
      7#include <linux/of.h>
      8#include <linux/of_address.h>
      9#include <linux/regmap.h>
     10#include <linux/mfd/syscon.h>
     11
     12#include <asm/cacheflush.h>
     13#include <asm/smp_plat.h>
     14#include <asm/smp_scu.h>
     15
     16#include "platsmp.h"
     17
     18#define REALVIEW_SYS_FLAGSSET_OFFSET	0x30
     19
     20static const struct of_device_id realview_scu_match[] = {
     21	{ .compatible = "arm,arm11mp-scu", },
     22	{ .compatible = "arm,cortex-a9-scu", },
     23	{ .compatible = "arm,cortex-a5-scu", },
     24	{ }
     25};
     26
     27static const struct of_device_id realview_syscon_match[] = {
     28        { .compatible = "arm,core-module-integrator", },
     29        { .compatible = "arm,realview-eb-syscon", },
     30        { .compatible = "arm,realview-pb11mp-syscon", },
     31        { .compatible = "arm,realview-pbx-syscon", },
     32        { },
     33};
     34
     35static void __init realview_smp_prepare_cpus(unsigned int max_cpus)
     36{
     37	struct device_node *np;
     38	void __iomem *scu_base;
     39	struct regmap *map;
     40	unsigned int ncores;
     41	int i;
     42
     43	np = of_find_matching_node(NULL, realview_scu_match);
     44	if (!np) {
     45		pr_err("PLATSMP: No SCU base address\n");
     46		return;
     47	}
     48	scu_base = of_iomap(np, 0);
     49	of_node_put(np);
     50	if (!scu_base) {
     51		pr_err("PLATSMP: No SCU remap\n");
     52		return;
     53	}
     54
     55	scu_enable(scu_base);
     56	ncores = scu_get_core_count(scu_base);
     57	pr_info("SCU: %d cores detected\n", ncores);
     58	for (i = 0; i < ncores; i++)
     59		set_cpu_possible(i, true);
     60	iounmap(scu_base);
     61
     62	/* The syscon contains the magic SMP start address registers */
     63	np = of_find_matching_node(NULL, realview_syscon_match);
     64	if (!np) {
     65		pr_err("PLATSMP: No syscon match\n");
     66		return;
     67	}
     68	map = syscon_node_to_regmap(np);
     69	if (IS_ERR(map)) {
     70		pr_err("PLATSMP: No syscon regmap\n");
     71		return;
     72	}
     73	/* Put the boot address in this magic register */
     74	regmap_write(map, REALVIEW_SYS_FLAGSSET_OFFSET,
     75		     __pa_symbol(versatile_secondary_startup));
     76}
     77
     78#ifdef CONFIG_HOTPLUG_CPU
     79static void realview_cpu_die(unsigned int cpu)
     80{
     81	return versatile_immitation_cpu_die(cpu, 0x20);
     82}
     83#endif
     84
     85static const struct smp_operations realview_dt_smp_ops __initconst = {
     86	.smp_prepare_cpus	= realview_smp_prepare_cpus,
     87	.smp_secondary_init	= versatile_secondary_init,
     88	.smp_boot_secondary	= versatile_boot_secondary,
     89#ifdef CONFIG_HOTPLUG_CPU
     90	.cpu_die		= realview_cpu_die,
     91#endif
     92};
     93CPU_METHOD_OF_DECLARE(realview_smp, "arm,realview-smp", &realview_dt_smp_ops);