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

Commit e607b0f9 authored by Nicolas Pitre's avatar Nicolas Pitre Committed by Pawel Moll
Browse files

ARM: vexpress/TC2: implement PM suspend method 



Similar to power_down(), except that for a suspend, the firmware
mailbox address has to be set prior entering low power mode.

The residency argument is not used yet, so the last man always shuts
down the cluster for now.

Signed-off-by: default avatarNicolas Pitre <nico@linaro.org>
Acked-by: default avatarPawel Moll <pawel.moll@arm.com>
parent 11b277ea

arch/arm/mach-vexpress/tc2_pm.c

+18 −1
Original line number Diff line number Diff line
@@ -95,7 +95,7 @@ static int tc2_pm_power_up(unsigned int cpu, unsigned int cluster) 
	return 0;

}



static void tc2_pm_power_down(void)

static void tc2_pm_down(u64 residency)

{

	unsigned int mpidr, cpu, cluster;

	bool last_man = false, skip_wfi = false;
@@ -209,6 +209,22 @@ static void tc2_pm_power_down(void) 
	/* Not dead at this point?  Let our caller cope. */

}



static void tc2_pm_power_down(void)

{

	tc2_pm_down(0);

}



static void tc2_pm_suspend(u64 residency)

{

	unsigned int mpidr, cpu, cluster;



	mpidr = read_cpuid_mpidr();

	cpu = MPIDR_AFFINITY_LEVEL(mpidr, 0);

	cluster = MPIDR_AFFINITY_LEVEL(mpidr, 1);

	ve_spc_set_resume_addr(cluster, cpu, virt_to_phys(mcpm_entry_point));

	tc2_pm_down(residency);

}



static void tc2_pm_powered_up(void)

{

	unsigned int mpidr, cpu, cluster;
@@ -242,6 +258,7 @@ static void tc2_pm_powered_up(void) 
static const struct mcpm_platform_ops tc2_pm_power_ops = {

	.power_up	= tc2_pm_power_up,

	.power_down	= tc2_pm_power_down,

	.suspend	= tc2_pm_suspend,

	.powered_up	= tc2_pm_powered_up,

};