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