You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
kernel_samsung_sm7125/drivers/soc/qcom/memory_dump_v2.c

381 lines
9.2 KiB

/* Copyright (c) 2014-2018, 2020 The Linux Foundation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 and
* only version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include <asm/cacheflush.h>
#include <linux/slab.h>
#include <linux/io.h>
#include <linux/init.h>
#include <linux/export.h>
#include <linux/err.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <soc/qcom/memory_dump.h>
#include <soc/qcom/minidump.h>
#include <soc/qcom/scm.h>
#include <linux/of_device.h>
#include <linux/dma-mapping.h>
#include <linux/module.h>
#include <linux/syscore_ops.h>
#include <linux/sec_debug.h>
#define MSM_DUMP_TABLE_VERSION MSM_DUMP_MAKE_VERSION(2, 0)
#define SCM_CMD_DEBUG_LAR_UNLOCK 0x4
struct msm_dump_table {
uint32_t version;
uint32_t num_entries;
struct msm_dump_entry entries[MAX_NUM_ENTRIES];
};
struct msm_memory_dump {
uint64_t table_phys;
struct msm_dump_table *table;
};
static struct msm_memory_dump memdump;
static struct msm_mem_dump_vaddr_tbl vaddr_tbl;
#ifdef CONFIG_SEC_DEBUG_SUMMARY
void summary_set_msm_memdump_info(struct sec_debug_summary_data_apss *apss)
{
apss->msm_memdump_paddr = (uint64_t)memdump.table_phys;
pr_info("%s : 0x%llx\n", __func__, apss->msm_memdump_paddr);
}
#endif
uint32_t msm_dump_table_version(void)
{
return MSM_DUMP_TABLE_VERSION;
}
EXPORT_SYMBOL(msm_dump_table_version);
static int msm_dump_table_register(struct msm_dump_entry *entry)
{
struct msm_dump_entry *e;
struct msm_dump_table *table = memdump.table;
if (!table || table->num_entries >= MAX_NUM_ENTRIES)
return -EINVAL;
e = &table->entries[table->num_entries];
e->id = entry->id;
e->type = MSM_DUMP_TYPE_TABLE;
e->addr = entry->addr;
table->num_entries++;
dmac_flush_range(table, (void *)table + sizeof(struct msm_dump_table));
return 0;
}
static struct msm_dump_table *msm_dump_get_table(enum msm_dump_table_ids id)
{
struct msm_dump_table *table = memdump.table;
int i;
if (!table) {
pr_err("mem dump base table does not exist\n");
return ERR_PTR(-EINVAL);
}
for (i = 0; i < MAX_NUM_ENTRIES; i++) {
if (table->entries[i].id == id)
break;
}
if (i == MAX_NUM_ENTRIES || !table->entries[i].addr) {
pr_err("mem dump base table entry %d invalid\n", id);
return ERR_PTR(-EINVAL);
}
/* Get the apps table pointer */
table = phys_to_virt(table->entries[i].addr);
return table;
}
static int msm_dump_data_add_minidump(struct msm_dump_entry *entry)
{
struct msm_dump_data *data;
struct md_region md_entry;
data = (struct msm_dump_data *)(phys_to_virt(entry->addr));
if (!data->addr || !data->len)
return -EINVAL;
if (!strcmp(data->name, "")) {
pr_debug("Entry name is NULL, Use ID %d for minidump\n",
entry->id);
snprintf(md_entry.name, sizeof(md_entry.name), "KMDT0x%X",
entry->id);
} else {
strlcpy(md_entry.name, data->name, sizeof(md_entry.name));
}
md_entry.phys_addr = data->addr;
md_entry.virt_addr = (uintptr_t)phys_to_virt(data->addr);
md_entry.size = data->len;
md_entry.id = entry->id;
return msm_minidump_add_region(&md_entry);
}
int msm_dump_data_register(enum msm_dump_table_ids id,
struct msm_dump_entry *entry)
{
struct msm_dump_entry *e;
struct msm_dump_table *table;
table = msm_dump_get_table(id);
if (IS_ERR(table))
return PTR_ERR(table);
if (!table || table->num_entries >= MAX_NUM_ENTRIES)
return -EINVAL;
e = &table->entries[table->num_entries];
e->id = entry->id;
e->type = MSM_DUMP_TYPE_DATA;
e->addr = entry->addr;
table->num_entries++;
dmac_flush_range(table, (void *)table + sizeof(struct msm_dump_table));
if (msm_dump_data_add_minidump(entry))
pr_err("Failed to add entry in Minidump table\n");
return 0;
}
EXPORT_SYMBOL(msm_dump_data_register);
struct dump_vaddr_entry *get_msm_dump_ptr(enum msm_dump_data_ids id)
{
int i;
if (!vaddr_tbl.entries)
return NULL;
if (id > MSM_DUMP_DATA_MAX)
return NULL;
for (i = 0; i < vaddr_tbl.num_node; i++) {
if (vaddr_tbl.entries[i].id == id)
break;
}
if (i == vaddr_tbl.num_node)
return NULL;
return &vaddr_tbl.entries[i];
}
EXPORT_SYMBOL(get_msm_dump_ptr);
static void __iomem *imem_base;
#ifdef CONFIG_HIBERNATION
static void memory_dump_syscore_resume(void)
{
memcpy_toio(imem_base, &memdump.table_phys, sizeof(memdump.table_phys));
}
static struct syscore_ops memory_dump_syscore_ops = {
.resume = memory_dump_syscore_resume,
};
#endif
static int __init init_memory_dump(void)
{
struct msm_dump_table *table;
struct msm_dump_entry entry;
struct device_node *np;
int ret;
np = of_find_compatible_node(NULL, NULL,
"qcom,msm-imem-mem_dump_table");
if (!np) {
pr_err("mem dump base table DT node does not exist\n");
return -ENODEV;
}
imem_base = of_iomap(np, 0);
if (!imem_base) {
pr_err("mem dump base table imem offset mapping failed\n");
return -ENOMEM;
}
memdump.table = kzalloc(sizeof(struct msm_dump_table), GFP_KERNEL);
if (!memdump.table) {
ret = -ENOMEM;
goto err0;
}
memdump.table->version = MSM_DUMP_TABLE_VERSION;
memdump.table_phys = virt_to_phys(memdump.table);
memcpy_toio(imem_base, &memdump.table_phys, sizeof(memdump.table_phys));
/* Ensure write to imem_base is complete before unmapping */
mb();
pr_info("MSM Memory Dump base table set up\n");
#ifndef CONFIG_HIBERNATION
iounmap(imem_base);
#endif
table = kzalloc(sizeof(struct msm_dump_table), GFP_KERNEL);
if (!table) {
ret = -ENOMEM;
goto err1;
}
table->version = MSM_DUMP_TABLE_VERSION;
entry.id = MSM_DUMP_TABLE_APPS;
entry.addr = virt_to_phys(table);
ret = msm_dump_table_register(&entry);
if (ret) {
pr_info("mem dump apps data table register failed\n");
goto err2;
}
pr_info("MSM Memory Dump apps data table set up\n");
#ifdef CONFIG_HIBERNATION
register_syscore_ops(&memory_dump_syscore_ops);
#endif
return 0;
err2:
kfree(table);
err1:
kfree(memdump.table);
return ret;
err0:
iounmap(imem_base);
return ret;
}
early_initcall(init_memory_dump);
#ifdef CONFIG_MSM_DEBUG_LAR_UNLOCK
static int __init init_debug_lar_unlock(void)
{
int ret;
struct scm_desc desc = {0};
ret = scm_call2(SCM_SIP_FNID(SCM_SVC_TZ,
SCM_CMD_DEBUG_LAR_UNLOCK), &desc);
if (ret)
pr_err("Core Debug Lock unlock failed, ret: %d\n", ret);
else
pr_info("Core Debug Lock unlocked\n");
return ret;
}
early_initcall(init_debug_lar_unlock);
#endif
static int mem_dump_probe(struct platform_device *pdev)
{
struct device_node *child_node;
const struct device_node *node = pdev->dev.of_node;
static dma_addr_t dump_addr;
static void *dump_vaddr;
struct msm_dump_data *dump_data;
struct msm_dump_entry dump_entry;
int ret;
u32 size, id;
int i = 0;
vaddr_tbl.num_node = of_get_child_count(node);
vaddr_tbl.entries = devm_kcalloc(&pdev->dev, vaddr_tbl.num_node,
sizeof(struct dump_vaddr_entry),
GFP_KERNEL);
if (!vaddr_tbl.entries)
dev_err(&pdev->dev, "Unable to allocate mem for ptr addr\n");
for_each_available_child_of_node(node, child_node) {
ret = of_property_read_u32(child_node, "qcom,dump-size", &size);
if (ret) {
dev_err(&pdev->dev, "Unable to find size for %s\n",
child_node->name);
continue;
}
ret = of_property_read_u32(child_node, "qcom,dump-id", &id);
if (ret) {
dev_err(&pdev->dev, "Unable to find id for %s\n",
child_node->name);
continue;
}
dump_vaddr = (void *) dma_alloc_coherent(&pdev->dev, size,
&dump_addr, GFP_KERNEL);
if (!dump_vaddr) {
dev_err(&pdev->dev, "Couldn't get memory for dumping\n");
continue;
}
memset(dump_vaddr, 0x0, size);
dump_data = devm_kzalloc(&pdev->dev,
sizeof(struct msm_dump_data), GFP_KERNEL);
if (!dump_data) {
dma_free_coherent(&pdev->dev, size, dump_vaddr,
dump_addr);
continue;
}
dump_data->addr = dump_addr;
dump_data->len = size;
strlcpy(dump_data->name, child_node->name,
strlen(child_node->name) + 1);
dump_entry.id = id;
dump_entry.addr = virt_to_phys(dump_data);
ret = msm_dump_data_register(MSM_DUMP_TABLE_APPS, &dump_entry);
if (ret) {
dev_err(&pdev->dev, "Data dump setup failed, id = %d\n",
id);
dma_free_coherent(&pdev->dev, size, dump_vaddr,
dump_addr);
devm_kfree(&pdev->dev, dump_data);
} else if (vaddr_tbl.entries) {
vaddr_tbl.entries[i].id = id;
vaddr_tbl.entries[i].dump_vaddr = dump_vaddr;
vaddr_tbl.entries[i].dump_data_vaddr = dump_data;
i++;
}
}
return 0;
}
static const struct of_device_id mem_dump_match_table[] = {
{.compatible = "qcom,mem-dump",},
{}
};
static struct platform_driver mem_dump_driver = {
.probe = mem_dump_probe,
.driver = {
.name = "msm_mem_dump",
.owner = THIS_MODULE,
.of_match_table = mem_dump_match_table,
},
};
static int __init mem_dump_init(void)
{
return platform_driver_register(&mem_dump_driver);
}
pure_initcall(mem_dump_init);
#ifdef CONFIG_SEC_DEBUG_SUMMARY
void sec_debug_summary_set_msm_memdump_info(struct sec_debug_summary_data_apss *apss)
{
apss->msm_memdump_paddr = (uint64_t)memdump.table_phys;
pr_info("%s : 0x%llx\n", __func__, apss->msm_memdump_paddr);
}
#endif