mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-28 10:41:38 -04:00
Add am335x and am437x PM code for v4.17
This series of changes from Dave Gerlach adds the PM related code to allow low-power suspend states. The code consists of the SoC specific assembly code and a related PM driver. -----BEGIN PGP SIGNATURE----- iQJFBAABCAAvFiEEkgNvrZJU/QSQYIcQG9Q+yVyrpXMFAlqdeI4RHHRvbnlAYXRv bWlkZS5jb20ACgkQG9Q+yVyrpXPRoxAA3M1qhApgnJBrvCoVbOQbDsL/Jst5geJz eQIQMjqzLTJQDd6+0SJVggjRhDYW2mKk+SYbpbzjVfmdJeKAIX3IZj9MUMstbRSD g8YCzSpW9C2EuOHlDhDDd4U6pc7/pMmWHH87PMaj05Qfct+hcSpI7OB5RfntX0Os mhQ6e3SxlM9EZikiW2BXXjjKmQHYmqkfSZHhjbiGtpEXTa/zq/fVM67NEjdez7/F 1Uy3Hefv895H0TU+P3TtzLmvcQQn4JrIXNqi4wWM7ATf6MN9d9cPMxZ9mdTweCgd B0nSYgwwzXS2bNd7KhtghAXckGqLRL+0CifB0xw+jCExwL+aOQPwKdvbfnF2JVqe R8MochWgDBUAVX8hYpYD+IJ6qeoWFfu4ZEwFeMaQ0M2T7I417SSRwtNF2P9YSYOj b6dv8Fe54m8QhPJo2OPD/bbzo2wwNuLqJ9bqI3oy9yrMe5EEAzuhtqGBeg1B4WKB zWB2TQYLLl4FVJsfxV7wgsO2fk9xzs1cn70JWqdWMQ1kUl7k0NorZhSVlXt5x+oH gPfkWO2S7+Il/FKsOAdb+HeCklDyy/xh/B0VFErHvqXOK78j1IpcUh6I9lgg1GFs OXioMaGE13p+yOKQHDGqeK42Qjw2F6cPdkCGm67Mte66IqBV0khLpwK8WwzlcEio C5jhVOor2u8= =hBzh -----END PGP SIGNATURE----- Merge tag 'omap-for-v4.17/am-pm-signed' of ssh://gitolite.kernel.org/pub/scm/linux/kernel/git/tmlind/linux-omap into next/soc Pull "Add am335x and am437x PM code for v4.17" from Tony Lindgren: This series of changes from Dave Gerlach adds the PM related code to allow low-power suspend states. The code consists of the SoC specific assembly code and a related PM driver. * tag 'omap-for-v4.17/am-pm-signed' of ssh://gitolite.kernel.org/pub/scm/linux/kernel/git/tmlind/linux-omap: soc: ti: Add pm33xx driver for basic suspend support ARM: OMAP2+: pm33xx-core: Add platform code needed for PM ARM: OMAP2+: Introduce low-level suspend code for AM43XX ARM: OMAP2+: Introduce low-level suspend code for AM33XX
This commit is contained in:
Arnd Bergmann
commit
18b4788bad
14 changed files with 1267 additions and 0 deletions
|
|
@ -28,6 +28,15 @@ config KEYSTONE_NAVIGATOR_DMA
|
|||
|
||||
If unsure, say N.
|
||||
|
||||
config AMX3_PM
|
||||
tristate "AMx3 Power Management"
|
||||
depends on SOC_AM33XX || SOC_AM43XX
|
||||
depends on WKUP_M3_IPC && TI_EMIF_SRAM && SRAM
|
||||
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.
|
||||
|
||||
config WKUP_M3_IPC
|
||||
tristate "TI AMx3 Wkup-M3 IPC Driver"
|
||||
depends on WKUP_M3_RPROC
|
||||
|
|
|
|||
|
|
@ -5,5 +5,6 @@
|
|||
obj-$(CONFIG_KEYSTONE_NAVIGATOR_QMSS) += knav_qmss.o
|
||||
knav_qmss-y := knav_qmss_queue.o knav_qmss_acc.o
|
||||
obj-$(CONFIG_KEYSTONE_NAVIGATOR_DMA) += knav_dma.o
|
||||
obj-$(CONFIG_AMX3_PM) += pm33xx.o
|
||||
obj-$(CONFIG_WKUP_M3_IPC) += wkup_m3_ipc.o
|
||||
obj-$(CONFIG_TI_SCI_PM_DOMAINS) += ti_sci_pm_domains.o
|
||||
|
|
|
|||
349
drivers/soc/ti/pm33xx.c
Normal file
349
drivers/soc/ti/pm33xx.c
Normal file
|
|
@ -0,0 +1,349 @@
|
|||
// SPDX-License-Identifier: GPL-2.0
|
||||
/*
|
||||
* AM33XX Power Management Routines
|
||||
*
|
||||
* Copyright (C) 2012-2018 Texas Instruments Incorporated - http://www.ti.com/
|
||||
* Vaibhav Bedia, Dave Gerlach
|
||||
*/
|
||||
|
||||
#include <linux/cpu.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/genalloc.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/platform_data/pm33xx.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/sizes.h>
|
||||
#include <linux/sram.h>
|
||||
#include <linux/suspend.h>
|
||||
#include <linux/ti-emif-sram.h>
|
||||
#include <linux/wkup_m3_ipc.h>
|
||||
|
||||
#include <asm/proc-fns.h>
|
||||
#include <asm/suspend.h>
|
||||
#include <asm/system_misc.h>
|
||||
|
||||
#define AMX3_PM_SRAM_SYMBOL_OFFSET(sym) ((unsigned long)(sym) - \
|
||||
(unsigned long)pm_sram->do_wfi)
|
||||
|
||||
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 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;
|
||||
|
||||
static u32 sram_suspend_address(unsigned long addr)
|
||||
{
|
||||
return ((unsigned long)am33xx_do_wfi_sram +
|
||||
AMX3_PM_SRAM_SYMBOL_OFFSET(addr));
|
||||
}
|
||||
|
||||
#ifdef CONFIG_SUSPEND
|
||||
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);
|
||||
|
||||
if (ret) {
|
||||
dev_err(pm33xx_dev, "PM: Kernel suspend failure\n");
|
||||
} else {
|
||||
i = m3_ipc->ops->request_pm_status(m3_ipc);
|
||||
|
||||
switch (i) {
|
||||
case 0:
|
||||
dev_info(pm33xx_dev,
|
||||
"PM: Successfully put all powerdomains to target state\n");
|
||||
break;
|
||||
case 1:
|
||||
dev_err(pm33xx_dev,
|
||||
"PM: Could not transition all powerdomains to target state\n");
|
||||
ret = -1;
|
||||
break;
|
||||
default:
|
||||
dev_err(pm33xx_dev,
|
||||
"PM: CM3 returned unknown result = %d\n", i);
|
||||
ret = -1;
|
||||
}
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int am33xx_pm_enter(suspend_state_t suspend_state)
|
||||
{
|
||||
int ret = 0;
|
||||
|
||||
switch (suspend_state) {
|
||||
case PM_SUSPEND_MEM:
|
||||
case PM_SUSPEND_STANDBY:
|
||||
ret = am33xx_pm_suspend(suspend_state);
|
||||
break;
|
||||
default:
|
||||
ret = -EINVAL;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int am33xx_pm_begin(suspend_state_t state)
|
||||
{
|
||||
int ret = -EINVAL;
|
||||
|
||||
switch (state) {
|
||||
case PM_SUSPEND_MEM:
|
||||
ret = m3_ipc->ops->prepare_low_power(m3_ipc, WKUP_M3_DEEPSLEEP);
|
||||
break;
|
||||
case PM_SUSPEND_STANDBY:
|
||||
ret = m3_ipc->ops->prepare_low_power(m3_ipc, WKUP_M3_STANDBY);
|
||||
break;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void am33xx_pm_end(void)
|
||||
{
|
||||
m3_ipc->ops->finish_low_power(m3_ipc);
|
||||
}
|
||||
|
||||
static int am33xx_pm_valid(suspend_state_t state)
|
||||
{
|
||||
switch (state) {
|
||||
case PM_SUSPEND_STANDBY:
|
||||
case PM_SUSPEND_MEM:
|
||||
return 1;
|
||||
default:
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
static const struct platform_suspend_ops am33xx_pm_ops = {
|
||||
.begin = am33xx_pm_begin,
|
||||
.end = am33xx_pm_end,
|
||||
.enter = am33xx_pm_enter,
|
||||
.valid = am33xx_pm_valid,
|
||||
};
|
||||
#endif /* CONFIG_SUSPEND */
|
||||
|
||||
static void am33xx_pm_set_ipc_ops(void)
|
||||
{
|
||||
u32 resume_address;
|
||||
int temp;
|
||||
|
||||
temp = ti_emif_get_mem_type();
|
||||
if (temp < 0) {
|
||||
dev_err(pm33xx_dev, "PM: Cannot determine memory type, no PM available\n");
|
||||
return;
|
||||
}
|
||||
m3_ipc->ops->set_mem_type(m3_ipc, temp);
|
||||
|
||||
/* Physical resume address to be used by ROM code */
|
||||
resume_address = am33xx_do_wfi_sram_phys +
|
||||
*pm_sram->resume_offset + 0x4;
|
||||
|
||||
m3_ipc->ops->set_resume_address(m3_ipc, (void *)resume_address);
|
||||
}
|
||||
|
||||
static void am33xx_pm_free_sram(void)
|
||||
{
|
||||
gen_pool_free(sram_pool, ocmcram_location, *pm_sram->do_wfi_sz);
|
||||
gen_pool_free(sram_pool_data, ocmcram_location_data,
|
||||
sizeof(struct am33xx_pm_ro_sram_data));
|
||||
}
|
||||
|
||||
/*
|
||||
* Push the minimal suspend-resume code to SRAM
|
||||
*/
|
||||
static int am33xx_pm_alloc_sram(void)
|
||||
{
|
||||
struct device_node *np;
|
||||
int ret = 0;
|
||||
|
||||
np = of_find_compatible_node(NULL, NULL, "ti,omap3-mpu");
|
||||
if (!np) {
|
||||
np = of_find_compatible_node(NULL, NULL, "ti,omap4-mpu");
|
||||
if (!np) {
|
||||
dev_err(pm33xx_dev, "PM: %s: Unable to find device node for mpu\n",
|
||||
__func__);
|
||||
return -ENODEV;
|
||||
}
|
||||
}
|
||||
|
||||
sram_pool = of_gen_pool_get(np, "pm-sram", 0);
|
||||
if (!sram_pool) {
|
||||
dev_err(pm33xx_dev, "PM: %s: Unable to get sram pool for ocmcram\n",
|
||||
__func__);
|
||||
ret = -ENODEV;
|
||||
goto mpu_put_node;
|
||||
}
|
||||
|
||||
sram_pool_data = of_gen_pool_get(np, "pm-sram", 1);
|
||||
if (!sram_pool_data) {
|
||||
dev_err(pm33xx_dev, "PM: %s: Unable to get sram data pool for ocmcram\n",
|
||||
__func__);
|
||||
ret = -ENODEV;
|
||||
goto mpu_put_node;
|
||||
}
|
||||
|
||||
ocmcram_location = gen_pool_alloc(sram_pool, *pm_sram->do_wfi_sz);
|
||||
if (!ocmcram_location) {
|
||||
dev_err(pm33xx_dev, "PM: %s: Unable to allocate memory from ocmcram\n",
|
||||
__func__);
|
||||
ret = -ENOMEM;
|
||||
goto mpu_put_node;
|
||||
}
|
||||
|
||||
ocmcram_location_data = gen_pool_alloc(sram_pool_data,
|
||||
sizeof(struct emif_regs_amx3));
|
||||
if (!ocmcram_location_data) {
|
||||
dev_err(pm33xx_dev, "PM: Unable to allocate memory from ocmcram\n");
|
||||
gen_pool_free(sram_pool, ocmcram_location, *pm_sram->do_wfi_sz);
|
||||
ret = -ENOMEM;
|
||||
}
|
||||
|
||||
mpu_put_node:
|
||||
of_node_put(np);
|
||||
return ret;
|
||||
}
|
||||
|
||||
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);
|
||||
|
||||
/* 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 am33xx_pm_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct device *dev = &pdev->dev;
|
||||
int ret;
|
||||
|
||||
if (!of_machine_is_compatible("ti,am33xx") &&
|
||||
!of_machine_is_compatible("ti,am43"))
|
||||
return -ENODEV;
|
||||
|
||||
pm_ops = dev->platform_data;
|
||||
if (!pm_ops) {
|
||||
dev_err(dev, "PM: Cannot get core PM ops!\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
pm_sram = pm_ops->get_sram_addrs();
|
||||
if (!pm_sram) {
|
||||
dev_err(dev, "PM: Cannot get PM asm function addresses!!\n");
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
pm33xx_dev = dev;
|
||||
|
||||
ret = am33xx_pm_alloc_sram();
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = am33xx_push_sram_idle();
|
||||
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;
|
||||
goto err_free_sram;
|
||||
}
|
||||
|
||||
am33xx_pm_set_ipc_ops();
|
||||
|
||||
#ifdef CONFIG_SUSPEND
|
||||
suspend_set_ops(&am33xx_pm_ops);
|
||||
#endif /* CONFIG_SUSPEND */
|
||||
|
||||
ret = pm_ops->init();
|
||||
if (ret) {
|
||||
dev_err(dev, "Unable to call core pm init!\n");
|
||||
ret = -ENODEV;
|
||||
goto err_put_wkup_m3_ipc;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_put_wkup_m3_ipc:
|
||||
wkup_m3_ipc_put(m3_ipc);
|
||||
err_free_sram:
|
||||
am33xx_pm_free_sram();
|
||||
pm33xx_dev = NULL;
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int am33xx_pm_remove(struct platform_device *pdev)
|
||||
{
|
||||
suspend_set_ops(NULL);
|
||||
wkup_m3_ipc_put(m3_ipc);
|
||||
am33xx_pm_free_sram();
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct platform_driver am33xx_pm_driver = {
|
||||
.driver = {
|
||||
.name = "pm33xx",
|
||||
},
|
||||
.probe = am33xx_pm_probe,
|
||||
.remove = am33xx_pm_remove,
|
||||
};
|
||||
module_platform_driver(am33xx_pm_driver);
|
||||
|
||||
MODULE_ALIAS("platform:pm33xx");
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_DESCRIPTION("am33xx power management driver");
|
||||
Loading…
Reference in a new issue