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