A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-14 08:36:12 -04:00
Code Issues Projects Releases Packages Wiki Activity

soc: qcom: smem: Add support for suspend to disk

Browse source 
Add support to smem driver for suspend to disk feature.
SMEM is cleared during Hibernation and initialize SMEM
during resume from Hibernation.

Change-Id: I363eea1f959c3f2b224054884ec7569d434cb74c
Signed-off-by: Arun Prakash <app@codeaurora.org>
This commit is contained in:
Arun Prakash 2020-03-16 17:36:31 +05:30 • committed by Gerrit - the friendly Code Review server
commit 28e93189db
1 changed files with 62 additions and 11 deletions
Download patch file Download diff file Expand all files Collapse all files

73
drivers/soc/qcom/smem.c
View file

@ -1,7 +1,7 @@
// SPDX-License-Identifier: GPL-2.0-only
/*
* Copyright (c) 2015, Sony Mobile Communications AB.
* Copyright (c) 2012-2013, 2019 The Linux Foundation. All rights reserved.
* Copyright (c) 2012-2013, 2019-2020 The Linux Foundation. All rights reserved.
*/
#include <linux/hwspinlock.h>
@ -980,7 +980,7 @@ static int qcom_smem_probe(struct platform_device *pdev)
num_regions++;
array_size = num_regions * sizeof(struct smem_region);
smem = devm_kzalloc(&pdev->dev, sizeof(*smem) + array_size, GFP_KERNEL);
smem = kzalloc(sizeof(*smem) + array_size, GFP_KERNEL);
if (!smem)
return -ENOMEM;
@ -989,17 +989,18 @@ static int qcom_smem_probe(struct platform_device *pdev)
ret = qcom_smem_map_memory(smem, &pdev->dev, "memory-region", 0);
if (ret)
return ret;
goto release;
if (num_regions > 1 && (ret = qcom_smem_map_memory(smem, &pdev->dev,
"qcom,rpm-msg-ram", 1)))
return ret;
goto release;
header = smem->regions[0].virt_base;
if (le32_to_cpu(header->initialized) != 1 ||
le32_to_cpu(header->reserved)) {
dev_err(&pdev->dev, "SMEM is not initialized by SBL\n");
return -EINVAL;
ret = -EINVAL;
goto release;
}
version = qcom_smem_get_sbl_version(smem);
@ -1007,7 +1008,7 @@ static int qcom_smem_probe(struct platform_device *pdev)
case SMEM_GLOBAL_PART_VERSION:
ret = qcom_smem_set_global_partition(smem);
if (ret < 0)
return ret;
goto release;
smem->item_count = qcom_smem_get_item_count(smem);
break;
case SMEM_GLOBAL_HEAP_VERSION:
@ -1015,24 +1016,28 @@ static int qcom_smem_probe(struct platform_device *pdev)
break;
default:
dev_err(&pdev->dev, "Unsupported SMEM version 0x%x\n", version);
return -EINVAL;
ret = -EINVAL;
goto release;
}
BUILD_BUG_ON(SMEM_HOST_APPS >= SMEM_HOST_COUNT);
ret = qcom_smem_enumerate_partitions(smem, SMEM_HOST_APPS);
if (ret < 0 && ret != -ENOENT)
return ret;
goto release;
hwlock_id = of_hwspin_lock_get_id(pdev->dev.of_node, 0);
if (hwlock_id < 0) {
if (hwlock_id != -EPROBE_DEFER)
dev_err(&pdev->dev, "failed to retrieve hwlock\n");
return hwlock_id;
ret = hwlock_id;
goto release;
}
smem->hwlock = hwspin_lock_request_specific(hwlock_id);
if (!smem->hwlock)
return -ENXIO;
if (!smem->hwlock) {
ret = -ENXIO;
goto release;
}
__smem = smem;
@ -1043,6 +1048,10 @@ static int qcom_smem_probe(struct platform_device *pdev)
dev_dbg(&pdev->dev, "failed to register socinfo device\n");
return 0;
release:
kfree(smem);
return ret;
}
static int qcom_smem_remove(struct platform_device *pdev)
@ -1050,11 +1059,52 @@ static int qcom_smem_remove(struct platform_device *pdev)
platform_device_unregister(__smem->socinfo);
hwspin_lock_free(__smem->hwlock);
/*
* In case of Hibernation Restore __smem object is still valid
* and we call probe again so same object get allocated again
* that result into possible memory leak, hence explicitly freeing
* it here.
*/
kfree(__smem);
__smem = NULL;
return 0;
}
static int qcom_smem_freeze(struct device *dev)
{
struct platform_device *pdev = container_of(dev, struct
platform_device, dev);
dev_dbg(dev, "%s\n", __func__);
qcom_smem_remove(pdev);
return 0;
}
static int qcom_smem_restore(struct device *dev)
{
int ret = 0;
struct platform_device *pdev = container_of(dev, struct
platform_device, dev);
dev_dbg(dev, "%s\n", __func__);
/*
* SMEM related information has to fetched again
* during resuming from Hibernation, Hence call probe.
*/
ret = qcom_smem_probe(pdev);
if (ret)
dev_err(dev, "Error getting SMEM information\n");
return ret;
}
static const struct dev_pm_ops qcom_smem_pm_ops = {
.freeze_late = qcom_smem_freeze,
.restore_early = qcom_smem_restore,
.thaw_early = qcom_smem_restore,
};
static const struct of_device_id qcom_smem_of_match[] = {
{ .compatible = "qcom,smem" },
{}
@ -1068,6 +1118,7 @@ static struct platform_driver qcom_smem_driver = {
.name = "qcom-smem",
.of_match_table = qcom_smem_of_match,
.suppress_bind_attrs = true,
.pm = &qcom_smem_pm_ops,
},
};