2012-08-02 12:17:51 +04:00
|
|
|
/*
|
|
|
|
* 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
|
|
|
|
*/
|
|
|
|
|
2014-04-14 17:50:30 +04:00
|
|
|
#define pr_fmt(fmt) "mvebu-pmsu: " fmt
|
|
|
|
|
2014-07-09 19:45:10 +04:00
|
|
|
#include <linux/clk.h>
|
2014-04-14 19:10:12 +04:00
|
|
|
#include <linux/cpu_pm.h>
|
2014-07-09 19:45:10 +04:00
|
|
|
#include <linux/delay.h>
|
2012-08-02 12:17:51 +04:00
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/io.h>
|
2014-07-23 17:00:39 +04:00
|
|
|
#include <linux/kernel.h>
|
2014-07-23 17:00:40 +04:00
|
|
|
#include <linux/mbus.h>
|
2016-06-07 22:03:45 +03:00
|
|
|
#include <linux/mvebu-pmsu.h>
|
2012-08-02 12:17:51 +04:00
|
|
|
#include <linux/of_address.h>
|
2014-07-09 19:45:10 +04:00
|
|
|
#include <linux/of_device.h>
|
2014-04-14 19:10:14 +04:00
|
|
|
#include <linux/platform_device.h>
|
ARM: mvebu: start using the CPU reset driver
This commit changes the PMSU driver to no longer map itself the CPU
reset registers, and instead call into the CPU reset driver to
deassert the secondary CPUs for SMP booting.
In order to provide Device Tree backward compatibility, the CPU reset
driver is extended to not only support its official compatible string
"marvell,armada-370-cpu-reset", but to also look at the PMSU
compatible string "marvell,armada-370-xp-pmsu" to find the CPU reset
registers address. This allows old Device Tree to work correctly with
newer kernel versions. Therefore, the CPU reset driver implements the
following logic:
* If one of the normal compatible strings
"marvell,armada-370-cpu-reset" is found, then we map its first
memory resource as the CPU reset registers.
* Otherwise, if none of the normal compatible strings have been
found, we look for the "marvell,armada-370-xp-pmsu" compatible
string, and we map the second memory as the CPU reset registers.
Signed-off-by: Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
Link: https://lkml.kernel.org/r/1397483433-25836-3-git-send-email-thomas.petazzoni@free-electrons.com
Acked-by: Gregory CLEMENT <gregory.clement@free-electrons.com>
Signed-off-by: Jason Cooper <jason@lakedaemon.net>
2014-04-14 17:50:29 +04:00
|
|
|
#include <linux/resource.h>
|
2014-07-09 19:45:10 +04:00
|
|
|
#include <linux/slab.h>
|
2014-07-23 17:00:39 +04:00
|
|
|
#include <linux/smp.h>
|
2014-04-14 19:10:11 +04:00
|
|
|
#include <asm/cacheflush.h>
|
|
|
|
#include <asm/cp15.h>
|
2014-07-23 17:00:52 +04:00
|
|
|
#include <asm/smp_scu.h>
|
2012-08-02 12:17:51 +04:00
|
|
|
#include <asm/smp_plat.h>
|
2014-04-14 19:10:11 +04:00
|
|
|
#include <asm/suspend.h>
|
|
|
|
#include <asm/tlbflush.h>
|
ARM: mvebu: start using the CPU reset driver
This commit changes the PMSU driver to no longer map itself the CPU
reset registers, and instead call into the CPU reset driver to
deassert the secondary CPUs for SMP booting.
In order to provide Device Tree backward compatibility, the CPU reset
driver is extended to not only support its official compatible string
"marvell,armada-370-cpu-reset", but to also look at the PMSU
compatible string "marvell,armada-370-xp-pmsu" to find the CPU reset
registers address. This allows old Device Tree to work correctly with
newer kernel versions. Therefore, the CPU reset driver implements the
following logic:
* If one of the normal compatible strings
"marvell,armada-370-cpu-reset" is found, then we map its first
memory resource as the CPU reset registers.
* Otherwise, if none of the normal compatible strings have been
found, we look for the "marvell,armada-370-xp-pmsu" compatible
string, and we map the second memory as the CPU reset registers.
Signed-off-by: Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
Link: https://lkml.kernel.org/r/1397483433-25836-3-git-send-email-thomas.petazzoni@free-electrons.com
Acked-by: Gregory CLEMENT <gregory.clement@free-electrons.com>
Signed-off-by: Jason Cooper <jason@lakedaemon.net>
2014-04-14 17:50:29 +04:00
|
|
|
#include "common.h"
|
2016-06-07 22:03:45 +03:00
|
|
|
#include "pmsu.h"
|
2012-08-02 12:17:51 +04:00
|
|
|
|
2014-04-14 17:50:31 +04:00
|
|
|
#define PMSU_BASE_OFFSET 0x100
|
|
|
|
#define PMSU_REG_SIZE 0x1000
|
|
|
|
|
2014-04-14 19:10:10 +04:00
|
|
|
/* PMSU MP registers */
|
2014-04-14 19:10:11 +04:00
|
|
|
#define PMSU_CONTROL_AND_CONFIG(cpu) ((cpu * 0x100) + 0x104)
|
|
|
|
#define PMSU_CONTROL_AND_CONFIG_DFS_REQ BIT(18)
|
|
|
|
#define PMSU_CONTROL_AND_CONFIG_PWDDN_REQ BIT(16)
|
|
|
|
#define PMSU_CONTROL_AND_CONFIG_L2_PWDDN BIT(20)
|
|
|
|
|
|
|
|
#define PMSU_CPU_POWER_DOWN_CONTROL(cpu) ((cpu * 0x100) + 0x108)
|
|
|
|
|
|
|
|
#define PMSU_CPU_POWER_DOWN_DIS_SNP_Q_SKIP BIT(0)
|
|
|
|
|
|
|
|
#define PMSU_STATUS_AND_MASK(cpu) ((cpu * 0x100) + 0x10c)
|
|
|
|
#define PMSU_STATUS_AND_MASK_CPU_IDLE_WAIT BIT(16)
|
|
|
|
#define PMSU_STATUS_AND_MASK_SNP_Q_EMPTY_WAIT BIT(17)
|
|
|
|
#define PMSU_STATUS_AND_MASK_IRQ_WAKEUP BIT(20)
|
|
|
|
#define PMSU_STATUS_AND_MASK_FIQ_WAKEUP BIT(21)
|
|
|
|
#define PMSU_STATUS_AND_MASK_DBG_WAKEUP BIT(22)
|
|
|
|
#define PMSU_STATUS_AND_MASK_IRQ_MASK BIT(24)
|
|
|
|
#define PMSU_STATUS_AND_MASK_FIQ_MASK BIT(25)
|
|
|
|
|
2014-07-09 19:45:10 +04:00
|
|
|
#define PMSU_EVENT_STATUS_AND_MASK(cpu) ((cpu * 0x100) + 0x120)
|
|
|
|
#define PMSU_EVENT_STATUS_AND_MASK_DFS_DONE BIT(1)
|
|
|
|
#define PMSU_EVENT_STATUS_AND_MASK_DFS_DONE_MASK BIT(17)
|
|
|
|
|
2014-04-14 19:10:10 +04:00
|
|
|
#define PMSU_BOOT_ADDR_REDIRECT_OFFSET(cpu) ((cpu * 0x100) + 0x124)
|
|
|
|
|
|
|
|
/* PMSU fabric registers */
|
|
|
|
#define L2C_NFABRIC_PM_CTL 0x4
|
|
|
|
#define L2C_NFABRIC_PM_CTL_PWR_DOWN BIT(20)
|
2012-08-02 12:17:51 +04:00
|
|
|
|
2014-07-23 17:00:52 +04:00
|
|
|
/* PMSU delay registers */
|
|
|
|
#define PMSU_POWERDOWN_DELAY 0xF04
|
|
|
|
#define PMSU_POWERDOWN_DELAY_PMU BIT(1)
|
|
|
|
#define PMSU_POWERDOWN_DELAY_MASK 0xFFFE
|
|
|
|
#define PMSU_DFLT_ARMADA38X_DELAY 0x64
|
|
|
|
|
|
|
|
/* CA9 MPcore SoC Control registers */
|
|
|
|
|
|
|
|
#define MPCORE_RESET_CTL 0x64
|
|
|
|
#define MPCORE_RESET_CTL_L2 BIT(0)
|
|
|
|
#define MPCORE_RESET_CTL_DEBUG BIT(16)
|
|
|
|
|
2014-07-23 17:00:40 +04:00
|
|
|
#define SRAM_PHYS_BASE 0xFFFF0000
|
|
|
|
#define BOOTROM_BASE 0xFFF00000
|
|
|
|
#define BOOTROM_SIZE 0x100000
|
|
|
|
|
2014-07-23 17:00:51 +04:00
|
|
|
#define ARMADA_370_CRYPT0_ENG_TARGET 0x9
|
|
|
|
#define ARMADA_370_CRYPT0_ENG_ATTR 0x1
|
|
|
|
|
2014-04-14 19:10:11 +04:00
|
|
|
extern void ll_disable_coherency(void);
|
|
|
|
extern void ll_enable_coherency(void);
|
|
|
|
|
ARM: mvebu: fix cpuidle implementation to work on big-endian systems
On Marvell Armada XP, when a CPU comes back from deep idle state of
cpuidle, it restarts its execution at armada_370_xp_cpu_resume(),
which puts back the CPU into the coherency, and then calls the generic
cpu_resume() function.
While this works on little-endian configurations, it doesn't work on
big-endian configurations because the CPU restarts in little-endian,
and therefore must be switched back to big-endian to operate
properly. To achieve this, a 'setend be' instruction must be executed
in big-endian configurations. However, the ARM_BE8() macro that is
used to implement nice compile-time conditional for ARM LE vs. ARM BE8
is not easily usable in inline assembly.
Therefore, this patch moves the armada_370_xp_cpu_resume() C function,
which was anyway just a block of inline assembly, into a proper
pmsu_ll.S file, and adds the appropriate ARM_BE8(setend be)
instruction.
Without this patch, an Armada XP big endian configuration with cpuidle
enabled fails to boot, as it hangs as soon as one of the CPU hits the
deep idle state.
Signed-off-by: Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
Link: https://lkml.kernel.org/r/1404130165-3593-1-git-send-email-thomas.petazzoni@free-electrons.com
Signed-off-by: Jason Cooper <jason@lakedaemon.net>
2014-06-30 16:09:25 +04:00
|
|
|
extern void armada_370_xp_cpu_resume(void);
|
2014-07-23 17:00:52 +04:00
|
|
|
extern void armada_38x_cpu_resume(void);
|
|
|
|
|
2014-07-23 17:00:51 +04:00
|
|
|
static phys_addr_t pmsu_mp_phys_base;
|
|
|
|
static void __iomem *pmsu_mp_base;
|
ARM: mvebu: fix cpuidle implementation to work on big-endian systems
On Marvell Armada XP, when a CPU comes back from deep idle state of
cpuidle, it restarts its execution at armada_370_xp_cpu_resume(),
which puts back the CPU into the coherency, and then calls the generic
cpu_resume() function.
While this works on little-endian configurations, it doesn't work on
big-endian configurations because the CPU restarts in little-endian,
and therefore must be switched back to big-endian to operate
properly. To achieve this, a 'setend be' instruction must be executed
in big-endian configurations. However, the ARM_BE8() macro that is
used to implement nice compile-time conditional for ARM LE vs. ARM BE8
is not easily usable in inline assembly.
Therefore, this patch moves the armada_370_xp_cpu_resume() C function,
which was anyway just a block of inline assembly, into a proper
pmsu_ll.S file, and adds the appropriate ARM_BE8(setend be)
instruction.
Without this patch, an Armada XP big endian configuration with cpuidle
enabled fails to boot, as it hangs as soon as one of the CPU hits the
deep idle state.
Signed-off-by: Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
Link: https://lkml.kernel.org/r/1404130165-3593-1-git-send-email-thomas.petazzoni@free-electrons.com
Signed-off-by: Jason Cooper <jason@lakedaemon.net>
2014-06-30 16:09:25 +04:00
|
|
|
|
2014-07-23 17:00:44 +04:00
|
|
|
static void *mvebu_cpu_resume;
|
2014-04-14 19:10:14 +04:00
|
|
|
|
2015-02-18 23:19:56 +03:00
|
|
|
static const struct of_device_id of_pmsu_table[] = {
|
2014-04-14 17:50:31 +04:00
|
|
|
{ .compatible = "marvell,armada-370-pmsu", },
|
|
|
|
{ .compatible = "marvell,armada-370-xp-pmsu", },
|
2014-04-14 17:54:04 +04:00
|
|
|
{ .compatible = "marvell,armada-380-pmsu", },
|
2012-08-02 12:17:51 +04:00
|
|
|
{ /* end of list */ },
|
|
|
|
};
|
|
|
|
|
2014-04-14 17:53:58 +04:00
|
|
|
void mvebu_pmsu_set_cpu_boot_addr(int hw_cpu, void *boot_addr)
|
2014-04-14 17:50:33 +04:00
|
|
|
{
|
2017-01-15 05:59:29 +03:00
|
|
|
writel(__pa_symbol(boot_addr), pmsu_mp_base +
|
2014-04-14 17:50:33 +04:00
|
|
|
PMSU_BOOT_ADDR_REDIRECT_OFFSET(hw_cpu));
|
|
|
|
}
|
|
|
|
|
2018-06-20 07:31:08 +03:00
|
|
|
extern unsigned char mvebu_boot_wa_start[];
|
|
|
|
extern unsigned char mvebu_boot_wa_end[];
|
2014-07-23 17:00:40 +04:00
|
|
|
|
|
|
|
/*
|
|
|
|
* This function sets up the boot address workaround needed for SMP
|
|
|
|
* boot on Armada 375 Z1 and cpuidle on Armada 370. It unmaps the
|
|
|
|
* BootROM Mbus window, and instead remaps a crypto SRAM into which a
|
|
|
|
* custom piece of code is copied to replace the problematic BootROM.
|
|
|
|
*/
|
|
|
|
int mvebu_setup_boot_addr_wa(unsigned int crypto_eng_target,
|
|
|
|
unsigned int crypto_eng_attribute,
|
|
|
|
phys_addr_t resume_addr_reg)
|
|
|
|
{
|
|
|
|
void __iomem *sram_virt_base;
|
2018-06-20 07:31:08 +03:00
|
|
|
u32 code_len = mvebu_boot_wa_end - mvebu_boot_wa_start;
|
2014-07-23 17:00:40 +04:00
|
|
|
|
|
|
|
mvebu_mbus_del_window(BOOTROM_BASE, BOOTROM_SIZE);
|
|
|
|
mvebu_mbus_add_window_by_id(crypto_eng_target, crypto_eng_attribute,
|
|
|
|
SRAM_PHYS_BASE, SZ_64K);
|
|
|
|
|
|
|
|
sram_virt_base = ioremap(SRAM_PHYS_BASE, SZ_64K);
|
|
|
|
if (!sram_virt_base) {
|
|
|
|
pr_err("Unable to map SRAM to setup the boot address WA\n");
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
|
|
|
|
|
|
|
memcpy(sram_virt_base, &mvebu_boot_wa_start, code_len);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* The last word of the code copied in SRAM must contain the
|
|
|
|
* physical base address of the PMSU register. We
|
|
|
|
* intentionally store this address in the native endianness
|
|
|
|
* of the system.
|
|
|
|
*/
|
|
|
|
__raw_writel((unsigned long)resume_addr_reg,
|
|
|
|
sram_virt_base + code_len - 4);
|
|
|
|
|
|
|
|
iounmap(sram_virt_base);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:42 +04:00
|
|
|
static int __init mvebu_v7_pmsu_init(void)
|
2012-08-02 12:17:51 +04:00
|
|
|
{
|
|
|
|
struct device_node *np;
|
2014-04-14 17:50:30 +04:00
|
|
|
struct resource res;
|
|
|
|
int ret = 0;
|
2012-08-02 12:17:51 +04:00
|
|
|
|
|
|
|
np = of_find_matching_node(NULL, of_pmsu_table);
|
2014-04-14 17:50:30 +04:00
|
|
|
if (!np)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
pr_info("Initializing Power Management Service Unit\n");
|
|
|
|
|
|
|
|
if (of_address_to_resource(np, 0, &res)) {
|
|
|
|
pr_err("unable to get resource\n");
|
|
|
|
ret = -ENOENT;
|
|
|
|
goto out;
|
2012-08-02 12:17:51 +04:00
|
|
|
}
|
|
|
|
|
2014-04-14 17:50:31 +04:00
|
|
|
if (of_device_is_compatible(np, "marvell,armada-370-xp-pmsu")) {
|
|
|
|
pr_warn(FW_WARN "deprecated pmsu binding\n");
|
|
|
|
res.start = res.start - PMSU_BASE_OFFSET;
|
|
|
|
res.end = res.start + PMSU_REG_SIZE - 1;
|
|
|
|
}
|
|
|
|
|
2014-04-14 17:50:30 +04:00
|
|
|
if (!request_mem_region(res.start, resource_size(&res),
|
|
|
|
np->full_name)) {
|
|
|
|
pr_err("unable to request region\n");
|
|
|
|
ret = -EBUSY;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:51 +04:00
|
|
|
pmsu_mp_phys_base = res.start;
|
|
|
|
|
2014-04-14 17:50:30 +04:00
|
|
|
pmsu_mp_base = ioremap(res.start, resource_size(&res));
|
|
|
|
if (!pmsu_mp_base) {
|
|
|
|
pr_err("unable to map registers\n");
|
|
|
|
release_mem_region(res.start, resource_size(&res));
|
|
|
|
ret = -ENOMEM;
|
|
|
|
goto out;
|
|
|
|
}
|
|
|
|
|
|
|
|
out:
|
|
|
|
of_node_put(np);
|
|
|
|
return ret;
|
2012-08-02 12:17:51 +04:00
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:42 +04:00
|
|
|
static void mvebu_v7_pmsu_enable_l2_powerdown_onidle(void)
|
2014-04-14 19:10:10 +04:00
|
|
|
{
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
if (pmsu_mp_base == NULL)
|
|
|
|
return;
|
|
|
|
|
|
|
|
/* Enable L2 & Fabric powerdown in Deep-Idle mode - Fabric */
|
|
|
|
reg = readl(pmsu_mp_base + L2C_NFABRIC_PM_CTL);
|
|
|
|
reg |= L2C_NFABRIC_PM_CTL_PWR_DOWN;
|
|
|
|
writel(reg, pmsu_mp_base + L2C_NFABRIC_PM_CTL);
|
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:45 +04:00
|
|
|
enum pmsu_idle_prepare_flags {
|
|
|
|
PMSU_PREPARE_NORMAL = 0,
|
|
|
|
PMSU_PREPARE_DEEP_IDLE = BIT(0),
|
|
|
|
PMSU_PREPARE_SNOOP_DISABLE = BIT(1),
|
|
|
|
};
|
2014-04-14 19:10:11 +04:00
|
|
|
|
|
|
|
/* No locking is needed because we only access per-CPU registers */
|
2014-07-23 17:00:45 +04:00
|
|
|
static int mvebu_v7_pmsu_idle_prepare(unsigned long flags)
|
2014-04-14 19:10:11 +04:00
|
|
|
{
|
|
|
|
unsigned int hw_cpu = cpu_logical_map(smp_processor_id());
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
if (pmsu_mp_base == NULL)
|
2014-05-31 00:18:15 +04:00
|
|
|
return -EINVAL;
|
2014-04-14 19:10:11 +04:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Adjust the PMSU configuration to wait for WFI signal, enable
|
|
|
|
* IRQ and FIQ as wakeup events, set wait for snoop queue empty
|
|
|
|
* indication and mask IRQ and FIQ from CPU
|
|
|
|
*/
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_STATUS_AND_MASK(hw_cpu));
|
|
|
|
reg |= PMSU_STATUS_AND_MASK_CPU_IDLE_WAIT |
|
|
|
|
PMSU_STATUS_AND_MASK_IRQ_WAKEUP |
|
|
|
|
PMSU_STATUS_AND_MASK_FIQ_WAKEUP |
|
|
|
|
PMSU_STATUS_AND_MASK_SNP_Q_EMPTY_WAIT |
|
|
|
|
PMSU_STATUS_AND_MASK_IRQ_MASK |
|
|
|
|
PMSU_STATUS_AND_MASK_FIQ_MASK;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_STATUS_AND_MASK(hw_cpu));
|
|
|
|
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(hw_cpu));
|
|
|
|
/* ask HW to power down the L2 Cache if needed */
|
2014-07-23 17:00:45 +04:00
|
|
|
if (flags & PMSU_PREPARE_DEEP_IDLE)
|
2014-04-14 19:10:11 +04:00
|
|
|
reg |= PMSU_CONTROL_AND_CONFIG_L2_PWDDN;
|
|
|
|
|
|
|
|
/* request power down */
|
|
|
|
reg |= PMSU_CONTROL_AND_CONFIG_PWDDN_REQ;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(hw_cpu));
|
|
|
|
|
2014-07-23 17:00:45 +04:00
|
|
|
if (flags & PMSU_PREPARE_SNOOP_DISABLE) {
|
|
|
|
/* Disable snoop disable by HW - SW is taking care of it */
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_CPU_POWER_DOWN_CONTROL(hw_cpu));
|
|
|
|
reg |= PMSU_CPU_POWER_DOWN_DIS_SNP_Q_SKIP;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_CPU_POWER_DOWN_CONTROL(hw_cpu));
|
|
|
|
}
|
2014-04-14 19:10:11 +04:00
|
|
|
|
2014-07-23 17:00:38 +04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
int armada_370_xp_pmsu_idle_enter(unsigned long deepidle)
|
|
|
|
{
|
2014-07-23 17:00:45 +04:00
|
|
|
unsigned long flags = PMSU_PREPARE_SNOOP_DISABLE;
|
2014-07-23 17:00:38 +04:00
|
|
|
int ret;
|
|
|
|
|
2014-07-23 17:00:45 +04:00
|
|
|
if (deepidle)
|
|
|
|
flags |= PMSU_PREPARE_DEEP_IDLE;
|
|
|
|
|
|
|
|
ret = mvebu_v7_pmsu_idle_prepare(flags);
|
2014-07-23 17:00:38 +04:00
|
|
|
if (ret)
|
|
|
|
return ret;
|
2014-04-14 19:10:11 +04:00
|
|
|
|
|
|
|
v7_exit_coherency_flush(all);
|
|
|
|
|
|
|
|
ll_disable_coherency();
|
|
|
|
|
|
|
|
dsb();
|
|
|
|
|
|
|
|
wfi();
|
|
|
|
|
|
|
|
/* If we are here, wfi failed. As processors run out of
|
|
|
|
* coherency for some time, tlbs might be stale, so flush them
|
|
|
|
*/
|
|
|
|
local_flush_tlb_all();
|
|
|
|
|
|
|
|
ll_enable_coherency();
|
|
|
|
|
|
|
|
/* Test the CR_C bit and set it if it was cleared */
|
|
|
|
asm volatile(
|
2014-07-04 18:22:16 +04:00
|
|
|
"mrc p15, 0, r0, c1, c0, 0 \n\t"
|
2015-08-10 16:47:51 +03:00
|
|
|
"tst r0, %0 \n\t"
|
2014-07-04 18:22:16 +04:00
|
|
|
"orreq r0, r0, #(1 << 2) \n\t"
|
|
|
|
"mcreq p15, 0, r0, c1, c0, 0 \n\t"
|
2014-04-14 19:10:11 +04:00
|
|
|
"isb "
|
2015-08-10 16:47:51 +03:00
|
|
|
: : "Ir" (CR_C) : "r0");
|
2014-04-14 19:10:11 +04:00
|
|
|
|
2014-07-23 17:00:51 +04:00
|
|
|
pr_debug("Failed to suspend the system\n");
|
2014-04-14 19:10:11 +04:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int armada_370_xp_cpu_suspend(unsigned long deepidle)
|
|
|
|
{
|
2014-05-31 00:18:15 +04:00
|
|
|
return cpu_suspend(deepidle, armada_370_xp_pmsu_idle_enter);
|
2014-04-14 19:10:11 +04:00
|
|
|
}
|
|
|
|
|
2014-10-30 14:39:44 +03:00
|
|
|
int armada_38x_do_cpu_suspend(unsigned long deepidle)
|
2014-07-23 17:00:52 +04:00
|
|
|
{
|
|
|
|
unsigned long flags = 0;
|
|
|
|
|
|
|
|
if (deepidle)
|
|
|
|
flags |= PMSU_PREPARE_DEEP_IDLE;
|
|
|
|
|
|
|
|
mvebu_v7_pmsu_idle_prepare(flags);
|
|
|
|
/*
|
|
|
|
* Already flushed cache, but do it again as the outer cache
|
|
|
|
* functions dirty the cache with spinlocks
|
|
|
|
*/
|
|
|
|
v7_exit_coherency_flush(louis);
|
|
|
|
|
|
|
|
scu_power_mode(mvebu_get_scu_base(), SCU_PM_POWEROFF);
|
|
|
|
|
|
|
|
cpu_do_idle();
|
|
|
|
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int armada_38x_cpu_suspend(unsigned long deepidle)
|
|
|
|
{
|
|
|
|
return cpu_suspend(false, armada_38x_do_cpu_suspend);
|
|
|
|
}
|
|
|
|
|
2014-04-14 19:10:11 +04:00
|
|
|
/* No locking is needed because we only access per-CPU registers */
|
2014-07-23 17:00:42 +04:00
|
|
|
void mvebu_v7_pmsu_idle_exit(void)
|
2014-04-14 19:10:11 +04:00
|
|
|
{
|
|
|
|
unsigned int hw_cpu = cpu_logical_map(smp_processor_id());
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
if (pmsu_mp_base == NULL)
|
|
|
|
return;
|
|
|
|
/* cancel ask HW to power down the L2 Cache if possible */
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(hw_cpu));
|
|
|
|
reg &= ~PMSU_CONTROL_AND_CONFIG_L2_PWDDN;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(hw_cpu));
|
|
|
|
|
|
|
|
/* cancel Enable wakeup events and mask interrupts */
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_STATUS_AND_MASK(hw_cpu));
|
|
|
|
reg &= ~(PMSU_STATUS_AND_MASK_IRQ_WAKEUP | PMSU_STATUS_AND_MASK_FIQ_WAKEUP);
|
|
|
|
reg &= ~PMSU_STATUS_AND_MASK_CPU_IDLE_WAIT;
|
|
|
|
reg &= ~PMSU_STATUS_AND_MASK_SNP_Q_EMPTY_WAIT;
|
|
|
|
reg &= ~(PMSU_STATUS_AND_MASK_IRQ_MASK | PMSU_STATUS_AND_MASK_FIQ_MASK);
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_STATUS_AND_MASK(hw_cpu));
|
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:42 +04:00
|
|
|
static int mvebu_v7_cpu_pm_notify(struct notifier_block *self,
|
2014-04-14 19:10:12 +04:00
|
|
|
unsigned long action, void *hcpu)
|
|
|
|
{
|
|
|
|
if (action == CPU_PM_ENTER) {
|
|
|
|
unsigned int hw_cpu = cpu_logical_map(smp_processor_id());
|
2014-07-23 17:00:44 +04:00
|
|
|
mvebu_pmsu_set_cpu_boot_addr(hw_cpu, mvebu_cpu_resume);
|
2014-04-14 19:10:12 +04:00
|
|
|
} else if (action == CPU_PM_EXIT) {
|
2014-07-23 17:00:42 +04:00
|
|
|
mvebu_v7_pmsu_idle_exit();
|
2014-04-14 19:10:12 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
return NOTIFY_OK;
|
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:42 +04:00
|
|
|
static struct notifier_block mvebu_v7_cpu_pm_notifier = {
|
|
|
|
.notifier_call = mvebu_v7_cpu_pm_notify,
|
2014-04-14 19:10:12 +04:00
|
|
|
};
|
|
|
|
|
2014-07-23 17:00:51 +04:00
|
|
|
static struct platform_device mvebu_v7_cpuidle_device;
|
|
|
|
|
2015-10-23 13:59:58 +03:00
|
|
|
static int broken_idle(struct device_node *np)
|
|
|
|
{
|
|
|
|
if (of_property_read_bool(np, "broken-idle")) {
|
|
|
|
pr_warn("CPU idle is currently broken: disabling\n");
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:51 +04:00
|
|
|
static __init int armada_370_cpuidle_init(void)
|
2014-04-14 19:10:14 +04:00
|
|
|
{
|
|
|
|
struct device_node *np;
|
2014-07-23 17:00:51 +04:00
|
|
|
phys_addr_t redirect_reg;
|
|
|
|
|
|
|
|
np = of_find_compatible_node(NULL, NULL, "marvell,coherency-fabric");
|
|
|
|
if (!np)
|
|
|
|
return -ENODEV;
|
2015-10-23 13:59:58 +03:00
|
|
|
|
|
|
|
if (broken_idle(np))
|
|
|
|
goto end;
|
2014-04-14 19:10:14 +04:00
|
|
|
|
|
|
|
/*
|
2014-07-23 17:00:51 +04:00
|
|
|
* On Armada 370, there is "a slow exit process from the deep
|
|
|
|
* idle state due to heavy L1/L2 cache cleanup operations
|
|
|
|
* performed by the BootROM software". To avoid this, we
|
|
|
|
* replace the restart code of the bootrom by a a simple jump
|
|
|
|
* to the boot address. Then the code located at this boot
|
|
|
|
* address will take care of the initialization.
|
2014-04-14 19:10:14 +04:00
|
|
|
*/
|
2014-07-23 17:00:51 +04:00
|
|
|
redirect_reg = pmsu_mp_phys_base + PMSU_BOOT_ADDR_REDIRECT_OFFSET(0);
|
|
|
|
mvebu_setup_boot_addr_wa(ARMADA_370_CRYPT0_ENG_TARGET,
|
|
|
|
ARMADA_370_CRYPT0_ENG_ATTR,
|
|
|
|
redirect_reg);
|
2014-04-14 19:10:14 +04:00
|
|
|
|
2014-07-23 17:00:51 +04:00
|
|
|
mvebu_cpu_resume = armada_370_xp_cpu_resume;
|
|
|
|
mvebu_v7_cpuidle_device.dev.platform_data = armada_370_xp_cpu_suspend;
|
|
|
|
mvebu_v7_cpuidle_device.name = "cpuidle-armada-370";
|
|
|
|
|
2015-10-23 13:59:58 +03:00
|
|
|
end:
|
|
|
|
of_node_put(np);
|
2014-07-23 17:00:51 +04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:52 +04:00
|
|
|
static __init int armada_38x_cpuidle_init(void)
|
|
|
|
{
|
|
|
|
struct device_node *np;
|
|
|
|
void __iomem *mpsoc_base;
|
|
|
|
u32 reg;
|
|
|
|
|
2015-06-12 16:38:34 +03:00
|
|
|
pr_warn("CPU idle is currently broken on Armada 38x: disabling\n");
|
2015-01-30 14:34:25 +03:00
|
|
|
return 0;
|
|
|
|
|
2014-07-23 17:00:52 +04:00
|
|
|
np = of_find_compatible_node(NULL, NULL,
|
|
|
|
"marvell,armada-380-coherency-fabric");
|
|
|
|
if (!np)
|
|
|
|
return -ENODEV;
|
2015-10-23 13:59:58 +03:00
|
|
|
|
|
|
|
if (broken_idle(np))
|
|
|
|
goto end;
|
|
|
|
|
2014-07-23 17:00:52 +04:00
|
|
|
of_node_put(np);
|
|
|
|
|
|
|
|
np = of_find_compatible_node(NULL, NULL,
|
|
|
|
"marvell,armada-380-mpcore-soc-ctrl");
|
|
|
|
if (!np)
|
|
|
|
return -ENODEV;
|
|
|
|
mpsoc_base = of_iomap(np, 0);
|
|
|
|
BUG_ON(!mpsoc_base);
|
|
|
|
|
|
|
|
/* Set up reset mask when powering down the cpus */
|
|
|
|
reg = readl(mpsoc_base + MPCORE_RESET_CTL);
|
|
|
|
reg |= MPCORE_RESET_CTL_L2;
|
|
|
|
reg |= MPCORE_RESET_CTL_DEBUG;
|
|
|
|
writel(reg, mpsoc_base + MPCORE_RESET_CTL);
|
|
|
|
iounmap(mpsoc_base);
|
|
|
|
|
|
|
|
/* Set up delay */
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_POWERDOWN_DELAY);
|
|
|
|
reg &= ~PMSU_POWERDOWN_DELAY_MASK;
|
|
|
|
reg |= PMSU_DFLT_ARMADA38X_DELAY;
|
|
|
|
reg |= PMSU_POWERDOWN_DELAY_PMU;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_POWERDOWN_DELAY);
|
|
|
|
|
|
|
|
mvebu_cpu_resume = armada_38x_cpu_resume;
|
|
|
|
mvebu_v7_cpuidle_device.dev.platform_data = armada_38x_cpu_suspend;
|
|
|
|
mvebu_v7_cpuidle_device.name = "cpuidle-armada-38x";
|
|
|
|
|
2015-10-23 13:59:58 +03:00
|
|
|
end:
|
|
|
|
of_node_put(np);
|
2014-07-23 17:00:52 +04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:51 +04:00
|
|
|
static __init int armada_xp_cpuidle_init(void)
|
2014-04-14 19:10:14 +04:00
|
|
|
{
|
|
|
|
struct device_node *np;
|
|
|
|
|
|
|
|
np = of_find_compatible_node(NULL, NULL, "marvell,coherency-fabric");
|
|
|
|
if (!np)
|
2014-07-23 17:00:43 +04:00
|
|
|
return -ENODEV;
|
2015-10-23 13:59:58 +03:00
|
|
|
|
|
|
|
if (broken_idle(np))
|
|
|
|
goto end;
|
2014-04-14 19:10:14 +04:00
|
|
|
|
2014-07-23 17:00:44 +04:00
|
|
|
mvebu_cpu_resume = armada_370_xp_cpu_resume;
|
2014-07-23 17:00:43 +04:00
|
|
|
mvebu_v7_cpuidle_device.dev.platform_data = armada_370_xp_cpu_suspend;
|
2014-07-23 17:00:51 +04:00
|
|
|
mvebu_v7_cpuidle_device.name = "cpuidle-armada-xp";
|
2014-07-23 17:00:43 +04:00
|
|
|
|
2015-10-23 13:59:58 +03:00
|
|
|
end:
|
|
|
|
of_node_put(np);
|
2014-07-23 17:00:43 +04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int __init mvebu_v7_cpu_pm_init(void)
|
|
|
|
{
|
|
|
|
struct device_node *np;
|
|
|
|
int ret;
|
|
|
|
|
2014-04-14 19:10:14 +04:00
|
|
|
np = of_find_matching_node(NULL, of_pmsu_table);
|
|
|
|
if (!np)
|
|
|
|
return 0;
|
|
|
|
of_node_put(np);
|
|
|
|
|
2015-01-30 14:34:25 +03:00
|
|
|
/*
|
|
|
|
* Currently the CPU idle support for Armada 38x is broken, as
|
|
|
|
* the CPU hotplug uses some of the CPU idle functions it is
|
|
|
|
* broken too, so let's disable it
|
|
|
|
*/
|
|
|
|
if (of_machine_is_compatible("marvell,armada380")) {
|
|
|
|
cpu_hotplug_disable();
|
2015-06-12 16:38:34 +03:00
|
|
|
pr_warn("CPU hotplug support is currently broken on Armada 38x: disabling\n");
|
2015-01-30 14:34:25 +03:00
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:43 +04:00
|
|
|
if (of_machine_is_compatible("marvell,armadaxp"))
|
|
|
|
ret = armada_xp_cpuidle_init();
|
2014-07-23 17:00:51 +04:00
|
|
|
else if (of_machine_is_compatible("marvell,armada370"))
|
|
|
|
ret = armada_370_cpuidle_init();
|
2014-07-23 17:00:52 +04:00
|
|
|
else if (of_machine_is_compatible("marvell,armada380"))
|
|
|
|
ret = armada_38x_cpuidle_init();
|
2014-07-23 17:00:43 +04:00
|
|
|
else
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
2014-07-23 17:00:42 +04:00
|
|
|
mvebu_v7_pmsu_enable_l2_powerdown_onidle();
|
2015-01-30 14:34:25 +03:00
|
|
|
if (mvebu_v7_cpuidle_device.name)
|
|
|
|
platform_device_register(&mvebu_v7_cpuidle_device);
|
2014-07-23 17:00:42 +04:00
|
|
|
cpu_pm_register_notifier(&mvebu_v7_cpu_pm_notifier);
|
2014-04-14 19:10:14 +04:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2014-07-23 17:00:42 +04:00
|
|
|
arch_initcall(mvebu_v7_cpu_pm_init);
|
|
|
|
early_initcall(mvebu_v7_pmsu_init);
|
2014-07-09 19:45:10 +04:00
|
|
|
|
|
|
|
static void mvebu_pmsu_dfs_request_local(void *data)
|
|
|
|
{
|
|
|
|
u32 reg;
|
|
|
|
u32 cpu = smp_processor_id();
|
|
|
|
unsigned long flags;
|
|
|
|
|
|
|
|
local_irq_save(flags);
|
|
|
|
|
|
|
|
/* Prepare to enter idle */
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_STATUS_AND_MASK(cpu));
|
|
|
|
reg |= PMSU_STATUS_AND_MASK_CPU_IDLE_WAIT |
|
|
|
|
PMSU_STATUS_AND_MASK_IRQ_MASK |
|
|
|
|
PMSU_STATUS_AND_MASK_FIQ_MASK;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_STATUS_AND_MASK(cpu));
|
|
|
|
|
|
|
|
/* Request the DFS transition */
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(cpu));
|
|
|
|
reg |= PMSU_CONTROL_AND_CONFIG_DFS_REQ;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_CONTROL_AND_CONFIG(cpu));
|
|
|
|
|
|
|
|
/* The fact of entering idle will trigger the DFS transition */
|
|
|
|
wfi();
|
|
|
|
|
|
|
|
/*
|
|
|
|
* We're back from idle, the DFS transition has completed,
|
|
|
|
* clear the idle wait indication.
|
|
|
|
*/
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_STATUS_AND_MASK(cpu));
|
|
|
|
reg &= ~PMSU_STATUS_AND_MASK_CPU_IDLE_WAIT;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_STATUS_AND_MASK(cpu));
|
|
|
|
|
|
|
|
local_irq_restore(flags);
|
|
|
|
}
|
|
|
|
|
|
|
|
int mvebu_pmsu_dfs_request(int cpu)
|
|
|
|
{
|
|
|
|
unsigned long timeout;
|
|
|
|
int hwcpu = cpu_logical_map(cpu);
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
/* Clear any previous DFS DONE event */
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_EVENT_STATUS_AND_MASK(hwcpu));
|
|
|
|
reg &= ~PMSU_EVENT_STATUS_AND_MASK_DFS_DONE;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_EVENT_STATUS_AND_MASK(hwcpu));
|
|
|
|
|
|
|
|
/* Mask the DFS done interrupt, since we are going to poll */
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_EVENT_STATUS_AND_MASK(hwcpu));
|
|
|
|
reg |= PMSU_EVENT_STATUS_AND_MASK_DFS_DONE_MASK;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_EVENT_STATUS_AND_MASK(hwcpu));
|
|
|
|
|
|
|
|
/* Trigger the DFS on the appropriate CPU */
|
|
|
|
smp_call_function_single(cpu, mvebu_pmsu_dfs_request_local,
|
|
|
|
NULL, false);
|
|
|
|
|
|
|
|
/* Poll until the DFS done event is generated */
|
|
|
|
timeout = jiffies + HZ;
|
|
|
|
while (time_before(jiffies, timeout)) {
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_EVENT_STATUS_AND_MASK(hwcpu));
|
|
|
|
if (reg & PMSU_EVENT_STATUS_AND_MASK_DFS_DONE)
|
|
|
|
break;
|
|
|
|
udelay(10);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (time_after(jiffies, timeout))
|
|
|
|
return -ETIME;
|
|
|
|
|
|
|
|
/* Restore the DFS mask to its original state */
|
|
|
|
reg = readl(pmsu_mp_base + PMSU_EVENT_STATUS_AND_MASK(hwcpu));
|
|
|
|
reg &= ~PMSU_EVENT_STATUS_AND_MASK_DFS_DONE_MASK;
|
|
|
|
writel(reg, pmsu_mp_base + PMSU_EVENT_STATUS_AND_MASK(hwcpu));
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|