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("Shannon Nelson <shannon.nelson@amd.com>"); 19 MODULE_LICENSE("GPL"); 20 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 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 return -EINVAL; 85 case IONIC_RC_ENOSUPP: 86 return -EOPNOTSUPP; 87 case IONIC_RC_EPERM: 88 return -EPERM; 89 case IONIC_RC_ENOENT: 90 return -ENOENT; 91 case IONIC_RC_EAGAIN: 92 return -EAGAIN; 93 case IONIC_RC_ENOMEM: 94 return -ENOMEM; 95 case IONIC_RC_EFAULT: 96 return -EFAULT; 97 case IONIC_RC_EBUSY: 98 return -EBUSY; 99 case IONIC_RC_EEXIST: 100 return -EEXIST; 101 case IONIC_RC_ENOSPC: 102 return -ENOSPC; 103 case IONIC_RC_ERANGE: 104 return -ERANGE; 105 case IONIC_RC_BAD_ADDR: 106 return -EFAULT; 107 case IONIC_RC_EOPCODE: 108 case IONIC_RC_EINTR: 109 case IONIC_RC_DEV_CMD: 110 case IONIC_RC_ERROR: 111 case IONIC_RC_ERDMA: 112 case IONIC_RC_EIO: 113 default: 114 return -EIO; 115 } 116 } 117 118 static const char *ionic_opcode_to_str(enum ionic_cmd_opcode opcode) 119 { 120 switch (opcode) { 121 case IONIC_CMD_NOP: 122 return "IONIC_CMD_NOP"; 123 case IONIC_CMD_INIT: 124 return "IONIC_CMD_INIT"; 125 case IONIC_CMD_RESET: 126 return "IONIC_CMD_RESET"; 127 case IONIC_CMD_IDENTIFY: 128 return "IONIC_CMD_IDENTIFY"; 129 case IONIC_CMD_GETATTR: 130 return "IONIC_CMD_GETATTR"; 131 case IONIC_CMD_SETATTR: 132 return "IONIC_CMD_SETATTR"; 133 case IONIC_CMD_PORT_IDENTIFY: 134 return "IONIC_CMD_PORT_IDENTIFY"; 135 case IONIC_CMD_PORT_INIT: 136 return "IONIC_CMD_PORT_INIT"; 137 case IONIC_CMD_PORT_RESET: 138 return "IONIC_CMD_PORT_RESET"; 139 case IONIC_CMD_PORT_GETATTR: 140 return "IONIC_CMD_PORT_GETATTR"; 141 case IONIC_CMD_PORT_SETATTR: 142 return "IONIC_CMD_PORT_SETATTR"; 143 case IONIC_CMD_LIF_INIT: 144 return "IONIC_CMD_LIF_INIT"; 145 case IONIC_CMD_LIF_RESET: 146 return "IONIC_CMD_LIF_RESET"; 147 case IONIC_CMD_LIF_IDENTIFY: 148 return "IONIC_CMD_LIF_IDENTIFY"; 149 case IONIC_CMD_LIF_SETATTR: 150 return "IONIC_CMD_LIF_SETATTR"; 151 case IONIC_CMD_LIF_GETATTR: 152 return "IONIC_CMD_LIF_GETATTR"; 153 case IONIC_CMD_LIF_SETPHC: 154 return "IONIC_CMD_LIF_SETPHC"; 155 case IONIC_CMD_RX_MODE_SET: 156 return "IONIC_CMD_RX_MODE_SET"; 157 case IONIC_CMD_RX_FILTER_ADD: 158 return "IONIC_CMD_RX_FILTER_ADD"; 159 case IONIC_CMD_RX_FILTER_DEL: 160 return "IONIC_CMD_RX_FILTER_DEL"; 161 case IONIC_CMD_Q_IDENTIFY: 162 return "IONIC_CMD_Q_IDENTIFY"; 163 case IONIC_CMD_Q_INIT: 164 return "IONIC_CMD_Q_INIT"; 165 case IONIC_CMD_Q_CONTROL: 166 return "IONIC_CMD_Q_CONTROL"; 167 case IONIC_CMD_RDMA_RESET_LIF: 168 return "IONIC_CMD_RDMA_RESET_LIF"; 169 case IONIC_CMD_RDMA_CREATE_EQ: 170 return "IONIC_CMD_RDMA_CREATE_EQ"; 171 case IONIC_CMD_RDMA_CREATE_CQ: 172 return "IONIC_CMD_RDMA_CREATE_CQ"; 173 case IONIC_CMD_RDMA_CREATE_ADMINQ: 174 return "IONIC_CMD_RDMA_CREATE_ADMINQ"; 175 case IONIC_CMD_FW_DOWNLOAD: 176 return "IONIC_CMD_FW_DOWNLOAD"; 177 case IONIC_CMD_FW_CONTROL: 178 return "IONIC_CMD_FW_CONTROL"; 179 case IONIC_CMD_FW_DOWNLOAD_V1: 180 return "IONIC_CMD_FW_DOWNLOAD_V1"; 181 case IONIC_CMD_FW_CONTROL_V1: 182 return "IONIC_CMD_FW_CONTROL_V1"; 183 case IONIC_CMD_VF_GETATTR: 184 return "IONIC_CMD_VF_GETATTR"; 185 case IONIC_CMD_VF_SETATTR: 186 return "IONIC_CMD_VF_SETATTR"; 187 default: 188 return "DEVCMD_UNKNOWN"; 189 } 190 } 191 192 static void ionic_adminq_flush(struct ionic_lif *lif) 193 { 194 struct ionic_admin_desc_info *desc_info; 195 struct ionic_admin_cmd *desc; 196 unsigned long irqflags; 197 struct ionic_queue *q; 198 199 spin_lock_irqsave(&lif->adminq_lock, irqflags); 200 if (!lif->adminqcq) { 201 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 202 return; 203 } 204 205 q = &lif->adminqcq->q; 206 207 while (q->tail_idx != q->head_idx) { 208 desc = &q->adminq[q->tail_idx]; 209 desc_info = &q->admin_info[q->tail_idx]; 210 memset(desc, 0, sizeof(union ionic_adminq_cmd)); 211 desc_info->ctx = NULL; 212 q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1); 213 } 214 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 215 } 216 217 void ionic_adminq_netdev_err_print(struct ionic_lif *lif, u8 opcode, 218 u8 status, int err) 219 { 220 const char *stat_str; 221 222 stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" : 223 ionic_error_to_str(status); 224 225 netdev_err(lif->netdev, "%s (%d) failed: %s (%d)\n", 226 ionic_opcode_to_str(opcode), opcode, stat_str, err); 227 } 228 229 static int ionic_adminq_check_err(struct ionic_lif *lif, 230 struct ionic_admin_ctx *ctx, 231 const bool timeout, 232 const bool do_msg) 233 { 234 int err = 0; 235 236 if (ctx->comp.comp.status || timeout) { 237 err = timeout ? -ETIMEDOUT : 238 ionic_error_to_errno(ctx->comp.comp.status); 239 240 if (do_msg) 241 ionic_adminq_netdev_err_print(lif, ctx->cmd.cmd.opcode, 242 ctx->comp.comp.status, err); 243 244 if (timeout) 245 ionic_adminq_flush(lif); 246 } 247 248 return err; 249 } 250 251 bool ionic_notifyq_service(struct ionic_cq *cq) 252 { 253 struct ionic_deferred_work *work; 254 union ionic_notifyq_comp *comp; 255 struct net_device *netdev; 256 struct ionic_queue *q; 257 struct ionic_lif *lif; 258 u64 eid; 259 260 comp = &((union ionic_notifyq_comp *)cq->base)[cq->tail_idx]; 261 262 q = cq->bound_q; 263 lif = q->admin_info[0].ctx; 264 netdev = lif->netdev; 265 eid = le64_to_cpu(comp->event.eid); 266 267 /* Have we run out of new completions to process? */ 268 if ((s64)(eid - lif->last_eid) <= 0) 269 return false; 270 271 lif->last_eid = eid; 272 273 dev_dbg(lif->ionic->dev, "notifyq event:\n"); 274 dynamic_hex_dump("event ", DUMP_PREFIX_OFFSET, 16, 1, 275 comp, sizeof(*comp), true); 276 277 switch (le16_to_cpu(comp->event.ecode)) { 278 case IONIC_EVENT_LINK_CHANGE: 279 ionic_link_status_check_request(lif, CAN_NOT_SLEEP); 280 break; 281 case IONIC_EVENT_RESET: 282 if (lif->ionic->idev.fw_status_ready && 283 !test_bit(IONIC_LIF_F_FW_RESET, lif->state) && 284 !test_and_set_bit(IONIC_LIF_F_FW_STOPPING, lif->state)) { 285 work = kzalloc(sizeof(*work), GFP_ATOMIC); 286 if (!work) { 287 netdev_err(lif->netdev, "Reset event dropped\n"); 288 clear_bit(IONIC_LIF_F_FW_STOPPING, lif->state); 289 } else { 290 work->type = IONIC_DW_TYPE_LIF_RESET; 291 ionic_lif_deferred_enqueue(lif, work); 292 } 293 } 294 break; 295 default: 296 netdev_warn(netdev, "Notifyq event ecode=%d eid=%lld\n", 297 comp->event.ecode, eid); 298 break; 299 } 300 301 return true; 302 } 303 304 bool ionic_adminq_service(struct ionic_cq *cq) 305 { 306 struct ionic_admin_desc_info *desc_info; 307 struct ionic_queue *q = cq->bound_q; 308 struct ionic_admin_comp *comp; 309 u16 index; 310 311 comp = &((struct ionic_admin_comp *)cq->base)[cq->tail_idx]; 312 313 if (!color_match(comp->color, cq->done_color)) 314 return false; 315 316 /* check for empty queue */ 317 if (q->tail_idx == q->head_idx) 318 return false; 319 320 do { 321 desc_info = &q->admin_info[q->tail_idx]; 322 index = q->tail_idx; 323 q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1); 324 if (likely(desc_info->ctx)) { 325 struct ionic_admin_ctx *ctx = desc_info->ctx; 326 327 memcpy(&ctx->comp, comp, sizeof(*comp)); 328 329 dev_dbg(q->dev, "comp admin queue command:\n"); 330 dynamic_hex_dump("comp ", DUMP_PREFIX_OFFSET, 16, 1, 331 &ctx->comp, sizeof(ctx->comp), true); 332 complete_all(&ctx->work); 333 desc_info->ctx = NULL; 334 } 335 } while (index != le16_to_cpu(comp->comp_index)); 336 337 return true; 338 } 339 340 bool ionic_adminq_poke_doorbell(struct ionic_queue *q) 341 { 342 struct ionic_lif *lif = q->lif; 343 unsigned long now, then, dif; 344 unsigned long irqflags; 345 346 spin_lock_irqsave(&lif->adminq_lock, irqflags); 347 348 if (q->tail_idx == q->head_idx) { 349 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 350 return false; 351 } 352 353 now = READ_ONCE(jiffies); 354 then = q->dbell_jiffies; 355 dif = now - then; 356 357 if (dif > q->dbell_deadline) { 358 ionic_dbell_ring(q->lif->kern_dbpage, q->hw_type, 359 q->dbval | q->head_idx); 360 361 q->dbell_jiffies = now; 362 } 363 364 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 365 366 return true; 367 } 368 369 int ionic_adminq_post(struct ionic_lif *lif, struct ionic_admin_ctx *ctx) 370 { 371 struct ionic_admin_desc_info *desc_info; 372 struct ionic_admin_cmd *desc; 373 unsigned long irqflags; 374 struct ionic_queue *q; 375 int err = 0; 376 377 spin_lock_irqsave(&lif->adminq_lock, irqflags); 378 if (!lif->adminqcq) { 379 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 380 return -EIO; 381 } 382 383 q = &lif->adminqcq->q; 384 385 if (!ionic_q_has_space(q, 1)) { 386 err = -ENOSPC; 387 goto err_out; 388 } 389 390 err = ionic_heartbeat_check(lif->ionic); 391 if (err) 392 goto err_out; 393 394 desc_info = &q->admin_info[q->head_idx]; 395 desc_info->ctx = ctx; 396 397 desc = &q->adminq[q->head_idx]; 398 memcpy(desc, &ctx->cmd, sizeof(ctx->cmd)); 399 400 dev_dbg(&lif->netdev->dev, "post admin queue command:\n"); 401 dynamic_hex_dump("cmd ", DUMP_PREFIX_OFFSET, 16, 1, 402 &ctx->cmd, sizeof(ctx->cmd), true); 403 404 ionic_q_post(q, true); 405 406 err_out: 407 spin_unlock_irqrestore(&lif->adminq_lock, irqflags); 408 409 return err; 410 } 411 412 int ionic_adminq_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx, 413 const int err, const bool do_msg) 414 { 415 struct net_device *netdev = lif->netdev; 416 unsigned long time_limit; 417 unsigned long time_start; 418 unsigned long time_done; 419 unsigned long remaining; 420 const char *name; 421 422 name = ionic_opcode_to_str(ctx->cmd.cmd.opcode); 423 424 if (err) { 425 if (do_msg && !test_bit(IONIC_LIF_F_FW_RESET, lif->state)) 426 netdev_err(netdev, "Posting of %s (%d) failed: %d\n", 427 name, ctx->cmd.cmd.opcode, err); 428 ctx->comp.comp.status = IONIC_RC_ERROR; 429 return err; 430 } 431 432 time_start = jiffies; 433 time_limit = time_start + HZ * (ulong)DEVCMD_TIMEOUT; 434 do { 435 remaining = wait_for_completion_timeout(&ctx->work, 436 IONIC_ADMINQ_TIME_SLICE); 437 438 /* check for done */ 439 if (remaining) 440 break; 441 442 /* force a check of FW status and break out if FW reset */ 443 ionic_heartbeat_check(lif->ionic); 444 if ((test_bit(IONIC_LIF_F_FW_RESET, lif->state) && 445 !lif->ionic->idev.fw_status_ready) || 446 test_bit(IONIC_LIF_F_FW_STOPPING, lif->state)) { 447 if (do_msg) 448 netdev_warn(netdev, "%s (%d) interrupted, FW in reset\n", 449 name, ctx->cmd.cmd.opcode); 450 ctx->comp.comp.status = IONIC_RC_ERROR; 451 return -ENXIO; 452 } 453 454 } while (time_before(jiffies, time_limit)); 455 time_done = jiffies; 456 457 dev_dbg(lif->ionic->dev, "%s: elapsed %d msecs\n", 458 __func__, jiffies_to_msecs(time_done - time_start)); 459 460 return ionic_adminq_check_err(lif, ctx, 461 time_after_eq(time_done, time_limit), 462 do_msg); 463 } 464 465 static int __ionic_adminq_post_wait(struct ionic_lif *lif, 466 struct ionic_admin_ctx *ctx, 467 const bool do_msg) 468 { 469 int err; 470 471 if (!ionic_is_fw_running(&lif->ionic->idev)) 472 return 0; 473 474 err = ionic_adminq_post(lif, ctx); 475 476 return ionic_adminq_wait(lif, ctx, err, do_msg); 477 } 478 479 int ionic_adminq_post_wait(struct ionic_lif *lif, struct ionic_admin_ctx *ctx) 480 { 481 return __ionic_adminq_post_wait(lif, ctx, true); 482 } 483 484 int ionic_adminq_post_wait_nomsg(struct ionic_lif *lif, struct ionic_admin_ctx *ctx) 485 { 486 return __ionic_adminq_post_wait(lif, ctx, false); 487 } 488 489 static void ionic_dev_cmd_clean(struct ionic *ionic) 490 { 491 struct ionic_dev *idev = &ionic->idev; 492 493 if (!idev->dev_cmd_regs) 494 return; 495 496 iowrite32(0, &idev->dev_cmd_regs->doorbell); 497 memset_io(&idev->dev_cmd_regs->cmd, 0, sizeof(idev->dev_cmd_regs->cmd)); 498 } 499 500 void ionic_dev_cmd_dev_err_print(struct ionic *ionic, u8 opcode, u8 status, 501 int err) 502 { 503 const char *stat_str; 504 505 stat_str = (err == -ETIMEDOUT) ? "TIMEOUT" : 506 ionic_error_to_str(status); 507 508 dev_err(ionic->dev, "DEV_CMD %s (%d) error, %s (%d) failed\n", 509 ionic_opcode_to_str(opcode), opcode, stat_str, err); 510 } 511 512 static int __ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds, 513 const bool do_msg) 514 { 515 struct ionic_dev *idev = &ionic->idev; 516 unsigned long start_time; 517 unsigned long max_wait; 518 unsigned long duration; 519 bool fw_up; 520 int opcode; 521 bool done; 522 int err; 523 524 /* Wait for dev cmd to complete, retrying if we get EAGAIN, 525 * but don't wait any longer than max_seconds. 526 */ 527 max_wait = jiffies + (max_seconds * HZ); 528 try_again: 529 done = false; 530 opcode = idev->opcode; 531 start_time = jiffies; 532 for (fw_up = ionic_is_fw_running(idev); 533 !done && fw_up && time_before(jiffies, max_wait); 534 fw_up = ionic_is_fw_running(idev)) { 535 done = ionic_dev_cmd_done(idev); 536 if (done) 537 break; 538 usleep_range(100, 200); 539 } 540 duration = jiffies - start_time; 541 542 dev_dbg(ionic->dev, "DEVCMD %s (%d) done=%d took %ld secs (%ld jiffies)\n", 543 ionic_opcode_to_str(opcode), opcode, 544 done, duration / HZ, duration); 545 546 if (!done && !fw_up) { 547 ionic_dev_cmd_clean(ionic); 548 dev_warn(ionic->dev, "DEVCMD %s (%d) interrupted - FW is down\n", 549 ionic_opcode_to_str(opcode), opcode); 550 return -ENXIO; 551 } 552 553 if (!done && !time_before(jiffies, max_wait)) { 554 ionic_dev_cmd_clean(ionic); 555 dev_warn(ionic->dev, "DEVCMD %s (%d) timeout after %ld secs\n", 556 ionic_opcode_to_str(opcode), opcode, max_seconds); 557 return -ETIMEDOUT; 558 } 559 560 err = ionic_dev_cmd_status(&ionic->idev); 561 if (err) { 562 if (err == IONIC_RC_EAGAIN && 563 time_before(jiffies, (max_wait - HZ))) { 564 dev_dbg(ionic->dev, "DEV_CMD %s (%d), %s (%d) retrying...\n", 565 ionic_opcode_to_str(opcode), opcode, 566 ionic_error_to_str(err), err); 567 568 iowrite32(0, &idev->dev_cmd_regs->done); 569 msleep(1000); 570 iowrite32(1, &idev->dev_cmd_regs->doorbell); 571 goto try_again; 572 } 573 574 if (!(opcode == IONIC_CMD_FW_CONTROL && err == IONIC_RC_EAGAIN)) 575 if (do_msg) 576 ionic_dev_cmd_dev_err_print(ionic, opcode, err, 577 ionic_error_to_errno(err)); 578 579 return ionic_error_to_errno(err); 580 } 581 582 ionic_dev_cmd_clean(ionic); 583 584 return 0; 585 } 586 587 int ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds) 588 { 589 return __ionic_dev_cmd_wait(ionic, max_seconds, true); 590 } 591 592 int ionic_dev_cmd_wait_nomsg(struct ionic *ionic, unsigned long max_seconds) 593 { 594 return __ionic_dev_cmd_wait(ionic, max_seconds, false); 595 } 596 597 int ionic_setup(struct ionic *ionic) 598 { 599 int err; 600 601 err = ionic_dev_setup(ionic); 602 if (err) 603 return err; 604 ionic_reset(ionic); 605 606 return 0; 607 } 608 609 int ionic_identify(struct ionic *ionic) 610 { 611 struct ionic_identity *ident = &ionic->ident; 612 struct ionic_dev *idev = &ionic->idev; 613 size_t sz; 614 int err; 615 616 memset(ident, 0, sizeof(*ident)); 617 618 ident->drv.os_type = cpu_to_le32(IONIC_OS_TYPE_LINUX); 619 strscpy(ident->drv.driver_ver_str, UTS_RELEASE, 620 sizeof(ident->drv.driver_ver_str)); 621 622 mutex_lock(&ionic->dev_cmd_lock); 623 624 sz = min(sizeof(ident->drv), sizeof(idev->dev_cmd_regs->data)); 625 memcpy_toio(&idev->dev_cmd_regs->data, &ident->drv, sz); 626 627 ionic_dev_cmd_identify(idev, IONIC_DEV_IDENTITY_VERSION_2); 628 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 629 if (!err) { 630 sz = min(sizeof(ident->dev), sizeof(idev->dev_cmd_regs->data)); 631 memcpy_fromio(&ident->dev, &idev->dev_cmd_regs->data, sz); 632 } 633 mutex_unlock(&ionic->dev_cmd_lock); 634 635 if (err) { 636 dev_err(ionic->dev, "Cannot identify ionic: %d\n", err); 637 goto err_out; 638 } 639 640 if (isprint(idev->dev_info.fw_version[0]) && 641 isascii(idev->dev_info.fw_version[0])) 642 dev_info(ionic->dev, "FW: %.*s\n", 643 (int)(sizeof(idev->dev_info.fw_version) - 1), 644 idev->dev_info.fw_version); 645 else 646 dev_info(ionic->dev, "FW: (invalid string) 0x%02x 0x%02x 0x%02x 0x%02x ...\n", 647 (u8)idev->dev_info.fw_version[0], 648 (u8)idev->dev_info.fw_version[1], 649 (u8)idev->dev_info.fw_version[2], 650 (u8)idev->dev_info.fw_version[3]); 651 652 err = ionic_lif_identify(ionic, IONIC_LIF_TYPE_CLASSIC, 653 &ionic->ident.lif); 654 if (err) { 655 dev_err(ionic->dev, "Cannot identify LIFs: %d\n", err); 656 goto err_out; 657 } 658 659 return 0; 660 661 err_out: 662 return err; 663 } 664 665 int ionic_init(struct ionic *ionic) 666 { 667 struct ionic_dev *idev = &ionic->idev; 668 int err; 669 670 mutex_lock(&ionic->dev_cmd_lock); 671 ionic_dev_cmd_init(idev); 672 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 673 mutex_unlock(&ionic->dev_cmd_lock); 674 675 return err; 676 } 677 678 int ionic_reset(struct ionic *ionic) 679 { 680 struct ionic_dev *idev = &ionic->idev; 681 int err; 682 683 if (!ionic_is_fw_running(idev)) 684 return 0; 685 686 mutex_lock(&ionic->dev_cmd_lock); 687 ionic_dev_cmd_reset(idev); 688 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 689 mutex_unlock(&ionic->dev_cmd_lock); 690 691 return err; 692 } 693 694 int ionic_port_identify(struct ionic *ionic) 695 { 696 struct ionic_identity *ident = &ionic->ident; 697 struct ionic_dev *idev = &ionic->idev; 698 size_t sz; 699 int err; 700 701 mutex_lock(&ionic->dev_cmd_lock); 702 703 ionic_dev_cmd_port_identify(idev); 704 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 705 if (!err) { 706 sz = min(sizeof(ident->port), sizeof(idev->dev_cmd_regs->data)); 707 memcpy_fromio(&ident->port, &idev->dev_cmd_regs->data, sz); 708 } 709 710 mutex_unlock(&ionic->dev_cmd_lock); 711 712 return err; 713 } 714 715 int ionic_port_init(struct ionic *ionic) 716 { 717 struct ionic_identity *ident = &ionic->ident; 718 struct ionic_dev *idev = &ionic->idev; 719 size_t sz; 720 int err; 721 722 if (!idev->port_info) { 723 idev->port_info_sz = ALIGN(sizeof(*idev->port_info), PAGE_SIZE); 724 idev->port_info = dma_alloc_coherent(ionic->dev, 725 idev->port_info_sz, 726 &idev->port_info_pa, 727 GFP_KERNEL); 728 if (!idev->port_info) 729 return -ENOMEM; 730 } 731 732 sz = min(sizeof(ident->port.config), sizeof(idev->dev_cmd_regs->data)); 733 734 mutex_lock(&ionic->dev_cmd_lock); 735 736 memcpy_toio(&idev->dev_cmd_regs->data, &ident->port.config, sz); 737 ionic_dev_cmd_port_init(idev); 738 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 739 740 ionic_dev_cmd_port_state(&ionic->idev, IONIC_PORT_ADMIN_STATE_UP); 741 ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 742 743 mutex_unlock(&ionic->dev_cmd_lock); 744 if (err) { 745 dev_err(ionic->dev, "Failed to init port\n"); 746 dma_free_coherent(ionic->dev, idev->port_info_sz, 747 idev->port_info, idev->port_info_pa); 748 idev->port_info = NULL; 749 idev->port_info_pa = 0; 750 } 751 752 return err; 753 } 754 755 int ionic_port_reset(struct ionic *ionic) 756 { 757 struct ionic_dev *idev = &ionic->idev; 758 int err = 0; 759 760 if (!idev->port_info) 761 return 0; 762 763 if (ionic_is_fw_running(idev)) { 764 mutex_lock(&ionic->dev_cmd_lock); 765 ionic_dev_cmd_port_reset(idev); 766 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 767 mutex_unlock(&ionic->dev_cmd_lock); 768 } 769 770 dma_free_coherent(ionic->dev, idev->port_info_sz, 771 idev->port_info, idev->port_info_pa); 772 773 idev->port_info = NULL; 774 idev->port_info_pa = 0; 775 776 return err; 777 } 778 779 static int __init ionic_init_module(void) 780 { 781 int ret; 782 783 ionic_debugfs_create(); 784 ret = ionic_bus_register_driver(); 785 if (ret) 786 ionic_debugfs_destroy(); 787 788 return ret; 789 } 790 791 static void __exit ionic_cleanup_module(void) 792 { 793 ionic_bus_unregister_driver(); 794 ionic_debugfs_destroy(); 795 796 pr_info("%s removed\n", IONIC_DRV_NAME); 797 } 798 799 module_init(ionic_init_module); 800 module_exit(ionic_cleanup_module); 801