15ef51809SAlfredo Cardigliano /* SPDX-License-Identifier: (BSD-3-Clause OR GPL-2.0) 25ef51809SAlfredo Cardigliano * Copyright(c) 2018-2019 Pensando Systems, Inc. All rights reserved. 35ef51809SAlfredo Cardigliano */ 45ef51809SAlfredo Cardigliano 55ef51809SAlfredo Cardigliano #include <rte_malloc.h> 65ef51809SAlfredo Cardigliano 75ef51809SAlfredo Cardigliano #include "ionic_dev.h" 8c67719e1SAlfredo Cardigliano #include "ionic_lif.h" 95ef51809SAlfredo Cardigliano #include "ionic.h" 105ef51809SAlfredo Cardigliano 115ef51809SAlfredo Cardigliano int 125ef51809SAlfredo Cardigliano ionic_dev_setup(struct ionic_adapter *adapter) 135ef51809SAlfredo Cardigliano { 145ef51809SAlfredo Cardigliano struct ionic_dev_bar *bar = adapter->bars; 155ef51809SAlfredo Cardigliano unsigned int num_bars = adapter->num_bars; 165ef51809SAlfredo Cardigliano struct ionic_dev *idev = &adapter->idev; 175ef51809SAlfredo Cardigliano uint32_t sig; 185ef51809SAlfredo Cardigliano u_char *bar0_base; 19*eec10fb0SAlfredo Cardigliano unsigned int i; 205ef51809SAlfredo Cardigliano 215ef51809SAlfredo Cardigliano /* BAR0: dev_cmd and interrupts */ 225ef51809SAlfredo Cardigliano if (num_bars < 1) { 235ef51809SAlfredo Cardigliano IONIC_PRINT(ERR, "No bars found, aborting"); 245ef51809SAlfredo Cardigliano return -EFAULT; 255ef51809SAlfredo Cardigliano } 265ef51809SAlfredo Cardigliano 275ef51809SAlfredo Cardigliano if (bar->len < IONIC_BAR0_SIZE) { 285ef51809SAlfredo Cardigliano IONIC_PRINT(ERR, 295ef51809SAlfredo Cardigliano "Resource bar size %lu too small, aborting", 305ef51809SAlfredo Cardigliano bar->len); 315ef51809SAlfredo Cardigliano return -EFAULT; 325ef51809SAlfredo Cardigliano } 335ef51809SAlfredo Cardigliano 345ef51809SAlfredo Cardigliano bar0_base = bar->vaddr; 355ef51809SAlfredo Cardigliano idev->dev_info = (union ionic_dev_info_regs *) 365ef51809SAlfredo Cardigliano &bar0_base[IONIC_BAR0_DEV_INFO_REGS_OFFSET]; 375ef51809SAlfredo Cardigliano idev->dev_cmd = (union ionic_dev_cmd_regs *) 385ef51809SAlfredo Cardigliano &bar0_base[IONIC_BAR0_DEV_CMD_REGS_OFFSET]; 395ef51809SAlfredo Cardigliano idev->intr_status = (struct ionic_intr_status *) 405ef51809SAlfredo Cardigliano &bar0_base[IONIC_BAR0_INTR_STATUS_OFFSET]; 415ef51809SAlfredo Cardigliano idev->intr_ctrl = (struct ionic_intr *) 425ef51809SAlfredo Cardigliano &bar0_base[IONIC_BAR0_INTR_CTRL_OFFSET]; 435ef51809SAlfredo Cardigliano 445ef51809SAlfredo Cardigliano sig = ioread32(&idev->dev_info->signature); 455ef51809SAlfredo Cardigliano if (sig != IONIC_DEV_INFO_SIGNATURE) { 465ef51809SAlfredo Cardigliano IONIC_PRINT(ERR, "Incompatible firmware signature %" PRIx32 "", 475ef51809SAlfredo Cardigliano sig); 485ef51809SAlfredo Cardigliano return -EFAULT; 495ef51809SAlfredo Cardigliano } 505ef51809SAlfredo Cardigliano 51*eec10fb0SAlfredo Cardigliano for (i = 0; i < IONIC_DEVINFO_FWVERS_BUFLEN; i++) 52*eec10fb0SAlfredo Cardigliano adapter->fw_version[i] = 53*eec10fb0SAlfredo Cardigliano ioread8(&idev->dev_info->fw_version[i]); 54*eec10fb0SAlfredo Cardigliano adapter->fw_version[IONIC_DEVINFO_FWVERS_BUFLEN - 1] = '\0'; 55*eec10fb0SAlfredo Cardigliano 56*eec10fb0SAlfredo Cardigliano IONIC_PRINT(DEBUG, "Firmware version: %s", adapter->fw_version); 57*eec10fb0SAlfredo Cardigliano 585ef51809SAlfredo Cardigliano /* BAR1: doorbells */ 595ef51809SAlfredo Cardigliano bar++; 605ef51809SAlfredo Cardigliano if (num_bars < 2) { 615ef51809SAlfredo Cardigliano IONIC_PRINT(ERR, "Doorbell bar missing, aborting"); 625ef51809SAlfredo Cardigliano return -EFAULT; 635ef51809SAlfredo Cardigliano } 645ef51809SAlfredo Cardigliano 655ef51809SAlfredo Cardigliano idev->db_pages = bar->vaddr; 665ef51809SAlfredo Cardigliano idev->phy_db_pages = bar->bus_addr; 675ef51809SAlfredo Cardigliano 685ef51809SAlfredo Cardigliano return 0; 695ef51809SAlfredo Cardigliano } 705ef51809SAlfredo Cardigliano 715ef51809SAlfredo Cardigliano /* Devcmd Interface */ 725ef51809SAlfredo Cardigliano 735ef51809SAlfredo Cardigliano uint8_t 745ef51809SAlfredo Cardigliano ionic_dev_cmd_status(struct ionic_dev *idev) 755ef51809SAlfredo Cardigliano { 765ef51809SAlfredo Cardigliano return ioread8(&idev->dev_cmd->comp.comp.status); 775ef51809SAlfredo Cardigliano } 785ef51809SAlfredo Cardigliano 795ef51809SAlfredo Cardigliano bool 805ef51809SAlfredo Cardigliano ionic_dev_cmd_done(struct ionic_dev *idev) 815ef51809SAlfredo Cardigliano { 825ef51809SAlfredo Cardigliano return ioread32(&idev->dev_cmd->done) & IONIC_DEV_CMD_DONE; 835ef51809SAlfredo Cardigliano } 845ef51809SAlfredo Cardigliano 855ef51809SAlfredo Cardigliano void 865ef51809SAlfredo Cardigliano ionic_dev_cmd_comp(struct ionic_dev *idev, void *mem) 875ef51809SAlfredo Cardigliano { 885ef51809SAlfredo Cardigliano union ionic_dev_cmd_comp *comp = mem; 895ef51809SAlfredo Cardigliano unsigned int i; 905ef51809SAlfredo Cardigliano uint32_t comp_size = sizeof(comp->words) / 915ef51809SAlfredo Cardigliano sizeof(comp->words[0]); 925ef51809SAlfredo Cardigliano 935ef51809SAlfredo Cardigliano for (i = 0; i < comp_size; i++) 945ef51809SAlfredo Cardigliano comp->words[i] = ioread32(&idev->dev_cmd->comp.words[i]); 955ef51809SAlfredo Cardigliano } 965ef51809SAlfredo Cardigliano 975ef51809SAlfredo Cardigliano void 985ef51809SAlfredo Cardigliano ionic_dev_cmd_go(struct ionic_dev *idev, union ionic_dev_cmd *cmd) 995ef51809SAlfredo Cardigliano { 1005ef51809SAlfredo Cardigliano unsigned int i; 1015ef51809SAlfredo Cardigliano uint32_t cmd_size = sizeof(cmd->words) / 1025ef51809SAlfredo Cardigliano sizeof(cmd->words[0]); 1035ef51809SAlfredo Cardigliano 1045ef51809SAlfredo Cardigliano for (i = 0; i < cmd_size; i++) 1055ef51809SAlfredo Cardigliano iowrite32(cmd->words[i], &idev->dev_cmd->cmd.words[i]); 1065ef51809SAlfredo Cardigliano 1075ef51809SAlfredo Cardigliano iowrite32(0, &idev->dev_cmd->done); 1085ef51809SAlfredo Cardigliano iowrite32(1, &idev->dev_cmd->doorbell); 1095ef51809SAlfredo Cardigliano } 1105ef51809SAlfredo Cardigliano 1115ef51809SAlfredo Cardigliano /* Device commands */ 1125ef51809SAlfredo Cardigliano 1135ef51809SAlfredo Cardigliano void 1145ef51809SAlfredo Cardigliano ionic_dev_cmd_identify(struct ionic_dev *idev, uint8_t ver) 1155ef51809SAlfredo Cardigliano { 1165ef51809SAlfredo Cardigliano union ionic_dev_cmd cmd = { 1175ef51809SAlfredo Cardigliano .identify.opcode = IONIC_CMD_IDENTIFY, 1185ef51809SAlfredo Cardigliano .identify.ver = ver, 1195ef51809SAlfredo Cardigliano }; 1205ef51809SAlfredo Cardigliano 1215ef51809SAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 1225ef51809SAlfredo Cardigliano } 1235ef51809SAlfredo Cardigliano 1245ef51809SAlfredo Cardigliano void 1255ef51809SAlfredo Cardigliano ionic_dev_cmd_init(struct ionic_dev *idev) 1265ef51809SAlfredo Cardigliano { 1275ef51809SAlfredo Cardigliano union ionic_dev_cmd cmd = { 1285ef51809SAlfredo Cardigliano .init.opcode = IONIC_CMD_INIT, 1295ef51809SAlfredo Cardigliano .init.type = 0, 1305ef51809SAlfredo Cardigliano }; 1315ef51809SAlfredo Cardigliano 1325ef51809SAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 1335ef51809SAlfredo Cardigliano } 1345ef51809SAlfredo Cardigliano 1355ef51809SAlfredo Cardigliano void 1365ef51809SAlfredo Cardigliano ionic_dev_cmd_reset(struct ionic_dev *idev) 1375ef51809SAlfredo Cardigliano { 1385ef51809SAlfredo Cardigliano union ionic_dev_cmd cmd = { 1395ef51809SAlfredo Cardigliano .reset.opcode = IONIC_CMD_RESET, 1405ef51809SAlfredo Cardigliano }; 1415ef51809SAlfredo Cardigliano 1425ef51809SAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 1435ef51809SAlfredo Cardigliano } 14423bf4ddbSAlfredo Cardigliano 14523bf4ddbSAlfredo Cardigliano /* Port commands */ 14623bf4ddbSAlfredo Cardigliano 14723bf4ddbSAlfredo Cardigliano void 14823bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_identify(struct ionic_dev *idev) 14923bf4ddbSAlfredo Cardigliano { 15023bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 15123bf4ddbSAlfredo Cardigliano .port_init.opcode = IONIC_CMD_PORT_IDENTIFY, 15223bf4ddbSAlfredo Cardigliano .port_init.index = 0, 15323bf4ddbSAlfredo Cardigliano }; 15423bf4ddbSAlfredo Cardigliano 15523bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 15623bf4ddbSAlfredo Cardigliano } 15723bf4ddbSAlfredo Cardigliano 15823bf4ddbSAlfredo Cardigliano void 15923bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_init(struct ionic_dev *idev) 16023bf4ddbSAlfredo Cardigliano { 16123bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 16223bf4ddbSAlfredo Cardigliano .port_init.opcode = IONIC_CMD_PORT_INIT, 16323bf4ddbSAlfredo Cardigliano .port_init.index = 0, 16423bf4ddbSAlfredo Cardigliano .port_init.info_pa = idev->port_info_pa, 16523bf4ddbSAlfredo Cardigliano }; 16623bf4ddbSAlfredo Cardigliano 16723bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 16823bf4ddbSAlfredo Cardigliano } 16923bf4ddbSAlfredo Cardigliano 17023bf4ddbSAlfredo Cardigliano void 17123bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_reset(struct ionic_dev *idev) 17223bf4ddbSAlfredo Cardigliano { 17323bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 17423bf4ddbSAlfredo Cardigliano .port_reset.opcode = IONIC_CMD_PORT_RESET, 17523bf4ddbSAlfredo Cardigliano .port_reset.index = 0, 17623bf4ddbSAlfredo Cardigliano }; 17723bf4ddbSAlfredo Cardigliano 17823bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 17923bf4ddbSAlfredo Cardigliano } 18023bf4ddbSAlfredo Cardigliano 18123bf4ddbSAlfredo Cardigliano void 18223bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_state(struct ionic_dev *idev, uint8_t state) 18323bf4ddbSAlfredo Cardigliano { 18423bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 18523bf4ddbSAlfredo Cardigliano .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 18623bf4ddbSAlfredo Cardigliano .port_setattr.index = 0, 18723bf4ddbSAlfredo Cardigliano .port_setattr.attr = IONIC_PORT_ATTR_STATE, 18823bf4ddbSAlfredo Cardigliano .port_setattr.state = state, 18923bf4ddbSAlfredo Cardigliano }; 19023bf4ddbSAlfredo Cardigliano 19123bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 19223bf4ddbSAlfredo Cardigliano } 19323bf4ddbSAlfredo Cardigliano 19423bf4ddbSAlfredo Cardigliano void 19523bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_speed(struct ionic_dev *idev, uint32_t speed) 19623bf4ddbSAlfredo Cardigliano { 19723bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 19823bf4ddbSAlfredo Cardigliano .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 19923bf4ddbSAlfredo Cardigliano .port_setattr.index = 0, 20023bf4ddbSAlfredo Cardigliano .port_setattr.attr = IONIC_PORT_ATTR_SPEED, 20123bf4ddbSAlfredo Cardigliano .port_setattr.speed = speed, 20223bf4ddbSAlfredo Cardigliano }; 20323bf4ddbSAlfredo Cardigliano 20423bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 20523bf4ddbSAlfredo Cardigliano } 20623bf4ddbSAlfredo Cardigliano 20723bf4ddbSAlfredo Cardigliano void 20823bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_mtu(struct ionic_dev *idev, uint32_t mtu) 20923bf4ddbSAlfredo Cardigliano { 21023bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 21123bf4ddbSAlfredo Cardigliano .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 21223bf4ddbSAlfredo Cardigliano .port_setattr.index = 0, 21323bf4ddbSAlfredo Cardigliano .port_setattr.attr = IONIC_PORT_ATTR_MTU, 21423bf4ddbSAlfredo Cardigliano .port_setattr.mtu = mtu, 21523bf4ddbSAlfredo Cardigliano }; 21623bf4ddbSAlfredo Cardigliano 21723bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 21823bf4ddbSAlfredo Cardigliano } 21923bf4ddbSAlfredo Cardigliano 22023bf4ddbSAlfredo Cardigliano void 22123bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_autoneg(struct ionic_dev *idev, uint8_t an_enable) 22223bf4ddbSAlfredo Cardigliano { 22323bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 22423bf4ddbSAlfredo Cardigliano .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 22523bf4ddbSAlfredo Cardigliano .port_setattr.index = 0, 22623bf4ddbSAlfredo Cardigliano .port_setattr.attr = IONIC_PORT_ATTR_AUTONEG, 22723bf4ddbSAlfredo Cardigliano .port_setattr.an_enable = an_enable, 22823bf4ddbSAlfredo Cardigliano }; 22923bf4ddbSAlfredo Cardigliano 23023bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 23123bf4ddbSAlfredo Cardigliano } 23223bf4ddbSAlfredo Cardigliano 23323bf4ddbSAlfredo Cardigliano void 23423bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_fec(struct ionic_dev *idev, uint8_t fec_type) 23523bf4ddbSAlfredo Cardigliano { 23623bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 23723bf4ddbSAlfredo Cardigliano .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 23823bf4ddbSAlfredo Cardigliano .port_setattr.index = 0, 23923bf4ddbSAlfredo Cardigliano .port_setattr.attr = IONIC_PORT_ATTR_FEC, 24023bf4ddbSAlfredo Cardigliano .port_setattr.fec_type = fec_type, 24123bf4ddbSAlfredo Cardigliano }; 24223bf4ddbSAlfredo Cardigliano 24323bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 24423bf4ddbSAlfredo Cardigliano } 24523bf4ddbSAlfredo Cardigliano 24623bf4ddbSAlfredo Cardigliano void 24723bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_pause(struct ionic_dev *idev, uint8_t pause_type) 24823bf4ddbSAlfredo Cardigliano { 24923bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 25023bf4ddbSAlfredo Cardigliano .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 25123bf4ddbSAlfredo Cardigliano .port_setattr.index = 0, 25223bf4ddbSAlfredo Cardigliano .port_setattr.attr = IONIC_PORT_ATTR_PAUSE, 25323bf4ddbSAlfredo Cardigliano .port_setattr.pause_type = pause_type, 25423bf4ddbSAlfredo Cardigliano }; 25523bf4ddbSAlfredo Cardigliano 25623bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 25723bf4ddbSAlfredo Cardigliano } 25823bf4ddbSAlfredo Cardigliano 25923bf4ddbSAlfredo Cardigliano void 26023bf4ddbSAlfredo Cardigliano ionic_dev_cmd_port_loopback(struct ionic_dev *idev, uint8_t loopback_mode) 26123bf4ddbSAlfredo Cardigliano { 26223bf4ddbSAlfredo Cardigliano union ionic_dev_cmd cmd = { 26323bf4ddbSAlfredo Cardigliano .port_setattr.opcode = IONIC_CMD_PORT_SETATTR, 26423bf4ddbSAlfredo Cardigliano .port_setattr.index = 0, 26523bf4ddbSAlfredo Cardigliano .port_setattr.attr = IONIC_PORT_ATTR_LOOPBACK, 26623bf4ddbSAlfredo Cardigliano .port_setattr.loopback_mode = loopback_mode, 26723bf4ddbSAlfredo Cardigliano }; 26823bf4ddbSAlfredo Cardigliano 26923bf4ddbSAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 27023bf4ddbSAlfredo Cardigliano } 271669c8de6SAlfredo Cardigliano 272669c8de6SAlfredo Cardigliano /* LIF commands */ 273669c8de6SAlfredo Cardigliano 274669c8de6SAlfredo Cardigliano void 275669c8de6SAlfredo Cardigliano ionic_dev_cmd_lif_identify(struct ionic_dev *idev, uint8_t type, uint8_t ver) 276669c8de6SAlfredo Cardigliano { 277669c8de6SAlfredo Cardigliano union ionic_dev_cmd cmd = { 278669c8de6SAlfredo Cardigliano .lif_identify.opcode = IONIC_CMD_LIF_IDENTIFY, 279669c8de6SAlfredo Cardigliano .lif_identify.type = type, 280669c8de6SAlfredo Cardigliano .lif_identify.ver = ver, 281669c8de6SAlfredo Cardigliano }; 282669c8de6SAlfredo Cardigliano 283669c8de6SAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 284669c8de6SAlfredo Cardigliano } 285669c8de6SAlfredo Cardigliano 286669c8de6SAlfredo Cardigliano void 287669c8de6SAlfredo Cardigliano ionic_dev_cmd_lif_init(struct ionic_dev *idev, uint16_t lif_index, 288669c8de6SAlfredo Cardigliano rte_iova_t info_pa) 289669c8de6SAlfredo Cardigliano { 290669c8de6SAlfredo Cardigliano union ionic_dev_cmd cmd = { 291669c8de6SAlfredo Cardigliano .lif_init.opcode = IONIC_CMD_LIF_INIT, 292669c8de6SAlfredo Cardigliano .lif_init.index = lif_index, 293669c8de6SAlfredo Cardigliano .lif_init.info_pa = info_pa, 294669c8de6SAlfredo Cardigliano }; 295669c8de6SAlfredo Cardigliano 296669c8de6SAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 297669c8de6SAlfredo Cardigliano } 298669c8de6SAlfredo Cardigliano 299669c8de6SAlfredo Cardigliano void 300669c8de6SAlfredo Cardigliano ionic_dev_cmd_lif_reset(struct ionic_dev *idev, uint16_t lif_index) 301669c8de6SAlfredo Cardigliano { 302669c8de6SAlfredo Cardigliano union ionic_dev_cmd cmd = { 303669c8de6SAlfredo Cardigliano .lif_init.opcode = IONIC_CMD_LIF_RESET, 304669c8de6SAlfredo Cardigliano .lif_init.index = lif_index, 305669c8de6SAlfredo Cardigliano }; 306669c8de6SAlfredo Cardigliano 307669c8de6SAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 308669c8de6SAlfredo Cardigliano } 309c67719e1SAlfredo Cardigliano 31001a6c311SAlfredo Cardigliano struct ionic_doorbell * 31101a6c311SAlfredo Cardigliano ionic_db_map(struct ionic_lif *lif, struct ionic_queue *q) 31201a6c311SAlfredo Cardigliano { 31301a6c311SAlfredo Cardigliano return lif->kern_dbpage + q->hw_type; 31401a6c311SAlfredo Cardigliano } 31501a6c311SAlfredo Cardigliano 316c67719e1SAlfredo Cardigliano int 317c67719e1SAlfredo Cardigliano ionic_db_page_num(struct ionic_lif *lif, int pid) 318c67719e1SAlfredo Cardigliano { 319c67719e1SAlfredo Cardigliano return (lif->index * 0) + pid; 320c67719e1SAlfredo Cardigliano } 321c67719e1SAlfredo Cardigliano 322c67719e1SAlfredo Cardigliano void 323c67719e1SAlfredo Cardigliano ionic_intr_init(struct ionic_dev *idev, struct ionic_intr_info *intr, 324c67719e1SAlfredo Cardigliano unsigned long index) 325c67719e1SAlfredo Cardigliano { 326c67719e1SAlfredo Cardigliano ionic_intr_clean(idev->intr_ctrl, index); 327c67719e1SAlfredo Cardigliano intr->index = index; 328c67719e1SAlfredo Cardigliano } 32901a6c311SAlfredo Cardigliano 33001a6c311SAlfredo Cardigliano void 33101a6c311SAlfredo Cardigliano ionic_dev_cmd_adminq_init(struct ionic_dev *idev, 33201a6c311SAlfredo Cardigliano struct ionic_qcq *qcq, 33301a6c311SAlfredo Cardigliano uint16_t lif_index, uint16_t intr_index) 33401a6c311SAlfredo Cardigliano { 33501a6c311SAlfredo Cardigliano struct ionic_queue *q = &qcq->q; 33601a6c311SAlfredo Cardigliano struct ionic_cq *cq = &qcq->cq; 33701a6c311SAlfredo Cardigliano 33801a6c311SAlfredo Cardigliano union ionic_dev_cmd cmd = { 33901a6c311SAlfredo Cardigliano .q_init.opcode = IONIC_CMD_Q_INIT, 34001a6c311SAlfredo Cardigliano .q_init.lif_index = lif_index, 34101a6c311SAlfredo Cardigliano .q_init.type = q->type, 34201a6c311SAlfredo Cardigliano .q_init.index = q->index, 34301a6c311SAlfredo Cardigliano .q_init.flags = IONIC_QINIT_F_ENA, 34401a6c311SAlfredo Cardigliano .q_init.pid = q->pid, 34501a6c311SAlfredo Cardigliano .q_init.intr_index = intr_index, 34601a6c311SAlfredo Cardigliano .q_init.ring_size = rte_log2_u32(q->num_descs), 34701a6c311SAlfredo Cardigliano .q_init.ring_base = q->base_pa, 34801a6c311SAlfredo Cardigliano .q_init.cq_ring_base = cq->base_pa, 34901a6c311SAlfredo Cardigliano }; 35001a6c311SAlfredo Cardigliano 35101a6c311SAlfredo Cardigliano ionic_dev_cmd_go(idev, &cmd); 35201a6c311SAlfredo Cardigliano } 35301a6c311SAlfredo Cardigliano 35401a6c311SAlfredo Cardigliano int 35501a6c311SAlfredo Cardigliano ionic_cq_init(struct ionic_lif *lif, struct ionic_cq *cq, 35601a6c311SAlfredo Cardigliano struct ionic_intr_info *intr, 35701a6c311SAlfredo Cardigliano uint32_t num_descs, size_t desc_size) 35801a6c311SAlfredo Cardigliano { 35901a6c311SAlfredo Cardigliano if (desc_size == 0) { 36001a6c311SAlfredo Cardigliano IONIC_PRINT(ERR, "Descriptor size is %zu", desc_size); 36101a6c311SAlfredo Cardigliano return -EINVAL; 36201a6c311SAlfredo Cardigliano } 36301a6c311SAlfredo Cardigliano 36401a6c311SAlfredo Cardigliano if (!rte_is_power_of_2(num_descs) || 36501a6c311SAlfredo Cardigliano num_descs < IONIC_MIN_RING_DESC || 36601a6c311SAlfredo Cardigliano num_descs > IONIC_MAX_RING_DESC) { 36701a6c311SAlfredo Cardigliano IONIC_PRINT(ERR, "%u descriptors (min: %u max: %u)", 36801a6c311SAlfredo Cardigliano num_descs, IONIC_MIN_RING_DESC, IONIC_MAX_RING_DESC); 36901a6c311SAlfredo Cardigliano return -EINVAL; 37001a6c311SAlfredo Cardigliano } 37101a6c311SAlfredo Cardigliano 37201a6c311SAlfredo Cardigliano cq->lif = lif; 37301a6c311SAlfredo Cardigliano cq->bound_intr = intr; 37401a6c311SAlfredo Cardigliano cq->num_descs = num_descs; 37501a6c311SAlfredo Cardigliano cq->desc_size = desc_size; 37601a6c311SAlfredo Cardigliano cq->tail_idx = 0; 37701a6c311SAlfredo Cardigliano cq->done_color = 1; 37801a6c311SAlfredo Cardigliano 37901a6c311SAlfredo Cardigliano return 0; 38001a6c311SAlfredo Cardigliano } 38101a6c311SAlfredo Cardigliano 38201a6c311SAlfredo Cardigliano void 38301a6c311SAlfredo Cardigliano ionic_cq_map(struct ionic_cq *cq, void *base, rte_iova_t base_pa) 38401a6c311SAlfredo Cardigliano { 38501a6c311SAlfredo Cardigliano cq->base = base; 38601a6c311SAlfredo Cardigliano cq->base_pa = base_pa; 38701a6c311SAlfredo Cardigliano } 38801a6c311SAlfredo Cardigliano 38901a6c311SAlfredo Cardigliano void 39001a6c311SAlfredo Cardigliano ionic_cq_bind(struct ionic_cq *cq, struct ionic_queue *q) 39101a6c311SAlfredo Cardigliano { 39201a6c311SAlfredo Cardigliano cq->bound_q = q; 39301a6c311SAlfredo Cardigliano q->bound_cq = cq; 39401a6c311SAlfredo Cardigliano } 39501a6c311SAlfredo Cardigliano 39601a6c311SAlfredo Cardigliano uint32_t 39701a6c311SAlfredo Cardigliano ionic_cq_service(struct ionic_cq *cq, uint32_t work_to_do, 39801a6c311SAlfredo Cardigliano ionic_cq_cb cb, void *cb_arg) 39901a6c311SAlfredo Cardigliano { 40001a6c311SAlfredo Cardigliano uint32_t work_done = 0; 40101a6c311SAlfredo Cardigliano 40201a6c311SAlfredo Cardigliano if (work_to_do == 0) 40301a6c311SAlfredo Cardigliano return 0; 40401a6c311SAlfredo Cardigliano 40501a6c311SAlfredo Cardigliano while (cb(cq, cq->tail_idx, cb_arg)) { 40601a6c311SAlfredo Cardigliano cq->tail_idx = (cq->tail_idx + 1) & (cq->num_descs - 1); 40701a6c311SAlfredo Cardigliano if (cq->tail_idx == 0) 40801a6c311SAlfredo Cardigliano cq->done_color = !cq->done_color; 40901a6c311SAlfredo Cardigliano 41001a6c311SAlfredo Cardigliano if (++work_done == work_to_do) 41101a6c311SAlfredo Cardigliano break; 41201a6c311SAlfredo Cardigliano } 41301a6c311SAlfredo Cardigliano 41401a6c311SAlfredo Cardigliano return work_done; 41501a6c311SAlfredo Cardigliano } 41601a6c311SAlfredo Cardigliano 41701a6c311SAlfredo Cardigliano int 41801a6c311SAlfredo Cardigliano ionic_q_init(struct ionic_lif *lif, struct ionic_dev *idev, 41901a6c311SAlfredo Cardigliano struct ionic_queue *q, uint32_t index, uint32_t num_descs, 42001a6c311SAlfredo Cardigliano size_t desc_size, size_t sg_desc_size, uint32_t pid) 42101a6c311SAlfredo Cardigliano { 42201a6c311SAlfredo Cardigliano uint32_t ring_size; 42301a6c311SAlfredo Cardigliano 42401a6c311SAlfredo Cardigliano if (desc_size == 0 || !rte_is_power_of_2(num_descs)) 42501a6c311SAlfredo Cardigliano return -EINVAL; 42601a6c311SAlfredo Cardigliano 42701a6c311SAlfredo Cardigliano ring_size = rte_log2_u32(num_descs); 42801a6c311SAlfredo Cardigliano 42901a6c311SAlfredo Cardigliano if (ring_size < 2 || ring_size > 16) 43001a6c311SAlfredo Cardigliano return -EINVAL; 43101a6c311SAlfredo Cardigliano 43201a6c311SAlfredo Cardigliano q->lif = lif; 43301a6c311SAlfredo Cardigliano q->idev = idev; 43401a6c311SAlfredo Cardigliano q->index = index; 43501a6c311SAlfredo Cardigliano q->num_descs = num_descs; 43601a6c311SAlfredo Cardigliano q->desc_size = desc_size; 43701a6c311SAlfredo Cardigliano q->sg_desc_size = sg_desc_size; 43801a6c311SAlfredo Cardigliano q->head_idx = 0; 43901a6c311SAlfredo Cardigliano q->tail_idx = 0; 44001a6c311SAlfredo Cardigliano q->pid = pid; 44101a6c311SAlfredo Cardigliano 44201a6c311SAlfredo Cardigliano return 0; 44301a6c311SAlfredo Cardigliano } 44401a6c311SAlfredo Cardigliano 44501a6c311SAlfredo Cardigliano void 44601a6c311SAlfredo Cardigliano ionic_q_map(struct ionic_queue *q, void *base, rte_iova_t base_pa) 44701a6c311SAlfredo Cardigliano { 44801a6c311SAlfredo Cardigliano q->base = base; 44901a6c311SAlfredo Cardigliano q->base_pa = base_pa; 45001a6c311SAlfredo Cardigliano } 45101a6c311SAlfredo Cardigliano 45201a6c311SAlfredo Cardigliano void 45301a6c311SAlfredo Cardigliano ionic_q_sg_map(struct ionic_queue *q, void *base, rte_iova_t base_pa) 45401a6c311SAlfredo Cardigliano { 45501a6c311SAlfredo Cardigliano q->sg_base = base; 45601a6c311SAlfredo Cardigliano q->sg_base_pa = base_pa; 45701a6c311SAlfredo Cardigliano } 45801a6c311SAlfredo Cardigliano 45901a6c311SAlfredo Cardigliano void 46001a6c311SAlfredo Cardigliano ionic_q_flush(struct ionic_queue *q) 46101a6c311SAlfredo Cardigliano { 46201a6c311SAlfredo Cardigliano writeq(IONIC_DBELL_QID(q->hw_index) | q->head_idx, q->db); 46301a6c311SAlfredo Cardigliano } 46401a6c311SAlfredo Cardigliano 46501a6c311SAlfredo Cardigliano void 46601a6c311SAlfredo Cardigliano ionic_q_post(struct ionic_queue *q, bool ring_doorbell, desc_cb cb, 46701a6c311SAlfredo Cardigliano void *cb_arg) 46801a6c311SAlfredo Cardigliano { 46901a6c311SAlfredo Cardigliano struct ionic_desc_info *head = &q->info[q->head_idx]; 47001a6c311SAlfredo Cardigliano 47101a6c311SAlfredo Cardigliano head->cb = cb; 47201a6c311SAlfredo Cardigliano head->cb_arg = cb_arg; 47301a6c311SAlfredo Cardigliano 47401a6c311SAlfredo Cardigliano q->head_idx = (q->head_idx + 1) & (q->num_descs - 1); 47501a6c311SAlfredo Cardigliano 47601a6c311SAlfredo Cardigliano if (ring_doorbell) 47701a6c311SAlfredo Cardigliano ionic_q_flush(q); 47801a6c311SAlfredo Cardigliano } 47901a6c311SAlfredo Cardigliano 48001a6c311SAlfredo Cardigliano uint32_t 48101a6c311SAlfredo Cardigliano ionic_q_space_avail(struct ionic_queue *q) 48201a6c311SAlfredo Cardigliano { 48301a6c311SAlfredo Cardigliano uint32_t avail = q->tail_idx; 48401a6c311SAlfredo Cardigliano 48501a6c311SAlfredo Cardigliano if (q->head_idx >= avail) 48601a6c311SAlfredo Cardigliano avail += q->num_descs - q->head_idx - 1; 48701a6c311SAlfredo Cardigliano else 48801a6c311SAlfredo Cardigliano avail -= q->head_idx + 1; 48901a6c311SAlfredo Cardigliano 49001a6c311SAlfredo Cardigliano return avail; 49101a6c311SAlfredo Cardigliano } 49201a6c311SAlfredo Cardigliano 49301a6c311SAlfredo Cardigliano bool 49401a6c311SAlfredo Cardigliano ionic_q_has_space(struct ionic_queue *q, uint32_t want) 49501a6c311SAlfredo Cardigliano { 49601a6c311SAlfredo Cardigliano return ionic_q_space_avail(q) >= want; 49701a6c311SAlfredo Cardigliano } 49801a6c311SAlfredo Cardigliano 49901a6c311SAlfredo Cardigliano void 50001a6c311SAlfredo Cardigliano ionic_q_service(struct ionic_queue *q, uint32_t cq_desc_index, 50101a6c311SAlfredo Cardigliano uint32_t stop_index, void *service_cb_arg) 50201a6c311SAlfredo Cardigliano { 50301a6c311SAlfredo Cardigliano struct ionic_desc_info *desc_info; 50401a6c311SAlfredo Cardigliano uint32_t curr_q_tail_idx; 50501a6c311SAlfredo Cardigliano 50601a6c311SAlfredo Cardigliano do { 50701a6c311SAlfredo Cardigliano desc_info = &q->info[q->tail_idx]; 50801a6c311SAlfredo Cardigliano 50901a6c311SAlfredo Cardigliano if (desc_info->cb) 51001a6c311SAlfredo Cardigliano desc_info->cb(q, q->tail_idx, cq_desc_index, 51101a6c311SAlfredo Cardigliano desc_info->cb_arg, service_cb_arg); 51201a6c311SAlfredo Cardigliano 51301a6c311SAlfredo Cardigliano desc_info->cb = NULL; 51401a6c311SAlfredo Cardigliano desc_info->cb_arg = NULL; 51501a6c311SAlfredo Cardigliano 51601a6c311SAlfredo Cardigliano curr_q_tail_idx = q->tail_idx; 51701a6c311SAlfredo Cardigliano q->tail_idx = (q->tail_idx + 1) & (q->num_descs - 1); 51801a6c311SAlfredo Cardigliano 51901a6c311SAlfredo Cardigliano } while (curr_q_tail_idx != stop_index); 52001a6c311SAlfredo Cardigliano } 52101a6c311SAlfredo Cardigliano 52201a6c311SAlfredo Cardigliano static void 52301a6c311SAlfredo Cardigliano ionic_adminq_cb(struct ionic_queue *q, 52401a6c311SAlfredo Cardigliano uint32_t q_desc_index, uint32_t cq_desc_index, 52501a6c311SAlfredo Cardigliano void *cb_arg, void *service_cb_arg __rte_unused) 52601a6c311SAlfredo Cardigliano { 52701a6c311SAlfredo Cardigliano struct ionic_admin_ctx *ctx = cb_arg; 52801a6c311SAlfredo Cardigliano struct ionic_admin_comp *cq_desc_base = q->bound_cq->base; 52901a6c311SAlfredo Cardigliano struct ionic_admin_comp *cq_desc = &cq_desc_base[cq_desc_index]; 53001a6c311SAlfredo Cardigliano 53101a6c311SAlfredo Cardigliano if (unlikely(cq_desc->comp_index != q_desc_index)) { 53201a6c311SAlfredo Cardigliano IONIC_WARN_ON(cq_desc->comp_index != q_desc_index); 53301a6c311SAlfredo Cardigliano return; 53401a6c311SAlfredo Cardigliano } 53501a6c311SAlfredo Cardigliano 53601a6c311SAlfredo Cardigliano memcpy(&ctx->comp, cq_desc, sizeof(*cq_desc)); 53701a6c311SAlfredo Cardigliano 53801a6c311SAlfredo Cardigliano ctx->pending_work = false; /* done */ 53901a6c311SAlfredo Cardigliano } 54001a6c311SAlfredo Cardigliano 54101a6c311SAlfredo Cardigliano /** ionic_adminq_post - Post an admin command. 54201a6c311SAlfredo Cardigliano * @lif: Handle to lif. 54301a6c311SAlfredo Cardigliano * @cmd_ctx: Api admin command context. 54401a6c311SAlfredo Cardigliano * 54501a6c311SAlfredo Cardigliano * Post the command to an admin queue in the ethernet driver. If this command 54601a6c311SAlfredo Cardigliano * succeeds, then the command has been posted, but that does not indicate a 54701a6c311SAlfredo Cardigliano * completion. If this command returns success, then the completion callback 54801a6c311SAlfredo Cardigliano * will eventually be called. 54901a6c311SAlfredo Cardigliano * 55001a6c311SAlfredo Cardigliano * Return: zero or negative error status. 55101a6c311SAlfredo Cardigliano */ 55201a6c311SAlfredo Cardigliano int 55301a6c311SAlfredo Cardigliano ionic_adminq_post(struct ionic_lif *lif, struct ionic_admin_ctx *ctx) 55401a6c311SAlfredo Cardigliano { 55501a6c311SAlfredo Cardigliano struct ionic_queue *adminq = &lif->adminqcq->q; 55601a6c311SAlfredo Cardigliano struct ionic_admin_cmd *q_desc_base = adminq->base; 55701a6c311SAlfredo Cardigliano struct ionic_admin_cmd *q_desc; 55801a6c311SAlfredo Cardigliano int err = 0; 55901a6c311SAlfredo Cardigliano 56001a6c311SAlfredo Cardigliano rte_spinlock_lock(&lif->adminq_lock); 56101a6c311SAlfredo Cardigliano 56201a6c311SAlfredo Cardigliano if (!ionic_q_has_space(adminq, 1)) { 56301a6c311SAlfredo Cardigliano err = -ENOSPC; 56401a6c311SAlfredo Cardigliano goto err_out; 56501a6c311SAlfredo Cardigliano } 56601a6c311SAlfredo Cardigliano 56701a6c311SAlfredo Cardigliano q_desc = &q_desc_base[adminq->head_idx]; 56801a6c311SAlfredo Cardigliano 56901a6c311SAlfredo Cardigliano memcpy(q_desc, &ctx->cmd, sizeof(ctx->cmd)); 57001a6c311SAlfredo Cardigliano 57101a6c311SAlfredo Cardigliano ionic_q_post(adminq, true, ionic_adminq_cb, ctx); 57201a6c311SAlfredo Cardigliano 57301a6c311SAlfredo Cardigliano err_out: 57401a6c311SAlfredo Cardigliano rte_spinlock_unlock(&lif->adminq_lock); 57501a6c311SAlfredo Cardigliano 57601a6c311SAlfredo Cardigliano return err; 57701a6c311SAlfredo Cardigliano } 578