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