Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 7444dad2 authored by Gregory CLEMENT's avatar Gregory CLEMENT
Browse files

arm: mvebu: Add initial support for power managmement service unit 



The Armada 370 and Armada XP SOCs have a power management service unit
which is responsible for powering down and waking up CPUs and other
SOC units. This patch adds support for this unit.

Signed-off-by: default avatarYehuda Yitschak <yehuday@marvell.com>
Signed-off-by: default avatarGregory CLEMENT <gregory.clement@free-electrons.com>
parent 009f1315

Documentation/devicetree/bindings/arm/armada-370-xp-pmsu.txt

0 → 100644
+20 −0
Original line number Diff line number Diff line 
Power Management Service Unit(PMSU)

-----------------------------------

Available on Marvell SOCs: Armada 370 and Armada XP



Required properties:



- compatible: "marvell,armada-370-xp-pmsu"



- reg: Should contain PMSU registers location and length. First pair

  for the per-CPU SW Reset Control registers, second pair for the

  Power Management Service Unit.



Example:



armada-370-xp-pmsu@d0022000 {

	compatible = "marvell,armada-370-xp-pmsu";

	reg = <0xd0022100 0x430>,

	      <0xd0020800 0x20>;

};

arch/arm/boot/dts/armada-xp.dtsi

+6 −0
Original line number Diff line number Diff line
@@ -27,6 +27,12 @@ 
		    <0xd0021870 0x58>;

	};



	armada-370-xp-pmsu@d0022000 {

		compatible = "marvell,armada-370-xp-pmsu";

		reg = <0xd0022100 0x430>,

		      <0xd0020800 0x20>;

	};



	soc {

		serial@d0012200 {

				compatible = "ns16550";

arch/arm/mach-mvebu/Makefile

+1 −1
Original line number Diff line number Diff line
@@ -2,4 +2,4 @@ ccflags-$(CONFIG_ARCH_MULTIPLATFORM) := -I$(srctree)/$(src)/include \ 
	-I$(srctree)/arch/arm/plat-orion/include



obj-y += system-controller.o

obj-$(CONFIG_MACH_ARMADA_370_XP) += armada-370-xp.o irq-armada-370-xp.o addr-map.o coherency.o coherency_ll.o
 
obj-$(CONFIG_MACH_ARMADA_370_XP) += armada-370-xp.o irq-armada-370-xp.o addr-map.o coherency.o coherency_ll.o pmsu.o

arch/arm/mach-mvebu/common.h

+1 −0
Original line number Diff line number Diff line
@@ -21,4 +21,5 @@ void armada_370_xp_init_irq(void); 
void armada_370_xp_handle_irq(struct pt_regs *regs);



int armada_370_xp_coherency_init(void);

int armada_370_xp_pmsu_init(void);

#endif

arch/arm/mach-mvebu/pmsu.c

0 → 100644
+75 −0
Original line number Diff line number Diff line 
/*

 * Power Management Service Unit(PMSU) support for Armada 370/XP platforms.

 *

 * Copyright (C) 2012 Marvell

 *

 * Yehuda Yitschak <yehuday@marvell.com>

 * Gregory Clement <gregory.clement@free-electrons.com>

 * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>

 *

 * This file is licensed under the terms of the GNU General Public

 * License version 2.  This program is licensed "as is" without any

 * warranty of any kind, whether express or implied.

 *

 * The Armada 370 and Armada XP SOCs have a power management service

 * unit which is responsible for powering down and waking up CPUs and

 * other SOC units

 */



#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/of_address.h>

#include <linux/io.h>

#include <linux/smp.h>

#include <asm/smp_plat.h>



static void __iomem *pmsu_mp_base;

static void __iomem *pmsu_reset_base;



#define PMSU_BOOT_ADDR_REDIRECT_OFFSET(cpu)	((cpu * 0x100) + 0x24)

#define PMSU_RESET_CTL_OFFSET(cpu)		(cpu * 0x8)



static struct of_device_id of_pmsu_table[] = {

	{.compatible = "marvell,armada-370-xp-pmsu"},

	{ /* end of list */ },

};



#ifdef CONFIG_SMP

int armada_xp_boot_cpu(unsigned int cpu_id, void *boot_addr)

{

	int reg, hw_cpu;



	if (!pmsu_mp_base || !pmsu_reset_base) {

		pr_warn("Can't boot CPU. PMSU is uninitialized\n");

		return 1;

	}



	hw_cpu = cpu_logical_map(cpu_id);



	writel(virt_to_phys(boot_addr), pmsu_mp_base +

			PMSU_BOOT_ADDR_REDIRECT_OFFSET(hw_cpu));



	/* Release CPU from reset by clearing reset bit*/

	reg = readl(pmsu_reset_base + PMSU_RESET_CTL_OFFSET(hw_cpu));

	reg &= (~0x1);

	writel(reg, pmsu_reset_base + PMSU_RESET_CTL_OFFSET(hw_cpu));



	return 0;

}

#endif



int __init armada_370_xp_pmsu_init(void)

{

	struct device_node *np;



	np = of_find_matching_node(NULL, of_pmsu_table);

	if (np) {

		pr_info("Initializing Power Management Service Unit\n");

		pmsu_mp_base = of_iomap(np, 0);

		pmsu_reset_base = of_iomap(np, 1);

	}



	return 0;

}



early_initcall(armada_370_xp_pmsu_init);