Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/jmorris...
[linux/fpc-iii.git] / arch / arm / mach-mvebu / pmsu.c
blobd71ef53107c4e9a530a558458d31eecf92039bd2
1 /*
2 * Power Management Service Unit(PMSU) support for Armada 370/XP platforms.
4 * Copyright (C) 2012 Marvell
6 * Yehuda Yitschak <yehuday@marvell.com>
7 * Gregory Clement <gregory.clement@free-electrons.com>
8 * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
10 * This file is licensed under the terms of the GNU General Public
11 * License version 2. This program is licensed "as is" without any
12 * warranty of any kind, whether express or implied.
14 * The Armada 370 and Armada XP SOCs have a power management service
15 * unit which is responsible for powering down and waking up CPUs and
16 * other SOC units
19 #include <linux/kernel.h>
20 #include <linux/init.h>
21 #include <linux/of_address.h>
22 #include <linux/io.h>
23 #include <linux/smp.h>
24 #include <asm/smp_plat.h>
25 #include "pmsu.h"
27 static void __iomem *pmsu_mp_base;
28 static void __iomem *pmsu_reset_base;
30 #define PMSU_BOOT_ADDR_REDIRECT_OFFSET(cpu) ((cpu * 0x100) + 0x24)
31 #define PMSU_RESET_CTL_OFFSET(cpu) (cpu * 0x8)
33 static struct of_device_id of_pmsu_table[] = {
34 {.compatible = "marvell,armada-370-xp-pmsu"},
35 { /* end of list */ },
38 #ifdef CONFIG_SMP
39 int armada_xp_boot_cpu(unsigned int cpu_id, void *boot_addr)
41 int reg, hw_cpu;
43 if (!pmsu_mp_base || !pmsu_reset_base) {
44 pr_warn("Can't boot CPU. PMSU is uninitialized\n");
45 return 1;
48 hw_cpu = cpu_logical_map(cpu_id);
50 writel(virt_to_phys(boot_addr), pmsu_mp_base +
51 PMSU_BOOT_ADDR_REDIRECT_OFFSET(hw_cpu));
53 /* Release CPU from reset by clearing reset bit*/
54 reg = readl(pmsu_reset_base + PMSU_RESET_CTL_OFFSET(hw_cpu));
55 reg &= (~0x1);
56 writel(reg, pmsu_reset_base + PMSU_RESET_CTL_OFFSET(hw_cpu));
58 return 0;
60 #endif
62 static int __init armada_370_xp_pmsu_init(void)
64 struct device_node *np;
66 np = of_find_matching_node(NULL, of_pmsu_table);
67 if (np) {
68 pr_info("Initializing Power Management Service Unit\n");
69 pmsu_mp_base = of_iomap(np, 0);
70 pmsu_reset_base = of_iomap(np, 1);
71 of_node_put(np);
74 return 0;
77 early_initcall(armada_370_xp_pmsu_init);