1 // SPDX-License-Identifier: GPL-2.0 2 /* Copyright(c) 2017 - 2019 Pensando Systems, Inc */ 3 4 #include <linux/printk.h> 5 #include <linux/dynamic_debug.h> 6 #include <linux/module.h> 7 #include <linux/netdevice.h> 8 #include <linux/utsname.h> 9 #include <generated/utsrelease.h> 10 #include <linux/ctype.h> 11 12 #include "ionic.h" 13 #include "ionic_bus.h" 14 #include "ionic_lif.h" 15 #include "ionic_debugfs.h" 16 17 MODULE_DESCRIPTION(IONIC_DRV_DESCRIPTION); 18 MODULE_AUTHOR("Pensando Systems, Inc"); 19 MODULE_LICENSE("GPL"); 20 ionic_error_to_str(enum ionic_status_code code)21 static const char *ionic_error_to_str(enum ionic_status_code code) 22 { 23 switch (code) { 24 case IONIC_RC_SUCCESS: 25 return "IONIC_RC_SUCCESS"; 26 case IONIC_RC_EVERSION: 27 return "IONIC_RC_EVERSION"; 28 case IONIC_RC_EOPCODE: 29 return "IONIC_RC_EOPCODE"; 30 case IONIC_RC_EIO: 31 return "IONIC_RC_EIO"; 32 case IONIC_RC_EPERM: 33 return "IONIC_RC_EPERM"; 34 case IONIC_RC_EQID: 35 return "IONIC_RC_EQID"; 36 case IONIC_RC_EQTYPE: 37 return "IONIC_RC_EQTYPE"; 38 case IONIC_RC_ENOENT: 39 return "IONIC_RC_ENOENT"; 40 case IONIC_RC_EINTR: 41 return "IONIC_RC_EINTR"; 42 case IONIC_RC_EAGAIN: 43 return "IONIC_RC_EAGAIN"; 44 case IONIC_RC_ENOMEM: 45 return "IONIC_RC_ENOMEM"; 46 case IONIC_RC_EFAULT: 47 return "IONIC_RC_EFAULT"; 48 case IONIC_RC_EBUSY: 49 return "IONIC_RC_EBUSY"; 50 case IONIC_RC_EEXIST: 51 return "IONIC_RC_EEXIST"; 52 case IONIC_RC_EINVAL: 53 return "IONIC_RC_EINVAL"; 54 case IONIC_RC_ENOSPC: 55 return "IONIC_RC_ENOSPC"; 56 case IONIC_RC_ERANGE: 57 return "IONIC_RC_ERANGE"; 58 case IONIC_RC_BAD_ADDR: 59 return "IONIC_RC_BAD_ADDR"; 60 case IONIC_RC_DEV_CMD: 61 return "IONIC_RC_DEV_CMD"; 62 case IONIC_RC_ENOSUPP: 63 return "IONIC_RC_ENOSUPP"; 64 case IONIC_RC_ERROR: 65 return "IONIC_RC_ERROR"; 66 case IONIC_RC_ERDMA: 67 return "IONIC_RC_ERDMA"; 68 case IONIC_RC_EBAD_FW: 69 return "IONIC_RC_EBAD_FW"; 70 default: 71 return "IONIC_RC_UNKNOWN"; 72 } 73 } 74 ionic_error_to_errno(enum ionic_status_code code)75 static int ionic_error_to_errno(enum ionic_status_code code) 76 { 77 switch (code) { 78 case IONIC_RC_SUCCESS: 79 return 0; 80 case IONIC_RC_EVERSION: 81 case IONIC_RC_EQTYPE: 82 case IONIC_RC_EQID: 83 case IONIC_RC_EINVAL: 84 case IONIC_RC_ENOSUPP: 85 return -EINVAL; 86 case IONIC_RC_EPERM: 87 return -EPERM; 88 case IONIC_RC_ENOENT: 89 return -ENOENT; 90 case IONIC_RC_EAGAIN: 91 return -EAGAIN; 92 case IONIC_RC_ENOMEM: 93 return -ENOMEM; 94 case IONIC_RC_EFAULT: 95 return -EFAULT; 96 case IONIC_RC_EBUSY: 97 return -EBUSY; 98 case IONIC_RC_EEXIST: 99 return -EEXIST; 100 case IONIC_RC_ENOSPC: 101 return -ENOSPC; 102 case IONIC_RC_ERANGE: 103 return -ERANGE; 104 case IONIC_RC_BAD_ADDR: 105 return -EFAULT; 106 case IONIC_RC_EOPCODE: 107 case IONIC_RC_EINTR: 108 case IONIC_RC_DEV_CMD: 109 case IONIC_RC_ERROR: 110 case IONIC_RC_ERDMA: 111 case IONIC_RC_EIO: 112 default: 113 return -EIO; 114 } 115 } 116 ionic_opcode_to_str(enum ionic_cmd_opcode opcode)117 static const char *ionic_opcode_to_str(enum ionic_cmd_opcode opcode) 118 { 119 switch (opcode) { 120 case IONIC_CMD_NOP: 121 return "IONIC_CMD_NOP"; 122 case IONIC_CMD_INIT: 123 return "IONIC_CMD_INIT"; 124 case IONIC_CMD_RESET: 125 return "IONIC_CMD_RESET"; 126 case IONIC_CMD_IDENTIFY: 127 return "IONIC_CMD_IDENTIFY"; 128 case IONIC_CMD_GETATTR: 129 return "IONIC_CMD_GETATTR"; 130 case IONIC_CMD_SETATTR: 131 return "IONIC_CMD_SETATTR"; 132 case IONIC_CMD_PORT_IDENTIFY: 133 return "IONIC_CMD_PORT_IDENTIFY"; 134 case IONIC_CMD_PORT_INIT: 135 return "IONIC_CMD_PORT_INIT"; 136 case IONIC_CMD_PORT_RESET: 137 return "IONIC_CMD_PORT_RESET"; 138 case IONIC_CMD_PORT_GETATTR: 139 return "IONIC_CMD_PORT_GETATTR"; 140 case IONIC_CMD_PORT_SETATTR: 141 return "IONIC_CMD_PORT_SETATTR"; 142 case IONIC_CMD_LIF_INIT: 143 return "IONIC_CMD_LIF_INIT"; 144 case IONIC_CMD_LIF_RESET: 145 return "IONIC_CMD_LIF_RESET"; 146 case IONIC_CMD_LIF_IDENTIFY: 147 return "IONIC_CMD_LIF_IDENTIFY"; 148 case IONIC_CMD_LIF_SETATTR: 149 return "IONIC_CMD_LIF_SETATTR"; 150 case IONIC_CMD_LIF_GETATTR: 151 return "IONIC_CMD_LIF_GETATTR"; 152 case IONIC_CMD_LIF_SETPHC: 153 return "IONIC_CMD_LIF_SETPHC"; 154 case IONIC_CMD_RX_MODE_SET: 155 return "IONIC_CMD_RX_MODE_SET"; 156 case IONIC_CMD_RX_FILTER_ADD: 157 return "IONIC_CMD_RX_FILTER_ADD"; 158 case IONIC_CMD_RX_FILTER_DEL: 159 return "IONIC_CMD_RX_FILTER_DEL"; 160 case IONIC_CMD_Q_IDENTIFY: 161 return "IONIC_CMD_Q_IDENTIFY"; 162 case IONIC_CMD_Q_INIT: 163 return "IONIC_CMD_Q_INIT"; 164 case IONIC_CMD_Q_CONTROL: 165 return "IONIC_CMD_Q_CONTROL"; 166 case IONIC_CMD_RDMA_RESET_LIF: 167 return "IONIC_CMD_RDMA_RESET_LIF"; 168 case IONIC_CMD_RDMA_CREATE_EQ: 169 return "IONIC_CMD_RDMA_CREATE_EQ"; 170 case IONIC_CMD_RDMA_CREATE_CQ: 171 return "IONIC_CMD_RDMA_CREATE_CQ"; 172 case IONIC_CMD_RDMA_CREATE_ADMINQ: 173 return "IONIC_CMD_RDMA_CREATE_ADMINQ"; 174 case IONIC_CMD_FW_DOWNLOAD: 175 return "IONIC_CMD_FW_DOWNLOAD"; 176 case IONIC_CMD_FW_CONTROL: 177 return "IONIC_CMD_FW_CONTROL"; 178 case IONIC_CMD_FW_DOWNLOAD_V1: 179 return "IONIC_CMD_FW_DOWNLOAD_V1"; 180 case IONIC_CMD_FW_CONTROL_V1: 181 return "IONIC_CMD_FW_CONTROL_V1"; 182 case IONIC_CMD_VF_GETATTR: 183 return "IONIC_CMD_VF_GETATTR"; 184 case IONIC_CMD_VF_SETATTR: 185 return "IONIC_CMD_VF_SETATTR"; 186 default: 187 return "DEVCMD_UNKNOWN"; 188 } 189 } 190 ionic_adminq_flush(struct ionic_lif * lif)191 static void ionic_adminq_flush(struct ionic_lif *lif) 192 { 193 struct ionic_desc_info *desc_info; 194 unsigned long irqflags; 195 struct ionic_queue *q; 196 197 spin_lock_irqsave(&lif->adminq_lock, irqflags); 198 if (!lif->adminqcq) { 199 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 200 return; 201 } 202 203 q = &lif->adminqcq->q; 204 205 while (q->tail_idx != q->head_idx) { 206 desc_info = &q->info[q->tail_idx]; 207 memset(desc_info->desc, 0, sizeof(union ionic_adminq_cmd)); 208 desc_info->cb = NULL; 209 desc_info->cb_arg = NULL; 210 q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1); 211 } 212 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 213 } 214 ionic_adminq_netdev_err_print(struct ionic_lif * lif,u8 opcode,u8 status,int err)215 void ionic_adminq_netdev_err_print(struct ionic_lif *lif, u8 opcode, 216 u8 status, int err) 217 { 218 netdev_err(lif->netdev, "%s (%d) failed: %s (%d)\n", 219 ionic_opcode_to_str(opcode), opcode, 220 ionic_error_to_str(status), err); 221 } 222 ionic_adminq_check_err(struct ionic_lif * lif,struct ionic_admin_ctx * ctx,const bool timeout,const bool do_msg)223 static int ionic_adminq_check_err(struct ionic_lif *lif, 224 struct ionic_admin_ctx *ctx, 225 const bool timeout, 226 const bool do_msg) 227 { 228 int err = 0; 229 230 if (ctx->comp.comp.status || timeout) { 231 err = timeout ? -ETIMEDOUT : 232 ionic_error_to_errno(ctx->comp.comp.status); 233 234 if (do_msg) 235 ionic_adminq_netdev_err_print(lif, ctx->cmd.cmd.opcode, 236 ctx->comp.comp.status, err); 237 238 if (timeout) 239 ionic_adminq_flush(lif); 240 } 241 242 return err; 243 } 244 ionic_adminq_cb(struct ionic_queue * q,struct ionic_desc_info * desc_info,struct ionic_cq_info * cq_info,void * cb_arg)245 static void ionic_adminq_cb(struct ionic_queue *q, 246 struct ionic_desc_info *desc_info, 247 struct ionic_cq_info *cq_info, void *cb_arg) 248 { 249 struct ionic_admin_ctx *ctx = cb_arg; 250 struct ionic_admin_comp *comp; 251 252 if (!ctx) 253 return; 254 255 comp = cq_info->cq_desc; 256 257 memcpy(&ctx->comp, comp, sizeof(*comp)); 258 259 dev_dbg(q->dev, "comp admin queue command:\n"); 260 dynamic_hex_dump("comp ", DUMP_PREFIX_OFFSET, 16, 1, 261 &ctx->comp, sizeof(ctx->comp), true); 262 263 complete_all(&ctx->work); 264 } 265 ionic_adminq_post(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)266 int ionic_adminq_post(struct ionic_lif *lif, struct ionic_admin_ctx *ctx) 267 { 268 struct ionic_desc_info *desc_info; 269 unsigned long irqflags; 270 struct ionic_queue *q; 271 int err = 0; 272 273 spin_lock_irqsave(&lif->adminq_lock, irqflags); 274 if (!lif->adminqcq) { 275 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 276 return -EIO; 277 } 278 279 q = &lif->adminqcq->q; 280 281 if (!ionic_q_has_space(q, 1)) { 282 err = -ENOSPC; 283 goto err_out; 284 } 285 286 err = ionic_heartbeat_check(lif->ionic); 287 if (err) 288 goto err_out; 289 290 desc_info = &q->info[q->head_idx]; 291 memcpy(desc_info->desc, &ctx->cmd, sizeof(ctx->cmd)); 292 293 dev_dbg(&lif->netdev->dev, "post admin queue command:\n"); 294 dynamic_hex_dump("cmd ", DUMP_PREFIX_OFFSET, 16, 1, 295 &ctx->cmd, sizeof(ctx->cmd), true); 296 297 ionic_q_post(q, true, ionic_adminq_cb, ctx); 298 299 err_out: 300 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 301 302 return err; 303 } 304 ionic_adminq_wait(struct ionic_lif * lif,struct ionic_admin_ctx * ctx,const int err,const bool do_msg)305 int ionic_adminq_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx, 306 const int err, const bool do_msg) 307 { 308 struct net_device *netdev = lif->netdev; 309 unsigned long time_limit; 310 unsigned long time_start; 311 unsigned long time_done; 312 unsigned long remaining; 313 const char *name; 314 315 name = ionic_opcode_to_str(ctx->cmd.cmd.opcode); 316 317 if (err) { 318 if (do_msg && !test_bit(IONIC_LIF_F_FW_RESET, lif->state)) 319 netdev_err(netdev, "Posting of %s (%d) failed: %d\n", 320 name, ctx->cmd.cmd.opcode, err); 321 return err; 322 } 323 324 time_start = jiffies; 325 time_limit = time_start + HZ * (ulong)DEVCMD_TIMEOUT; 326 do { 327 remaining = wait_for_completion_timeout(&ctx->work, 328 IONIC_ADMINQ_TIME_SLICE); 329 330 /* check for done */ 331 if (remaining) 332 break; 333 334 /* interrupt the wait if FW stopped */ 335 if (test_bit(IONIC_LIF_F_FW_RESET, lif->state)) { 336 if (do_msg) 337 netdev_err(netdev, "%s (%d) interrupted, FW in reset\n", 338 name, ctx->cmd.cmd.opcode); 339 return -ENXIO; 340 } 341 342 } while (time_before(jiffies, time_limit)); 343 time_done = jiffies; 344 345 dev_dbg(lif->ionic->dev, "%s: elapsed %d msecs\n", 346 __func__, jiffies_to_msecs(time_done - time_start)); 347 348 return ionic_adminq_check_err(lif, ctx, 349 time_after_eq(time_done, time_limit), 350 do_msg); 351 } 352 ionic_adminq_post_wait(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)353 int ionic_adminq_post_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx) 354 { 355 int err; 356 357 err = ionic_adminq_post(lif, ctx); 358 359 return ionic_adminq_wait(lif, ctx, err, true); 360 } 361 ionic_adminq_post_wait_nomsg(struct ionic_lif * lif,struct ionic_admin_ctx * ctx)362 int ionic_adminq_post_wait_nomsg(struct ionic_lif *lif, struct ionic_admin_ctx *ctx) 363 { 364 int err; 365 366 err = ionic_adminq_post(lif, ctx); 367 368 return ionic_adminq_wait(lif, ctx, err, false); 369 } 370 ionic_dev_cmd_clean(struct ionic * ionic)371 static void ionic_dev_cmd_clean(struct ionic *ionic) 372 { 373 union __iomem ionic_dev_cmd_regs *regs = ionic->idev.dev_cmd_regs; 374 375 iowrite32(0, ®s->doorbell); 376 memset_io(®s->cmd, 0, sizeof(regs->cmd)); 377 } 378 ionic_dev_cmd_wait(struct ionic * ionic,unsigned long max_seconds)379 int ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds) 380 { 381 struct ionic_dev *idev = &ionic->idev; 382 unsigned long start_time; 383 unsigned long max_wait; 384 unsigned long duration; 385 int opcode; 386 int hb = 0; 387 int done; 388 int err; 389 390 /* Wait for dev cmd to complete, retrying if we get EAGAIN, 391 * but don't wait any longer than max_seconds. 392 */ 393 max_wait = jiffies + (max_seconds * HZ); 394 try_again: 395 opcode = readb(&idev->dev_cmd_regs->cmd.cmd.opcode); 396 start_time = jiffies; 397 do { 398 done = ionic_dev_cmd_done(idev); 399 if (done) 400 break; 401 usleep_range(100, 200); 402 403 /* Don't check the heartbeat on FW_CONTROL commands as they are 404 * notorious for interrupting the firmware's heartbeat update. 405 */ 406 if (opcode != IONIC_CMD_FW_CONTROL) 407 hb = ionic_heartbeat_check(ionic); 408 } while (!done && !hb && time_before(jiffies, max_wait)); 409 duration = jiffies - start_time; 410 411 dev_dbg(ionic->dev, "DEVCMD %s (%d) done=%d took %ld secs (%ld jiffies)\n", 412 ionic_opcode_to_str(opcode), opcode, 413 done, duration / HZ, duration); 414 415 if (!done && hb) { 416 /* It is possible (but unlikely) that FW was busy and missed a 417 * heartbeat check but is still alive and will process this 418 * request, so don't clean the dev_cmd in this case. 419 */ 420 dev_dbg(ionic->dev, "DEVCMD %s (%d) failed - FW halted\n", 421 ionic_opcode_to_str(opcode), opcode); 422 return -ENXIO; 423 } 424 425 if (!done && !time_before(jiffies, max_wait)) { 426 ionic_dev_cmd_clean(ionic); 427 dev_warn(ionic->dev, "DEVCMD %s (%d) timeout after %ld secs\n", 428 ionic_opcode_to_str(opcode), opcode, max_seconds); 429 return -ETIMEDOUT; 430 } 431 432 err = ionic_dev_cmd_status(&ionic->idev); 433 if (err) { 434 if (err == IONIC_RC_EAGAIN && 435 time_before(jiffies, (max_wait - HZ))) { 436 dev_dbg(ionic->dev, "DEV_CMD %s (%d), %s (%d) retrying...\n", 437 ionic_opcode_to_str(opcode), opcode, 438 ionic_error_to_str(err), err); 439 440 msleep(1000); 441 iowrite32(0, &idev->dev_cmd_regs->done); 442 iowrite32(1, &idev->dev_cmd_regs->doorbell); 443 goto try_again; 444 } 445 446 if (!(opcode == IONIC_CMD_FW_CONTROL && err == IONIC_RC_EAGAIN)) 447 dev_err(ionic->dev, "DEV_CMD %s (%d) error, %s (%d) failed\n", 448 ionic_opcode_to_str(opcode), opcode, 449 ionic_error_to_str(err), err); 450 451 return ionic_error_to_errno(err); 452 } 453 454 return 0; 455 } 456 ionic_setup(struct ionic * ionic)457 int ionic_setup(struct ionic *ionic) 458 { 459 int err; 460 461 err = ionic_dev_setup(ionic); 462 if (err) 463 return err; 464 ionic_reset(ionic); 465 466 return 0; 467 } 468 ionic_identify(struct ionic * ionic)469 int ionic_identify(struct ionic *ionic) 470 { 471 struct ionic_identity *ident = &ionic->ident; 472 struct ionic_dev *idev = &ionic->idev; 473 size_t sz; 474 int err; 475 476 memset(ident, 0, sizeof(*ident)); 477 478 ident->drv.os_type = cpu_to_le32(IONIC_OS_TYPE_LINUX); 479 strncpy(ident->drv.driver_ver_str, UTS_RELEASE, 480 sizeof(ident->drv.driver_ver_str) - 1); 481 482 mutex_lock(&ionic->dev_cmd_lock); 483 484 sz = min(sizeof(ident->drv), sizeof(idev->dev_cmd_regs->data)); 485 memcpy_toio(&idev->dev_cmd_regs->data, &ident->drv, sz); 486 487 ionic_dev_cmd_identify(idev, IONIC_IDENTITY_VERSION_1); 488 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 489 if (!err) { 490 sz = min(sizeof(ident->dev), sizeof(idev->dev_cmd_regs->data)); 491 memcpy_fromio(&ident->dev, &idev->dev_cmd_regs->data, sz); 492 } 493 mutex_unlock(&ionic->dev_cmd_lock); 494 495 if (err) { 496 dev_err(ionic->dev, "Cannot identify ionic: %d\n", err); 497 goto err_out; 498 } 499 500 if (isprint(idev->dev_info.fw_version[0]) && 501 isascii(idev->dev_info.fw_version[0])) 502 dev_info(ionic->dev, "FW: %.*s\n", 503 (int)(sizeof(idev->dev_info.fw_version) - 1), 504 idev->dev_info.fw_version); 505 else 506 dev_info(ionic->dev, "FW: (invalid string) 0x%02x 0x%02x 0x%02x 0x%02x ...\n", 507 (u8)idev->dev_info.fw_version[0], 508 (u8)idev->dev_info.fw_version[1], 509 (u8)idev->dev_info.fw_version[2], 510 (u8)idev->dev_info.fw_version[3]); 511 512 err = ionic_lif_identify(ionic, IONIC_LIF_TYPE_CLASSIC, 513 &ionic->ident.lif); 514 if (err) { 515 dev_err(ionic->dev, "Cannot identify LIFs: %d\n", err); 516 goto err_out; 517 } 518 519 return 0; 520 521 err_out: 522 return err; 523 } 524 ionic_init(struct ionic * ionic)525 int ionic_init(struct ionic *ionic) 526 { 527 struct ionic_dev *idev = &ionic->idev; 528 int err; 529 530 mutex_lock(&ionic->dev_cmd_lock); 531 ionic_dev_cmd_init(idev); 532 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 533 mutex_unlock(&ionic->dev_cmd_lock); 534 535 return err; 536 } 537 ionic_reset(struct ionic * ionic)538 int ionic_reset(struct ionic *ionic) 539 { 540 struct ionic_dev *idev = &ionic->idev; 541 int err; 542 543 mutex_lock(&ionic->dev_cmd_lock); 544 ionic_dev_cmd_reset(idev); 545 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 546 mutex_unlock(&ionic->dev_cmd_lock); 547 548 return err; 549 } 550 ionic_port_identify(struct ionic * ionic)551 int ionic_port_identify(struct ionic *ionic) 552 { 553 struct ionic_identity *ident = &ionic->ident; 554 struct ionic_dev *idev = &ionic->idev; 555 size_t sz; 556 int err; 557 558 mutex_lock(&ionic->dev_cmd_lock); 559 560 ionic_dev_cmd_port_identify(idev); 561 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 562 if (!err) { 563 sz = min(sizeof(ident->port), sizeof(idev->dev_cmd_regs->data)); 564 memcpy_fromio(&ident->port, &idev->dev_cmd_regs->data, sz); 565 } 566 567 mutex_unlock(&ionic->dev_cmd_lock); 568 569 return err; 570 } 571 ionic_port_init(struct ionic * ionic)572 int ionic_port_init(struct ionic *ionic) 573 { 574 struct ionic_identity *ident = &ionic->ident; 575 struct ionic_dev *idev = &ionic->idev; 576 size_t sz; 577 int err; 578 579 if (!idev->port_info) { 580 idev->port_info_sz = ALIGN(sizeof(*idev->port_info), PAGE_SIZE); 581 idev->port_info = dma_alloc_coherent(ionic->dev, 582 idev->port_info_sz, 583 &idev->port_info_pa, 584 GFP_KERNEL); 585 if (!idev->port_info) 586 return -ENOMEM; 587 } 588 589 sz = min(sizeof(ident->port.config), sizeof(idev->dev_cmd_regs->data)); 590 591 mutex_lock(&ionic->dev_cmd_lock); 592 593 memcpy_toio(&idev->dev_cmd_regs->data, &ident->port.config, sz); 594 ionic_dev_cmd_port_init(idev); 595 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 596 597 ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_UP); 598 (void)ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 599 600 mutex_unlock(&ionic->dev_cmd_lock); 601 if (err) { 602 dev_err(ionic->dev, "Failed to init port\n"); 603 dma_free_coherent(ionic->dev, idev->port_info_sz, 604 idev->port_info, idev->port_info_pa); 605 idev->port_info = NULL; 606 idev->port_info_pa = 0; 607 } 608 609 return err; 610 } 611 ionic_port_reset(struct ionic * ionic)612 int ionic_port_reset(struct ionic *ionic) 613 { 614 struct ionic_dev *idev = &ionic->idev; 615 int err; 616 617 if (!idev->port_info) 618 return 0; 619 620 mutex_lock(&ionic->dev_cmd_lock); 621 ionic_dev_cmd_port_reset(idev); 622 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 623 mutex_unlock(&ionic->dev_cmd_lock); 624 625 dma_free_coherent(ionic->dev, idev->port_info_sz, 626 idev->port_info, idev->port_info_pa); 627 628 idev->port_info = NULL; 629 idev->port_info_pa = 0; 630 631 if (err) 632 dev_err(ionic->dev, "Failed to reset port\n"); 633 634 return err; 635 } 636 ionic_init_module(void)637 static int __init ionic_init_module(void) 638 { 639 ionic_debugfs_create(); 640 return ionic_bus_register_driver(); 641 } 642 ionic_cleanup_module(void)643 static void __exit ionic_cleanup_module(void) 644 { 645 ionic_bus_unregister_driver(); 646 ionic_debugfs_destroy(); 647 648 pr_info("%s removed\n", IONIC_DRV_NAME); 649 } 650 651 module_init(ionic_init_module); 652 module_exit(ionic_cleanup_module); 653