threeeye
bc1d038eac
Squashed backup commit (no shallow-clone history issues) of xiaomi-mt6833-dev/kernel_xiaomi_mt6833 (lineage-23.2 branch, upstream commit 9eece662e) plus all fixes applied to get everpal_defconfig building clean against a modern (GCC 15.2.0) toolchain -- see the previous commit message on the lineage-23.2 branch (also in this repo history is not available here since this is a squashed snapshot; full incremental history lives in the local DL380 checkout and the upstream GitHub remote). Upstream: https://github.com/xiaomi-mt6833-dev/kernel_xiaomi_mt6833 (lineage-23.2)
102 lines
2.1 KiB
C
102 lines
2.1 KiB
C
/* SPDX-License-Identifier: GPL-2.0 */
|
|
/*
|
|
* Copyright (c) 2019 MediaTek Inc.
|
|
*/
|
|
|
|
#include <linux/of.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/of_irq.h>
|
|
#include <linux/list.h>
|
|
#include <linux/slab.h>
|
|
|
|
#include <mtk_lpm_module.h>
|
|
#include <mtk_lpm_internal.h>
|
|
#include "mtk_lpm_trace.h"
|
|
|
|
|
|
#define MTK_LPM_TRACE_SYSRAM_MEMCPY_DEST(_offset, _buf, _sz) ({\
|
|
memcpy(buf, (void *)(mtk_lpm_trace_ins.mmu + _offset),\
|
|
_sz); })
|
|
|
|
#define MTK_LPM_TRACE_SYSRAM_MEMCPY_SRC(_offset, _buf, _sz) ({\
|
|
memcpy((void *)(mtk_lpm_trace_ins.mmu + _offset), buf,\
|
|
_sz); })
|
|
|
|
|
|
struct MTK_LPM_TRACE_INS {
|
|
void __iomem *mmu;
|
|
size_t size;
|
|
};
|
|
|
|
static struct MTK_LPM_TRACE_INS mtk_lpm_trace_ins;
|
|
|
|
int __init mtk_lpm_trace_parsing(struct device_node *parent)
|
|
{
|
|
struct device_node *node;
|
|
|
|
if (!parent)
|
|
return -EINVAL;
|
|
|
|
node = of_find_compatible_node(parent, NULL,
|
|
"mediatek,lpm-sysram");
|
|
if (node) {
|
|
struct resource res;
|
|
|
|
if (!of_address_to_resource(node, 0, &res)) {
|
|
mtk_lpm_trace_ins.size = (size_t)resource_size(&res);
|
|
mtk_lpm_trace_ins.mmu = ioremap(res.start,
|
|
resource_size(&res));
|
|
}
|
|
of_node_put(node);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
size_t mtk_lpm_trace_sysram_read(unsigned long offset,
|
|
void *buf, size_t sz)
|
|
{
|
|
size_t rSz = 0;
|
|
|
|
if ((offset >= mtk_lpm_trace_ins.size)
|
|
|| !mtk_lpm_trace_ins.mmu)
|
|
return -EINVAL;
|
|
|
|
rSz = ((offset + sz) < mtk_lpm_trace_ins.size) ?
|
|
sz : (mtk_lpm_trace_ins.size - offset);
|
|
|
|
MTK_LPM_TRACE_SYSRAM_MEMCPY_DEST(offset, buf, rSz);
|
|
return rSz;
|
|
}
|
|
|
|
size_t mtk_lpm_trace_sysram_wrtie(unsigned long offset,
|
|
const void *buf, size_t sz)
|
|
{
|
|
size_t rSz = 0;
|
|
|
|
if ((offset >= mtk_lpm_trace_ins.size)
|
|
|| !mtk_lpm_trace_ins.mmu)
|
|
return -EINVAL;
|
|
|
|
rSz = ((offset + sz) < mtk_lpm_trace_ins.size) ?
|
|
sz : (mtk_lpm_trace_ins.size - offset);
|
|
|
|
MTK_LPM_TRACE_SYSRAM_MEMCPY_SRC(offset, buf, rSz);
|
|
return 0;
|
|
}
|
|
|
|
int mtk_lpm_trace_instance_get(int type, struct MTK_LPM_PLAT_TRACE *ins)
|
|
{
|
|
int ret = 0;
|
|
|
|
if (!ins)
|
|
return -EINVAL;
|
|
|
|
if (type == MT_LPM_PLAT_TRACE_SYSRAM) {
|
|
ins->read = mtk_lpm_trace_sysram_read;
|
|
ins->write = mtk_lpm_trace_sysram_wrtie;
|
|
} else
|
|
ret = -EINVAL;
|
|
|
|
return ret;
|
|
}
|