mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-30 03:27:44 -04:00
PM changes for am335x and am437x
This series adds support for am437x RTC-only mode in suspend. In the RTC-only mode suspend, everything is shut down except the RTC. This makes the power consumption very low for suspend mode. To support RTC-only mode, we need to export omap_rtc_power_off_program() from the rtc driver and improve PM code to save and restore the wkup domain context. As RTC-only mode depends on the device being wired properly for things like memory, we need to also check for the machine type before we allow it. We also need to run DDR3 hardware leveling on resume. Note that there is a trivial merge conflict between the RTC branch and these changes where the RTC branch makes tm2bcd() a void function and the error handling parts can be just dropped. -----BEGIN PGP SIGNATURE----- iQJFBAABCAAvFiEEkgNvrZJU/QSQYIcQG9Q+yVyrpXMFAlywwLIRHHRvbnlAYXRv bWlkZS5jb20ACgkQG9Q+yVyrpXOBhg/+NRYTBaO4pmFKlTMKs+bgdpftHf6wPSID kUy62YiKhMMgbe6J+Ts/Hk2kCibuOfFmQ0axGFdHzMhpwTGThsWFiwaVr7OKF6ZE DwOlJ1ZwM2OXcdf8wVupRL/54Tg1Wjc6y/T63Q5K+IqKz7gjdf6n7CXdYn22qTmp 4WK81dW1fx+9QNBbGBmMXEbNRlEImxeZRnWF1zJvydOCxO0jRbgnlGgpZJr36TeL Jj+HN+4fD6WmaQ3Slbgcr0jbAowjjTuyUfFwzEBe9G2KlxRyrxDd4ryY78tNxcIe L+yNMm7RGHD1Mb0+tdmpXESuj+O4hsuXglnK5vl19yc95nbwbTeRu0sv+WBEAal4 mY7xTMzT08rLT7fDXuJ+5vZNbR1TLGIekmNnj5BvV8LyZ9ypXToOlOCtFonQxULu HFsiDkOOdKQhkuzw+V8EBksMXdD5crTVxyHY95hguvWTBUMTJjBo0Bq/9EmhKx0m HOglctIivV1/GFg/82QKatjXLLeuXtFqUJa7lc6GIkVteAvEhrbg2DQ8QhnZ8Zg+ ghx0kKsA+KXvOItI6JrMjk/GQuwXTcIytkUhfTVuVlN+gV2PbGFCbohJOatwtXkp 0+VQ0H6AN04FJPqgLDR1njvks6Ll503gbnqodDNL/xgaN+Pjw5zTabkM/hdIyCNV KS6XhdlYvtQ= =yNbG -----END PGP SIGNATURE----- Merge tag 'omap-for-v5.2/am4-pm-v2-signed' of git://git.kernel.org/pub/scm/linux/kernel/git/tmlind/linux-omap into arm/drivers PM changes for am335x and am437x This series adds support for am437x RTC-only mode in suspend. In the RTC-only mode suspend, everything is shut down except the RTC. This makes the power consumption very low for suspend mode. To support RTC-only mode, we need to export omap_rtc_power_off_program() from the rtc driver and improve PM code to save and restore the wkup domain context. As RTC-only mode depends on the device being wired properly for things like memory, we need to also check for the machine type before we allow it. We also need to run DDR3 hardware leveling on resume. Note that there is a trivial merge conflict between the RTC branch and these changes where the RTC branch makes tm2bcd() a void function and the error handling parts can be just dropped. * tag 'omap-for-v5.2/am4-pm-v2-signed' of git://git.kernel.org/pub/scm/linux/kernel/git/tmlind/linux-omap: ARM: OMAP2+: sleep43xx: Run EMIF HW leveling on resume path memory: ti-emif-sram: Add ti_emif_run_hw_leveling for DDR3 hardware leveling soc: ti: pm33xx: AM437X: Add rtc_only with ddr in self-refresh support soc: ti: pm33xx: Move the am33xx_push_sram_idle to the top ARM: OMAP2+: pm33xx: Add support for rtc+ddr in self refresh mode rtc: OMAP: Add support for rtc-only mode Signed-off-by: Olof Johansson <[email protected]>
This commit is contained in:
Olof Johansson
commit
0065198e67
11 changed files with 409 additions and 62 deletions
|
|
@ -45,11 +45,12 @@ config KEYSTONE_NAVIGATOR_DMA
|
|||
config AMX3_PM
|
||||
tristate "AMx3 Power Management"
|
||||
depends on SOC_AM33XX || SOC_AM43XX
|
||||
depends on WKUP_M3_IPC && TI_EMIF_SRAM && SRAM
|
||||
depends on WKUP_M3_IPC && TI_EMIF_SRAM && SRAM && RTC_DRV_OMAP
|
||||
help
|
||||
Enable power management on AM335x and AM437x. Required for suspend to mem
|
||||
and standby states on both AM335x and AM437x platforms and for deeper cpuidle
|
||||
c-states on AM335x.
|
||||
c-states on AM335x. Also required for rtc and ddr in self-refresh low
|
||||
power mode on AM437x platforms.
|
||||
|
||||
config WKUP_M3_IPC
|
||||
tristate "TI AMx3 Wkup-M3 IPC Driver"
|
||||
|
|
|
|||
|
|
@ -6,6 +6,7 @@
|
|||
* Vaibhav Bedia, Dave Gerlach
|
||||
*/
|
||||
|
||||
#include <linux/clk.h>
|
||||
#include <linux/cpu.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/genalloc.h>
|
||||
|
|
@ -13,9 +14,12 @@
|
|||
#include <linux/init.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/nvmem-consumer.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/platform_data/pm33xx.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/rtc.h>
|
||||
#include <linux/rtc/rtc-omap.h>
|
||||
#include <linux/sizes.h>
|
||||
#include <linux/sram.h>
|
||||
#include <linux/suspend.h>
|
||||
|
|
@ -29,33 +33,162 @@
|
|||
#define AMX3_PM_SRAM_SYMBOL_OFFSET(sym) ((unsigned long)(sym) - \
|
||||
(unsigned long)pm_sram->do_wfi)
|
||||
|
||||
#define RTC_SCRATCH_RESUME_REG 0
|
||||
#define RTC_SCRATCH_MAGIC_REG 1
|
||||
#define RTC_REG_BOOT_MAGIC 0x8cd0 /* RTC */
|
||||
#define GIC_INT_SET_PENDING_BASE 0x200
|
||||
#define AM43XX_GIC_DIST_BASE 0x48241000
|
||||
|
||||
static u32 rtc_magic_val;
|
||||
|
||||
static int (*am33xx_do_wfi_sram)(unsigned long unused);
|
||||
static phys_addr_t am33xx_do_wfi_sram_phys;
|
||||
|
||||
static struct gen_pool *sram_pool, *sram_pool_data;
|
||||
static unsigned long ocmcram_location, ocmcram_location_data;
|
||||
|
||||
static struct rtc_device *omap_rtc;
|
||||
static void __iomem *gic_dist_base;
|
||||
|
||||
static struct am33xx_pm_platform_data *pm_ops;
|
||||
static struct am33xx_pm_sram_addr *pm_sram;
|
||||
|
||||
static struct device *pm33xx_dev;
|
||||
static struct wkup_m3_ipc *m3_ipc;
|
||||
|
||||
#ifdef CONFIG_SUSPEND
|
||||
static int rtc_only_idle;
|
||||
static int retrigger_irq;
|
||||
static unsigned long suspend_wfi_flags;
|
||||
|
||||
static struct wkup_m3_wakeup_src wakeup_src = {.irq_nr = 0,
|
||||
.src = "Unknown",
|
||||
};
|
||||
|
||||
static struct wkup_m3_wakeup_src rtc_alarm_wakeup = {
|
||||
.irq_nr = 108, .src = "RTC Alarm",
|
||||
};
|
||||
|
||||
static struct wkup_m3_wakeup_src rtc_ext_wakeup = {
|
||||
.irq_nr = 0, .src = "Ext wakeup",
|
||||
};
|
||||
#endif
|
||||
|
||||
static u32 sram_suspend_address(unsigned long addr)
|
||||
{
|
||||
return ((unsigned long)am33xx_do_wfi_sram +
|
||||
AMX3_PM_SRAM_SYMBOL_OFFSET(addr));
|
||||
}
|
||||
|
||||
static int am33xx_push_sram_idle(void)
|
||||
{
|
||||
struct am33xx_pm_ro_sram_data ro_sram_data;
|
||||
int ret;
|
||||
u32 table_addr, ro_data_addr;
|
||||
void *copy_addr;
|
||||
|
||||
ro_sram_data.amx3_pm_sram_data_virt = ocmcram_location_data;
|
||||
ro_sram_data.amx3_pm_sram_data_phys =
|
||||
gen_pool_virt_to_phys(sram_pool_data, ocmcram_location_data);
|
||||
ro_sram_data.rtc_base_virt = pm_ops->get_rtc_base_addr();
|
||||
|
||||
/* Save physical address to calculate resume offset during pm init */
|
||||
am33xx_do_wfi_sram_phys = gen_pool_virt_to_phys(sram_pool,
|
||||
ocmcram_location);
|
||||
|
||||
am33xx_do_wfi_sram = sram_exec_copy(sram_pool, (void *)ocmcram_location,
|
||||
pm_sram->do_wfi,
|
||||
*pm_sram->do_wfi_sz);
|
||||
if (!am33xx_do_wfi_sram) {
|
||||
dev_err(pm33xx_dev,
|
||||
"PM: %s: am33xx_do_wfi copy to sram failed\n",
|
||||
__func__);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
table_addr =
|
||||
sram_suspend_address((unsigned long)pm_sram->emif_sram_table);
|
||||
ret = ti_emif_copy_pm_function_table(sram_pool, (void *)table_addr);
|
||||
if (ret) {
|
||||
dev_dbg(pm33xx_dev,
|
||||
"PM: %s: EMIF function copy failed\n", __func__);
|
||||
return -EPROBE_DEFER;
|
||||
}
|
||||
|
||||
ro_data_addr =
|
||||
sram_suspend_address((unsigned long)pm_sram->ro_sram_data);
|
||||
copy_addr = sram_exec_copy(sram_pool, (void *)ro_data_addr,
|
||||
&ro_sram_data,
|
||||
sizeof(ro_sram_data));
|
||||
if (!copy_addr) {
|
||||
dev_err(pm33xx_dev,
|
||||
"PM: %s: ro_sram_data copy to sram failed\n",
|
||||
__func__);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int __init am43xx_map_gic(void)
|
||||
{
|
||||
gic_dist_base = ioremap(AM43XX_GIC_DIST_BASE, SZ_4K);
|
||||
|
||||
if (!gic_dist_base)
|
||||
return -ENOMEM;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_SUSPEND
|
||||
struct wkup_m3_wakeup_src rtc_wake_src(void)
|
||||
{
|
||||
u32 i;
|
||||
|
||||
i = __raw_readl(pm_ops->get_rtc_base_addr() + 0x44) & 0x40;
|
||||
|
||||
if (i) {
|
||||
retrigger_irq = rtc_alarm_wakeup.irq_nr;
|
||||
return rtc_alarm_wakeup;
|
||||
}
|
||||
|
||||
retrigger_irq = rtc_ext_wakeup.irq_nr;
|
||||
|
||||
return rtc_ext_wakeup;
|
||||
}
|
||||
|
||||
int am33xx_rtc_only_idle(unsigned long wfi_flags)
|
||||
{
|
||||
omap_rtc_power_off_program(&omap_rtc->dev);
|
||||
am33xx_do_wfi_sram(wfi_flags);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int am33xx_pm_suspend(suspend_state_t suspend_state)
|
||||
{
|
||||
int i, ret = 0;
|
||||
|
||||
ret = pm_ops->soc_suspend((unsigned long)suspend_state,
|
||||
am33xx_do_wfi_sram, suspend_wfi_flags);
|
||||
if (suspend_state == PM_SUSPEND_MEM &&
|
||||
pm_ops->check_off_mode_enable()) {
|
||||
pm_ops->prepare_rtc_suspend();
|
||||
pm_ops->save_context();
|
||||
suspend_wfi_flags |= WFI_FLAG_RTC_ONLY;
|
||||
clk_save_context();
|
||||
ret = pm_ops->soc_suspend(suspend_state, am33xx_rtc_only_idle,
|
||||
suspend_wfi_flags);
|
||||
|
||||
suspend_wfi_flags &= ~WFI_FLAG_RTC_ONLY;
|
||||
|
||||
if (!ret) {
|
||||
clk_restore_context();
|
||||
pm_ops->restore_context();
|
||||
m3_ipc->ops->set_rtc_only(m3_ipc);
|
||||
am33xx_push_sram_idle();
|
||||
}
|
||||
} else {
|
||||
ret = pm_ops->soc_suspend(suspend_state, am33xx_do_wfi_sram,
|
||||
suspend_wfi_flags);
|
||||
}
|
||||
|
||||
if (ret) {
|
||||
dev_err(pm33xx_dev, "PM: Kernel suspend failure\n");
|
||||
|
|
@ -77,8 +210,20 @@ static int am33xx_pm_suspend(suspend_state_t suspend_state)
|
|||
"PM: CM3 returned unknown result = %d\n", i);
|
||||
ret = -1;
|
||||
}
|
||||
|
||||
/* print the wakeup reason */
|
||||
if (rtc_only_idle) {
|
||||
wakeup_src = rtc_wake_src();
|
||||
pr_info("PM: Wakeup source %s\n", wakeup_src.src);
|
||||
} else {
|
||||
pr_info("PM: Wakeup source %s\n",
|
||||
m3_ipc->ops->request_wake_src(m3_ipc));
|
||||
}
|
||||
}
|
||||
|
||||
if (suspend_state == PM_SUSPEND_MEM && pm_ops->check_off_mode_enable())
|
||||
pm_ops->prepare_rtc_resume();
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
|
@ -101,6 +246,18 @@ static int am33xx_pm_enter(suspend_state_t suspend_state)
|
|||
static int am33xx_pm_begin(suspend_state_t state)
|
||||
{
|
||||
int ret = -EINVAL;
|
||||
struct nvmem_device *nvmem;
|
||||
|
||||
if (state == PM_SUSPEND_MEM && pm_ops->check_off_mode_enable()) {
|
||||
nvmem = devm_nvmem_device_get(&omap_rtc->dev,
|
||||
"omap_rtc_scratch0");
|
||||
if (nvmem)
|
||||
nvmem_device_write(nvmem, RTC_SCRATCH_MAGIC_REG * 4, 4,
|
||||
(void *)&rtc_magic_val);
|
||||
rtc_only_idle = 1;
|
||||
} else {
|
||||
rtc_only_idle = 0;
|
||||
}
|
||||
|
||||
switch (state) {
|
||||
case PM_SUSPEND_MEM:
|
||||
|
|
@ -116,7 +273,28 @@ static int am33xx_pm_begin(suspend_state_t state)
|
|||
|
||||
static void am33xx_pm_end(void)
|
||||
{
|
||||
u32 val = 0;
|
||||
struct nvmem_device *nvmem;
|
||||
|
||||
nvmem = devm_nvmem_device_get(&omap_rtc->dev, "omap_rtc_scratch0");
|
||||
m3_ipc->ops->finish_low_power(m3_ipc);
|
||||
if (rtc_only_idle) {
|
||||
if (retrigger_irq)
|
||||
/*
|
||||
* 32 bits of Interrupt Set-Pending correspond to 32
|
||||
* 32 interrupts. Compute the bit offset of the
|
||||
* Interrupt and set that particular bit
|
||||
* Compute the register offset by dividing interrupt
|
||||
* number by 32 and mutiplying by 4
|
||||
*/
|
||||
writel_relaxed(1 << (retrigger_irq & 31),
|
||||
gic_dist_base + GIC_INT_SET_PENDING_BASE
|
||||
+ retrigger_irq / 32 * 4);
|
||||
nvmem_device_write(nvmem, RTC_SCRATCH_MAGIC_REG * 4, 4,
|
||||
(void *)&val);
|
||||
}
|
||||
|
||||
rtc_only_idle = 0;
|
||||
}
|
||||
|
||||
static int am33xx_pm_valid(suspend_state_t state)
|
||||
|
|
@ -219,51 +397,37 @@ mpu_put_node:
|
|||
return ret;
|
||||
}
|
||||
|
||||
static int am33xx_push_sram_idle(void)
|
||||
static int am33xx_pm_rtc_setup(void)
|
||||
{
|
||||
struct am33xx_pm_ro_sram_data ro_sram_data;
|
||||
int ret;
|
||||
u32 table_addr, ro_data_addr;
|
||||
void *copy_addr;
|
||||
struct device_node *np;
|
||||
unsigned long val = 0;
|
||||
struct nvmem_device *nvmem;
|
||||
|
||||
ro_sram_data.amx3_pm_sram_data_virt = ocmcram_location_data;
|
||||
ro_sram_data.amx3_pm_sram_data_phys =
|
||||
gen_pool_virt_to_phys(sram_pool_data, ocmcram_location_data);
|
||||
ro_sram_data.rtc_base_virt = pm_ops->get_rtc_base_addr();
|
||||
np = of_find_node_by_name(NULL, "rtc");
|
||||
|
||||
/* Save physical address to calculate resume offset during pm init */
|
||||
am33xx_do_wfi_sram_phys = gen_pool_virt_to_phys(sram_pool,
|
||||
ocmcram_location);
|
||||
if (of_device_is_available(np)) {
|
||||
omap_rtc = rtc_class_open("rtc0");
|
||||
if (!omap_rtc) {
|
||||
pr_warn("PM: rtc0 not available");
|
||||
return -EPROBE_DEFER;
|
||||
}
|
||||
|
||||
am33xx_do_wfi_sram = sram_exec_copy(sram_pool, (void *)ocmcram_location,
|
||||
pm_sram->do_wfi,
|
||||
*pm_sram->do_wfi_sz);
|
||||
if (!am33xx_do_wfi_sram) {
|
||||
dev_err(pm33xx_dev,
|
||||
"PM: %s: am33xx_do_wfi copy to sram failed\n",
|
||||
__func__);
|
||||
return -ENODEV;
|
||||
}
|
||||
nvmem = devm_nvmem_device_get(&omap_rtc->dev,
|
||||
"omap_rtc_scratch0");
|
||||
if (nvmem) {
|
||||
nvmem_device_read(nvmem, RTC_SCRATCH_MAGIC_REG * 4,
|
||||
4, (void *)&rtc_magic_val);
|
||||
if ((rtc_magic_val & 0xffff) != RTC_REG_BOOT_MAGIC)
|
||||
pr_warn("PM: bootloader does not support rtc-only!\n");
|
||||
|
||||
table_addr =
|
||||
sram_suspend_address((unsigned long)pm_sram->emif_sram_table);
|
||||
ret = ti_emif_copy_pm_function_table(sram_pool, (void *)table_addr);
|
||||
if (ret) {
|
||||
dev_dbg(pm33xx_dev,
|
||||
"PM: %s: EMIF function copy failed\n", __func__);
|
||||
return -EPROBE_DEFER;
|
||||
}
|
||||
|
||||
ro_data_addr =
|
||||
sram_suspend_address((unsigned long)pm_sram->ro_sram_data);
|
||||
copy_addr = sram_exec_copy(sram_pool, (void *)ro_data_addr,
|
||||
&ro_sram_data,
|
||||
sizeof(ro_sram_data));
|
||||
if (!copy_addr) {
|
||||
dev_err(pm33xx_dev,
|
||||
"PM: %s: ro_sram_data copy to sram failed\n",
|
||||
__func__);
|
||||
return -ENODEV;
|
||||
nvmem_device_write(nvmem, RTC_SCRATCH_MAGIC_REG * 4,
|
||||
4, (void *)&val);
|
||||
val = pm_sram->resume_address;
|
||||
nvmem_device_write(nvmem, RTC_SCRATCH_RESUME_REG * 4,
|
||||
4, (void *)&val);
|
||||
}
|
||||
} else {
|
||||
pr_warn("PM: no-rtc available, rtc-only mode disabled.\n");
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
|
@ -284,34 +448,42 @@ static int am33xx_pm_probe(struct platform_device *pdev)
|
|||
return -ENODEV;
|
||||
}
|
||||
|
||||
ret = am43xx_map_gic();
|
||||
if (ret) {
|
||||
pr_err("PM: Could not ioremap GIC base\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
pm_sram = pm_ops->get_sram_addrs();
|
||||
if (!pm_sram) {
|
||||
dev_err(dev, "PM: Cannot get PM asm function addresses!!\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
m3_ipc = wkup_m3_ipc_get();
|
||||
if (!m3_ipc) {
|
||||
pr_err("PM: Cannot get wkup_m3_ipc handle\n");
|
||||
return -EPROBE_DEFER;
|
||||
}
|
||||
|
||||
pm33xx_dev = dev;
|
||||
|
||||
ret = am33xx_pm_alloc_sram();
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = am33xx_push_sram_idle();
|
||||
ret = am33xx_pm_rtc_setup();
|
||||
if (ret)
|
||||
goto err_free_sram;
|
||||
|
||||
m3_ipc = wkup_m3_ipc_get();
|
||||
if (!m3_ipc) {
|
||||
dev_dbg(dev, "PM: Cannot get wkup_m3_ipc handle\n");
|
||||
ret = -EPROBE_DEFER;
|
||||
ret = am33xx_push_sram_idle();
|
||||
if (ret)
|
||||
goto err_free_sram;
|
||||
}
|
||||
|
||||
am33xx_pm_set_ipc_ops();
|
||||
|
||||
#ifdef CONFIG_SUSPEND
|
||||
suspend_set_ops(&am33xx_pm_ops);
|
||||
#endif /* CONFIG_SUSPEND */
|
||||
|
||||
/*
|
||||
* For a system suspend we must flush the caches, we want
|
||||
|
|
@ -323,6 +495,7 @@ static int am33xx_pm_probe(struct platform_device *pdev)
|
|||
suspend_wfi_flags |= WFI_FLAG_SELF_REFRESH;
|
||||
suspend_wfi_flags |= WFI_FLAG_SAVE_EMIF;
|
||||
suspend_wfi_flags |= WFI_FLAG_WAKE_M3;
|
||||
#endif /* CONFIG_SUSPEND */
|
||||
|
||||
ret = pm_ops->init();
|
||||
if (ret) {
|
||||
|
|
|
|||
Loading…
Reference in a new issue