1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/debugfs.h>
19#include <linux/export.h>
20
21#include "bfad_drv.h"
22#include "bfad_im.h"
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43struct bfad_debug_info {
44 char *debug_buffer;
45 void *i_private;
46 int buffer_len;
47};
48
49static int
50bfad_debugfs_open_drvtrc(struct inode *inode, struct file *file)
51{
52 struct bfad_port_s *port = inode->i_private;
53 struct bfad_s *bfad = port->bfad;
54 struct bfad_debug_info *debug;
55
56 debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
57 if (!debug)
58 return -ENOMEM;
59
60 debug->debug_buffer = (void *) bfad->trcmod;
61 debug->buffer_len = sizeof(struct bfa_trc_mod_s);
62
63 file->private_data = debug;
64
65 return 0;
66}
67
68static int
69bfad_debugfs_open_fwtrc(struct inode *inode, struct file *file)
70{
71 struct bfad_port_s *port = inode->i_private;
72 struct bfad_s *bfad = port->bfad;
73 struct bfad_debug_info *fw_debug;
74 unsigned long flags;
75 int rc;
76
77 fw_debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
78 if (!fw_debug)
79 return -ENOMEM;
80
81 fw_debug->buffer_len = sizeof(struct bfa_trc_mod_s);
82
83 fw_debug->debug_buffer = vmalloc(fw_debug->buffer_len);
84 if (!fw_debug->debug_buffer) {
85 kfree(fw_debug);
86 printk(KERN_INFO "bfad[%d]: Failed to allocate fwtrc buffer\n",
87 bfad->inst_no);
88 return -ENOMEM;
89 }
90
91 memset(fw_debug->debug_buffer, 0, fw_debug->buffer_len);
92
93 spin_lock_irqsave(&bfad->bfad_lock, flags);
94 rc = bfa_ioc_debug_fwtrc(&bfad->bfa.ioc,
95 fw_debug->debug_buffer,
96 &fw_debug->buffer_len);
97 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
98 if (rc != BFA_STATUS_OK) {
99 vfree(fw_debug->debug_buffer);
100 fw_debug->debug_buffer = NULL;
101 kfree(fw_debug);
102 printk(KERN_INFO "bfad[%d]: Failed to collect fwtrc\n",
103 bfad->inst_no);
104 return -ENOMEM;
105 }
106
107 file->private_data = fw_debug;
108
109 return 0;
110}
111
112static int
113bfad_debugfs_open_fwsave(struct inode *inode, struct file *file)
114{
115 struct bfad_port_s *port = inode->i_private;
116 struct bfad_s *bfad = port->bfad;
117 struct bfad_debug_info *fw_debug;
118 unsigned long flags;
119 int rc;
120
121 fw_debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
122 if (!fw_debug)
123 return -ENOMEM;
124
125 fw_debug->buffer_len = sizeof(struct bfa_trc_mod_s);
126
127 fw_debug->debug_buffer = vmalloc(fw_debug->buffer_len);
128 if (!fw_debug->debug_buffer) {
129 kfree(fw_debug);
130 printk(KERN_INFO "bfad[%d]: Failed to allocate fwsave buffer\n",
131 bfad->inst_no);
132 return -ENOMEM;
133 }
134
135 memset(fw_debug->debug_buffer, 0, fw_debug->buffer_len);
136
137 spin_lock_irqsave(&bfad->bfad_lock, flags);
138 rc = bfa_ioc_debug_fwsave(&bfad->bfa.ioc,
139 fw_debug->debug_buffer,
140 &fw_debug->buffer_len);
141 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
142 if (rc != BFA_STATUS_OK) {
143 vfree(fw_debug->debug_buffer);
144 fw_debug->debug_buffer = NULL;
145 kfree(fw_debug);
146 printk(KERN_INFO "bfad[%d]: Failed to collect fwsave\n",
147 bfad->inst_no);
148 return -ENOMEM;
149 }
150
151 file->private_data = fw_debug;
152
153 return 0;
154}
155
156static int
157bfad_debugfs_open_reg(struct inode *inode, struct file *file)
158{
159 struct bfad_debug_info *reg_debug;
160
161 reg_debug = kzalloc(sizeof(struct bfad_debug_info), GFP_KERNEL);
162 if (!reg_debug)
163 return -ENOMEM;
164
165 reg_debug->i_private = inode->i_private;
166
167 file->private_data = reg_debug;
168
169 return 0;
170}
171
172
173static loff_t
174bfad_debugfs_lseek(struct file *file, loff_t offset, int orig)
175{
176 struct bfad_debug_info *debug = file->private_data;
177 return fixed_size_llseek(file, offset, orig,
178 debug->buffer_len);
179}
180
181static ssize_t
182bfad_debugfs_read(struct file *file, char __user *buf,
183 size_t nbytes, loff_t *pos)
184{
185 struct bfad_debug_info *debug = file->private_data;
186
187 if (!debug || !debug->debug_buffer)
188 return 0;
189
190 return simple_read_from_buffer(buf, nbytes, pos,
191 debug->debug_buffer, debug->buffer_len);
192}
193
194#define BFA_REG_CT_ADDRSZ (0x40000)
195#define BFA_REG_CB_ADDRSZ (0x20000)
196#define BFA_REG_ADDRSZ(__ioc) \
197 ((u32)(bfa_asic_id_ctc(bfa_ioc_devid(__ioc)) ? \
198 BFA_REG_CT_ADDRSZ : BFA_REG_CB_ADDRSZ))
199#define BFA_REG_ADDRMSK(__ioc) (BFA_REG_ADDRSZ(__ioc) - 1)
200
201static bfa_status_t
202bfad_reg_offset_check(struct bfa_s *bfa, u32 offset, u32 len)
203{
204 u8 area;
205
206
207 area = (offset >> 15) & 0x7;
208 if (area == 0) {
209
210 if ((offset + (len<<2)) > 0x8000)
211 return BFA_STATUS_EINVAL;
212 } else if (area == 0x1) {
213
214 if ((offset + (len<<2)) > 0x10000)
215 return BFA_STATUS_EINVAL;
216 } else {
217
218 if ((offset + (len<<2)) > BFA_REG_ADDRMSK(&bfa->ioc))
219 return BFA_STATUS_EINVAL;
220 }
221 return BFA_STATUS_OK;
222}
223
224static ssize_t
225bfad_debugfs_read_regrd(struct file *file, char __user *buf,
226 size_t nbytes, loff_t *pos)
227{
228 struct bfad_debug_info *regrd_debug = file->private_data;
229 struct bfad_port_s *port = (struct bfad_port_s *)regrd_debug->i_private;
230 struct bfad_s *bfad = port->bfad;
231 ssize_t rc;
232
233 if (!bfad->regdata)
234 return 0;
235
236 rc = simple_read_from_buffer(buf, nbytes, pos,
237 bfad->regdata, bfad->reglen);
238
239 if ((*pos + nbytes) >= bfad->reglen) {
240 kfree(bfad->regdata);
241 bfad->regdata = NULL;
242 bfad->reglen = 0;
243 }
244
245 return rc;
246}
247
248static ssize_t
249bfad_debugfs_write_regrd(struct file *file, const char __user *buf,
250 size_t nbytes, loff_t *ppos)
251{
252 struct bfad_debug_info *regrd_debug = file->private_data;
253 struct bfad_port_s *port = (struct bfad_port_s *)regrd_debug->i_private;
254 struct bfad_s *bfad = port->bfad;
255 struct bfa_s *bfa = &bfad->bfa;
256 struct bfa_ioc_s *ioc = &bfa->ioc;
257 int addr, len, rc, i;
258 u32 *regbuf;
259 void __iomem *rb, *reg_addr;
260 unsigned long flags;
261 void *kern_buf;
262
263 kern_buf = memdup_user(buf, nbytes);
264 if (IS_ERR(kern_buf))
265 return PTR_ERR(kern_buf);
266
267 rc = sscanf(kern_buf, "%x:%x", &addr, &len);
268 if (rc < 2) {
269 printk(KERN_INFO
270 "bfad[%d]: %s failed to read user buf\n",
271 bfad->inst_no, __func__);
272 kfree(kern_buf);
273 return -EINVAL;
274 }
275
276 kfree(kern_buf);
277 kfree(bfad->regdata);
278 bfad->regdata = NULL;
279 bfad->reglen = 0;
280
281 bfad->regdata = kzalloc(len << 2, GFP_KERNEL);
282 if (!bfad->regdata) {
283 printk(KERN_INFO "bfad[%d]: Failed to allocate regrd buffer\n",
284 bfad->inst_no);
285 return -ENOMEM;
286 }
287
288 bfad->reglen = len << 2;
289 rb = bfa_ioc_bar0(ioc);
290 addr &= BFA_REG_ADDRMSK(ioc);
291
292
293 rc = bfad_reg_offset_check(bfa, addr, len);
294 if (rc) {
295 printk(KERN_INFO "bfad[%d]: Failed reg offset check\n",
296 bfad->inst_no);
297 kfree(bfad->regdata);
298 bfad->regdata = NULL;
299 bfad->reglen = 0;
300 return -EINVAL;
301 }
302
303 reg_addr = rb + addr;
304 regbuf = (u32 *)bfad->regdata;
305 spin_lock_irqsave(&bfad->bfad_lock, flags);
306 for (i = 0; i < len; i++) {
307 *regbuf = readl(reg_addr);
308 regbuf++;
309 reg_addr += sizeof(u32);
310 }
311 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
312
313 return nbytes;
314}
315
316static ssize_t
317bfad_debugfs_write_regwr(struct file *file, const char __user *buf,
318 size_t nbytes, loff_t *ppos)
319{
320 struct bfad_debug_info *debug = file->private_data;
321 struct bfad_port_s *port = (struct bfad_port_s *)debug->i_private;
322 struct bfad_s *bfad = port->bfad;
323 struct bfa_s *bfa = &bfad->bfa;
324 struct bfa_ioc_s *ioc = &bfa->ioc;
325 int addr, val, rc;
326 void __iomem *reg_addr;
327 unsigned long flags;
328 void *kern_buf;
329
330 kern_buf = memdup_user(buf, nbytes);
331 if (IS_ERR(kern_buf))
332 return PTR_ERR(kern_buf);
333
334 rc = sscanf(kern_buf, "%x:%x", &addr, &val);
335 if (rc < 2) {
336 printk(KERN_INFO
337 "bfad[%d]: %s failed to read user buf\n",
338 bfad->inst_no, __func__);
339 kfree(kern_buf);
340 return -EINVAL;
341 }
342 kfree(kern_buf);
343
344 addr &= BFA_REG_ADDRMSK(ioc);
345
346
347 rc = bfad_reg_offset_check(bfa, addr, 1);
348 if (rc) {
349 printk(KERN_INFO
350 "bfad[%d]: Failed reg offset check\n",
351 bfad->inst_no);
352 return -EINVAL;
353 }
354
355 reg_addr = (bfa_ioc_bar0(ioc)) + addr;
356 spin_lock_irqsave(&bfad->bfad_lock, flags);
357 writel(val, reg_addr);
358 spin_unlock_irqrestore(&bfad->bfad_lock, flags);
359
360 return nbytes;
361}
362
363static int
364bfad_debugfs_release(struct inode *inode, struct file *file)
365{
366 struct bfad_debug_info *debug = file->private_data;
367
368 if (!debug)
369 return 0;
370
371 file->private_data = NULL;
372 kfree(debug);
373 return 0;
374}
375
376static int
377bfad_debugfs_release_fwtrc(struct inode *inode, struct file *file)
378{
379 struct bfad_debug_info *fw_debug = file->private_data;
380
381 if (!fw_debug)
382 return 0;
383
384 if (fw_debug->debug_buffer)
385 vfree(fw_debug->debug_buffer);
386
387 file->private_data = NULL;
388 kfree(fw_debug);
389 return 0;
390}
391
392static const struct file_operations bfad_debugfs_op_drvtrc = {
393 .owner = THIS_MODULE,
394 .open = bfad_debugfs_open_drvtrc,
395 .llseek = bfad_debugfs_lseek,
396 .read = bfad_debugfs_read,
397 .release = bfad_debugfs_release,
398};
399
400static const struct file_operations bfad_debugfs_op_fwtrc = {
401 .owner = THIS_MODULE,
402 .open = bfad_debugfs_open_fwtrc,
403 .llseek = bfad_debugfs_lseek,
404 .read = bfad_debugfs_read,
405 .release = bfad_debugfs_release_fwtrc,
406};
407
408static const struct file_operations bfad_debugfs_op_fwsave = {
409 .owner = THIS_MODULE,
410 .open = bfad_debugfs_open_fwsave,
411 .llseek = bfad_debugfs_lseek,
412 .read = bfad_debugfs_read,
413 .release = bfad_debugfs_release_fwtrc,
414};
415
416static const struct file_operations bfad_debugfs_op_regrd = {
417 .owner = THIS_MODULE,
418 .open = bfad_debugfs_open_reg,
419 .llseek = bfad_debugfs_lseek,
420 .read = bfad_debugfs_read_regrd,
421 .write = bfad_debugfs_write_regrd,
422 .release = bfad_debugfs_release,
423};
424
425static const struct file_operations bfad_debugfs_op_regwr = {
426 .owner = THIS_MODULE,
427 .open = bfad_debugfs_open_reg,
428 .llseek = bfad_debugfs_lseek,
429 .write = bfad_debugfs_write_regwr,
430 .release = bfad_debugfs_release,
431};
432
433struct bfad_debugfs_entry {
434 const char *name;
435 umode_t mode;
436 const struct file_operations *fops;
437};
438
439static const struct bfad_debugfs_entry bfad_debugfs_files[] = {
440 { "drvtrc", S_IFREG|S_IRUGO, &bfad_debugfs_op_drvtrc, },
441 { "fwtrc", S_IFREG|S_IRUGO, &bfad_debugfs_op_fwtrc, },
442 { "fwsave", S_IFREG|S_IRUGO, &bfad_debugfs_op_fwsave, },
443 { "regrd", S_IFREG|S_IRUGO|S_IWUSR, &bfad_debugfs_op_regrd, },
444 { "regwr", S_IFREG|S_IWUSR, &bfad_debugfs_op_regwr, },
445};
446
447static struct dentry *bfa_debugfs_root;
448static atomic_t bfa_debugfs_port_count;
449
450inline void
451bfad_debugfs_init(struct bfad_port_s *port)
452{
453 struct bfad_s *bfad = port->bfad;
454 const struct bfad_debugfs_entry *file;
455 char name[64];
456 int i;
457
458 if (!bfa_debugfs_enable)
459 return;
460
461
462 if (!bfa_debugfs_root) {
463 bfa_debugfs_root = debugfs_create_dir("bfa", NULL);
464 atomic_set(&bfa_debugfs_port_count, 0);
465 if (!bfa_debugfs_root) {
466 printk(KERN_WARNING
467 "BFA debugfs root dir creation failed\n");
468 goto err;
469 }
470 }
471
472
473 snprintf(name, sizeof(name), "pci_dev:%s", bfad->pci_name);
474 if (!port->port_debugfs_root) {
475 port->port_debugfs_root =
476 debugfs_create_dir(name, bfa_debugfs_root);
477 if (!port->port_debugfs_root) {
478 printk(KERN_WARNING
479 "bfa %s: debugfs root creation failed\n",
480 bfad->pci_name);
481 goto err;
482 }
483
484 atomic_inc(&bfa_debugfs_port_count);
485
486 for (i = 0; i < ARRAY_SIZE(bfad_debugfs_files); i++) {
487 file = &bfad_debugfs_files[i];
488 bfad->bfad_dentry_files[i] =
489 debugfs_create_file(file->name,
490 file->mode,
491 port->port_debugfs_root,
492 port,
493 file->fops);
494 if (!bfad->bfad_dentry_files[i]) {
495 printk(KERN_WARNING
496 "bfa %s: debugfs %s creation failed\n",
497 bfad->pci_name, file->name);
498 goto err;
499 }
500 }
501 }
502
503err:
504 return;
505}
506
507inline void
508bfad_debugfs_exit(struct bfad_port_s *port)
509{
510 struct bfad_s *bfad = port->bfad;
511 int i;
512
513 for (i = 0; i < ARRAY_SIZE(bfad_debugfs_files); i++) {
514 if (bfad->bfad_dentry_files[i]) {
515 debugfs_remove(bfad->bfad_dentry_files[i]);
516 bfad->bfad_dentry_files[i] = NULL;
517 }
518 }
519
520
521 if (port->port_debugfs_root) {
522 debugfs_remove(port->port_debugfs_root);
523 port->port_debugfs_root = NULL;
524 atomic_dec(&bfa_debugfs_port_count);
525 }
526
527
528 if (atomic_read(&bfa_debugfs_port_count) == 0) {
529 debugfs_remove(bfa_debugfs_root);
530 bfa_debugfs_root = NULL;
531 }
532}
533
