1// SPDX-License-Identifier: GPL-2.0 2/* Copyright(c) 2017 - 2019 Pensando Systems, Inc */ 3 4#include <linux/kernel.h> 5#include <linux/types.h> 6#include <linux/errno.h> 7#include <linux/io.h> 8#include <linux/slab.h> 9#include <linux/etherdevice.h> 10#include "ionic.h" 11#include "ionic_dev.h" 12#include "ionic_lif.h" 13 14static void ionic_watchdog_cb(struct timer_list *t) 15{ 16 struct ionic *ionic = from_timer(ionic, t, watchdog_timer); 17 struct ionic_lif *lif = ionic->lif; 18 struct ionic_deferred_work *work; 19 int hb; 20 21 mod_timer(&ionic->watchdog_timer, 22 round_jiffies(jiffies + ionic->watchdog_period)); 23 24 if (!lif) 25 return; 26 27 hb = ionic_heartbeat_check(ionic); 28 dev_dbg(ionic->dev, "%s: hb %d running %d UP %d\n", 29 __func__, hb, netif_running(lif->netdev), 30 test_bit(IONIC_LIF_F_UP, lif->state)); 31 32 if (hb >= 0 && 33 !test_bit(IONIC_LIF_F_FW_RESET, lif->state)) 34 ionic_link_status_check_request(lif, CAN_NOT_SLEEP); 35 36 if (test_bit(IONIC_LIF_F_FILTER_SYNC_NEEDED, lif->state) && 37 !test_bit(IONIC_LIF_F_FW_RESET, lif->state)) { 38 work = kzalloc(sizeof(*work), GFP_ATOMIC); 39 if (!work) { 40 netdev_err(lif->netdev, "rxmode change dropped\n"); 41 return; 42 } 43 44 work->type = IONIC_DW_TYPE_RX_MODE; 45 netdev_dbg(lif->netdev, "deferred: rx_mode\n"); 46 ionic_lif_deferred_enqueue(&lif->deferred, work); 47 } 48} 49 50static void ionic_watchdog_init(struct ionic *ionic) 51{ 52 struct ionic_dev *idev = &ionic->idev; 53 54 timer_setup(&ionic->watchdog_timer, ionic_watchdog_cb, 0); 55 ionic->watchdog_period = IONIC_WATCHDOG_SECS * HZ; 56 57 /* set times to ensure the first check will proceed */ 58 atomic_long_set(&idev->last_check_time, jiffies - 2 * HZ); 59 idev->last_hb_time = jiffies - 2 * ionic->watchdog_period; 60 /* init as ready, so no transition if the first check succeeds */ 61 idev->last_fw_hb = 0; 62 idev->fw_hb_ready = true; 63 idev->fw_status_ready = true; 64 idev->fw_generation = IONIC_FW_STS_F_GENERATION & 65 ioread8(&idev->dev_info_regs->fw_status); 66} 67 68void ionic_init_devinfo(struct ionic *ionic) 69{ 70 struct ionic_dev *idev = &ionic->idev; 71 72 idev->dev_info.asic_type = ioread8(&idev->dev_info_regs->asic_type); 73 idev->dev_info.asic_rev = ioread8(&idev->dev_info_regs->asic_rev); 74 75 memcpy_fromio(idev->dev_info.fw_version, 76 idev->dev_info_regs->fw_version, 77 IONIC_DEVINFO_FWVERS_BUFLEN); 78 79 memcpy_fromio(idev->dev_info.serial_num, 80 idev->dev_info_regs->serial_num, 81 IONIC_DEVINFO_SERIAL_BUFLEN); 82 83 idev->dev_info.fw_version[IONIC_DEVINFO_FWVERS_BUFLEN] = 0; 84 idev->dev_info.serial_num[IONIC_DEVINFO_SERIAL_BUFLEN] = 0; 85 86 dev_dbg(ionic->dev, "fw_version %s\n", idev->dev_info.fw_version); 87} 88 89int ionic_dev_setup(struct ionic *ionic) 90{ 91 struct ionic_dev_bar *bar = ionic->bars; 92 unsigned int num_bars = ionic->num_bars; 93 struct ionic_dev *idev = &ionic->idev; 94 struct device *dev = ionic->dev; 95 int size; 96 u32 sig; 97 98 /* BAR0: dev_cmd and interrupts */ 99 if (num_bars < 1) { 100 dev_err(dev, "No bars found, aborting\n"); 101 return -EFAULT; 102 } 103 104 if (bar->len < IONIC_BAR0_SIZE) { 105 dev_err(dev, "Resource bar size %lu too small, aborting\n", 106 bar->len); 107 return -EFAULT; 108 } 109 110 idev->dev_info_regs = bar->vaddr + IONIC_BAR0_DEV_INFO_REGS_OFFSET; 111 idev->dev_cmd_regs = bar->vaddr + IONIC_BAR0_DEV_CMD_REGS_OFFSET; 112 idev->intr_status = bar->vaddr + IONIC_BAR0_INTR_STATUS_OFFSET; 113 idev->intr_ctrl = bar->vaddr + IONIC_BAR0_INTR_CTRL_OFFSET; 114 115 idev->hwstamp_regs = &idev->dev_info_regs->hwstamp; 116 117 sig = ioread32(&idev->dev_info_regs->signature); 118 if (sig != IONIC_DEV_INFO_SIGNATURE) { 119 dev_err(dev, "Incompatible firmware signature %x", sig); 120 return -EFAULT; 121 } 122 123 ionic_init_devinfo(ionic); 124 125 /* BAR1: doorbells */ 126 bar++; 127 if (num_bars < 2) { 128 dev_err(dev, "Doorbell bar missing, aborting\n"); 129 return -EFAULT; 130 } 131 132 ionic_watchdog_init(ionic); 133 134 idev->db_pages = bar->vaddr; 135 idev->phy_db_pages = bar->bus_addr; 136 137 /* BAR2: optional controller memory mapping */ 138 bar++; 139 mutex_init(&idev->cmb_inuse_lock); 140 if (num_bars < 3 || !ionic->bars[IONIC_PCI_BAR_CMB].len) { 141 idev->cmb_inuse = NULL; 142 return 0; 143 } 144 145 idev->phy_cmb_pages = bar->bus_addr; 146 idev->cmb_npages = bar->len / PAGE_SIZE; 147 size = BITS_TO_LONGS(idev->cmb_npages) * sizeof(long); 148 idev->cmb_inuse = kzalloc(size, GFP_KERNEL); 149 if (!idev->cmb_inuse) 150 dev_warn(dev, "No memory for CMB, disabling\n"); 151 152 return 0; 153} 154 155void ionic_dev_teardown(struct ionic *ionic) 156{ 157 struct ionic_dev *idev = &ionic->idev; 158 159 kfree(idev->cmb_inuse); 160 idev->cmb_inuse = NULL; 161 idev->phy_cmb_pages = 0; 162 idev->cmb_npages = 0; 163 164 mutex_destroy(&idev->cmb_inuse_lock); 165} 166 167/* Devcmd Interface */ 168bool ionic_is_fw_running(struct ionic_dev *idev) 169{ 170 u8 fw_status = ioread8(&idev->dev_info_regs->fw_status); 171 172 /* firmware is useful only if the running bit is set and 173 * fw_status != 0xff (bad PCI read) 174 */ 175 return (fw_status != 0xff) && (fw_status & IONIC_FW_STS_F_RUNNING); 176} 177 178int ionic_heartbeat_check(struct ionic *ionic) 179{ 180 unsigned long check_time, last_check_time; 181 struct ionic_dev *idev = &ionic->idev; 182 struct ionic_lif *lif = ionic->lif; 183 bool fw_status_ready = true; 184 bool fw_hb_ready; 185 u8 fw_generation; 186 u8 fw_status; 187 u32 fw_hb; 188 189 /* wait a least one second before testing again */ 190 check_time = jiffies; 191 last_check_time = atomic_long_read(&idev->last_check_time); 192do_check_time: 193 if (time_before(check_time, last_check_time + HZ)) 194 return 0; 195 if (!atomic_long_try_cmpxchg_relaxed(&idev->last_check_time, 196 &last_check_time, check_time)) { 197 /* if called concurrently, only the first should proceed. */ 198 dev_dbg(ionic->dev, "%s: do_check_time again\n", __func__); 199 goto do_check_time; 200 } 201 202 fw_status = ioread8(&idev->dev_info_regs->fw_status); 203 204 /* If fw_status is not ready don't bother with the generation */ 205 if (!ionic_is_fw_running(idev)) { 206 fw_status_ready = false; 207 } else { 208 fw_generation = fw_status & IONIC_FW_STS_F_GENERATION; 209 if (idev->fw_generation != fw_generation) { 210 dev_info(ionic->dev, "FW generation 0x%02x -> 0x%02x\n", 211 idev->fw_generation, fw_generation); 212 213 idev->fw_generation = fw_generation; 214 215 /* If the generation changed, the fw status is not 216 * ready so we need to trigger a fw-down cycle. After 217 * the down, the next watchdog will see the fw is up 218 * and the generation value stable, so will trigger 219 * the fw-up activity. 220 * 221 * If we had already moved to FW_RESET from a RESET event, 222 * it is possible that we never saw the fw_status go to 0, 223 * so we fake the current idev->fw_status_ready here to 224 * force the transition and get FW up again. 225 */ 226 if (test_bit(IONIC_LIF_F_FW_RESET, lif->state)) 227 idev->fw_status_ready = false; /* go to running */ 228 else 229 fw_status_ready = false; /* go to down */ 230 } 231 } 232 233 dev_dbg(ionic->dev, "fw_status 0x%02x ready %d idev->ready %d last_hb 0x%x state 0x%02lx\n", 234 fw_status, fw_status_ready, idev->fw_status_ready, 235 idev->last_fw_hb, lif->state[0]); 236 237 /* is this a transition? */ 238 if (fw_status_ready != idev->fw_status_ready && 239 !test_bit(IONIC_LIF_F_FW_STOPPING, lif->state)) { 240 bool trigger = false; 241 242 idev->fw_status_ready = fw_status_ready; 243 244 if (!fw_status_ready && 245 !test_bit(IONIC_LIF_F_FW_RESET, lif->state) && 246 !test_and_set_bit(IONIC_LIF_F_FW_STOPPING, lif->state)) { 247 dev_info(ionic->dev, "FW stopped 0x%02x\n", fw_status); 248 trigger = true; 249 250 } else if (fw_status_ready && 251 test_bit(IONIC_LIF_F_FW_RESET, lif->state)) { 252 dev_info(ionic->dev, "FW running 0x%02x\n", fw_status); 253 trigger = true; 254 } 255 256 if (trigger) { 257 struct ionic_deferred_work *work; 258 259 work = kzalloc(sizeof(*work), GFP_ATOMIC); 260 if (work) { 261 work->type = IONIC_DW_TYPE_LIF_RESET; 262 work->fw_status = fw_status_ready; 263 ionic_lif_deferred_enqueue(&lif->deferred, work); 264 } 265 } 266 } 267 268 if (!idev->fw_status_ready) 269 return -ENXIO; 270 271 /* Because of some variability in the actual FW heartbeat, we 272 * wait longer than the DEVCMD_TIMEOUT before checking again. 273 */ 274 last_check_time = idev->last_hb_time; 275 if (time_before(check_time, last_check_time + DEVCMD_TIMEOUT * 2 * HZ)) 276 return 0; 277 278 fw_hb = ioread32(&idev->dev_info_regs->fw_heartbeat); 279 fw_hb_ready = fw_hb != idev->last_fw_hb; 280 281 /* early FW version had no heartbeat, so fake it */ 282 if (!fw_hb_ready && !fw_hb) 283 fw_hb_ready = true; 284 285 dev_dbg(ionic->dev, "%s: fw_hb %u last_fw_hb %u ready %u\n", 286 __func__, fw_hb, idev->last_fw_hb, fw_hb_ready); 287 288 idev->last_fw_hb = fw_hb; 289 290 /* log a transition */ 291 if (fw_hb_ready != idev->fw_hb_ready) { 292 idev->fw_hb_ready = fw_hb_ready; 293 if (!fw_hb_ready) 294 dev_info(ionic->dev, "FW heartbeat stalled at %d\n", fw_hb); 295 else 296 dev_info(ionic->dev, "FW heartbeat restored at %d\n", fw_hb); 297 } 298 299 if (!fw_hb_ready) 300 return -ENXIO; 301 302 idev->last_hb_time = check_time; 303 304 return 0; 305} 306 307u8 ionic_dev_cmd_status(struct ionic_dev *idev) 308{ 309 return ioread8(&idev->dev_cmd_regs->comp.comp.status); 310} 311 312bool ionic_dev_cmd_done(struct ionic_dev *idev) 313{ 314 return ioread32(&idev->dev_cmd_regs->done) & IONIC_DEV_CMD_DONE; 315} 316 317void ionic_dev_cmd_comp(struct ionic_dev *idev, union ionic_dev_cmd_comp *comp) 318{ 319 memcpy_fromio(comp, &idev->dev_cmd_regs->comp, sizeof(*comp)); 320} 321 322void ionic_dev_cmd_go(struct ionic_dev *idev, union ionic_dev_cmd *cmd) 323{ 324 idev->opcode = cmd->cmd.opcode; 325 memcpy_toio(&idev->dev_cmd_regs->cmd, cmd, sizeof(*cmd)); 326 iowrite32(0, &idev->dev_cmd_regs->done); 327 iowrite32(1, &idev->dev_cmd_regs->doorbell); 328} 329 330/* Device commands */ 331void ionic_dev_cmd_identify(struct ionic_dev *idev, u8 ver) 332{ 333 union ionic_dev_cmd cmd = { 334 .identify.opcode = IONIC_CMD_IDENTIFY, 335 .identify.ver = ver, 336 }; 337 338 ionic_dev_cmd_go(idev, &cmd); 339} 340 341void ionic_dev_cmd_init(struct ionic_dev *idev) 342{ 343 union ionic_dev_cmd cmd = { 344 .init.opcode = IONIC_CMD_INIT, 345 .init.type = 0, 346 }; 347 348 ionic_dev_cmd_go(idev, &cmd); 349} 350 351void ionic_dev_cmd_reset(struct ionic_dev *idev) 352{ 353 union ionic_dev_cmd cmd = { 354 .reset.opcode = IONIC_CMD_RESET, 355 }; 356 357 ionic_dev_cmd_go(idev, &cmd); 358} 359 360/* Port commands */ 361void ionic_dev_cmd_port_identify(struct ionic_dev *idev) 362{ 363 union ionic_dev_cmd cmd = { 364 .port_init.opcode = IONIC_CMD_PORT_IDENTIFY, 365 .port_init.index = 0, 366 }; 367 368 ionic_dev_cmd_go(idev, &cmd); 369} 370 371void ionic_dev_cmd_port_init(struct ionic_dev *idev) 372{ 373 union ionic_dev_cmd cmd = { 374 .port_init.opcode = IONIC_CMD_PORT_INIT, 375 .port_init.index = 0, 376 .port_init.info_pa = cpu_to_le64(idev->port_info_pa), 377 }; 378 379 ionic_dev_cmd_go(idev, &cmd); 380} 381 382void ionic_dev_cmd_port_reset(struct ionic_dev *idev) 383{ 384 union ionic_dev_cmd cmd = { 385 .port_reset.opcode = IONIC_CMD_PORT_RESET, 386 .port_reset.index = 0, 387 }; 388 389 ionic_dev_cmd_go(idev, &cmd); 390} 391 392void ionic_dev_cmd_port_state(struct ionic_dev *idev, u8 state) 393{ 394 union ionic_dev_cmd cmd = { 395 .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 396 .port_setattr.index = 0, 397 .port_setattr.attr = IONIC_PORT_ATTR_STATE, 398 .port_setattr.state = state, 399 }; 400 401 ionic_dev_cmd_go(idev, &cmd); 402} 403 404void ionic_dev_cmd_port_speed(struct ionic_dev *idev, u32 speed) 405{ 406 union ionic_dev_cmd cmd = { 407 .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 408 .port_setattr.index = 0, 409 .port_setattr.attr = IONIC_PORT_ATTR_SPEED, 410 .port_setattr.speed = cpu_to_le32(speed), 411 }; 412 413 ionic_dev_cmd_go(idev, &cmd); 414} 415 416void ionic_dev_cmd_port_autoneg(struct ionic_dev *idev, u8 an_enable) 417{ 418 union ionic_dev_cmd cmd = { 419 .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 420 .port_setattr.index = 0, 421 .port_setattr.attr = IONIC_PORT_ATTR_AUTONEG, 422 .port_setattr.an_enable = an_enable, 423 }; 424 425 ionic_dev_cmd_go(idev, &cmd); 426} 427 428void ionic_dev_cmd_port_fec(struct ionic_dev *idev, u8 fec_type) 429{ 430 union ionic_dev_cmd cmd = { 431 .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 432 .port_setattr.index = 0, 433 .port_setattr.attr = IONIC_PORT_ATTR_FEC, 434 .port_setattr.fec_type = fec_type, 435 }; 436 437 ionic_dev_cmd_go(idev, &cmd); 438} 439 440void ionic_dev_cmd_port_pause(struct ionic_dev *idev, u8 pause_type) 441{ 442 union ionic_dev_cmd cmd = { 443 .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 444 .port_setattr.index = 0, 445 .port_setattr.attr = IONIC_PORT_ATTR_PAUSE, 446 .port_setattr.pause_type = pause_type, 447 }; 448 449 ionic_dev_cmd_go(idev, &cmd); 450} 451 452/* VF commands */ 453int ionic_set_vf_config(struct ionic *ionic, int vf, 454 struct ionic_vf_setattr_cmd *vfc) 455{ 456 union ionic_dev_cmd cmd = { 457 .vf_setattr.opcode = IONIC_CMD_VF_SETATTR, 458 .vf_setattr.attr = vfc->attr, 459 .vf_setattr.vf_index = cpu_to_le16(vf), 460 }; 461 int err; 462 463 memcpy(cmd.vf_setattr.pad, vfc->pad, sizeof(vfc->pad)); 464 465 mutex_lock(&ionic->dev_cmd_lock); 466 ionic_dev_cmd_go(&ionic->idev, &cmd); 467 err = ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 468 mutex_unlock(&ionic->dev_cmd_lock); 469 470 return err; 471} 472 473int ionic_dev_cmd_vf_getattr(struct ionic *ionic, int vf, u8 attr, 474 struct ionic_vf_getattr_comp *comp) 475{ 476 union ionic_dev_cmd cmd = { 477 .vf_getattr.opcode = IONIC_CMD_VF_GETATTR, 478 .vf_getattr.attr = attr, 479 .vf_getattr.vf_index = cpu_to_le16(vf), 480 }; 481 int err; 482 483 if (vf >= ionic->num_vfs) 484 return -EINVAL; 485 486 switch (attr) { 487 case IONIC_VF_ATTR_SPOOFCHK: 488 case IONIC_VF_ATTR_TRUST: 489 case IONIC_VF_ATTR_LINKSTATE: 490 case IONIC_VF_ATTR_MAC: 491 case IONIC_VF_ATTR_VLAN: 492 case IONIC_VF_ATTR_RATE: 493 break; 494 case IONIC_VF_ATTR_STATSADDR: 495 default: 496 return -EINVAL; 497 } 498 499 mutex_lock(&ionic->dev_cmd_lock); 500 ionic_dev_cmd_go(&ionic->idev, &cmd); 501 err = ionic_dev_cmd_wait_nomsg(ionic, DEVCMD_TIMEOUT); 502 memcpy_fromio(comp, &ionic->idev.dev_cmd_regs->comp.vf_getattr, 503 sizeof(*comp)); 504 mutex_unlock(&ionic->dev_cmd_lock); 505 506 if (err && comp->status != IONIC_RC_ENOSUPP) 507 ionic_dev_cmd_dev_err_print(ionic, cmd.vf_getattr.opcode, 508 comp->status, err); 509 510 return err; 511} 512 513void ionic_vf_start(struct ionic *ionic) 514{ 515 union ionic_dev_cmd cmd = { 516 .vf_ctrl.opcode = IONIC_CMD_VF_CTRL, 517 .vf_ctrl.ctrl_opcode = IONIC_VF_CTRL_START_ALL, 518 }; 519 520 if (!(ionic->ident.dev.capabilities & cpu_to_le64(IONIC_DEV_CAP_VF_CTRL))) 521 return; 522 523 ionic_dev_cmd_go(&ionic->idev, &cmd); 524 ionic_dev_cmd_wait(ionic, DEVCMD_TIMEOUT); 525} 526 527/* LIF commands */ 528void ionic_dev_cmd_queue_identify(struct ionic_dev *idev, 529 u16 lif_type, u8 qtype, u8 qver) 530{ 531 union ionic_dev_cmd cmd = { 532 .q_identify.opcode = IONIC_CMD_Q_IDENTIFY, 533 .q_identify.lif_type = cpu_to_le16(lif_type), 534 .q_identify.type = qtype, 535 .q_identify.ver = qver, 536 }; 537 538 ionic_dev_cmd_go(idev, &cmd); 539} 540 541void ionic_dev_cmd_lif_identify(struct ionic_dev *idev, u8 type, u8 ver) 542{ 543 union ionic_dev_cmd cmd = { 544 .lif_identify.opcode = IONIC_CMD_LIF_IDENTIFY, 545 .lif_identify.type = type, 546 .lif_identify.ver = ver, 547 }; 548 549 ionic_dev_cmd_go(idev, &cmd); 550} 551 552void ionic_dev_cmd_lif_init(struct ionic_dev *idev, u16 lif_index, 553 dma_addr_t info_pa) 554{ 555 union ionic_dev_cmd cmd = { 556 .lif_init.opcode = IONIC_CMD_LIF_INIT, 557 .lif_init.index = cpu_to_le16(lif_index), 558 .lif_init.info_pa = cpu_to_le64(info_pa), 559 }; 560 561 ionic_dev_cmd_go(idev, &cmd); 562} 563 564void ionic_dev_cmd_lif_reset(struct ionic_dev *idev, u16 lif_index) 565{ 566 union ionic_dev_cmd cmd = { 567 .lif_init.opcode = IONIC_CMD_LIF_RESET, 568 .lif_init.index = cpu_to_le16(lif_index), 569 }; 570 571 ionic_dev_cmd_go(idev, &cmd); 572} 573 574void ionic_dev_cmd_adminq_init(struct ionic_dev *idev, struct ionic_qcq *qcq, 575 u16 lif_index, u16 intr_index) 576{ 577 struct ionic_queue *q = &qcq->q; 578 struct ionic_cq *cq = &qcq->cq; 579 580 union ionic_dev_cmd cmd = { 581 .q_init.opcode = IONIC_CMD_Q_INIT, 582 .q_init.lif_index = cpu_to_le16(lif_index), 583 .q_init.type = q->type, 584 .q_init.ver = qcq->q.lif->qtype_info[q->type].version, 585 .q_init.index = cpu_to_le32(q->index), 586 .q_init.flags = cpu_to_le16(IONIC_QINIT_F_IRQ | 587 IONIC_QINIT_F_ENA), 588 .q_init.pid = cpu_to_le16(q->pid), 589 .q_init.intr_index = cpu_to_le16(intr_index), 590 .q_init.ring_size = ilog2(q->num_descs), 591 .q_init.ring_base = cpu_to_le64(q->base_pa), 592 .q_init.cq_ring_base = cpu_to_le64(cq->base_pa), 593 }; 594 595 ionic_dev_cmd_go(idev, &cmd); 596} 597 598int ionic_db_page_num(struct ionic_lif *lif, int pid) 599{ 600 return (lif->hw_index * lif->dbid_count) + pid; 601} 602 603int ionic_get_cmb(struct ionic_lif *lif, u32 *pgid, phys_addr_t *pgaddr, int order) 604{ 605 struct ionic_dev *idev = &lif->ionic->idev; 606 int ret; 607 608 mutex_lock(&idev->cmb_inuse_lock); 609 ret = bitmap_find_free_region(idev->cmb_inuse, idev->cmb_npages, order); 610 mutex_unlock(&idev->cmb_inuse_lock); 611 612 if (ret < 0) 613 return ret; 614 615 *pgid = ret; 616 *pgaddr = idev->phy_cmb_pages + ret * PAGE_SIZE; 617 618 return 0; 619} 620 621void ionic_put_cmb(struct ionic_lif *lif, u32 pgid, int order) 622{ 623 struct ionic_dev *idev = &lif->ionic->idev; 624 625 mutex_lock(&idev->cmb_inuse_lock); 626 bitmap_release_region(idev->cmb_inuse, pgid, order); 627 mutex_unlock(&idev->cmb_inuse_lock); 628} 629 630int ionic_cq_init(struct ionic_lif *lif, struct ionic_cq *cq, 631 struct ionic_intr_info *intr, 632 unsigned int num_descs, size_t desc_size) 633{ 634 unsigned int ring_size; 635 636 if (desc_size == 0 || !is_power_of_2(num_descs)) 637 return -EINVAL; 638 639 ring_size = ilog2(num_descs); 640 if (ring_size < 2 || ring_size > 16) 641 return -EINVAL; 642 643 cq->lif = lif; 644 cq->bound_intr = intr; 645 cq->num_descs = num_descs; 646 cq->desc_size = desc_size; 647 cq->tail_idx = 0; 648 cq->done_color = 1; 649 650 return 0; 651} 652 653void ionic_cq_map(struct ionic_cq *cq, void *base, dma_addr_t base_pa) 654{ 655 struct ionic_cq_info *cur; 656 unsigned int i; 657 658 cq->base = base; 659 cq->base_pa = base_pa; 660 661 for (i = 0, cur = cq->info; i < cq->num_descs; i++, cur++) 662 cur->cq_desc = base + (i * cq->desc_size); 663} 664 665void ionic_cq_bind(struct ionic_cq *cq, struct ionic_queue *q) 666{ 667 cq->bound_q = q; 668} 669 670unsigned int ionic_cq_service(struct ionic_cq *cq, unsigned int work_to_do, 671 ionic_cq_cb cb, ionic_cq_done_cb done_cb, 672 void *done_arg) 673{ 674 struct ionic_cq_info *cq_info; 675 unsigned int work_done = 0; 676 677 if (work_to_do == 0) 678 return 0; 679 680 cq_info = &cq->info[cq->tail_idx]; 681 while (cb(cq, cq_info)) { 682 if (cq->tail_idx == cq->num_descs - 1) 683 cq->done_color = !cq->done_color; 684 cq->tail_idx = (cq->tail_idx + 1) & (cq->num_descs - 1); 685 cq_info = &cq->info[cq->tail_idx]; 686 687 if (++work_done >= work_to_do) 688 break; 689 } 690 691 if (work_done && done_cb) 692 done_cb(done_arg); 693 694 return work_done; 695} 696 697int ionic_q_init(struct ionic_lif *lif, struct ionic_dev *idev, 698 struct ionic_queue *q, unsigned int index, const char *name, 699 unsigned int num_descs, size_t desc_size, 700 size_t sg_desc_size, unsigned int pid) 701{ 702 unsigned int ring_size; 703 704 if (desc_size == 0 || !is_power_of_2(num_descs)) 705 return -EINVAL; 706 707 ring_size = ilog2(num_descs); 708 if (ring_size < 2 || ring_size > 16) 709 return -EINVAL; 710 711 q->lif = lif; 712 q->idev = idev; 713 q->index = index; 714 q->num_descs = num_descs; 715 q->desc_size = desc_size; 716 q->sg_desc_size = sg_desc_size; 717 q->tail_idx = 0; 718 q->head_idx = 0; 719 q->pid = pid; 720 721 snprintf(q->name, sizeof(q->name), "L%d-%s%u", lif->index, name, index); 722 723 return 0; 724} 725 726void ionic_q_map(struct ionic_queue *q, void *base, dma_addr_t base_pa) 727{ 728 struct ionic_desc_info *cur; 729 unsigned int i; 730 731 q->base = base; 732 q->base_pa = base_pa; 733 734 for (i = 0, cur = q->info; i < q->num_descs; i++, cur++) 735 cur->desc = base + (i * q->desc_size); 736} 737 738void ionic_q_cmb_map(struct ionic_queue *q, void __iomem *base, dma_addr_t base_pa) 739{ 740 struct ionic_desc_info *cur; 741 unsigned int i; 742 743 q->cmb_base = base; 744 q->cmb_base_pa = base_pa; 745 746 for (i = 0, cur = q->info; i < q->num_descs; i++, cur++) 747 cur->cmb_desc = base + (i * q->desc_size); 748} 749 750void ionic_q_sg_map(struct ionic_queue *q, void *base, dma_addr_t base_pa) 751{ 752 struct ionic_desc_info *cur; 753 unsigned int i; 754 755 q->sg_base = base; 756 q->sg_base_pa = base_pa; 757 758 for (i = 0, cur = q->info; i < q->num_descs; i++, cur++) 759 cur->sg_desc = base + (i * q->sg_desc_size); 760} 761 762void ionic_q_post(struct ionic_queue *q, bool ring_doorbell, ionic_desc_cb cb, 763 void *cb_arg) 764{ 765 struct ionic_desc_info *desc_info; 766 struct ionic_lif *lif = q->lif; 767 struct device *dev = q->dev; 768 769 desc_info = &q->info[q->head_idx]; 770 desc_info->cb = cb; 771 desc_info->cb_arg = cb_arg; 772 773 q->head_idx = (q->head_idx + 1) & (q->num_descs - 1); 774 775 dev_dbg(dev, "lif=%d qname=%s qid=%d qtype=%d p_index=%d ringdb=%d\n", 776 q->lif->index, q->name, q->hw_type, q->hw_index, 777 q->head_idx, ring_doorbell); 778 779 if (ring_doorbell) { 780 ionic_dbell_ring(lif->kern_dbpage, q->hw_type, 781 q->dbval | q->head_idx); 782 783 q->dbell_jiffies = jiffies; 784 785 if (q_to_qcq(q)->napi_qcq) 786 mod_timer(&q_to_qcq(q)->napi_qcq->napi_deadline, 787 jiffies + IONIC_NAPI_DEADLINE); 788 } 789} 790 791static bool ionic_q_is_posted(struct ionic_queue *q, unsigned int pos) 792{ 793 unsigned int mask, tail, head; 794 795 mask = q->num_descs - 1; 796 tail = q->tail_idx; 797 head = q->head_idx; 798 799 return ((pos - tail) & mask) < ((head - tail) & mask); 800} 801 802void ionic_q_service(struct ionic_queue *q, struct ionic_cq_info *cq_info, 803 unsigned int stop_index) 804{ 805 struct ionic_desc_info *desc_info; 806 ionic_desc_cb cb; 807 void *cb_arg; 808 u16 index; 809 810 /* check for empty queue */ 811 if (q->tail_idx == q->head_idx) 812 return; 813 814 /* stop index must be for a descriptor that is not yet completed */ 815 if (unlikely(!ionic_q_is_posted(q, stop_index))) 816 dev_err(q->dev, 817 "ionic stop is not posted %s stop %u tail %u head %u\n", 818 q->name, stop_index, q->tail_idx, q->head_idx); 819 820 do { 821 desc_info = &q->info[q->tail_idx]; 822 index = q->tail_idx; 823 q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1); 824 825 cb = desc_info->cb; 826 cb_arg = desc_info->cb_arg; 827 828 desc_info->cb = NULL; 829 desc_info->cb_arg = NULL; 830 831 if (cb) 832 cb(q, desc_info, cq_info, cb_arg); 833 } while (index != stop_index); 834} 835