1 /*
2  * Copyright (c) 2004, 2005 Topspin Communications.  All rights reserved.
3  * Copyright (c) 2005 Mellanox Technologies Ltd.  All rights reserved.
4  * Copyright (c) 2005 Sun Microsystems, Inc. All rights reserved.
5  *
6  * This software is available to you under a choice of one of two
7  * licenses.  You may choose to be licensed under the terms of the GNU
8  * General Public License (GPL) Version 2, available from the file
9  * COPYING in the main directory of this source tree, or the
10  * OpenIB.org BSD license below:
11  *
12  *     Redistribution and use in source and binary forms, with or
13  *     without modification, are permitted provided that the following
14  *     conditions are met:
15  *
16  *      - Redistributions of source code must retain the above
17  *        copyright notice, this list of conditions and the following
18  *        disclaimer.
19  *
20  *      - Redistributions in binary form must reproduce the above
21  *        copyright notice, this list of conditions and the following
22  *        disclaimer in the documentation and/or other materials
23  *        provided with the distribution.
24  *
25  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
26  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
27  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
28  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
29  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
30  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
31  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
32  * SOFTWARE.
33  */
34 
35 #include "core_priv.h"
36 
37 #include <linux/slab.h>
38 #include <linux/stat.h>
39 #include <linux/string.h>
40 #include <linux/netdevice.h>
41 #include <linux/ethtool.h>
42 
43 #include <rdma/ib_mad.h>
44 #include <rdma/ib_pma.h>
45 #include <rdma/ib_cache.h>
46 #include <rdma/rdma_counter.h>
47 #include <rdma/ib_sysfs.h>
48 
49 struct port_table_attribute {
50 	struct ib_port_attribute attr;
51 	char			name[8];
52 	int			index;
53 	__be16			attr_id;
54 };
55 
56 struct gid_attr_group {
57 	struct ib_port *port;
58 	struct kobject kobj;
59 	struct attribute_group groups[2];
60 	const struct attribute_group *groups_list[3];
61 	struct port_table_attribute attrs_list[];
62 };
63 
64 struct ib_port {
65 	struct kobject kobj;
66 	struct ib_device *ibdev;
67 	struct gid_attr_group *gid_attr_group;
68 	struct hw_stats_port_data *hw_stats_data;
69 
70 	struct attribute_group groups[3];
71 	const struct attribute_group *groups_list[5];
72 	u32 port_num;
73 	struct port_table_attribute attrs_list[];
74 };
75 
76 struct hw_stats_device_attribute {
77 	struct device_attribute attr;
78 	ssize_t (*show)(struct ib_device *ibdev, struct rdma_hw_stats *stats,
79 			unsigned int index, unsigned int port_num, char *buf);
80 	ssize_t (*store)(struct ib_device *ibdev, struct rdma_hw_stats *stats,
81 			 unsigned int index, unsigned int port_num,
82 			 const char *buf, size_t count);
83 };
84 
85 struct hw_stats_port_attribute {
86 	struct ib_port_attribute attr;
87 	ssize_t (*show)(struct ib_device *ibdev, struct rdma_hw_stats *stats,
88 			unsigned int index, unsigned int port_num, char *buf);
89 	ssize_t (*store)(struct ib_device *ibdev, struct rdma_hw_stats *stats,
90 			 unsigned int index, unsigned int port_num,
91 			 const char *buf, size_t count);
92 };
93 
94 struct hw_stats_device_data {
95 	struct attribute_group group;
96 	struct rdma_hw_stats *stats;
97 	struct hw_stats_device_attribute attrs[];
98 };
99 
100 struct hw_stats_port_data {
101 	struct rdma_hw_stats *stats;
102 	struct hw_stats_port_attribute attrs[];
103 };
104 
105 static ssize_t port_attr_show(struct kobject *kobj,
106 			      struct attribute *attr, char *buf)
107 {
108 	struct ib_port_attribute *port_attr =
109 		container_of(attr, struct ib_port_attribute, attr);
110 	struct ib_port *p = container_of(kobj, struct ib_port, kobj);
111 
112 	if (!port_attr->show)
113 		return -EIO;
114 
115 	return port_attr->show(p->ibdev, p->port_num, port_attr, buf);
116 }
117 
118 static ssize_t port_attr_store(struct kobject *kobj,
119 			       struct attribute *attr,
120 			       const char *buf, size_t count)
121 {
122 	struct ib_port_attribute *port_attr =
123 		container_of(attr, struct ib_port_attribute, attr);
124 	struct ib_port *p = container_of(kobj, struct ib_port, kobj);
125 
126 	if (!port_attr->store)
127 		return -EIO;
128 	return port_attr->store(p->ibdev, p->port_num, port_attr, buf, count);
129 }
130 
131 struct ib_device *ib_port_sysfs_get_ibdev_kobj(struct kobject *kobj,
132 					       u32 *port_num)
133 {
134 	struct ib_port *port = container_of(kobj, struct ib_port, kobj);
135 
136 	*port_num = port->port_num;
137 	return port->ibdev;
138 }
139 EXPORT_SYMBOL(ib_port_sysfs_get_ibdev_kobj);
140 
141 static const struct sysfs_ops port_sysfs_ops = {
142 	.show	= port_attr_show,
143 	.store	= port_attr_store
144 };
145 
146 static ssize_t hw_stat_device_show(struct device *dev,
147 				   struct device_attribute *attr, char *buf)
148 {
149 	struct hw_stats_device_attribute *stat_attr =
150 		container_of(attr, struct hw_stats_device_attribute, attr);
151 	struct ib_device *ibdev = container_of(dev, struct ib_device, dev);
152 
153 	return stat_attr->show(ibdev, ibdev->hw_stats_data->stats,
154 			       stat_attr - ibdev->hw_stats_data->attrs, 0, buf);
155 }
156 
157 static ssize_t hw_stat_device_store(struct device *dev,
158 				    struct device_attribute *attr,
159 				    const char *buf, size_t count)
160 {
161 	struct hw_stats_device_attribute *stat_attr =
162 		container_of(attr, struct hw_stats_device_attribute, attr);
163 	struct ib_device *ibdev = container_of(dev, struct ib_device, dev);
164 
165 	return stat_attr->store(ibdev, ibdev->hw_stats_data->stats,
166 				stat_attr - ibdev->hw_stats_data->attrs, 0, buf,
167 				count);
168 }
169 
170 static ssize_t hw_stat_port_show(struct ib_device *ibdev, u32 port_num,
171 				 struct ib_port_attribute *attr, char *buf)
172 {
173 	struct hw_stats_port_attribute *stat_attr =
174 		container_of(attr, struct hw_stats_port_attribute, attr);
175 	struct ib_port *port = ibdev->port_data[port_num].sysfs;
176 
177 	return stat_attr->show(ibdev, port->hw_stats_data->stats,
178 			       stat_attr - port->hw_stats_data->attrs,
179 			       port->port_num, buf);
180 }
181 
182 static ssize_t hw_stat_port_store(struct ib_device *ibdev, u32 port_num,
183 				  struct ib_port_attribute *attr,
184 				  const char *buf, size_t count)
185 {
186 	struct hw_stats_port_attribute *stat_attr =
187 		container_of(attr, struct hw_stats_port_attribute, attr);
188 	struct ib_port *port = ibdev->port_data[port_num].sysfs;
189 
190 	return stat_attr->store(ibdev, port->hw_stats_data->stats,
191 				stat_attr - port->hw_stats_data->attrs,
192 				port->port_num, buf, count);
193 }
194 
195 static ssize_t gid_attr_show(struct kobject *kobj,
196 			     struct attribute *attr, char *buf)
197 {
198 	struct ib_port_attribute *port_attr =
199 		container_of(attr, struct ib_port_attribute, attr);
200 	struct ib_port *p = container_of(kobj, struct gid_attr_group,
201 					 kobj)->port;
202 
203 	if (!port_attr->show)
204 		return -EIO;
205 
206 	return port_attr->show(p->ibdev, p->port_num, port_attr, buf);
207 }
208 
209 static const struct sysfs_ops gid_attr_sysfs_ops = {
210 	.show = gid_attr_show
211 };
212 
213 static ssize_t state_show(struct ib_device *ibdev, u32 port_num,
214 			  struct ib_port_attribute *unused, char *buf)
215 {
216 	struct ib_port_attr attr;
217 	ssize_t ret;
218 
219 	ret = ib_query_port(ibdev, port_num, &attr);
220 	if (ret)
221 		return ret;
222 
223 	return sysfs_emit(buf, "%d: %s\n", attr.state,
224 			  ib_port_state_to_str(attr.state));
225 }
226 
227 static ssize_t lid_show(struct ib_device *ibdev, u32 port_num,
228 			struct ib_port_attribute *unused, char *buf)
229 {
230 	struct ib_port_attr attr;
231 	ssize_t ret;
232 
233 	ret = ib_query_port(ibdev, port_num, &attr);
234 	if (ret)
235 		return ret;
236 
237 	return sysfs_emit(buf, "0x%x\n", attr.lid);
238 }
239 
240 static ssize_t lid_mask_count_show(struct ib_device *ibdev, u32 port_num,
241 				   struct ib_port_attribute *unused, char *buf)
242 {
243 	struct ib_port_attr attr;
244 	ssize_t ret;
245 
246 	ret = ib_query_port(ibdev, port_num, &attr);
247 	if (ret)
248 		return ret;
249 
250 	return sysfs_emit(buf, "%u\n", attr.lmc);
251 }
252 
253 static ssize_t sm_lid_show(struct ib_device *ibdev, u32 port_num,
254 			   struct ib_port_attribute *unused, char *buf)
255 {
256 	struct ib_port_attr attr;
257 	ssize_t ret;
258 
259 	ret = ib_query_port(ibdev, port_num, &attr);
260 	if (ret)
261 		return ret;
262 
263 	return sysfs_emit(buf, "0x%x\n", attr.sm_lid);
264 }
265 
266 static ssize_t sm_sl_show(struct ib_device *ibdev, u32 port_num,
267 			  struct ib_port_attribute *unused, char *buf)
268 {
269 	struct ib_port_attr attr;
270 	ssize_t ret;
271 
272 	ret = ib_query_port(ibdev, port_num, &attr);
273 	if (ret)
274 		return ret;
275 
276 	return sysfs_emit(buf, "%u\n", attr.sm_sl);
277 }
278 
279 static ssize_t cap_mask_show(struct ib_device *ibdev, u32 port_num,
280 			     struct ib_port_attribute *unused, char *buf)
281 {
282 	struct ib_port_attr attr;
283 	ssize_t ret;
284 
285 	ret = ib_query_port(ibdev, port_num, &attr);
286 	if (ret)
287 		return ret;
288 
289 	return sysfs_emit(buf, "0x%08x\n", attr.port_cap_flags);
290 }
291 
292 static ssize_t rate_show(struct ib_device *ibdev, u32 port_num,
293 			 struct ib_port_attribute *unused, char *buf)
294 {
295 	struct ib_port_attr attr;
296 	char *speed = "";
297 	int rate;		/* in deci-Gb/sec */
298 	ssize_t ret;
299 
300 	ret = ib_query_port(ibdev, port_num, &attr);
301 	if (ret)
302 		return ret;
303 
304 	switch (attr.active_speed) {
305 	case IB_SPEED_DDR:
306 		speed = " DDR";
307 		rate = 50;
308 		break;
309 	case IB_SPEED_QDR:
310 		speed = " QDR";
311 		rate = 100;
312 		break;
313 	case IB_SPEED_FDR10:
314 		speed = " FDR10";
315 		rate = 100;
316 		break;
317 	case IB_SPEED_FDR:
318 		speed = " FDR";
319 		rate = 140;
320 		break;
321 	case IB_SPEED_EDR:
322 		speed = " EDR";
323 		rate = 250;
324 		break;
325 	case IB_SPEED_HDR:
326 		speed = " HDR";
327 		rate = 500;
328 		break;
329 	case IB_SPEED_NDR:
330 		speed = " NDR";
331 		rate = 1000;
332 		break;
333 	case IB_SPEED_XDR:
334 		speed = " XDR";
335 		rate = 2000;
336 		break;
337 	case IB_SPEED_SDR:
338 	default:		/* default to SDR for invalid rates */
339 		speed = " SDR";
340 		rate = 25;
341 		break;
342 	}
343 
344 	rate *= ib_width_enum_to_int(attr.active_width);
345 	if (rate < 0)
346 		return -EINVAL;
347 
348 	return sysfs_emit(buf, "%d%s Gb/sec (%dX%s)\n", rate / 10,
349 			  rate % 10 ? ".5" : "",
350 			  ib_width_enum_to_int(attr.active_width), speed);
351 }
352 
353 static const char *phys_state_to_str(enum ib_port_phys_state phys_state)
354 {
355 	static const char *phys_state_str[] = {
356 		"<unknown>",
357 		"Sleep",
358 		"Polling",
359 		"Disabled",
360 		"PortConfigurationTraining",
361 		"LinkUp",
362 		"LinkErrorRecovery",
363 		"Phy Test",
364 	};
365 
366 	if (phys_state < ARRAY_SIZE(phys_state_str))
367 		return phys_state_str[phys_state];
368 	return "<unknown>";
369 }
370 
371 static ssize_t phys_state_show(struct ib_device *ibdev, u32 port_num,
372 			       struct ib_port_attribute *unused, char *buf)
373 {
374 	struct ib_port_attr attr;
375 
376 	ssize_t ret;
377 
378 	ret = ib_query_port(ibdev, port_num, &attr);
379 	if (ret)
380 		return ret;
381 
382 	return sysfs_emit(buf, "%u: %s\n", attr.phys_state,
383 			  phys_state_to_str(attr.phys_state));
384 }
385 
386 static ssize_t link_layer_show(struct ib_device *ibdev, u32 port_num,
387 			       struct ib_port_attribute *unused, char *buf)
388 {
389 	const char *output;
390 
391 	switch (rdma_port_get_link_layer(ibdev, port_num)) {
392 	case IB_LINK_LAYER_INFINIBAND:
393 		output = "InfiniBand";
394 		break;
395 	case IB_LINK_LAYER_ETHERNET:
396 		output = "Ethernet";
397 		break;
398 	default:
399 		output = "Unknown";
400 		break;
401 	}
402 
403 	return sysfs_emit(buf, "%s\n", output);
404 }
405 
406 static IB_PORT_ATTR_RO(state);
407 static IB_PORT_ATTR_RO(lid);
408 static IB_PORT_ATTR_RO(lid_mask_count);
409 static IB_PORT_ATTR_RO(sm_lid);
410 static IB_PORT_ATTR_RO(sm_sl);
411 static IB_PORT_ATTR_RO(cap_mask);
412 static IB_PORT_ATTR_RO(rate);
413 static IB_PORT_ATTR_RO(phys_state);
414 static IB_PORT_ATTR_RO(link_layer);
415 
416 static struct attribute *port_default_attrs[] = {
417 	&ib_port_attr_state.attr,
418 	&ib_port_attr_lid.attr,
419 	&ib_port_attr_lid_mask_count.attr,
420 	&ib_port_attr_sm_lid.attr,
421 	&ib_port_attr_sm_sl.attr,
422 	&ib_port_attr_cap_mask.attr,
423 	&ib_port_attr_rate.attr,
424 	&ib_port_attr_phys_state.attr,
425 	&ib_port_attr_link_layer.attr,
426 	NULL
427 };
428 ATTRIBUTE_GROUPS(port_default);
429 
430 static ssize_t print_ndev(const struct ib_gid_attr *gid_attr, char *buf)
431 {
432 	struct net_device *ndev;
433 	int ret = -EINVAL;
434 
435 	rcu_read_lock();
436 	ndev = rcu_dereference(gid_attr->ndev);
437 	if (ndev)
438 		ret = sysfs_emit(buf, "%s\n", ndev->name);
439 	rcu_read_unlock();
440 	return ret;
441 }
442 
443 static ssize_t print_gid_type(const struct ib_gid_attr *gid_attr, char *buf)
444 {
445 	return sysfs_emit(buf, "%s\n",
446 			  ib_cache_gid_type_str(gid_attr->gid_type));
447 }
448 
449 static ssize_t _show_port_gid_attr(
450 	struct ib_device *ibdev, u32 port_num, struct ib_port_attribute *attr,
451 	char *buf,
452 	ssize_t (*print)(const struct ib_gid_attr *gid_attr, char *buf))
453 {
454 	struct port_table_attribute *tab_attr =
455 		container_of(attr, struct port_table_attribute, attr);
456 	const struct ib_gid_attr *gid_attr;
457 	ssize_t ret;
458 
459 	gid_attr = rdma_get_gid_attr(ibdev, port_num, tab_attr->index);
460 	if (IS_ERR(gid_attr))
461 		/* -EINVAL is returned for user space compatibility reasons. */
462 		return -EINVAL;
463 
464 	ret = print(gid_attr, buf);
465 	rdma_put_gid_attr(gid_attr);
466 	return ret;
467 }
468 
469 static ssize_t show_port_gid(struct ib_device *ibdev, u32 port_num,
470 			     struct ib_port_attribute *attr, char *buf)
471 {
472 	struct port_table_attribute *tab_attr =
473 		container_of(attr, struct port_table_attribute, attr);
474 	const struct ib_gid_attr *gid_attr;
475 	int len;
476 
477 	gid_attr = rdma_get_gid_attr(ibdev, port_num, tab_attr->index);
478 	if (IS_ERR(gid_attr)) {
479 		const union ib_gid zgid = {};
480 
481 		/* If reading GID fails, it is likely due to GID entry being
482 		 * empty (invalid) or reserved GID in the table.  User space
483 		 * expects to read GID table entries as long as it given index
484 		 * is within GID table size.  Administrative/debugging tool
485 		 * fails to query rest of the GID entries if it hits error
486 		 * while querying a GID of the given index.  To avoid user
487 		 * space throwing such error on fail to read gid, return zero
488 		 * GID as before. This maintains backward compatibility.
489 		 */
490 		return sysfs_emit(buf, "%pI6\n", zgid.raw);
491 	}
492 
493 	len = sysfs_emit(buf, "%pI6\n", gid_attr->gid.raw);
494 	rdma_put_gid_attr(gid_attr);
495 	return len;
496 }
497 
498 static ssize_t show_port_gid_attr_ndev(struct ib_device *ibdev, u32 port_num,
499 				       struct ib_port_attribute *attr,
500 				       char *buf)
501 {
502 	return _show_port_gid_attr(ibdev, port_num, attr, buf, print_ndev);
503 }
504 
505 static ssize_t show_port_gid_attr_gid_type(struct ib_device *ibdev,
506 					   u32 port_num,
507 					   struct ib_port_attribute *attr,
508 					   char *buf)
509 {
510 	return _show_port_gid_attr(ibdev, port_num, attr, buf, print_gid_type);
511 }
512 
513 static ssize_t show_port_pkey(struct ib_device *ibdev, u32 port_num,
514 			      struct ib_port_attribute *attr, char *buf)
515 {
516 	struct port_table_attribute *tab_attr =
517 		container_of(attr, struct port_table_attribute, attr);
518 	u16 pkey;
519 	int ret;
520 
521 	ret = ib_query_pkey(ibdev, port_num, tab_attr->index, &pkey);
522 	if (ret)
523 		return ret;
524 
525 	return sysfs_emit(buf, "0x%04x\n", pkey);
526 }
527 
528 #define PORT_PMA_ATTR(_name, _counter, _width, _offset)			\
529 struct port_table_attribute port_pma_attr_##_name = {			\
530 	.attr  = __ATTR(_name, S_IRUGO, show_pma_counter, NULL),	\
531 	.index = (_offset) | ((_width) << 16) | ((_counter) << 24),	\
532 	.attr_id = IB_PMA_PORT_COUNTERS,				\
533 }
534 
535 #define PORT_PMA_ATTR_EXT(_name, _width, _offset)			\
536 struct port_table_attribute port_pma_attr_ext_##_name = {		\
537 	.attr  = __ATTR(_name, S_IRUGO, show_pma_counter, NULL),	\
538 	.index = (_offset) | ((_width) << 16),				\
539 	.attr_id = IB_PMA_PORT_COUNTERS_EXT,				\
540 }
541 
542 /*
543  * Get a Perfmgmt MAD block of data.
544  * Returns error code or the number of bytes retrieved.
545  */
546 static int get_perf_mad(struct ib_device *dev, int port_num, __be16 attr,
547 		void *data, int offset, size_t size)
548 {
549 	struct ib_mad *in_mad;
550 	struct ib_mad *out_mad;
551 	size_t mad_size = sizeof(*out_mad);
552 	u16 out_mad_pkey_index = 0;
553 	ssize_t ret;
554 
555 	if (!dev->ops.process_mad)
556 		return -ENOSYS;
557 
558 	in_mad = kzalloc(sizeof(*in_mad), GFP_KERNEL);
559 	out_mad = kzalloc(sizeof(*out_mad), GFP_KERNEL);
560 	if (!in_mad || !out_mad) {
561 		ret = -ENOMEM;
562 		goto out;
563 	}
564 
565 	in_mad->mad_hdr.base_version  = 1;
566 	in_mad->mad_hdr.mgmt_class    = IB_MGMT_CLASS_PERF_MGMT;
567 	in_mad->mad_hdr.class_version = 1;
568 	in_mad->mad_hdr.method        = IB_MGMT_METHOD_GET;
569 	in_mad->mad_hdr.attr_id       = attr;
570 
571 	if (attr != IB_PMA_CLASS_PORT_INFO)
572 		in_mad->data[41] = port_num;	/* PortSelect field */
573 
574 	if ((dev->ops.process_mad(dev, IB_MAD_IGNORE_MKEY, port_num, NULL, NULL,
575 				  in_mad, out_mad, &mad_size,
576 				  &out_mad_pkey_index) &
577 	     (IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_REPLY)) !=
578 	    (IB_MAD_RESULT_SUCCESS | IB_MAD_RESULT_REPLY)) {
579 		ret = -EINVAL;
580 		goto out;
581 	}
582 	memcpy(data, out_mad->data + offset, size);
583 	ret = size;
584 out:
585 	kfree(in_mad);
586 	kfree(out_mad);
587 	return ret;
588 }
589 
590 static ssize_t show_pma_counter(struct ib_device *ibdev, u32 port_num,
591 				struct ib_port_attribute *attr, char *buf)
592 {
593 	struct port_table_attribute *tab_attr =
594 		container_of(attr, struct port_table_attribute, attr);
595 	int offset = tab_attr->index & 0xffff;
596 	int width  = (tab_attr->index >> 16) & 0xff;
597 	int ret;
598 	u8 data[8];
599 	int len;
600 
601 	ret = get_perf_mad(ibdev, port_num, tab_attr->attr_id, &data,
602 			40 + offset / 8, sizeof(data));
603 	if (ret < 0)
604 		return ret;
605 
606 	switch (width) {
607 	case 4:
608 		len = sysfs_emit(buf, "%d\n",
609 				 (*data >> (4 - (offset % 8))) & 0xf);
610 		break;
611 	case 8:
612 		len = sysfs_emit(buf, "%u\n", *data);
613 		break;
614 	case 16:
615 		len = sysfs_emit(buf, "%u\n", be16_to_cpup((__be16 *)data));
616 		break;
617 	case 32:
618 		len = sysfs_emit(buf, "%u\n", be32_to_cpup((__be32 *)data));
619 		break;
620 	case 64:
621 		len = sysfs_emit(buf, "%llu\n", be64_to_cpup((__be64 *)data));
622 		break;
623 	default:
624 		len = 0;
625 		break;
626 	}
627 
628 	return len;
629 }
630 
631 static PORT_PMA_ATTR(symbol_error		    ,  0, 16,  32);
632 static PORT_PMA_ATTR(link_error_recovery	    ,  1,  8,  48);
633 static PORT_PMA_ATTR(link_downed		    ,  2,  8,  56);
634 static PORT_PMA_ATTR(port_rcv_errors		    ,  3, 16,  64);
635 static PORT_PMA_ATTR(port_rcv_remote_physical_errors,  4, 16,  80);
636 static PORT_PMA_ATTR(port_rcv_switch_relay_errors   ,  5, 16,  96);
637 static PORT_PMA_ATTR(port_xmit_discards		    ,  6, 16, 112);
638 static PORT_PMA_ATTR(port_xmit_constraint_errors    ,  7,  8, 128);
639 static PORT_PMA_ATTR(port_rcv_constraint_errors	    ,  8,  8, 136);
640 static PORT_PMA_ATTR(local_link_integrity_errors    ,  9,  4, 152);
641 static PORT_PMA_ATTR(excessive_buffer_overrun_errors, 10,  4, 156);
642 static PORT_PMA_ATTR(VL15_dropped		    , 11, 16, 176);
643 static PORT_PMA_ATTR(port_xmit_data		    , 12, 32, 192);
644 static PORT_PMA_ATTR(port_rcv_data		    , 13, 32, 224);
645 static PORT_PMA_ATTR(port_xmit_packets		    , 14, 32, 256);
646 static PORT_PMA_ATTR(port_rcv_packets		    , 15, 32, 288);
647 static PORT_PMA_ATTR(port_xmit_wait		    ,  0, 32, 320);
648 
649 /*
650  * Counters added by extended set
651  */
652 static PORT_PMA_ATTR_EXT(port_xmit_data		    , 64,  64);
653 static PORT_PMA_ATTR_EXT(port_rcv_data		    , 64, 128);
654 static PORT_PMA_ATTR_EXT(port_xmit_packets	    , 64, 192);
655 static PORT_PMA_ATTR_EXT(port_rcv_packets	    , 64, 256);
656 static PORT_PMA_ATTR_EXT(unicast_xmit_packets	    , 64, 320);
657 static PORT_PMA_ATTR_EXT(unicast_rcv_packets	    , 64, 384);
658 static PORT_PMA_ATTR_EXT(multicast_xmit_packets	    , 64, 448);
659 static PORT_PMA_ATTR_EXT(multicast_rcv_packets	    , 64, 512);
660 
661 static struct attribute *pma_attrs[] = {
662 	&port_pma_attr_symbol_error.attr.attr,
663 	&port_pma_attr_link_error_recovery.attr.attr,
664 	&port_pma_attr_link_downed.attr.attr,
665 	&port_pma_attr_port_rcv_errors.attr.attr,
666 	&port_pma_attr_port_rcv_remote_physical_errors.attr.attr,
667 	&port_pma_attr_port_rcv_switch_relay_errors.attr.attr,
668 	&port_pma_attr_port_xmit_discards.attr.attr,
669 	&port_pma_attr_port_xmit_constraint_errors.attr.attr,
670 	&port_pma_attr_port_rcv_constraint_errors.attr.attr,
671 	&port_pma_attr_local_link_integrity_errors.attr.attr,
672 	&port_pma_attr_excessive_buffer_overrun_errors.attr.attr,
673 	&port_pma_attr_VL15_dropped.attr.attr,
674 	&port_pma_attr_port_xmit_data.attr.attr,
675 	&port_pma_attr_port_rcv_data.attr.attr,
676 	&port_pma_attr_port_xmit_packets.attr.attr,
677 	&port_pma_attr_port_rcv_packets.attr.attr,
678 	&port_pma_attr_port_xmit_wait.attr.attr,
679 	NULL
680 };
681 
682 static struct attribute *pma_attrs_ext[] = {
683 	&port_pma_attr_symbol_error.attr.attr,
684 	&port_pma_attr_link_error_recovery.attr.attr,
685 	&port_pma_attr_link_downed.attr.attr,
686 	&port_pma_attr_port_rcv_errors.attr.attr,
687 	&port_pma_attr_port_rcv_remote_physical_errors.attr.attr,
688 	&port_pma_attr_port_rcv_switch_relay_errors.attr.attr,
689 	&port_pma_attr_port_xmit_discards.attr.attr,
690 	&port_pma_attr_port_xmit_constraint_errors.attr.attr,
691 	&port_pma_attr_port_rcv_constraint_errors.attr.attr,
692 	&port_pma_attr_local_link_integrity_errors.attr.attr,
693 	&port_pma_attr_excessive_buffer_overrun_errors.attr.attr,
694 	&port_pma_attr_VL15_dropped.attr.attr,
695 	&port_pma_attr_ext_port_xmit_data.attr.attr,
696 	&port_pma_attr_ext_port_rcv_data.attr.attr,
697 	&port_pma_attr_ext_port_xmit_packets.attr.attr,
698 	&port_pma_attr_port_xmit_wait.attr.attr,
699 	&port_pma_attr_ext_port_rcv_packets.attr.attr,
700 	&port_pma_attr_ext_unicast_rcv_packets.attr.attr,
701 	&port_pma_attr_ext_unicast_xmit_packets.attr.attr,
702 	&port_pma_attr_ext_multicast_rcv_packets.attr.attr,
703 	&port_pma_attr_ext_multicast_xmit_packets.attr.attr,
704 	NULL
705 };
706 
707 static struct attribute *pma_attrs_noietf[] = {
708 	&port_pma_attr_symbol_error.attr.attr,
709 	&port_pma_attr_link_error_recovery.attr.attr,
710 	&port_pma_attr_link_downed.attr.attr,
711 	&port_pma_attr_port_rcv_errors.attr.attr,
712 	&port_pma_attr_port_rcv_remote_physical_errors.attr.attr,
713 	&port_pma_attr_port_rcv_switch_relay_errors.attr.attr,
714 	&port_pma_attr_port_xmit_discards.attr.attr,
715 	&port_pma_attr_port_xmit_constraint_errors.attr.attr,
716 	&port_pma_attr_port_rcv_constraint_errors.attr.attr,
717 	&port_pma_attr_local_link_integrity_errors.attr.attr,
718 	&port_pma_attr_excessive_buffer_overrun_errors.attr.attr,
719 	&port_pma_attr_VL15_dropped.attr.attr,
720 	&port_pma_attr_ext_port_xmit_data.attr.attr,
721 	&port_pma_attr_ext_port_rcv_data.attr.attr,
722 	&port_pma_attr_ext_port_xmit_packets.attr.attr,
723 	&port_pma_attr_ext_port_rcv_packets.attr.attr,
724 	&port_pma_attr_port_xmit_wait.attr.attr,
725 	NULL
726 };
727 
728 static const struct attribute_group pma_group = {
729 	.name  = "counters",
730 	.attrs  = pma_attrs
731 };
732 
733 static const struct attribute_group pma_group_ext = {
734 	.name  = "counters",
735 	.attrs  = pma_attrs_ext
736 };
737 
738 static const struct attribute_group pma_group_noietf = {
739 	.name  = "counters",
740 	.attrs  = pma_attrs_noietf
741 };
742 
743 static void ib_port_release(struct kobject *kobj)
744 {
745 	struct ib_port *port = container_of(kobj, struct ib_port, kobj);
746 	int i;
747 
748 	for (i = 0; i != ARRAY_SIZE(port->groups); i++)
749 		kfree(port->groups[i].attrs);
750 	if (port->hw_stats_data)
751 		rdma_free_hw_stats_struct(port->hw_stats_data->stats);
752 	kfree(port->hw_stats_data);
753 	kvfree(port);
754 }
755 
756 static void ib_port_gid_attr_release(struct kobject *kobj)
757 {
758 	struct gid_attr_group *gid_attr_group =
759 		container_of(kobj, struct gid_attr_group, kobj);
760 	int i;
761 
762 	for (i = 0; i != ARRAY_SIZE(gid_attr_group->groups); i++)
763 		kfree(gid_attr_group->groups[i].attrs);
764 	kfree(gid_attr_group);
765 }
766 
767 static struct kobj_type port_type = {
768 	.release       = ib_port_release,
769 	.sysfs_ops     = &port_sysfs_ops,
770 	.default_groups = port_default_groups,
771 };
772 
773 static struct kobj_type gid_attr_type = {
774 	.sysfs_ops      = &gid_attr_sysfs_ops,
775 	.release        = ib_port_gid_attr_release
776 };
777 
778 /*
779  * Figure out which counter table to use depending on
780  * the device capabilities.
781  */
782 static const struct attribute_group *get_counter_table(struct ib_device *dev,
783 						       int port_num)
784 {
785 	struct ib_class_port_info cpi;
786 
787 	if (get_perf_mad(dev, port_num, IB_PMA_CLASS_PORT_INFO,
788 				&cpi, 40, sizeof(cpi)) >= 0) {
789 		if (cpi.capability_mask & IB_PMA_CLASS_CAP_EXT_WIDTH)
790 			/* We have extended counters */
791 			return &pma_group_ext;
792 
793 		if (cpi.capability_mask & IB_PMA_CLASS_CAP_EXT_WIDTH_NOIETF)
794 			/* But not the IETF ones */
795 			return &pma_group_noietf;
796 	}
797 
798 	/* Fall back to normal counters */
799 	return &pma_group;
800 }
801 
802 static int update_hw_stats(struct ib_device *dev, struct rdma_hw_stats *stats,
803 			   u32 port_num, int index)
804 {
805 	int ret;
806 
807 	if (time_is_after_eq_jiffies(stats->timestamp + stats->lifespan))
808 		return 0;
809 	ret = dev->ops.get_hw_stats(dev, stats, port_num, index);
810 	if (ret < 0)
811 		return ret;
812 	if (ret == stats->num_counters)
813 		stats->timestamp = jiffies;
814 
815 	return 0;
816 }
817 
818 static int print_hw_stat(struct ib_device *dev, int port_num,
819 			 struct rdma_hw_stats *stats, int index, char *buf)
820 {
821 	u64 v = rdma_counter_get_hwstat_value(dev, port_num, index);
822 
823 	return sysfs_emit(buf, "%llu\n", stats->value[index] + v);
824 }
825 
826 static ssize_t show_hw_stats(struct ib_device *ibdev,
827 			     struct rdma_hw_stats *stats, unsigned int index,
828 			     unsigned int port_num, char *buf)
829 {
830 	int ret;
831 
832 	mutex_lock(&stats->lock);
833 	ret = update_hw_stats(ibdev, stats, port_num, index);
834 	if (ret)
835 		goto unlock;
836 	ret = print_hw_stat(ibdev, port_num, stats, index, buf);
837 unlock:
838 	mutex_unlock(&stats->lock);
839 
840 	return ret;
841 }
842 
843 static ssize_t show_stats_lifespan(struct ib_device *ibdev,
844 				   struct rdma_hw_stats *stats,
845 				   unsigned int index, unsigned int port_num,
846 				   char *buf)
847 {
848 	int msecs;
849 
850 	mutex_lock(&stats->lock);
851 	msecs = jiffies_to_msecs(stats->lifespan);
852 	mutex_unlock(&stats->lock);
853 
854 	return sysfs_emit(buf, "%d\n", msecs);
855 }
856 
857 static ssize_t set_stats_lifespan(struct ib_device *ibdev,
858 				   struct rdma_hw_stats *stats,
859 				   unsigned int index, unsigned int port_num,
860 				   const char *buf, size_t count)
861 {
862 	int msecs;
863 	int jiffies;
864 	int ret;
865 
866 	ret = kstrtoint(buf, 10, &msecs);
867 	if (ret)
868 		return ret;
869 	if (msecs < 0 || msecs > 10000)
870 		return -EINVAL;
871 	jiffies = msecs_to_jiffies(msecs);
872 
873 	mutex_lock(&stats->lock);
874 	stats->lifespan = jiffies;
875 	mutex_unlock(&stats->lock);
876 
877 	return count;
878 }
879 
880 static struct hw_stats_device_data *
881 alloc_hw_stats_device(struct ib_device *ibdev)
882 {
883 	struct hw_stats_device_data *data;
884 	struct rdma_hw_stats *stats;
885 
886 	if (!ibdev->ops.alloc_hw_device_stats)
887 		return ERR_PTR(-EOPNOTSUPP);
888 	stats = ibdev->ops.alloc_hw_device_stats(ibdev);
889 	if (!stats)
890 		return ERR_PTR(-ENOMEM);
891 	if (!stats->descs || stats->num_counters <= 0)
892 		goto err_free_stats;
893 
894 	/*
895 	 * Two extra attribue elements here, one for the lifespan entry and
896 	 * one to NULL terminate the list for the sysfs core code
897 	 */
898 	data = kzalloc(struct_size(data, attrs, size_add(stats->num_counters, 1)),
899 		       GFP_KERNEL);
900 	if (!data)
901 		goto err_free_stats;
902 	data->group.attrs = kcalloc(stats->num_counters + 2,
903 				    sizeof(*data->group.attrs), GFP_KERNEL);
904 	if (!data->group.attrs)
905 		goto err_free_data;
906 
907 	data->group.name = "hw_counters";
908 	data->stats = stats;
909 	return data;
910 
911 err_free_data:
912 	kfree(data);
913 err_free_stats:
914 	rdma_free_hw_stats_struct(stats);
915 	return ERR_PTR(-ENOMEM);
916 }
917 
918 void ib_device_release_hw_stats(struct hw_stats_device_data *data)
919 {
920 	kfree(data->group.attrs);
921 	rdma_free_hw_stats_struct(data->stats);
922 	kfree(data);
923 }
924 
925 int ib_setup_device_attrs(struct ib_device *ibdev)
926 {
927 	struct hw_stats_device_attribute *attr;
928 	struct hw_stats_device_data *data;
929 	bool opstat_skipped = false;
930 	int i, ret, pos = 0;
931 
932 	data = alloc_hw_stats_device(ibdev);
933 	if (IS_ERR(data)) {
934 		if (PTR_ERR(data) == -EOPNOTSUPP)
935 			return 0;
936 		return PTR_ERR(data);
937 	}
938 	ibdev->hw_stats_data = data;
939 
940 	ret = ibdev->ops.get_hw_stats(ibdev, data->stats, 0,
941 				      data->stats->num_counters);
942 	if (ret != data->stats->num_counters) {
943 		if (WARN_ON(ret >= 0))
944 			return -EINVAL;
945 		return ret;
946 	}
947 
948 	data->stats->timestamp = jiffies;
949 
950 	for (i = 0; i < data->stats->num_counters; i++) {
951 		if (data->stats->descs[i].flags & IB_STAT_FLAG_OPTIONAL) {
952 			opstat_skipped = true;
953 			continue;
954 		}
955 
956 		WARN_ON(opstat_skipped);
957 		attr = &data->attrs[pos];
958 		sysfs_attr_init(&attr->attr.attr);
959 		attr->attr.attr.name = data->stats->descs[i].name;
960 		attr->attr.attr.mode = 0444;
961 		attr->attr.show = hw_stat_device_show;
962 		attr->show = show_hw_stats;
963 		data->group.attrs[pos] = &attr->attr.attr;
964 		pos++;
965 	}
966 
967 	attr = &data->attrs[pos];
968 	sysfs_attr_init(&attr->attr.attr);
969 	attr->attr.attr.name = "lifespan";
970 	attr->attr.attr.mode = 0644;
971 	attr->attr.show = hw_stat_device_show;
972 	attr->show = show_stats_lifespan;
973 	attr->attr.store = hw_stat_device_store;
974 	attr->store = set_stats_lifespan;
975 	data->group.attrs[pos] = &attr->attr.attr;
976 	for (i = 0; i != ARRAY_SIZE(ibdev->groups); i++)
977 		if (!ibdev->groups[i]) {
978 			ibdev->groups[i] = &data->group;
979 			ibdev->hw_stats_attr_index = i;
980 			return 0;
981 		}
982 	WARN(true, "struct ib_device->groups is too small");
983 	return -EINVAL;
984 }
985 
986 static struct hw_stats_port_data *
987 alloc_hw_stats_port(struct ib_port *port, struct attribute_group *group)
988 {
989 	struct ib_device *ibdev = port->ibdev;
990 	struct hw_stats_port_data *data;
991 	struct rdma_hw_stats *stats;
992 
993 	if (!ibdev->ops.alloc_hw_port_stats)
994 		return ERR_PTR(-EOPNOTSUPP);
995 	stats = ibdev->ops.alloc_hw_port_stats(port->ibdev, port->port_num);
996 	if (!stats)
997 		return ERR_PTR(-ENOMEM);
998 	if (!stats->descs || stats->num_counters <= 0)
999 		goto err_free_stats;
1000 
1001 	/*
1002 	 * Two extra attribue elements here, one for the lifespan entry and
1003 	 * one to NULL terminate the list for the sysfs core code
1004 	 */
1005 	data = kzalloc(struct_size(data, attrs, size_add(stats->num_counters, 1)),
1006 		       GFP_KERNEL);
1007 	if (!data)
1008 		goto err_free_stats;
1009 	group->attrs = kcalloc(stats->num_counters + 2,
1010 				    sizeof(*group->attrs), GFP_KERNEL);
1011 	if (!group->attrs)
1012 		goto err_free_data;
1013 
1014 	group->name = "hw_counters";
1015 	data->stats = stats;
1016 	return data;
1017 
1018 err_free_data:
1019 	kfree(data);
1020 err_free_stats:
1021 	rdma_free_hw_stats_struct(stats);
1022 	return ERR_PTR(-ENOMEM);
1023 }
1024 
1025 static int setup_hw_port_stats(struct ib_port *port,
1026 			       struct attribute_group *group)
1027 {
1028 	struct hw_stats_port_attribute *attr;
1029 	struct hw_stats_port_data *data;
1030 	bool opstat_skipped = false;
1031 	int i, ret, pos = 0;
1032 
1033 	data = alloc_hw_stats_port(port, group);
1034 	if (IS_ERR(data))
1035 		return PTR_ERR(data);
1036 
1037 	ret = port->ibdev->ops.get_hw_stats(port->ibdev, data->stats,
1038 					    port->port_num,
1039 					    data->stats->num_counters);
1040 	if (ret != data->stats->num_counters) {
1041 		if (WARN_ON(ret >= 0))
1042 			return -EINVAL;
1043 		return ret;
1044 	}
1045 
1046 	data->stats->timestamp = jiffies;
1047 
1048 	for (i = 0; i < data->stats->num_counters; i++) {
1049 		if (data->stats->descs[i].flags & IB_STAT_FLAG_OPTIONAL) {
1050 			opstat_skipped = true;
1051 			continue;
1052 		}
1053 
1054 		WARN_ON(opstat_skipped);
1055 		attr = &data->attrs[pos];
1056 		sysfs_attr_init(&attr->attr.attr);
1057 		attr->attr.attr.name = data->stats->descs[i].name;
1058 		attr->attr.attr.mode = 0444;
1059 		attr->attr.show = hw_stat_port_show;
1060 		attr->show = show_hw_stats;
1061 		group->attrs[pos] = &attr->attr.attr;
1062 		pos++;
1063 	}
1064 
1065 	attr = &data->attrs[pos];
1066 	sysfs_attr_init(&attr->attr.attr);
1067 	attr->attr.attr.name = "lifespan";
1068 	attr->attr.attr.mode = 0644;
1069 	attr->attr.show = hw_stat_port_show;
1070 	attr->show = show_stats_lifespan;
1071 	attr->attr.store = hw_stat_port_store;
1072 	attr->store = set_stats_lifespan;
1073 	group->attrs[pos] = &attr->attr.attr;
1074 
1075 	port->hw_stats_data = data;
1076 	return 0;
1077 }
1078 
1079 struct rdma_hw_stats *ib_get_hw_stats_port(struct ib_device *ibdev,
1080 					   u32 port_num)
1081 {
1082 	if (!ibdev->port_data || !rdma_is_port_valid(ibdev, port_num) ||
1083 	    !ibdev->port_data[port_num].sysfs->hw_stats_data)
1084 		return NULL;
1085 	return ibdev->port_data[port_num].sysfs->hw_stats_data->stats;
1086 }
1087 
1088 static int
1089 alloc_port_table_group(const char *name, struct attribute_group *group,
1090 		       struct port_table_attribute *attrs, size_t num,
1091 		       ssize_t (*show)(struct ib_device *ibdev, u32 port_num,
1092 				       struct ib_port_attribute *, char *buf))
1093 {
1094 	struct attribute **attr_list;
1095 	int i;
1096 
1097 	attr_list = kcalloc(num + 1, sizeof(*attr_list), GFP_KERNEL);
1098 	if (!attr_list)
1099 		return -ENOMEM;
1100 
1101 	for (i = 0; i < num; i++) {
1102 		struct port_table_attribute *element = &attrs[i];
1103 
1104 		if (snprintf(element->name, sizeof(element->name), "%d", i) >=
1105 		    sizeof(element->name))
1106 			goto err;
1107 
1108 		sysfs_attr_init(&element->attr.attr);
1109 		element->attr.attr.name = element->name;
1110 		element->attr.attr.mode = 0444;
1111 		element->attr.show = show;
1112 		element->index = i;
1113 
1114 		attr_list[i] = &element->attr.attr;
1115 	}
1116 	group->name = name;
1117 	group->attrs = attr_list;
1118 	return 0;
1119 err:
1120 	kfree(attr_list);
1121 	return -EINVAL;
1122 }
1123 
1124 /*
1125  * Create the sysfs:
1126  *  ibp0s9/ports/XX/gid_attrs/{ndevs,types}/YYY
1127  * YYY is the gid table index in decimal
1128  */
1129 static int setup_gid_attrs(struct ib_port *port,
1130 			   const struct ib_port_attr *attr)
1131 {
1132 	struct gid_attr_group *gid_attr_group;
1133 	int ret;
1134 
1135 	gid_attr_group = kzalloc(struct_size(gid_attr_group, attrs_list,
1136 					     size_mul(attr->gid_tbl_len, 2)),
1137 				 GFP_KERNEL);
1138 	if (!gid_attr_group)
1139 		return -ENOMEM;
1140 	gid_attr_group->port = port;
1141 	kobject_init(&gid_attr_group->kobj, &gid_attr_type);
1142 
1143 	ret = alloc_port_table_group("ndevs", &gid_attr_group->groups[0],
1144 				     gid_attr_group->attrs_list,
1145 				     attr->gid_tbl_len,
1146 				     show_port_gid_attr_ndev);
1147 	if (ret)
1148 		goto err_put;
1149 	gid_attr_group->groups_list[0] = &gid_attr_group->groups[0];
1150 
1151 	ret = alloc_port_table_group(
1152 		"types", &gid_attr_group->groups[1],
1153 		gid_attr_group->attrs_list + attr->gid_tbl_len,
1154 		attr->gid_tbl_len, show_port_gid_attr_gid_type);
1155 	if (ret)
1156 		goto err_put;
1157 	gid_attr_group->groups_list[1] = &gid_attr_group->groups[1];
1158 
1159 	ret = kobject_add(&gid_attr_group->kobj, &port->kobj, "gid_attrs");
1160 	if (ret)
1161 		goto err_put;
1162 	ret = sysfs_create_groups(&gid_attr_group->kobj,
1163 				  gid_attr_group->groups_list);
1164 	if (ret)
1165 		goto err_del;
1166 	port->gid_attr_group = gid_attr_group;
1167 	return 0;
1168 
1169 err_del:
1170 	kobject_del(&gid_attr_group->kobj);
1171 err_put:
1172 	kobject_put(&gid_attr_group->kobj);
1173 	return ret;
1174 }
1175 
1176 static void destroy_gid_attrs(struct ib_port *port)
1177 {
1178 	struct gid_attr_group *gid_attr_group = port->gid_attr_group;
1179 
1180 	if (!gid_attr_group)
1181 		return;
1182 	sysfs_remove_groups(&gid_attr_group->kobj, gid_attr_group->groups_list);
1183 	kobject_del(&gid_attr_group->kobj);
1184 	kobject_put(&gid_attr_group->kobj);
1185 }
1186 
1187 /*
1188  * Create the sysfs:
1189  *  ibp0s9/ports/XX/{gids,pkeys,counters}/YYY
1190  */
1191 static struct ib_port *setup_port(struct ib_core_device *coredev, int port_num,
1192 				  const struct ib_port_attr *attr)
1193 {
1194 	struct ib_device *device = rdma_device_to_ibdev(&coredev->dev);
1195 	bool is_full_dev = &device->coredev == coredev;
1196 	const struct attribute_group **cur_group;
1197 	struct ib_port *p;
1198 	int ret;
1199 
1200 	p = kvzalloc(struct_size(p, attrs_list,
1201 				size_add(attr->gid_tbl_len, attr->pkey_tbl_len)),
1202 		     GFP_KERNEL);
1203 	if (!p)
1204 		return ERR_PTR(-ENOMEM);
1205 	p->ibdev = device;
1206 	p->port_num = port_num;
1207 	kobject_init(&p->kobj, &port_type);
1208 
1209 	if (device->port_data && is_full_dev)
1210 		device->port_data[port_num].sysfs = p;
1211 
1212 	cur_group = p->groups_list;
1213 	ret = alloc_port_table_group("gids", &p->groups[0], p->attrs_list,
1214 				     attr->gid_tbl_len, show_port_gid);
1215 	if (ret)
1216 		goto err_put;
1217 	*cur_group++ = &p->groups[0];
1218 
1219 	if (attr->pkey_tbl_len) {
1220 		ret = alloc_port_table_group("pkeys", &p->groups[1],
1221 					     p->attrs_list + attr->gid_tbl_len,
1222 					     attr->pkey_tbl_len, show_port_pkey);
1223 		if (ret)
1224 			goto err_put;
1225 		*cur_group++ = &p->groups[1];
1226 	}
1227 
1228 	/*
1229 	 * If port == 0, it means hw_counters are per device and not per
1230 	 * port, so holder should be device. Therefore skip per port
1231 	 * counter initialization.
1232 	 */
1233 	if (port_num && is_full_dev) {
1234 		ret = setup_hw_port_stats(p, &p->groups[2]);
1235 		if (ret && ret != -EOPNOTSUPP)
1236 			goto err_put;
1237 		if (!ret)
1238 			*cur_group++ = &p->groups[2];
1239 	}
1240 
1241 	if (device->ops.process_mad && is_full_dev)
1242 		*cur_group++ = get_counter_table(device, port_num);
1243 
1244 	ret = kobject_add(&p->kobj, coredev->ports_kobj, "%d", port_num);
1245 	if (ret)
1246 		goto err_put;
1247 	ret = sysfs_create_groups(&p->kobj, p->groups_list);
1248 	if (ret)
1249 		goto err_del;
1250 	if (is_full_dev) {
1251 		ret = sysfs_create_groups(&p->kobj, device->ops.port_groups);
1252 		if (ret)
1253 			goto err_groups;
1254 	}
1255 
1256 	list_add_tail(&p->kobj.entry, &coredev->port_list);
1257 	return p;
1258 
1259 err_groups:
1260 	sysfs_remove_groups(&p->kobj, p->groups_list);
1261 err_del:
1262 	kobject_del(&p->kobj);
1263 err_put:
1264 	if (device->port_data && is_full_dev)
1265 		device->port_data[port_num].sysfs = NULL;
1266 	kobject_put(&p->kobj);
1267 	return ERR_PTR(ret);
1268 }
1269 
1270 static void destroy_port(struct ib_core_device *coredev, struct ib_port *port)
1271 {
1272 	bool is_full_dev = &port->ibdev->coredev == coredev;
1273 
1274 	list_del(&port->kobj.entry);
1275 	if (is_full_dev)
1276 		sysfs_remove_groups(&port->kobj, port->ibdev->ops.port_groups);
1277 
1278 	sysfs_remove_groups(&port->kobj, port->groups_list);
1279 	kobject_del(&port->kobj);
1280 
1281 	if (port->ibdev->port_data &&
1282 	    port->ibdev->port_data[port->port_num].sysfs == port)
1283 		port->ibdev->port_data[port->port_num].sysfs = NULL;
1284 
1285 	kobject_put(&port->kobj);
1286 }
1287 
1288 static const char *node_type_string(int node_type)
1289 {
1290 	switch (node_type) {
1291 	case RDMA_NODE_IB_CA:
1292 		return "CA";
1293 	case RDMA_NODE_IB_SWITCH:
1294 		return "switch";
1295 	case RDMA_NODE_IB_ROUTER:
1296 		return "router";
1297 	case RDMA_NODE_RNIC:
1298 		return "RNIC";
1299 	case RDMA_NODE_USNIC:
1300 		return "usNIC";
1301 	case RDMA_NODE_USNIC_UDP:
1302 		return "usNIC UDP";
1303 	case RDMA_NODE_UNSPECIFIED:
1304 		return "unspecified";
1305 	}
1306 	return "<unknown>";
1307 }
1308 
1309 static ssize_t node_type_show(struct device *device,
1310 			      struct device_attribute *attr, char *buf)
1311 {
1312 	struct ib_device *dev = rdma_device_to_ibdev(device);
1313 
1314 	return sysfs_emit(buf, "%u: %s\n", dev->node_type,
1315 			  node_type_string(dev->node_type));
1316 }
1317 static DEVICE_ATTR_RO(node_type);
1318 
1319 static ssize_t sys_image_guid_show(struct device *device,
1320 				   struct device_attribute *dev_attr, char *buf)
1321 {
1322 	struct ib_device *dev = rdma_device_to_ibdev(device);
1323 	__be16 *guid = (__be16 *)&dev->attrs.sys_image_guid;
1324 
1325 	return sysfs_emit(buf, "%04x:%04x:%04x:%04x\n",
1326 			  be16_to_cpu(guid[0]),
1327 			  be16_to_cpu(guid[1]),
1328 			  be16_to_cpu(guid[2]),
1329 			  be16_to_cpu(guid[3]));
1330 }
1331 static DEVICE_ATTR_RO(sys_image_guid);
1332 
1333 static ssize_t node_guid_show(struct device *device,
1334 			      struct device_attribute *attr, char *buf)
1335 {
1336 	struct ib_device *dev = rdma_device_to_ibdev(device);
1337 	__be16 *node_guid = (__be16 *)&dev->node_guid;
1338 
1339 	return sysfs_emit(buf, "%04x:%04x:%04x:%04x\n",
1340 			  be16_to_cpu(node_guid[0]),
1341 			  be16_to_cpu(node_guid[1]),
1342 			  be16_to_cpu(node_guid[2]),
1343 			  be16_to_cpu(node_guid[3]));
1344 }
1345 static DEVICE_ATTR_RO(node_guid);
1346 
1347 static ssize_t node_desc_show(struct device *device,
1348 			      struct device_attribute *attr, char *buf)
1349 {
1350 	struct ib_device *dev = rdma_device_to_ibdev(device);
1351 
1352 	return sysfs_emit(buf, "%.64s\n", dev->node_desc);
1353 }
1354 
1355 static ssize_t node_desc_store(struct device *device,
1356 			       struct device_attribute *attr,
1357 			       const char *buf, size_t count)
1358 {
1359 	struct ib_device *dev = rdma_device_to_ibdev(device);
1360 	struct ib_device_modify desc = {};
1361 	int ret;
1362 
1363 	if (!dev->ops.modify_device)
1364 		return -EOPNOTSUPP;
1365 
1366 	memcpy(desc.node_desc, buf, min_t(int, count, IB_DEVICE_NODE_DESC_MAX));
1367 	ret = ib_modify_device(dev, IB_DEVICE_MODIFY_NODE_DESC, &desc);
1368 	if (ret)
1369 		return ret;
1370 
1371 	return count;
1372 }
1373 static DEVICE_ATTR_RW(node_desc);
1374 
1375 static ssize_t fw_ver_show(struct device *device, struct device_attribute *attr,
1376 			   char *buf)
1377 {
1378 	struct ib_device *dev = rdma_device_to_ibdev(device);
1379 	char version[IB_FW_VERSION_NAME_MAX] = {};
1380 
1381 	ib_get_device_fw_str(dev, version);
1382 
1383 	return sysfs_emit(buf, "%s\n", version);
1384 }
1385 static DEVICE_ATTR_RO(fw_ver);
1386 
1387 static struct attribute *ib_dev_attrs[] = {
1388 	&dev_attr_node_type.attr,
1389 	&dev_attr_node_guid.attr,
1390 	&dev_attr_sys_image_guid.attr,
1391 	&dev_attr_fw_ver.attr,
1392 	&dev_attr_node_desc.attr,
1393 	NULL,
1394 };
1395 
1396 const struct attribute_group ib_dev_attr_group = {
1397 	.attrs = ib_dev_attrs,
1398 };
1399 
1400 void ib_free_port_attrs(struct ib_core_device *coredev)
1401 {
1402 	struct kobject *p, *t;
1403 
1404 	list_for_each_entry_safe(p, t, &coredev->port_list, entry) {
1405 		struct ib_port *port = container_of(p, struct ib_port, kobj);
1406 
1407 		destroy_gid_attrs(port);
1408 		destroy_port(coredev, port);
1409 	}
1410 
1411 	kobject_put(coredev->ports_kobj);
1412 }
1413 
1414 int ib_setup_port_attrs(struct ib_core_device *coredev)
1415 {
1416 	struct ib_device *device = rdma_device_to_ibdev(&coredev->dev);
1417 	u32 port_num;
1418 	int ret;
1419 
1420 	coredev->ports_kobj = kobject_create_and_add("ports",
1421 						     &coredev->dev.kobj);
1422 	if (!coredev->ports_kobj)
1423 		return -ENOMEM;
1424 
1425 	rdma_for_each_port (device, port_num) {
1426 		struct ib_port_attr attr;
1427 		struct ib_port *port;
1428 
1429 		ret = ib_query_port(device, port_num, &attr);
1430 		if (ret)
1431 			goto err_put;
1432 
1433 		port = setup_port(coredev, port_num, &attr);
1434 		if (IS_ERR(port)) {
1435 			ret = PTR_ERR(port);
1436 			goto err_put;
1437 		}
1438 
1439 		ret = setup_gid_attrs(port, &attr);
1440 		if (ret)
1441 			goto err_put;
1442 	}
1443 	return 0;
1444 
1445 err_put:
1446 	ib_free_port_attrs(coredev);
1447 	return ret;
1448 }
1449 
1450 /**
1451  * ib_port_register_client_groups - Add an ib_client's attributes to the port
1452  *
1453  * @ibdev: IB device to add counters
1454  * @port_num: valid port number
1455  * @groups: Group list of attributes
1456  *
1457  * Do not use. Only for legacy sysfs compatibility.
1458  */
1459 int ib_port_register_client_groups(struct ib_device *ibdev, u32 port_num,
1460 				   const struct attribute_group **groups)
1461 {
1462 	return sysfs_create_groups(&ibdev->port_data[port_num].sysfs->kobj,
1463 				   groups);
1464 }
1465 EXPORT_SYMBOL(ib_port_register_client_groups);
1466 
1467 void ib_port_unregister_client_groups(struct ib_device *ibdev, u32 port_num,
1468 				      const struct attribute_group **groups)
1469 {
1470 	return sysfs_remove_groups(&ibdev->port_data[port_num].sysfs->kobj,
1471 				   groups);
1472 }
1473 EXPORT_SYMBOL(ib_port_unregister_client_groups);
1474