96 lines · c
1// SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)2//3// This file is provided under a dual BSD/GPLv2 license. When using or4// redistributing this file, you may do so under either license.5//6// Copyright(c) 2018-2023 Intel Corporation7//8 9#include <linux/debugfs.h>10#include <linux/io.h>11#include <linux/pm_runtime.h>12#include <sound/sof/debug.h>13#include <sound/sof/ipc4/header.h>14#include "sof-priv.h"15#include "ops.h"16#include "ipc4-telemetry.h"17#include "ipc4-priv.h"18 19static void __iomem *sof_ipc4_query_exception_address(struct snd_sof_dev *sdev)20{21 u32 type = SOF_IPC4_DEBUG_SLOT_TELEMETRY;22 size_t telemetry_slot_offset;23 u32 offset;24 25 telemetry_slot_offset = sof_ipc4_find_debug_slot_offset_by_type(sdev, type);26 if (!telemetry_slot_offset)27 return NULL;28 29 /* skip the first separator magic number */30 offset = telemetry_slot_offset + sizeof(u32);31 32 return sdev->bar[sdev->mailbox_bar] + offset;33}34 35static ssize_t sof_telemetry_entry_read(struct file *file, char __user *buffer,36 size_t count, loff_t *ppos)37{38 struct snd_sof_dfsentry *dfse = file->private_data;39 struct snd_sof_dev *sdev = dfse->sdev;40 void __iomem *io_addr;41 loff_t pos = *ppos;42 size_t size_ret;43 u8 *buf;44 45 if (pos < 0)46 return -EINVAL;47 /* skip the first separator magic number */48 if (pos >= SOF_IPC4_DEBUG_SLOT_SIZE - 4 || !count)49 return 0;50 if (count > SOF_IPC4_DEBUG_SLOT_SIZE - 4 - pos)51 count = SOF_IPC4_DEBUG_SLOT_SIZE - 4 - pos;52 53 io_addr = sof_ipc4_query_exception_address(sdev);54 if (!io_addr)55 return -EFAULT;56 57 buf = kzalloc(SOF_IPC4_DEBUG_SLOT_SIZE - 4, GFP_KERNEL);58 if (!buf)59 return -ENOMEM;60 61 memcpy_fromio(buf, io_addr, SOF_IPC4_DEBUG_SLOT_SIZE - 4);62 size_ret = copy_to_user(buffer, buf + pos, count);63 if (size_ret) {64 kfree(buf);65 return -EFAULT;66 }67 68 *ppos = pos + count;69 kfree(buf);70 71 return count;72}73 74static const struct file_operations sof_telemetry_fops = {75 .open = simple_open,76 .read = sof_telemetry_entry_read,77};78 79void sof_ipc4_create_exception_debugfs_node(struct snd_sof_dev *sdev)80{81 struct snd_sof_dfsentry *dfse;82 83 dfse = devm_kzalloc(sdev->dev, sizeof(*dfse), GFP_KERNEL);84 if (!dfse)85 return;86 87 dfse->type = SOF_DFSENTRY_TYPE_IOMEM;88 dfse->size = SOF_IPC4_DEBUG_SLOT_SIZE - 4;89 dfse->access_type = SOF_DEBUGFS_ACCESS_ALWAYS;90 dfse->sdev = sdev;91 92 list_add(&dfse->list, &sdev->dfsentry_list);93 94 debugfs_create_file("exception", 0444, sdev->debugfs_root, dfse, &sof_telemetry_fops);95}96