2010-06-17 00:49:48 +08:00
|
|
|
/*
|
|
|
|
* OMAP MPUSS low power code
|
|
|
|
*
|
|
|
|
* Copyright (C) 2011 Texas Instruments, Inc.
|
|
|
|
* Santosh Shilimkar <santosh.shilimkar@ti.com>
|
|
|
|
*
|
|
|
|
* OMAP4430 MPUSS mainly consists of dual Cortex-A9 with per-CPU
|
|
|
|
* Local timer and Watchdog, GIC, SCU, PL310 L2 cache controller,
|
|
|
|
* CPU0 and CPU1 LPRM modules.
|
|
|
|
* CPU0, CPU1 and MPUSS each have there own power domain and
|
|
|
|
* hence multiple low power combinations of MPUSS are possible.
|
|
|
|
*
|
|
|
|
* The CPU0 and CPU1 can't support Closed switch Retention (CSWR)
|
|
|
|
* because the mode is not supported by hw constraints of dormant
|
|
|
|
* mode. While waking up from the dormant mode, a reset signal
|
|
|
|
* to the Cortex-A9 processor must be asserted by the external
|
|
|
|
* power controller.
|
|
|
|
*
|
|
|
|
* With architectural inputs and hardware recommendations, only
|
|
|
|
* below modes are supported from power gain vs latency point of view.
|
|
|
|
*
|
|
|
|
* CPU0 CPU1 MPUSS
|
|
|
|
* ----------------------------------------------
|
|
|
|
* ON ON ON
|
|
|
|
* ON(Inactive) OFF ON(Inactive)
|
|
|
|
* OFF OFF CSWR
|
2011-06-06 17:03:29 +08:00
|
|
|
* OFF OFF OSWR
|
|
|
|
* OFF OFF OFF(Device OFF *TBD)
|
2010-06-17 00:49:48 +08:00
|
|
|
* ----------------------------------------------
|
|
|
|
*
|
|
|
|
* Note: CPU0 is the master core and it is the last CPU to go down
|
|
|
|
* and first to wake-up when MPUSS low power states are excercised
|
|
|
|
*
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
|
|
* published by the Free Software Foundation.
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/io.h>
|
|
|
|
#include <linux/errno.h>
|
|
|
|
#include <linux/linkage.h>
|
|
|
|
#include <linux/smp.h>
|
|
|
|
|
|
|
|
#include <asm/cacheflush.h>
|
|
|
|
#include <asm/tlbflush.h>
|
|
|
|
#include <asm/smp_scu.h>
|
|
|
|
#include <asm/pgalloc.h>
|
|
|
|
#include <asm/suspend.h>
|
2016-11-08 07:50:11 +08:00
|
|
|
#include <asm/virt.h>
|
2011-01-09 05:29:09 +08:00
|
|
|
#include <asm/hardware/cache-l2x0.h>
|
2010-06-17 00:49:48 +08:00
|
|
|
|
2012-10-06 04:25:59 +08:00
|
|
|
#include "soc.h"
|
2010-06-17 00:49:48 +08:00
|
|
|
#include "common.h"
|
2012-09-01 07:08:07 +08:00
|
|
|
#include "omap44xx.h"
|
2010-06-17 00:49:48 +08:00
|
|
|
#include "omap4-sar-layout.h"
|
|
|
|
#include "pm.h"
|
2011-06-06 17:03:29 +08:00
|
|
|
#include "prcm_mpu44xx.h"
|
2013-02-06 22:09:07 +08:00
|
|
|
#include "prcm_mpu54xx.h"
|
2011-06-06 17:03:29 +08:00
|
|
|
#include "prminst44xx.h"
|
|
|
|
#include "prcm44xx.h"
|
|
|
|
#include "prm44xx.h"
|
|
|
|
#include "prm-regbits-44xx.h"
|
2010-06-17 00:49:48 +08:00
|
|
|
|
2016-06-22 16:59:39 +08:00
|
|
|
static void __iomem *sar_base;
|
2017-03-23 02:01:48 +08:00
|
|
|
static u32 old_cpu1_ns_pa_addr;
|
2016-06-22 16:59:39 +08:00
|
|
|
|
2016-07-04 14:29:45 +08:00
|
|
|
#if defined(CONFIG_PM) && defined(CONFIG_SMP)
|
2010-06-17 00:49:48 +08:00
|
|
|
|
|
|
|
struct omap4_cpu_pm_info {
|
|
|
|
struct powerdomain *pwrdm;
|
|
|
|
void __iomem *scu_sar_addr;
|
|
|
|
void __iomem *wkup_sar_addr;
|
2011-01-09 05:29:09 +08:00
|
|
|
void __iomem *l2x0_sar_addr;
|
2010-06-17 00:49:48 +08:00
|
|
|
};
|
|
|
|
|
2013-04-05 20:59:00 +08:00
|
|
|
/**
|
|
|
|
* struct cpu_pm_ops - CPU pm operations
|
|
|
|
* @finish_suspend: CPU suspend finisher function pointer
|
|
|
|
* @resume: CPU resume function pointer
|
|
|
|
* @scu_prepare: CPU Snoop Control program function pointer
|
2014-06-07 06:30:43 +08:00
|
|
|
* @hotplug_restart: CPU restart function pointer
|
2013-04-05 20:59:00 +08:00
|
|
|
*
|
|
|
|
* Structure holds functions pointer for CPU low power operations like
|
|
|
|
* suspend, resume and scu programming.
|
|
|
|
*/
|
|
|
|
struct cpu_pm_ops {
|
|
|
|
int (*finish_suspend)(unsigned long cpu_state);
|
|
|
|
void (*resume)(void);
|
|
|
|
void (*scu_prepare)(unsigned int cpu_id, unsigned int cpu_state);
|
2014-06-07 06:30:43 +08:00
|
|
|
void (*hotplug_restart)(void);
|
2013-04-05 20:59:00 +08:00
|
|
|
};
|
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
static DEFINE_PER_CPU(struct omap4_cpu_pm_info, omap4_pm_info);
|
2010-06-17 00:49:49 +08:00
|
|
|
static struct powerdomain *mpuss_pd;
|
2013-02-06 22:09:07 +08:00
|
|
|
static u32 cpu_context_offset;
|
2010-06-17 00:49:48 +08:00
|
|
|
|
2013-04-05 20:59:00 +08:00
|
|
|
static int default_finish_suspend(unsigned long cpu_state)
|
|
|
|
{
|
|
|
|
omap_do_wfi();
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void dummy_cpu_resume(void)
|
|
|
|
{}
|
|
|
|
|
|
|
|
static void dummy_scu_prepare(unsigned int cpu_id, unsigned int cpu_state)
|
|
|
|
{}
|
|
|
|
|
2015-07-11 22:59:15 +08:00
|
|
|
static struct cpu_pm_ops omap_pm_ops = {
|
2013-04-05 20:59:00 +08:00
|
|
|
.finish_suspend = default_finish_suspend,
|
|
|
|
.resume = dummy_cpu_resume,
|
|
|
|
.scu_prepare = dummy_scu_prepare,
|
2014-06-07 06:30:43 +08:00
|
|
|
.hotplug_restart = dummy_cpu_resume,
|
2013-04-05 20:59:00 +08:00
|
|
|
};
|
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
/*
|
|
|
|
* Program the wakeup routine address for the CPU0 and CPU1
|
|
|
|
* used for OFF or DORMANT wakeup.
|
|
|
|
*/
|
|
|
|
static inline void set_cpu_wakeup_addr(unsigned int cpu_id, u32 addr)
|
|
|
|
{
|
|
|
|
struct omap4_cpu_pm_info *pm_info = &per_cpu(omap4_pm_info, cpu_id);
|
|
|
|
|
2013-05-03 18:04:40 +08:00
|
|
|
if (pm_info->wkup_sar_addr)
|
|
|
|
writel_relaxed(addr, pm_info->wkup_sar_addr);
|
2010-06-17 00:49:48 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Store the SCU power status value to scratchpad memory
|
|
|
|
*/
|
|
|
|
static void scu_pwrst_prepare(unsigned int cpu_id, unsigned int cpu_state)
|
|
|
|
{
|
|
|
|
struct omap4_cpu_pm_info *pm_info = &per_cpu(omap4_pm_info, cpu_id);
|
|
|
|
u32 scu_pwr_st;
|
|
|
|
|
|
|
|
switch (cpu_state) {
|
|
|
|
case PWRDM_POWER_RET:
|
|
|
|
scu_pwr_st = SCU_PM_DORMANT;
|
|
|
|
break;
|
|
|
|
case PWRDM_POWER_OFF:
|
|
|
|
scu_pwr_st = SCU_PM_POWEROFF;
|
|
|
|
break;
|
|
|
|
case PWRDM_POWER_ON:
|
|
|
|
case PWRDM_POWER_INACTIVE:
|
|
|
|
default:
|
|
|
|
scu_pwr_st = SCU_PM_NORMAL;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
2013-05-03 18:04:40 +08:00
|
|
|
if (pm_info->scu_sar_addr)
|
|
|
|
writel_relaxed(scu_pwr_st, pm_info->scu_sar_addr);
|
2010-06-17 00:49:48 +08:00
|
|
|
}
|
|
|
|
|
2011-06-06 17:03:29 +08:00
|
|
|
/* Helper functions for MPUSS OSWR */
|
|
|
|
static inline void mpuss_clear_prev_logic_pwrst(void)
|
|
|
|
{
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
reg = omap4_prminst_read_inst_reg(OMAP4430_PRM_PARTITION,
|
|
|
|
OMAP4430_PRM_MPU_INST, OMAP4_RM_MPU_MPU_CONTEXT_OFFSET);
|
|
|
|
omap4_prminst_write_inst_reg(reg, OMAP4430_PRM_PARTITION,
|
|
|
|
OMAP4430_PRM_MPU_INST, OMAP4_RM_MPU_MPU_CONTEXT_OFFSET);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void cpu_clear_prev_logic_pwrst(unsigned int cpu_id)
|
|
|
|
{
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
if (cpu_id) {
|
|
|
|
reg = omap4_prcm_mpu_read_inst_reg(OMAP4430_PRCM_MPU_CPU1_INST,
|
2013-02-06 22:09:07 +08:00
|
|
|
cpu_context_offset);
|
2011-06-06 17:03:29 +08:00
|
|
|
omap4_prcm_mpu_write_inst_reg(reg, OMAP4430_PRCM_MPU_CPU1_INST,
|
2013-02-06 22:09:07 +08:00
|
|
|
cpu_context_offset);
|
2011-06-06 17:03:29 +08:00
|
|
|
} else {
|
|
|
|
reg = omap4_prcm_mpu_read_inst_reg(OMAP4430_PRCM_MPU_CPU0_INST,
|
2013-02-06 22:09:07 +08:00
|
|
|
cpu_context_offset);
|
2011-06-06 17:03:29 +08:00
|
|
|
omap4_prcm_mpu_write_inst_reg(reg, OMAP4430_PRCM_MPU_CPU0_INST,
|
2013-02-06 22:09:07 +08:00
|
|
|
cpu_context_offset);
|
2011-06-06 17:03:29 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-01-09 05:29:09 +08:00
|
|
|
/*
|
|
|
|
* Store the CPU cluster state for L2X0 low power operations.
|
|
|
|
*/
|
|
|
|
static void l2x0_pwrst_prepare(unsigned int cpu_id, unsigned int save_state)
|
|
|
|
{
|
|
|
|
struct omap4_cpu_pm_info *pm_info = &per_cpu(omap4_pm_info, cpu_id);
|
|
|
|
|
2013-05-03 18:04:40 +08:00
|
|
|
if (pm_info->l2x0_sar_addr)
|
|
|
|
writel_relaxed(save_state, pm_info->l2x0_sar_addr);
|
2011-01-09 05:29:09 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Save the L2X0 AUXCTRL and POR value to SAR memory. Its used to
|
|
|
|
* in every restore MPUSS OFF path.
|
|
|
|
*/
|
|
|
|
#ifdef CONFIG_CACHE_L2X0
|
2014-04-05 17:57:44 +08:00
|
|
|
static void __init save_l2x0_context(void)
|
2011-01-09 05:29:09 +08:00
|
|
|
{
|
2013-05-03 18:04:40 +08:00
|
|
|
void __iomem *l2x0_base = omap4_get_l2cache_base();
|
|
|
|
|
|
|
|
if (l2x0_base && sar_base) {
|
|
|
|
writel_relaxed(l2x0_saved_regs.aux_ctrl,
|
|
|
|
sar_base + L2X0_AUXCTRL_OFFSET);
|
|
|
|
writel_relaxed(l2x0_saved_regs.prefetch_ctrl,
|
|
|
|
sar_base + L2X0_PREFETCH_CTRL_OFFSET);
|
|
|
|
}
|
2011-01-09 05:29:09 +08:00
|
|
|
}
|
|
|
|
#else
|
2014-04-05 17:57:44 +08:00
|
|
|
static void __init save_l2x0_context(void)
|
2011-01-09 05:29:09 +08:00
|
|
|
{}
|
|
|
|
#endif
|
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
/**
|
|
|
|
* omap4_enter_lowpower: OMAP4 MPUSS Low Power Entry Function
|
|
|
|
* The purpose of this function is to manage low power programming
|
|
|
|
* of OMAP4 MPUSS subsystem
|
|
|
|
* @cpu : CPU ID
|
|
|
|
* @power_state: Low power state.
|
2010-06-17 00:49:49 +08:00
|
|
|
*
|
|
|
|
* MPUSS states for the context save:
|
|
|
|
* save_state =
|
|
|
|
* 0 - Nothing lost and no need to save: MPUSS INACTIVE
|
|
|
|
* 1 - CPUx L1 and logic lost: MPUSS CSWR
|
|
|
|
* 2 - CPUx L1 and logic lost + GIC lost: MPUSS OSWR
|
|
|
|
* 3 - CPUx L1 and logic lost + GIC + L2 lost: DEVICE OFF
|
2010-06-17 00:49:48 +08:00
|
|
|
*/
|
|
|
|
int omap4_enter_lowpower(unsigned int cpu, unsigned int power_state)
|
|
|
|
{
|
2013-01-26 15:58:13 +08:00
|
|
|
struct omap4_cpu_pm_info *pm_info = &per_cpu(omap4_pm_info, cpu);
|
ARM: OMAP4+: PM: Program CPU logic power state
CPU logic power state is never programmed in either the initialization
or the suspend/resume logic, instead, we depend on mpuss to program this
properly. However, this leaves CPU logic power state indeterminate and
most probably in reset configuration (If bootloader or other similar
software have'nt monkeyed with the register). This can make powerstate=
RET be either programmed for CSWR (logic=ret) or OSWR(logic = OFF) and
in OSWR, there can be context loss when the code does not expect it.
To prevent all these confusions, just support clearly ON, INA, CSWR,
OFF which is the intent of the existing code by explicitly programming
logic state.
NOTE: since this is a hot path (using in cpuidle), the exit path just
programs powerstate (logic state is immaterial when powerstate is ON).
Without doing this, we end up with lockups when CPUs enter OSWR and
multiple blocks loose context, when we expect them to hit CSWR.
Signed-off-by: Nishanth Menon <nm@ti.com>
Acked-by: Kevin Hilman <khilman@linaro.org>
Signed-off-by: Tony Lindgren <tony@atomide.com>
2014-10-22 04:24:36 +08:00
|
|
|
unsigned int save_state = 0, cpu_logic_state = PWRDM_POWER_RET;
|
2010-06-17 00:49:48 +08:00
|
|
|
unsigned int wakeup_cpu;
|
|
|
|
|
|
|
|
if (omap_rev() == OMAP4430_REV_ES1_0)
|
|
|
|
return -ENXIO;
|
|
|
|
|
|
|
|
switch (power_state) {
|
|
|
|
case PWRDM_POWER_ON:
|
|
|
|
case PWRDM_POWER_INACTIVE:
|
|
|
|
save_state = 0;
|
|
|
|
break;
|
|
|
|
case PWRDM_POWER_OFF:
|
ARM: OMAP4+: PM: Program CPU logic power state
CPU logic power state is never programmed in either the initialization
or the suspend/resume logic, instead, we depend on mpuss to program this
properly. However, this leaves CPU logic power state indeterminate and
most probably in reset configuration (If bootloader or other similar
software have'nt monkeyed with the register). This can make powerstate=
RET be either programmed for CSWR (logic=ret) or OSWR(logic = OFF) and
in OSWR, there can be context loss when the code does not expect it.
To prevent all these confusions, just support clearly ON, INA, CSWR,
OFF which is the intent of the existing code by explicitly programming
logic state.
NOTE: since this is a hot path (using in cpuidle), the exit path just
programs powerstate (logic state is immaterial when powerstate is ON).
Without doing this, we end up with lockups when CPUs enter OSWR and
multiple blocks loose context, when we expect them to hit CSWR.
Signed-off-by: Nishanth Menon <nm@ti.com>
Acked-by: Kevin Hilman <khilman@linaro.org>
Signed-off-by: Tony Lindgren <tony@atomide.com>
2014-10-22 04:24:36 +08:00
|
|
|
cpu_logic_state = PWRDM_POWER_OFF;
|
2010-06-17 00:49:48 +08:00
|
|
|
save_state = 1;
|
|
|
|
break;
|
|
|
|
case PWRDM_POWER_RET:
|
2016-11-08 07:50:11 +08:00
|
|
|
if (IS_PM44XX_ERRATUM(PM_OMAP4_CPU_OSWR_DISABLE))
|
2013-05-27 18:16:44 +08:00
|
|
|
save_state = 0;
|
2016-11-08 07:50:11 +08:00
|
|
|
break;
|
2010-06-17 00:49:48 +08:00
|
|
|
default:
|
|
|
|
/*
|
|
|
|
* CPUx CSWR is invalid hardware state. Also CPUx OSWR
|
|
|
|
* doesn't make much scense, since logic is lost and $L1
|
|
|
|
* needs to be cleaned because of coherency. This makes
|
|
|
|
* CPUx OSWR equivalent to CPUX OFF and hence not supported
|
|
|
|
*/
|
|
|
|
WARN_ON(1);
|
|
|
|
return -ENXIO;
|
|
|
|
}
|
|
|
|
|
2012-05-12 07:00:24 +08:00
|
|
|
pwrdm_pre_transition(NULL);
|
2011-01-10 03:32:15 +08:00
|
|
|
|
2011-06-06 17:03:29 +08:00
|
|
|
/*
|
|
|
|
* Check MPUSS next state and save interrupt controller if needed.
|
|
|
|
* In MPUSS OSWR or device OFF, interrupt controller contest is lost.
|
|
|
|
*/
|
|
|
|
mpuss_clear_prev_logic_pwrst();
|
|
|
|
if ((pwrdm_read_next_pwrst(mpuss_pd) == PWRDM_POWER_RET) &&
|
|
|
|
(pwrdm_read_logic_retst(mpuss_pd) == PWRDM_POWER_OFF))
|
|
|
|
save_state = 2;
|
|
|
|
|
|
|
|
cpu_clear_prev_logic_pwrst(cpu);
|
2013-01-26 15:58:13 +08:00
|
|
|
pwrdm_set_next_pwrst(pm_info->pwrdm, power_state);
|
ARM: OMAP4+: PM: Program CPU logic power state
CPU logic power state is never programmed in either the initialization
or the suspend/resume logic, instead, we depend on mpuss to program this
properly. However, this leaves CPU logic power state indeterminate and
most probably in reset configuration (If bootloader or other similar
software have'nt monkeyed with the register). This can make powerstate=
RET be either programmed for CSWR (logic=ret) or OSWR(logic = OFF) and
in OSWR, there can be context loss when the code does not expect it.
To prevent all these confusions, just support clearly ON, INA, CSWR,
OFF which is the intent of the existing code by explicitly programming
logic state.
NOTE: since this is a hot path (using in cpuidle), the exit path just
programs powerstate (logic state is immaterial when powerstate is ON).
Without doing this, we end up with lockups when CPUs enter OSWR and
multiple blocks loose context, when we expect them to hit CSWR.
Signed-off-by: Nishanth Menon <nm@ti.com>
Acked-by: Kevin Hilman <khilman@linaro.org>
Signed-off-by: Tony Lindgren <tony@atomide.com>
2014-10-22 04:24:36 +08:00
|
|
|
pwrdm_set_logic_retst(pm_info->pwrdm, cpu_logic_state);
|
2017-01-15 10:59:29 +08:00
|
|
|
set_cpu_wakeup_addr(cpu, __pa_symbol(omap_pm_ops.resume));
|
2013-04-05 20:59:00 +08:00
|
|
|
omap_pm_ops.scu_prepare(cpu, power_state);
|
2011-01-09 05:29:09 +08:00
|
|
|
l2x0_pwrst_prepare(cpu, save_state);
|
2010-06-17 00:49:48 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Call low level function with targeted low power state.
|
|
|
|
*/
|
2013-02-13 16:55:24 +08:00
|
|
|
if (save_state)
|
2013-04-05 20:59:00 +08:00
|
|
|
cpu_suspend(save_state, omap_pm_ops.finish_suspend);
|
2013-02-13 16:55:24 +08:00
|
|
|
else
|
2013-04-05 20:59:00 +08:00
|
|
|
omap_pm_ops.finish_suspend(save_state);
|
2010-06-17 00:49:48 +08:00
|
|
|
|
2013-10-23 03:07:15 +08:00
|
|
|
if (IS_PM44XX_ERRATUM(PM_OMAP4_ROM_SMP_BOOT_ERRATUM_GICD) && cpu)
|
|
|
|
gic_dist_enable();
|
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
/*
|
|
|
|
* Restore the CPUx power state to ON otherwise CPUx
|
|
|
|
* power domain can transitions to programmed low power
|
|
|
|
* state while doing WFI outside the low powe code. On
|
|
|
|
* secure devices, CPUx does WFI which can result in
|
|
|
|
* domain transition
|
|
|
|
*/
|
|
|
|
wakeup_cpu = smp_processor_id();
|
2013-01-26 15:58:13 +08:00
|
|
|
pwrdm_set_next_pwrst(pm_info->pwrdm, PWRDM_POWER_ON);
|
2010-06-17 00:49:48 +08:00
|
|
|
|
2012-05-12 07:00:24 +08:00
|
|
|
pwrdm_post_transition(NULL);
|
2011-01-10 03:32:15 +08:00
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
/**
|
|
|
|
* omap4_hotplug_cpu: OMAP4 CPU hotplug entry
|
|
|
|
* @cpu : CPU ID
|
|
|
|
* @power_state: CPU low power state.
|
|
|
|
*/
|
2013-06-18 03:43:14 +08:00
|
|
|
int omap4_hotplug_cpu(unsigned int cpu, unsigned int power_state)
|
2010-06-17 00:49:48 +08:00
|
|
|
{
|
ARM: OMAP4460: Workaround for ROM bug because of CA9 r2pX GIC control register change.
On OMAP4+ devices, GIC register context is lost when MPUSS hits
the OSWR(Open Switch Retention). On the CPU wakeup path, ROM code
gets executed and one of the steps in it is to restore the
saved context of the GIC. The ROM Code GIC distributor restoration
is split in two parts: CPU specific register done by each CPU and
common register done by only one CPU.
Below is the abstract flow.
...............................................................
- MPUSS in OSWR state.
- CPU0 wakes up on the event(interrupt) and start executing ROM code.
[..]
- CPU0 executes "GIC Restoration:"
[...]
- CPU0 swicthes to non-secure mode and jumps to OS resume code.
[...]
- CPU0 is online in OS
- CPU0 enables the GIC distributor. GICD.Enable Non-secure = 1
- CPU0 wakes up CPU1 with clock-domain force wakeup method.
- CPU0 continues it's execution.
[..]
- CPU1 wakes up and start executing ROM code.
[..]
- CPU1 executes "GIC Restoration:"
[..]
- CPU1 swicthes to non-secure mode and jumps to OS resume code.
[...]
- CPU1 is online in OS and start executing.
[...] -
GIC Restoration: /* Common routine for HS and GP devices */
{
if (GICD != 1) { /* This will be true in OSWR state */
if (GIC_SAR_BACKUP_STATE == SAVED)
- CPU restores GIC distributor
else
- reconfigure GIC distributor to boot values.
GICD.Enable secure = 1
}
if (GIC_SAR_BACKUP_STATE == SAVED)
- CPU restore its GIC CPU interface registers if saved.
else
- reconfigure its GIC CPU interface registers to boot
values.
}
...............................................................
So as mentioned in the flow, GICD != 1 condition decides how
the GIC registers are handled in ROM code wakeup path from
OSWR. As evident from the flow, ROM code relies on the entire
GICD register value and not specific register bits.
The assumption was valid till CortexA9 r1pX version since there
was only one banked bit to control secure and non-secure GICD.
Secure view which ROM code sees:
bit 0 == Enable Non-secure
Non-secure view which HLOS sees:
bit 0 == Enable secure
But GICD register has changed between CortexA9 r1pX and r2pX.
On r2pX GICD register is composed of 2 bits.
Secure view which ROM code sees:
bit 1 == Enable Non-secure
bit 0 == Enable secure
Non-secure view which HLOS sees:
bit 0 == Enable Non-secure
Hence on OMAP4460(r2pX) devices, if you go through the
above flow again during CPU1 wakeup, GICD == 3 and hence
ROM code fails to understand the real wakeup power state
and reconfigures GIC distributor to boot values. This is
nasty since you loose the entire interrupt controller
context in a live system.
The ROM code fix done on next OMAP4 device (OMAP4470 - r2px) is to
check "GICD.Enable secure != 1" for GIC restoration in OSWR wakeup path.
Since ROM code can't be fixed on OMAP4460 devices, a work around
needs to be implemented. As evident from the flow, as long as
CPU1 sees GICD == 1 in it's wakeup path from OSWR, the issue
won't happen. Below is the flow with the work-around.
...............................................................
- MPUSS in OSWR state.
- CPU0 wakes up on the event(interrupt) and start executing ROM code.
[..]
- CPU0 executes "GIC Restoration:"
[..]
- CPU0 swicthes to non-secure mode and jumps to OS resume code.
[..]
- CPU0 is online in OS.
- CPU0 does GICD.Enable Non-secure = 0
- CPU0 wakes up CPU1 with clock domain force wakeup method.
- CPU0 waits for GICD.Enable Non-secure = 1
- CPU0 coninues it's execution.
[..]
- CPU1 wakes up and start executing ROM code.
[..]
- CPU1 executes "GIC Restoration:"
[..]
- CPU1 swicthes to non-secure mode and jumps to OS resume code.
[..]
- CPU1 is online in OS
- CPU1 does GICD.Enable Non-secure = 1
- CPU1 start executing
[...]
...............................................................
With this procedure, the GIC configuration done between the
CPU0 wakeup and CPU1 wakeup will not be lost but during this
short windows, the CPU0 will not receive interrupts.
The BUG is applicable to only OMAP4460(r2pX) devices.
OMAP4470 (also r2pX) is not affected by this bug because
ROM code has been fixed.
Signed-off-by: Santosh Shilimkar <santosh.shilimkar@ti.com>
Signed-off-by: Tero Kristo <t-kristo@ti.com>
Signed-off-by: Kevin Hilman <khilman@ti.com>
2012-10-18 17:20:05 +08:00
|
|
|
struct omap4_cpu_pm_info *pm_info = &per_cpu(omap4_pm_info, cpu);
|
2013-01-26 15:58:13 +08:00
|
|
|
unsigned int cpu_state = 0;
|
2010-06-17 00:49:48 +08:00
|
|
|
|
|
|
|
if (omap_rev() == OMAP4430_REV_ES1_0)
|
|
|
|
return -ENXIO;
|
|
|
|
|
2014-07-24 23:24:19 +08:00
|
|
|
/* Use the achievable power state for the domain */
|
|
|
|
power_state = pwrdm_get_valid_lp_state(pm_info->pwrdm,
|
|
|
|
false, power_state);
|
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
if (power_state == PWRDM_POWER_OFF)
|
|
|
|
cpu_state = 1;
|
|
|
|
|
2013-01-26 15:58:13 +08:00
|
|
|
pwrdm_clear_all_prev_pwrst(pm_info->pwrdm);
|
|
|
|
pwrdm_set_next_pwrst(pm_info->pwrdm, power_state);
|
2017-01-15 10:59:29 +08:00
|
|
|
set_cpu_wakeup_addr(cpu, __pa_symbol(omap_pm_ops.hotplug_restart));
|
2013-04-05 20:59:00 +08:00
|
|
|
omap_pm_ops.scu_prepare(cpu, power_state);
|
2010-06-17 00:49:48 +08:00
|
|
|
|
|
|
|
/*
|
2012-07-11 23:56:57 +08:00
|
|
|
* CPU never retuns back if targeted power state is OFF mode.
|
2010-06-17 00:49:48 +08:00
|
|
|
* CPU ONLINE follows normal CPU ONLINE ptah via
|
2013-04-05 20:59:02 +08:00
|
|
|
* omap4_secondary_startup().
|
2010-06-17 00:49:48 +08:00
|
|
|
*/
|
2013-04-05 20:59:00 +08:00
|
|
|
omap_pm_ops.finish_suspend(cpu_state);
|
2010-06-17 00:49:48 +08:00
|
|
|
|
2013-01-26 15:58:13 +08:00
|
|
|
pwrdm_set_next_pwrst(pm_info->pwrdm, PWRDM_POWER_ON);
|
2010-06-17 00:49:48 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2012-04-12 19:31:52 +08:00
|
|
|
/*
|
|
|
|
* Enable Mercury Fast HG retention mode by default.
|
|
|
|
*/
|
|
|
|
static void enable_mercury_retention_mode(void)
|
|
|
|
{
|
|
|
|
u32 reg;
|
|
|
|
|
|
|
|
reg = omap4_prcm_mpu_read_inst_reg(OMAP54XX_PRCM_MPU_DEVICE_INST,
|
|
|
|
OMAP54XX_PRCM_MPU_PRM_PSCON_COUNT_OFFSET);
|
|
|
|
/* Enable HG_EN, HG_RAMPUP = fast mode */
|
|
|
|
reg |= BIT(24) | BIT(25);
|
|
|
|
omap4_prcm_mpu_write_inst_reg(reg, OMAP54XX_PRCM_MPU_DEVICE_INST,
|
|
|
|
OMAP54XX_PRCM_MPU_PRM_PSCON_COUNT_OFFSET);
|
|
|
|
}
|
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
/*
|
|
|
|
* Initialise OMAP4 MPUSS
|
|
|
|
*/
|
|
|
|
int __init omap4_mpuss_init(void)
|
|
|
|
{
|
|
|
|
struct omap4_cpu_pm_info *pm_info;
|
|
|
|
|
|
|
|
if (omap_rev() == OMAP4430_REV_ES1_0) {
|
|
|
|
WARN(1, "Power Management not supported on OMAP4430 ES1.0\n");
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Initilaise per CPU PM information */
|
|
|
|
pm_info = &per_cpu(omap4_pm_info, 0x0);
|
2013-05-03 18:04:40 +08:00
|
|
|
if (sar_base) {
|
|
|
|
pm_info->scu_sar_addr = sar_base + SCU_OFFSET0;
|
2016-11-08 07:50:11 +08:00
|
|
|
if (cpu_is_omap44xx())
|
|
|
|
pm_info->wkup_sar_addr = sar_base +
|
|
|
|
CPU0_WAKEUP_NS_PA_ADDR_OFFSET;
|
|
|
|
else
|
|
|
|
pm_info->wkup_sar_addr = sar_base +
|
|
|
|
OMAP5_CPU0_WAKEUP_NS_PA_ADDR_OFFSET;
|
2013-05-03 18:04:40 +08:00
|
|
|
pm_info->l2x0_sar_addr = sar_base + L2X0_SAVE_OFFSET0;
|
|
|
|
}
|
2010-06-17 00:49:48 +08:00
|
|
|
pm_info->pwrdm = pwrdm_lookup("cpu0_pwrdm");
|
|
|
|
if (!pm_info->pwrdm) {
|
|
|
|
pr_err("Lookup failed for CPU0 pwrdm\n");
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Clear CPU previous power domain state */
|
|
|
|
pwrdm_clear_all_prev_pwrst(pm_info->pwrdm);
|
2011-06-06 17:03:29 +08:00
|
|
|
cpu_clear_prev_logic_pwrst(0);
|
2010-06-17 00:49:48 +08:00
|
|
|
|
|
|
|
/* Initialise CPU0 power domain state to ON */
|
|
|
|
pwrdm_set_next_pwrst(pm_info->pwrdm, PWRDM_POWER_ON);
|
|
|
|
|
|
|
|
pm_info = &per_cpu(omap4_pm_info, 0x1);
|
2013-05-03 18:04:40 +08:00
|
|
|
if (sar_base) {
|
|
|
|
pm_info->scu_sar_addr = sar_base + SCU_OFFSET1;
|
2016-11-08 07:50:11 +08:00
|
|
|
if (cpu_is_omap44xx())
|
|
|
|
pm_info->wkup_sar_addr = sar_base +
|
|
|
|
CPU1_WAKEUP_NS_PA_ADDR_OFFSET;
|
|
|
|
else
|
|
|
|
pm_info->wkup_sar_addr = sar_base +
|
|
|
|
OMAP5_CPU1_WAKEUP_NS_PA_ADDR_OFFSET;
|
2013-05-03 18:04:40 +08:00
|
|
|
pm_info->l2x0_sar_addr = sar_base + L2X0_SAVE_OFFSET1;
|
|
|
|
}
|
ARM: OMAP4460: Workaround for ROM bug because of CA9 r2pX GIC control register change.
On OMAP4+ devices, GIC register context is lost when MPUSS hits
the OSWR(Open Switch Retention). On the CPU wakeup path, ROM code
gets executed and one of the steps in it is to restore the
saved context of the GIC. The ROM Code GIC distributor restoration
is split in two parts: CPU specific register done by each CPU and
common register done by only one CPU.
Below is the abstract flow.
...............................................................
- MPUSS in OSWR state.
- CPU0 wakes up on the event(interrupt) and start executing ROM code.
[..]
- CPU0 executes "GIC Restoration:"
[...]
- CPU0 swicthes to non-secure mode and jumps to OS resume code.
[...]
- CPU0 is online in OS
- CPU0 enables the GIC distributor. GICD.Enable Non-secure = 1
- CPU0 wakes up CPU1 with clock-domain force wakeup method.
- CPU0 continues it's execution.
[..]
- CPU1 wakes up and start executing ROM code.
[..]
- CPU1 executes "GIC Restoration:"
[..]
- CPU1 swicthes to non-secure mode and jumps to OS resume code.
[...]
- CPU1 is online in OS and start executing.
[...] -
GIC Restoration: /* Common routine for HS and GP devices */
{
if (GICD != 1) { /* This will be true in OSWR state */
if (GIC_SAR_BACKUP_STATE == SAVED)
- CPU restores GIC distributor
else
- reconfigure GIC distributor to boot values.
GICD.Enable secure = 1
}
if (GIC_SAR_BACKUP_STATE == SAVED)
- CPU restore its GIC CPU interface registers if saved.
else
- reconfigure its GIC CPU interface registers to boot
values.
}
...............................................................
So as mentioned in the flow, GICD != 1 condition decides how
the GIC registers are handled in ROM code wakeup path from
OSWR. As evident from the flow, ROM code relies on the entire
GICD register value and not specific register bits.
The assumption was valid till CortexA9 r1pX version since there
was only one banked bit to control secure and non-secure GICD.
Secure view which ROM code sees:
bit 0 == Enable Non-secure
Non-secure view which HLOS sees:
bit 0 == Enable secure
But GICD register has changed between CortexA9 r1pX and r2pX.
On r2pX GICD register is composed of 2 bits.
Secure view which ROM code sees:
bit 1 == Enable Non-secure
bit 0 == Enable secure
Non-secure view which HLOS sees:
bit 0 == Enable Non-secure
Hence on OMAP4460(r2pX) devices, if you go through the
above flow again during CPU1 wakeup, GICD == 3 and hence
ROM code fails to understand the real wakeup power state
and reconfigures GIC distributor to boot values. This is
nasty since you loose the entire interrupt controller
context in a live system.
The ROM code fix done on next OMAP4 device (OMAP4470 - r2px) is to
check "GICD.Enable secure != 1" for GIC restoration in OSWR wakeup path.
Since ROM code can't be fixed on OMAP4460 devices, a work around
needs to be implemented. As evident from the flow, as long as
CPU1 sees GICD == 1 in it's wakeup path from OSWR, the issue
won't happen. Below is the flow with the work-around.
...............................................................
- MPUSS in OSWR state.
- CPU0 wakes up on the event(interrupt) and start executing ROM code.
[..]
- CPU0 executes "GIC Restoration:"
[..]
- CPU0 swicthes to non-secure mode and jumps to OS resume code.
[..]
- CPU0 is online in OS.
- CPU0 does GICD.Enable Non-secure = 0
- CPU0 wakes up CPU1 with clock domain force wakeup method.
- CPU0 waits for GICD.Enable Non-secure = 1
- CPU0 coninues it's execution.
[..]
- CPU1 wakes up and start executing ROM code.
[..]
- CPU1 executes "GIC Restoration:"
[..]
- CPU1 swicthes to non-secure mode and jumps to OS resume code.
[..]
- CPU1 is online in OS
- CPU1 does GICD.Enable Non-secure = 1
- CPU1 start executing
[...]
...............................................................
With this procedure, the GIC configuration done between the
CPU0 wakeup and CPU1 wakeup will not be lost but during this
short windows, the CPU0 will not receive interrupts.
The BUG is applicable to only OMAP4460(r2pX) devices.
OMAP4470 (also r2pX) is not affected by this bug because
ROM code has been fixed.
Signed-off-by: Santosh Shilimkar <santosh.shilimkar@ti.com>
Signed-off-by: Tero Kristo <t-kristo@ti.com>
Signed-off-by: Kevin Hilman <khilman@ti.com>
2012-10-18 17:20:05 +08:00
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
pm_info->pwrdm = pwrdm_lookup("cpu1_pwrdm");
|
|
|
|
if (!pm_info->pwrdm) {
|
|
|
|
pr_err("Lookup failed for CPU1 pwrdm\n");
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Clear CPU previous power domain state */
|
|
|
|
pwrdm_clear_all_prev_pwrst(pm_info->pwrdm);
|
2011-06-06 17:03:29 +08:00
|
|
|
cpu_clear_prev_logic_pwrst(1);
|
2010-06-17 00:49:48 +08:00
|
|
|
|
|
|
|
/* Initialise CPU1 power domain state to ON */
|
|
|
|
pwrdm_set_next_pwrst(pm_info->pwrdm, PWRDM_POWER_ON);
|
|
|
|
|
2010-06-17 00:49:49 +08:00
|
|
|
mpuss_pd = pwrdm_lookup("mpu_pwrdm");
|
|
|
|
if (!mpuss_pd) {
|
|
|
|
pr_err("Failed to lookup MPUSS power domain\n");
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
pwrdm_clear_all_prev_pwrst(mpuss_pd);
|
2011-06-06 17:03:29 +08:00
|
|
|
mpuss_clear_prev_logic_pwrst();
|
2010-06-17 00:49:49 +08:00
|
|
|
|
2013-05-03 18:04:40 +08:00
|
|
|
if (sar_base) {
|
|
|
|
/* Save device type on scratchpad for low level code to use */
|
|
|
|
writel_relaxed((omap_type() != OMAP2_DEVICE_TYPE_GP) ? 1 : 0,
|
|
|
|
sar_base + OMAP_TYPE_OFFSET);
|
|
|
|
save_l2x0_context();
|
|
|
|
}
|
2011-01-09 05:29:09 +08:00
|
|
|
|
2013-04-05 20:59:00 +08:00
|
|
|
if (cpu_is_omap44xx()) {
|
|
|
|
omap_pm_ops.finish_suspend = omap4_finish_suspend;
|
|
|
|
omap_pm_ops.resume = omap4_cpu_resume;
|
|
|
|
omap_pm_ops.scu_prepare = scu_pwrst_prepare;
|
2014-06-07 06:30:43 +08:00
|
|
|
omap_pm_ops.hotplug_restart = omap4_secondary_startup;
|
2013-02-06 22:09:07 +08:00
|
|
|
cpu_context_offset = OMAP4_RM_CPU0_CPU0_CONTEXT_OFFSET;
|
|
|
|
} else if (soc_is_omap54xx() || soc_is_dra7xx()) {
|
|
|
|
cpu_context_offset = OMAP54XX_RM_CPU0_CPU0_CONTEXT_OFFSET;
|
2012-04-12 19:31:52 +08:00
|
|
|
enable_mercury_retention_mode();
|
2013-04-05 20:59:00 +08:00
|
|
|
}
|
|
|
|
|
2014-06-07 06:30:43 +08:00
|
|
|
if (cpu_is_omap446x())
|
|
|
|
omap_pm_ops.hotplug_restart = omap4460_secondary_startup;
|
|
|
|
|
2010-06-17 00:49:48 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
2016-06-22 16:59:39 +08:00
|
|
|
|
2017-04-22 05:55:28 +08:00
|
|
|
u32 omap4_get_cpu1_ns_pa_addr(void)
|
|
|
|
{
|
|
|
|
return old_cpu1_ns_pa_addr;
|
|
|
|
}
|
|
|
|
|
2016-06-22 16:59:39 +08:00
|
|
|
/*
|
|
|
|
* For kexec, we must set CPU1_WAKEUP_NS_PA_ADDR to point to
|
|
|
|
* current kernel's secondary_startup() early before
|
|
|
|
* clockdomains_init(). Otherwise clockdomain_init() can
|
|
|
|
* wake CPU1 and cause a hang.
|
|
|
|
*/
|
|
|
|
void __init omap4_mpuss_early_init(void)
|
|
|
|
{
|
|
|
|
unsigned long startup_pa;
|
2017-03-23 02:01:48 +08:00
|
|
|
void __iomem *ns_pa_addr;
|
2016-06-22 16:59:39 +08:00
|
|
|
|
2017-03-23 02:01:48 +08:00
|
|
|
if (!(soc_is_omap44xx() || soc_is_omap54xx()))
|
2016-06-22 16:59:39 +08:00
|
|
|
return;
|
|
|
|
|
|
|
|
sar_base = omap4_get_sar_ram_base();
|
|
|
|
|
2017-03-23 02:01:48 +08:00
|
|
|
/* Save old NS_PA_ADDR for validity checks later on */
|
|
|
|
if (soc_is_omap44xx())
|
|
|
|
ns_pa_addr = sar_base + CPU1_WAKEUP_NS_PA_ADDR_OFFSET;
|
|
|
|
else
|
|
|
|
ns_pa_addr = sar_base + OMAP5_CPU1_WAKEUP_NS_PA_ADDR_OFFSET;
|
|
|
|
old_cpu1_ns_pa_addr = readl_relaxed(ns_pa_addr);
|
|
|
|
|
|
|
|
if (soc_is_omap443x())
|
2017-01-15 10:59:29 +08:00
|
|
|
startup_pa = __pa_symbol(omap4_secondary_startup);
|
2017-03-23 02:01:48 +08:00
|
|
|
else if (soc_is_omap446x())
|
2017-01-15 10:59:29 +08:00
|
|
|
startup_pa = __pa_symbol(omap4460_secondary_startup);
|
2016-11-08 07:50:11 +08:00
|
|
|
else if ((__boot_cpu_mode & MODE_MASK) == HYP_MODE)
|
2017-01-15 10:59:29 +08:00
|
|
|
startup_pa = __pa_symbol(omap5_secondary_hyp_startup);
|
2016-11-08 07:50:11 +08:00
|
|
|
else
|
2017-01-15 10:59:29 +08:00
|
|
|
startup_pa = __pa_symbol(omap5_secondary_startup);
|
2016-06-22 16:59:39 +08:00
|
|
|
|
2017-03-23 02:01:48 +08:00
|
|
|
if (soc_is_omap44xx())
|
2016-11-08 07:50:11 +08:00
|
|
|
writel_relaxed(startup_pa, sar_base +
|
|
|
|
CPU1_WAKEUP_NS_PA_ADDR_OFFSET);
|
|
|
|
else
|
|
|
|
writel_relaxed(startup_pa, sar_base +
|
|
|
|
OMAP5_CPU1_WAKEUP_NS_PA_ADDR_OFFSET);
|
2016-06-22 16:59:39 +08:00
|
|
|
}
|