1 // SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0-only)
2 /* Copyright(c) 2014 - 2020 Intel Corporation */
3 #include <linux/mutex.h>
4 #include <linux/slab.h>
5 #include <linux/seq_file.h>
6 #include "adf_accel_devices.h"
7 #include "adf_transport_internal.h"
8 #include "adf_transport_access_macros.h"
9
10 static DEFINE_MUTEX(ring_read_lock);
11 static DEFINE_MUTEX(bank_read_lock);
12
adf_ring_start(struct seq_file * sfile,loff_t * pos)13 static void *adf_ring_start(struct seq_file *sfile, loff_t *pos)
14 {
15 struct adf_etr_ring_data *ring = sfile->private;
16
17 mutex_lock(&ring_read_lock);
18 if (*pos == 0)
19 return SEQ_START_TOKEN;
20
21 if (*pos >= (ADF_SIZE_TO_RING_SIZE_IN_BYTES(ring->ring_size) /
22 ADF_MSG_SIZE_TO_BYTES(ring->msg_size)))
23 return NULL;
24
25 return ring->base_addr +
26 (ADF_MSG_SIZE_TO_BYTES(ring->msg_size) * (*pos)++);
27 }
28
adf_ring_next(struct seq_file * sfile,void * v,loff_t * pos)29 static void *adf_ring_next(struct seq_file *sfile, void *v, loff_t *pos)
30 {
31 struct adf_etr_ring_data *ring = sfile->private;
32
33 if (*pos >= (ADF_SIZE_TO_RING_SIZE_IN_BYTES(ring->ring_size) /
34 ADF_MSG_SIZE_TO_BYTES(ring->msg_size))) {
35 (*pos)++;
36 return NULL;
37 }
38
39 return ring->base_addr +
40 (ADF_MSG_SIZE_TO_BYTES(ring->msg_size) * (*pos)++);
41 }
42
adf_ring_show(struct seq_file * sfile,void * v)43 static int adf_ring_show(struct seq_file *sfile, void *v)
44 {
45 struct adf_etr_ring_data *ring = sfile->private;
46 struct adf_etr_bank_data *bank = ring->bank;
47 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
48 void __iomem *csr = ring->bank->csr_addr;
49
50 if (v == SEQ_START_TOKEN) {
51 int head, tail, empty;
52
53 head = csr_ops->read_csr_ring_head(csr, bank->bank_number,
54 ring->ring_number);
55 tail = csr_ops->read_csr_ring_tail(csr, bank->bank_number,
56 ring->ring_number);
57 empty = csr_ops->read_csr_e_stat(csr, bank->bank_number);
58
59 seq_puts(sfile, "------- Ring configuration -------\n");
60 seq_printf(sfile, "ring name: %s\n",
61 ring->ring_debug->ring_name);
62 seq_printf(sfile, "ring num %d, bank num %d\n",
63 ring->ring_number, ring->bank->bank_number);
64 seq_printf(sfile, "head %x, tail %x, empty: %d\n",
65 head, tail, (empty & 1 << ring->ring_number)
66 >> ring->ring_number);
67 seq_printf(sfile, "ring size %lld, msg size %d\n",
68 (long long)ADF_SIZE_TO_RING_SIZE_IN_BYTES(ring->ring_size),
69 ADF_MSG_SIZE_TO_BYTES(ring->msg_size));
70 seq_puts(sfile, "----------- Ring data ------------\n");
71 return 0;
72 }
73 seq_hex_dump(sfile, "", DUMP_PREFIX_ADDRESS, 32, 4,
74 v, ADF_MSG_SIZE_TO_BYTES(ring->msg_size), false);
75 return 0;
76 }
77
adf_ring_stop(struct seq_file * sfile,void * v)78 static void adf_ring_stop(struct seq_file *sfile, void *v)
79 {
80 mutex_unlock(&ring_read_lock);
81 }
82
83 static const struct seq_operations adf_ring_debug_sops = {
84 .start = adf_ring_start,
85 .next = adf_ring_next,
86 .stop = adf_ring_stop,
87 .show = adf_ring_show
88 };
89
90 DEFINE_SEQ_ATTRIBUTE(adf_ring_debug);
91
adf_ring_debugfs_add(struct adf_etr_ring_data * ring,const char * name)92 int adf_ring_debugfs_add(struct adf_etr_ring_data *ring, const char *name)
93 {
94 struct adf_etr_ring_debug_entry *ring_debug;
95 char entry_name[16];
96
97 ring_debug = kzalloc(sizeof(*ring_debug), GFP_KERNEL);
98 if (!ring_debug)
99 return -ENOMEM;
100
101 strscpy(ring_debug->ring_name, name, sizeof(ring_debug->ring_name));
102 snprintf(entry_name, sizeof(entry_name), "ring_%02d",
103 ring->ring_number);
104
105 ring_debug->debug = debugfs_create_file(entry_name, S_IRUSR,
106 ring->bank->bank_debug_dir,
107 ring, &adf_ring_debug_fops);
108 ring->ring_debug = ring_debug;
109 return 0;
110 }
111
adf_ring_debugfs_rm(struct adf_etr_ring_data * ring)112 void adf_ring_debugfs_rm(struct adf_etr_ring_data *ring)
113 {
114 if (ring->ring_debug) {
115 debugfs_remove(ring->ring_debug->debug);
116 kfree(ring->ring_debug);
117 ring->ring_debug = NULL;
118 }
119 }
120
adf_bank_start(struct seq_file * sfile,loff_t * pos)121 static void *adf_bank_start(struct seq_file *sfile, loff_t *pos)
122 {
123 struct adf_etr_bank_data *bank = sfile->private;
124 u8 num_rings_per_bank = GET_NUM_RINGS_PER_BANK(bank->accel_dev);
125
126 mutex_lock(&bank_read_lock);
127 if (*pos == 0)
128 return SEQ_START_TOKEN;
129
130 if (*pos >= num_rings_per_bank)
131 return NULL;
132
133 return pos;
134 }
135
adf_bank_next(struct seq_file * sfile,void * v,loff_t * pos)136 static void *adf_bank_next(struct seq_file *sfile, void *v, loff_t *pos)
137 {
138 struct adf_etr_bank_data *bank = sfile->private;
139 u8 num_rings_per_bank = GET_NUM_RINGS_PER_BANK(bank->accel_dev);
140
141 if (++(*pos) >= num_rings_per_bank)
142 return NULL;
143
144 return pos;
145 }
146
adf_bank_show(struct seq_file * sfile,void * v)147 static int adf_bank_show(struct seq_file *sfile, void *v)
148 {
149 struct adf_etr_bank_data *bank = sfile->private;
150 struct adf_hw_csr_ops *csr_ops = GET_CSR_OPS(bank->accel_dev);
151
152 if (v == SEQ_START_TOKEN) {
153 seq_printf(sfile, "------- Bank %d configuration -------\n",
154 bank->bank_number);
155 } else {
156 int ring_id = *((int *)v) - 1;
157 struct adf_etr_ring_data *ring = &bank->rings[ring_id];
158 void __iomem *csr = bank->csr_addr;
159 int head, tail, empty;
160
161 if (!(bank->ring_mask & 1 << ring_id))
162 return 0;
163
164 head = csr_ops->read_csr_ring_head(csr, bank->bank_number,
165 ring->ring_number);
166 tail = csr_ops->read_csr_ring_tail(csr, bank->bank_number,
167 ring->ring_number);
168 empty = csr_ops->read_csr_e_stat(csr, bank->bank_number);
169
170 seq_printf(sfile,
171 "ring num %02d, head %04x, tail %04x, empty: %d\n",
172 ring->ring_number, head, tail,
173 (empty & 1 << ring->ring_number) >>
174 ring->ring_number);
175 }
176 return 0;
177 }
178
adf_bank_stop(struct seq_file * sfile,void * v)179 static void adf_bank_stop(struct seq_file *sfile, void *v)
180 {
181 mutex_unlock(&bank_read_lock);
182 }
183
184 static const struct seq_operations adf_bank_debug_sops = {
185 .start = adf_bank_start,
186 .next = adf_bank_next,
187 .stop = adf_bank_stop,
188 .show = adf_bank_show
189 };
190
191 DEFINE_SEQ_ATTRIBUTE(adf_bank_debug);
192
adf_bank_debugfs_add(struct adf_etr_bank_data * bank)193 int adf_bank_debugfs_add(struct adf_etr_bank_data *bank)
194 {
195 struct adf_accel_dev *accel_dev = bank->accel_dev;
196 struct dentry *parent = accel_dev->transport->debug;
197 char name[16];
198
199 snprintf(name, sizeof(name), "bank_%02d", bank->bank_number);
200 bank->bank_debug_dir = debugfs_create_dir(name, parent);
201 bank->bank_debug_cfg = debugfs_create_file("config", S_IRUSR,
202 bank->bank_debug_dir, bank,
203 &adf_bank_debug_fops);
204 return 0;
205 }
206
adf_bank_debugfs_rm(struct adf_etr_bank_data * bank)207 void adf_bank_debugfs_rm(struct adf_etr_bank_data *bank)
208 {
209 debugfs_remove(bank->bank_debug_cfg);
210 debugfs_remove(bank->bank_debug_dir);
211 }
212