1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/kernel.h>
14#include <linux/rio.h>
15#include <linux/rio_drv.h>
16#include <linux/stat.h>
17#include <linux/capability.h>
18
19#include "rio.h"
20
21
22#define rio_config_attr(field, format_string) \
23static ssize_t \
24field##_show(struct device *dev, struct device_attribute *attr, char *buf) \
25{ \
26 struct rio_dev *rdev = to_rio_dev(dev); \
27 \
28 return sprintf(buf, format_string, rdev->field); \
29} \
30static DEVICE_ATTR_RO(field);
31
32rio_config_attr(did, "0x%04x\n");
33rio_config_attr(vid, "0x%04x\n");
34rio_config_attr(device_rev, "0x%08x\n");
35rio_config_attr(asm_did, "0x%04x\n");
36rio_config_attr(asm_vid, "0x%04x\n");
37rio_config_attr(asm_rev, "0x%04x\n");
38rio_config_attr(destid, "0x%04x\n");
39rio_config_attr(hopcount, "0x%02x\n");
40
41static ssize_t routes_show(struct device *dev, struct device_attribute *attr, char *buf)
42{
43 struct rio_dev *rdev = to_rio_dev(dev);
44 char *str = buf;
45 int i;
46
47 for (i = 0; i < RIO_MAX_ROUTE_ENTRIES(rdev->net->hport->sys_size);
48 i++) {
49 if (rdev->rswitch->route_table[i] == RIO_INVALID_ROUTE)
50 continue;
51 str +=
52 sprintf(str, "%04x %02x\n", i,
53 rdev->rswitch->route_table[i]);
54 }
55
56 return (str - buf);
57}
58static DEVICE_ATTR_RO(routes);
59
60static ssize_t lprev_show(struct device *dev,
61 struct device_attribute *attr, char *buf)
62{
63 struct rio_dev *rdev = to_rio_dev(dev);
64
65 return sprintf(buf, "%s\n",
66 (rdev->prev) ? rio_name(rdev->prev) : "root");
67}
68static DEVICE_ATTR_RO(lprev);
69
70static ssize_t lnext_show(struct device *dev,
71 struct device_attribute *attr, char *buf)
72{
73 struct rio_dev *rdev = to_rio_dev(dev);
74 char *str = buf;
75 int i;
76
77 if (rdev->pef & RIO_PEF_SWITCH) {
78 for (i = 0; i < RIO_GET_TOTAL_PORTS(rdev->swpinfo); i++) {
79 if (rdev->rswitch->nextdev[i])
80 str += sprintf(str, "%s\n",
81 rio_name(rdev->rswitch->nextdev[i]));
82 else
83 str += sprintf(str, "null\n");
84 }
85 }
86
87 return str - buf;
88}
89static DEVICE_ATTR_RO(lnext);
90
91static ssize_t modalias_show(struct device *dev,
92 struct device_attribute *attr, char *buf)
93{
94 struct rio_dev *rdev = to_rio_dev(dev);
95
96 return sprintf(buf, "rapidio:v%04Xd%04Xav%04Xad%04X\n",
97 rdev->vid, rdev->did, rdev->asm_vid, rdev->asm_did);
98}
99static DEVICE_ATTR_RO(modalias);
100
101static struct attribute *rio_dev_attrs[] = {
102 &dev_attr_did.attr,
103 &dev_attr_vid.attr,
104 &dev_attr_device_rev.attr,
105 &dev_attr_asm_did.attr,
106 &dev_attr_asm_vid.attr,
107 &dev_attr_asm_rev.attr,
108 &dev_attr_lprev.attr,
109 &dev_attr_destid.attr,
110 &dev_attr_modalias.attr,
111
112
113 &dev_attr_routes.attr,
114 &dev_attr_lnext.attr,
115 &dev_attr_hopcount.attr,
116 NULL,
117};
118
119static ssize_t
120rio_read_config(struct file *filp, struct kobject *kobj,
121 struct bin_attribute *bin_attr,
122 char *buf, loff_t off, size_t count)
123{
124 struct rio_dev *dev = to_rio_dev(kobj_to_dev(kobj));
125 unsigned int size = 0x100;
126 loff_t init_off = off;
127 u8 *data = (u8 *) buf;
128
129
130 if (capable(CAP_SYS_ADMIN))
131 size = RIO_MAINT_SPACE_SZ;
132
133 if (off >= size)
134 return 0;
135 if (off + count > size) {
136 size -= off;
137 count = size;
138 } else {
139 size = count;
140 }
141
142 if ((off & 1) && size) {
143 u8 val;
144 rio_read_config_8(dev, off, &val);
145 data[off - init_off] = val;
146 off++;
147 size--;
148 }
149
150 if ((off & 3) && size > 2) {
151 u16 val;
152 rio_read_config_16(dev, off, &val);
153 data[off - init_off] = (val >> 8) & 0xff;
154 data[off - init_off + 1] = val & 0xff;
155 off += 2;
156 size -= 2;
157 }
158
159 while (size > 3) {
160 u32 val;
161 rio_read_config_32(dev, off, &val);
162 data[off - init_off] = (val >> 24) & 0xff;
163 data[off - init_off + 1] = (val >> 16) & 0xff;
164 data[off - init_off + 2] = (val >> 8) & 0xff;
165 data[off - init_off + 3] = val & 0xff;
166 off += 4;
167 size -= 4;
168 }
169
170 if (size >= 2) {
171 u16 val;
172 rio_read_config_16(dev, off, &val);
173 data[off - init_off] = (val >> 8) & 0xff;
174 data[off - init_off + 1] = val & 0xff;
175 off += 2;
176 size -= 2;
177 }
178
179 if (size > 0) {
180 u8 val;
181 rio_read_config_8(dev, off, &val);
182 data[off - init_off] = val;
183 off++;
184 --size;
185 }
186
187 return count;
188}
189
190static ssize_t
191rio_write_config(struct file *filp, struct kobject *kobj,
192 struct bin_attribute *bin_attr,
193 char *buf, loff_t off, size_t count)
194{
195 struct rio_dev *dev = to_rio_dev(kobj_to_dev(kobj));
196 unsigned int size = count;
197 loff_t init_off = off;
198 u8 *data = (u8 *) buf;
199
200 if (off >= RIO_MAINT_SPACE_SZ)
201 return 0;
202 if (off + count > RIO_MAINT_SPACE_SZ) {
203 size = RIO_MAINT_SPACE_SZ - off;
204 count = size;
205 }
206
207 if ((off & 1) && size) {
208 rio_write_config_8(dev, off, data[off - init_off]);
209 off++;
210 size--;
211 }
212
213 if ((off & 3) && (size > 2)) {
214 u16 val = data[off - init_off + 1];
215 val |= (u16) data[off - init_off] << 8;
216 rio_write_config_16(dev, off, val);
217 off += 2;
218 size -= 2;
219 }
220
221 while (size > 3) {
222 u32 val = data[off - init_off + 3];
223 val |= (u32) data[off - init_off + 2] << 8;
224 val |= (u32) data[off - init_off + 1] << 16;
225 val |= (u32) data[off - init_off] << 24;
226 rio_write_config_32(dev, off, val);
227 off += 4;
228 size -= 4;
229 }
230
231 if (size >= 2) {
232 u16 val = data[off - init_off + 1];
233 val |= (u16) data[off - init_off] << 8;
234 rio_write_config_16(dev, off, val);
235 off += 2;
236 size -= 2;
237 }
238
239 if (size) {
240 rio_write_config_8(dev, off, data[off - init_off]);
241 off++;
242 --size;
243 }
244
245 return count;
246}
247
248static struct bin_attribute rio_config_attr = {
249 .attr = {
250 .name = "config",
251 .mode = S_IRUGO | S_IWUSR,
252 },
253 .size = RIO_MAINT_SPACE_SZ,
254 .read = rio_read_config,
255 .write = rio_write_config,
256};
257
258static struct bin_attribute *rio_dev_bin_attrs[] = {
259 &rio_config_attr,
260 NULL,
261};
262
263static umode_t rio_dev_is_attr_visible(struct kobject *kobj,
264 struct attribute *attr, int n)
265{
266 struct rio_dev *rdev = to_rio_dev(kobj_to_dev(kobj));
267 umode_t mode = attr->mode;
268
269 if (!(rdev->pef & RIO_PEF_SWITCH) &&
270 (attr == &dev_attr_routes.attr ||
271 attr == &dev_attr_lnext.attr ||
272 attr == &dev_attr_hopcount.attr)) {
273
274
275
276 mode = 0;
277 }
278
279 return mode;
280}
281
282static const struct attribute_group rio_dev_group = {
283 .attrs = rio_dev_attrs,
284 .is_visible = rio_dev_is_attr_visible,
285 .bin_attrs = rio_dev_bin_attrs,
286};
287
288const struct attribute_group *rio_dev_groups[] = {
289 &rio_dev_group,
290 NULL,
291};
292
293static ssize_t bus_scan_store(struct bus_type *bus, const char *buf,
294 size_t count)
295{
296 long val;
297 int rc;
298
299 if (kstrtol(buf, 0, &val) < 0)
300 return -EINVAL;
301
302 if (val == RIO_MPORT_ANY) {
303 rc = rio_init_mports();
304 goto exit;
305 }
306
307 if (val < 0 || val >= RIO_MAX_MPORTS)
308 return -EINVAL;
309
310 rc = rio_mport_scan((int)val);
311exit:
312 if (!rc)
313 rc = count;
314
315 return rc;
316}
317static BUS_ATTR(scan, (S_IWUSR|S_IWGRP), NULL, bus_scan_store);
318
319static struct attribute *rio_bus_attrs[] = {
320 &bus_attr_scan.attr,
321 NULL,
322};
323
324static const struct attribute_group rio_bus_group = {
325 .attrs = rio_bus_attrs,
326};
327
328const struct attribute_group *rio_bus_groups[] = {
329 &rio_bus_group,
330 NULL,
331};
332
333static ssize_t
334port_destid_show(struct device *dev, struct device_attribute *attr,
335 char *buf)
336{
337 struct rio_mport *mport = to_rio_mport(dev);
338
339 if (mport)
340 return sprintf(buf, "0x%04x\n", mport->host_deviceid);
341 else
342 return -ENODEV;
343}
344static DEVICE_ATTR_RO(port_destid);
345
346static ssize_t sys_size_show(struct device *dev, struct device_attribute *attr,
347 char *buf)
348{
349 struct rio_mport *mport = to_rio_mport(dev);
350
351 if (mport)
352 return sprintf(buf, "%u\n", mport->sys_size);
353 else
354 return -ENODEV;
355}
356static DEVICE_ATTR_RO(sys_size);
357
358static struct attribute *rio_mport_attrs[] = {
359 &dev_attr_port_destid.attr,
360 &dev_attr_sys_size.attr,
361 NULL,
362};
363
364static const struct attribute_group rio_mport_group = {
365 .attrs = rio_mport_attrs,
366};
367
368const struct attribute_group *rio_mport_groups[] = {
369 &rio_mport_group,
370 NULL,
371};
372
