arch/arm/mach-uniphier/arm64/smp_kick_cpus.c

   1 /*
   2  * Copyright (C) 2016 Socionext Inc.
   3  *   Author: Masahiro Yamada <yamada.masahiro@socionext.com>
   4  *
   5  * SPDX-License-Identifier:     GPL-2.0+
   6  */
   7
   8 #include <linux/io.h>
   9 #include <linux/sizes.h>
  10
  11 #include "../init.h"
  12
  13 #define UNIPHIER_SMPCTRL_ROM_RSV0       0x59801200
  14
  15 void uniphier_smp_setup(void);
  16 void uniphier_secondary_startup(void);
  17
  18 void uniphier_smp_kick_all_cpus(void)
  19 {
  20         void __iomem *rom_boot_rsv0;
  21
  22         rom_boot_rsv0 = ioremap(UNIPHIER_SMPCTRL_ROM_RSV0, SZ_8);
  23
  24         writeq((u64)uniphier_secondary_startup, rom_boot_rsv0);
  25
  26         iounmap(rom_boot_rsv0);
  27
  28         uniphier_smp_setup();
  29
  30         asm("dsb        ishst\n" /* Ensure the write to ROM_RSV0 is visible */
  31             "sev"); /* Bring up all secondary CPUs from Boot ROM into U-Boot */
  32 }