1 /*
2 * Copyright (C) 2015 CERN (www.cern.ch)
3 * Author: Federico Vaga <federico.vaga@cern.ch>
4 *
5 * Released according to the GNU GPL, version 2 or any later version.
6 */
7
8 #include <linux/module.h>
9 #include <linux/device.h>
10 #include <linux/init.h>
11 #include <linux/fs.h>
12 #include <linux/debugfs.h>
13 #include <linux/seq_file.h>
14 #include <asm/byteorder.h>
15
16 #include <linux/fmc.h>
17 #include <linux/sdb.h>
18 #include <linux/fmc-sdb.h>
19
20 #define FMC_DBG_SDB_DUMP "dump_sdb"
21
__strip_trailing_space(char * buf,char * str,int len)22 static char *__strip_trailing_space(char *buf, char *str, int len)
23 {
24 int i = len - 1;
25
26 memcpy(buf, str, len);
27 buf[len] = '\0';
28 while (i >= 0 && buf[i] == ' ')
29 buf[i--] = '\0';
30 return buf;
31 }
32
33 #define __sdb_string(buf, field) ({ \
34 BUILD_BUG_ON(sizeof(buf) < sizeof(field)); \
35 __strip_trailing_space(buf, (void *)(field), sizeof(field)); \
36 })
37
38 /**
39 * We do not check seq_printf() errors because we want to see things in any case
40 */
fmc_sdb_dump_recursive(struct fmc_device * fmc,struct seq_file * s,const struct sdb_array * arr)41 static void fmc_sdb_dump_recursive(struct fmc_device *fmc, struct seq_file *s,
42 const struct sdb_array *arr)
43 {
44 unsigned long base = arr->baseaddr;
45 int i, j, n = arr->len, level = arr->level;
46 char tmp[64];
47
48 for (i = 0; i < n; i++) {
49 union sdb_record *r;
50 struct sdb_product *p;
51 struct sdb_component *c;
52
53 r = &arr->record[i];
54 c = &r->dev.sdb_component;
55 p = &c->product;
56
57 for (j = 0; j < level; j++)
58 seq_printf(s, " ");
59 switch (r->empty.record_type) {
60 case sdb_type_interconnect:
61 seq_printf(s, "%08llx:%08x %.19s\n",
62 __be64_to_cpu(p->vendor_id),
63 __be32_to_cpu(p->device_id),
64 p->name);
65 break;
66 case sdb_type_device:
67 seq_printf(s, "%08llx:%08x %.19s (%08llx-%08llx)\n",
68 __be64_to_cpu(p->vendor_id),
69 __be32_to_cpu(p->device_id),
70 p->name,
71 __be64_to_cpu(c->addr_first) + base,
72 __be64_to_cpu(c->addr_last) + base);
73 break;
74 case sdb_type_bridge:
75 seq_printf(s, "%08llx:%08x %.19s (bridge: %08llx)\n",
76 __be64_to_cpu(p->vendor_id),
77 __be32_to_cpu(p->device_id),
78 p->name,
79 __be64_to_cpu(c->addr_first) + base);
80 if (IS_ERR(arr->subtree[i])) {
81 seq_printf(s, "SDB: (bridge error %li)\n",
82 PTR_ERR(arr->subtree[i]));
83 break;
84 }
85 fmc_sdb_dump_recursive(fmc, s, arr->subtree[i]);
86 break;
87 case sdb_type_integration:
88 seq_printf(s, "integration\n");
89 break;
90 case sdb_type_repo_url:
91 seq_printf(s, "Synthesis repository: %s\n",
92 __sdb_string(tmp, r->repo_url.repo_url));
93 break;
94 case sdb_type_synthesis:
95 seq_printf(s, "Bitstream '%s' ",
96 __sdb_string(tmp, r->synthesis.syn_name));
97 seq_printf(s, "synthesized %08x by %s ",
98 __be32_to_cpu(r->synthesis.date),
99 __sdb_string(tmp, r->synthesis.user_name));
100 seq_printf(s, "(%s version %x), ",
101 __sdb_string(tmp, r->synthesis.tool_name),
102 __be32_to_cpu(r->synthesis.tool_version));
103 seq_printf(s, "commit %pm\n",
104 r->synthesis.commit_id);
105 break;
106 case sdb_type_empty:
107 seq_printf(s, "empty\n");
108 break;
109 default:
110 seq_printf(s, "UNKNOWN TYPE 0x%02x\n",
111 r->empty.record_type);
112 break;
113 }
114 }
115 }
116
fmc_sdb_dump(struct seq_file * s,void * offset)117 static int fmc_sdb_dump(struct seq_file *s, void *offset)
118 {
119 struct fmc_device *fmc = s->private;
120
121 if (!fmc->sdb) {
122 seq_printf(s, "no SDB information\n");
123 return 0;
124 }
125
126 seq_printf(s, "FMC: %s (%s), slot %i, device %s\n", dev_name(fmc->hwdev),
127 fmc->carrier_name, fmc->slot_id, dev_name(&fmc->dev));
128 /* Dump SDB information */
129 fmc_sdb_dump_recursive(fmc, s, fmc->sdb);
130
131 return 0;
132 }
133
134
fmc_sdb_dump_open(struct inode * inode,struct file * file)135 static int fmc_sdb_dump_open(struct inode *inode, struct file *file)
136 {
137 struct fmc_device *fmc = inode->i_private;
138
139 return single_open(file, fmc_sdb_dump, fmc);
140 }
141
142
143 const struct file_operations fmc_dbgfs_sdb_dump = {
144 .owner = THIS_MODULE,
145 .open = fmc_sdb_dump_open,
146 .read = seq_read,
147 .llseek = seq_lseek,
148 .release = single_release,
149 };
150
fmc_debug_init(struct fmc_device * fmc)151 int fmc_debug_init(struct fmc_device *fmc)
152 {
153 fmc->dbg_dir = debugfs_create_dir(dev_name(&fmc->dev), NULL);
154 if (IS_ERR_OR_NULL(fmc->dbg_dir)) {
155 pr_err("FMC: Cannot create debugfs\n");
156 return PTR_ERR(fmc->dbg_dir);
157 }
158
159 fmc->dbg_sdb_dump = debugfs_create_file(FMC_DBG_SDB_DUMP, 0444,
160 fmc->dbg_dir, fmc,
161 &fmc_dbgfs_sdb_dump);
162 if (IS_ERR_OR_NULL(fmc->dbg_sdb_dump))
163 pr_err("FMC: Cannot create debugfs file %s\n",
164 FMC_DBG_SDB_DUMP);
165
166 return 0;
167 }
168
fmc_debug_exit(struct fmc_device * fmc)169 void fmc_debug_exit(struct fmc_device *fmc)
170 {
171 if (fmc->dbg_dir)
172 debugfs_remove_recursive(fmc->dbg_dir);
173 }
174
