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 or
4 // redistributing this file, you may do so under either license.
5 //
6 // Copyright(c) 2018-2023 Intel Corporation
7 //
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
sof_ipc4_query_exception_address(struct snd_sof_dev * sdev)19 static 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
sof_telemetry_entry_read(struct file * file,char __user * buffer,size_t count,loff_t * ppos)35 static 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
74 static const struct file_operations sof_telemetry_fops = {
75 .open = simple_open,
76 .read = sof_telemetry_entry_read,
77 };
78
sof_ipc4_create_exception_debugfs_node(struct snd_sof_dev * sdev)79 void 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