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