From patchwork Thu Jun 20 20:24:12 2019 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Shannon Nelson X-Patchwork-Id: 1119760 X-Patchwork-Delegate: davem@davemloft.net Return-Path: X-Original-To: patchwork-incoming-netdev@ozlabs.org Delivered-To: patchwork-incoming-netdev@ozlabs.org Authentication-Results: ozlabs.org; spf=none (mailfrom) smtp.mailfrom=vger.kernel.org (client-ip=209.132.180.67; helo=vger.kernel.org; envelope-from=netdev-owner@vger.kernel.org; receiver=) Authentication-Results: ozlabs.org; dmarc=none (p=none dis=none) header.from=pensando.io Authentication-Results: ozlabs.org; dkim=pass (2048-bit key; unprotected) header.d=pensando.io header.i=@pensando.io header.b="adugkuwZ"; dkim-atps=neutral Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 45VCwV6twPz9s5c for ; Fri, 21 Jun 2019 06:24:42 +1000 (AEST) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727143AbfFTUYl (ORCPT ); Thu, 20 Jun 2019 16:24:41 -0400 Received: from mail-pg1-f193.google.com ([209.85.215.193]:42318 "EHLO mail-pg1-f193.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1727077AbfFTUYh (ORCPT ); Thu, 20 Jun 2019 16:24:37 -0400 Received: by mail-pg1-f193.google.com with SMTP id l19so2146798pgh.9 for ; Thu, 20 Jun 2019 13:24:36 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=pensando.io; s=google; h=from:to:subject:date:message-id:in-reply-to:references; bh=lET53Wf5UTETjaSbTCa6TdBBBTE6UFvFnuHWPKxmfjc=; b=adugkuwZfRxLKfcNHV0et2P0bVuGI3BjcoCFP3EoIn+mfB2KmprkeKMlI4+hp1Dvgo svh3LkUKPy9gMzgHYO/I8vb+q2XPW61OrdjUKPCGgYUepHMW4CR1FBI0lD6fYLayRDtQ Ei/SHEl7HjPfPaz98sLmRj872PxVN/WacWh2TmvB9JHobOboBKtfMhQAVhW9DvN3RgMy PsUI/TxFQA2e1SlHVyz4B3X9KwHBelHnkgY1Fc/O2FYwihzNg7nzS79fMuzGI5x++ymk sR8vmBldxY8ge2rV0nTPbExEvu3kNRtn+nU/SeD43JVAsGscFhMfQ8nQ/MIK51Do3j8W KzBA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:subject:date:message-id:in-reply-to :references; bh=lET53Wf5UTETjaSbTCa6TdBBBTE6UFvFnuHWPKxmfjc=; b=gu1Lg3QjAvd0PuADYl2A9ZzsgcsllMaYU3XEgyl3bxX5nqBWERXrrTFBMF4Sw7gTqQ hrfQiPuzOs7tZUGHb2eWbbry9ZObjyf2O1edUNVHGW43jvnwpGKZkdB46WjruNSRHDCF kQAAwivyJgObIJmJvxIu/TB3RcVBy89Qhiun1rWKXSsLdz1mQ3GNXpO8m7nm77aR4f3t 7KiRHRnNB2mMVUklK8ub7f7yG67burbXmeGnL5pa9G+nE45bwCJrcgA9bZo1ffJBq6E3 Vl+mQDDx5m0qLdRjwFzQ4owP3JnfdeNIUFXkPKCCsD3xJg6YkmOB/0pex9uZWALGqxx6 Qi4Q== X-Gm-Message-State: APjAAAVq4Zmw+rwvxkr3NxR8NsO6nDmAqwoM0ptyv2qz8AvY7Ow6YGvg uCG4T+gfUdybIikb2KaUX7ITW+Pn0Zc= X-Google-Smtp-Source: APXvYqyOqAenxEO8170A9BbMxvFWJMf7i4UDxOUNILVxuWItoGo0bAjmuwma7q9UN8wja+GtlaZB2w== X-Received: by 2002:a65:6204:: with SMTP id d4mr14305654pgv.104.1561062275867; Thu, 20 Jun 2019 13:24:35 -0700 (PDT) Received: from driver-dev1.pensando.io ([12.1.37.26]) by smtp.gmail.com with ESMTPSA id h26sm340537pfq.64.2019.06.20.13.24.34 (version=TLS1_2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Thu, 20 Jun 2019 13:24:35 -0700 (PDT) From: Shannon Nelson To: snelson@pensando.io, netdev@vger.kernel.org Subject: [PATCH net-next 06/18] ionic: Add basic adminq support Date: Thu, 20 Jun 2019 13:24:12 -0700 Message-Id: <20190620202424.23215-7-snelson@pensando.io> X-Mailer: git-send-email 2.17.1 In-Reply-To: <20190620202424.23215-1-snelson@pensando.io> References: <20190620202424.23215-1-snelson@pensando.io> Sender: netdev-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org Most of the NIC configuration happens through the AdminQ message queue. NAPI is used for basic interrupt handling and message queue management. These routines are set up to be shared among different types of queues when used in slow-path handling. Signed-off-by: Shannon Nelson --- drivers/net/ethernet/pensando/ionic/ionic.h | 3 + .../net/ethernet/pensando/ionic/ionic_bus.h | 1 + .../ethernet/pensando/ionic/ionic_bus_pci.c | 5 + .../ethernet/pensando/ionic/ionic_debugfs.c | 149 ++++++++ .../ethernet/pensando/ionic/ionic_debugfs.h | 4 + .../net/ethernet/pensando/ionic/ionic_dev.c | 247 +++++++++++++ .../net/ethernet/pensando/ionic/ionic_dev.h | 92 +++++ .../net/ethernet/pensando/ionic/ionic_lif.c | 331 ++++++++++++++++++ .../net/ethernet/pensando/ionic/ionic_lif.h | 72 ++++ .../net/ethernet/pensando/ionic/ionic_main.c | 26 ++ 10 files changed, 930 insertions(+) diff --git a/drivers/net/ethernet/pensando/ionic/ionic.h b/drivers/net/ethernet/pensando/ionic/ionic.h index e89375a4af1c..f1e7c754bcda 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic.h +++ b/drivers/net/ethernet/pensando/ionic/ionic.h @@ -46,6 +46,9 @@ struct ionic { DECLARE_BITMAP(intrs, INTR_CTRL_REGS_MAX); }; +int ionic_napi(struct napi_struct *napi, int budget, ionic_cq_cb cb, + ionic_cq_done_cb done_cb, void *done_arg); + int ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_wait); int ionic_set_dma_mask(struct ionic *ionic); int ionic_setup(struct ionic *ionic); diff --git a/drivers/net/ethernet/pensando/ionic/ionic_bus.h b/drivers/net/ethernet/pensando/ionic/ionic_bus.h index 6b29e94f81d6..2f4d08c64910 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic_bus.h +++ b/drivers/net/ethernet/pensando/ionic/ionic_bus.h @@ -4,6 +4,7 @@ #ifndef _IONIC_BUS_H_ #define _IONIC_BUS_H_ +int ionic_bus_get_irq(struct ionic *ionic, unsigned int num); const char *ionic_bus_info(struct ionic *ionic); int ionic_bus_alloc_irq_vectors(struct ionic *ionic, unsigned int nintrs); void ionic_bus_free_irq_vectors(struct ionic *ionic); diff --git a/drivers/net/ethernet/pensando/ionic/ionic_bus_pci.c b/drivers/net/ethernet/pensando/ionic/ionic_bus_pci.c index 42f64243b15d..bb65a6518817 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic_bus_pci.c +++ b/drivers/net/ethernet/pensando/ionic/ionic_bus_pci.c @@ -20,6 +20,11 @@ static const struct pci_device_id ionic_id_table[] = { }; MODULE_DEVICE_TABLE(pci, ionic_id_table); +int ionic_bus_get_irq(struct ionic *ionic, unsigned int num) +{ + return pci_irq_vector(ionic->pdev, num); +} + const char *ionic_bus_info(struct ionic *ionic) { return pci_name(ionic->pdev); diff --git a/drivers/net/ethernet/pensando/ionic/ionic_debugfs.c b/drivers/net/ethernet/pensando/ionic/ionic_debugfs.c index 4f2c4bc48de0..e01126f3f6bd 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic_debugfs.c +++ b/drivers/net/ethernet/pensando/ionic/ionic_debugfs.c @@ -252,6 +252,148 @@ int ionic_debugfs_add_sizes(struct ionic *ionic) return 0; } +static int q_tail_show(struct seq_file *seq, void *v) +{ + struct queue *q = seq->private; + + seq_printf(seq, "%d\n", q->tail->index); + + return 0; +} +single(q_tail); + +static int q_head_show(struct seq_file *seq, void *v) +{ + struct queue *q = seq->private; + + seq_printf(seq, "%d\n", q->head->index); + + return 0; +} +single(q_head); + +static int cq_tail_show(struct seq_file *seq, void *v) +{ + struct cq *cq = seq->private; + + seq_printf(seq, "%d\n", cq->tail->index); + + return 0; +} +single(cq_tail); + +static const struct debugfs_reg32 intr_ctrl_regs[] = { + { .name = "coal_init", .offset = 0, }, + { .name = "mask", .offset = 4, }, + { .name = "credits", .offset = 8, }, + { .name = "mask_on_assert", .offset = 12, }, + { .name = "coal_timer", .offset = 16, }, +}; + +int ionic_debugfs_add_qcq(struct lif *lif, struct qcq *qcq) +{ + struct dentry *qcq_dentry, *q_dentry, *cq_dentry, *intr_dentry; + struct ionic_dev *idev = &lif->ionic->idev; + struct debugfs_regset32 *intr_ctrl_regset; + struct debugfs_blob_wrapper *desc_blob; + struct device *dev = lif->ionic->dev; + struct intr *intr = &qcq->intr; + struct queue *q = &qcq->q; + struct cq *cq = &qcq->cq; + + qcq_dentry = debugfs_create_dir(q->name, lif->dentry); + if (IS_ERR_OR_NULL(qcq_dentry)) + return PTR_ERR(qcq_dentry); + qcq->dentry = qcq_dentry; + + debugfs_create_x32("total_size", 0400, qcq_dentry, &qcq->total_size); + debugfs_create_x64("base_pa", 0400, qcq_dentry, &qcq->base_pa); + + q_dentry = debugfs_create_dir("q", qcq_dentry); + if (IS_ERR_OR_NULL(q_dentry)) + return PTR_ERR(q_dentry); + + debugfs_create_u32("index", 0400, q_dentry, &q->index); + debugfs_create_x64("base_pa", 0400, q_dentry, &q->base_pa); + if (qcq->flags & QCQ_F_SG) { + debugfs_create_x64("sg_base_pa", 0400, q_dentry, + &q->sg_base_pa); + debugfs_create_u32("sg_desc_size", 0400, q_dentry, + &q->sg_desc_size); + } + debugfs_create_u32("num_descs", 0400, q_dentry, &q->num_descs); + debugfs_create_u32("desc_size", 0400, q_dentry, &q->desc_size); + debugfs_create_u32("pid", 0400, q_dentry, &q->pid); + debugfs_create_u32("qid", 0400, q_dentry, &q->hw_index); + debugfs_create_u32("qtype", 0400, q_dentry, &q->hw_type); + debugfs_create_u64("drop", 0400, q_dentry, &q->drop); + debugfs_create_u64("stop", 0400, q_dentry, &q->stop); + debugfs_create_u64("wake", 0400, q_dentry, &q->wake); + + debugfs_create_file("tail", 0400, q_dentry, q, &q_tail_fops); + debugfs_create_file("head", 0400, q_dentry, q, &q_head_fops); + + desc_blob = devm_kzalloc(dev, sizeof(*desc_blob), GFP_KERNEL); + if (!desc_blob) + return -ENOMEM; + desc_blob->data = q->base; + desc_blob->size = (unsigned long)q->num_descs * q->desc_size; + debugfs_create_blob("desc_blob", 0400, q_dentry, desc_blob); + + if (qcq->flags & QCQ_F_SG) { + desc_blob = devm_kzalloc(dev, sizeof(*desc_blob), GFP_KERNEL); + if (!desc_blob) + return -ENOMEM; + desc_blob->data = q->sg_base; + desc_blob->size = (unsigned long)q->num_descs * q->sg_desc_size; + debugfs_create_blob("sg_desc_blob", 0400, q_dentry, + desc_blob); + } + + cq_dentry = debugfs_create_dir("cq", qcq_dentry); + if (IS_ERR_OR_NULL(cq_dentry)) + return PTR_ERR(cq_dentry); + + debugfs_create_x64("base_pa", 0400, cq_dentry, &cq->base_pa); + debugfs_create_u32("num_descs", 0400, cq_dentry, &cq->num_descs); + debugfs_create_u32("desc_size", 0400, cq_dentry, &cq->desc_size); + debugfs_create_u8("done_color", 0400, cq_dentry, + (u8 *)&cq->done_color); + + debugfs_create_file("tail", 0400, cq_dentry, cq, &cq_tail_fops); + + desc_blob = devm_kzalloc(dev, sizeof(*desc_blob), GFP_KERNEL); + if (!desc_blob) + return -ENOMEM; + desc_blob->data = cq->base; + desc_blob->size = (unsigned long)cq->num_descs * cq->desc_size; + debugfs_create_blob("desc_blob", 0400, cq_dentry, desc_blob); + + if (qcq->flags & QCQ_F_INTR) { + intr_dentry = debugfs_create_dir("intr", qcq_dentry); + if (IS_ERR_OR_NULL(intr_dentry)) + return PTR_ERR(intr_dentry); + + debugfs_create_u32("index", 0400, intr_dentry, + &intr->index); + debugfs_create_u32("vector", 0400, intr_dentry, + &intr->vector); + + intr_ctrl_regset = devm_kzalloc(dev, sizeof(*intr_ctrl_regset), + GFP_KERNEL); + if (!intr_ctrl_regset) + return -ENOMEM; + intr_ctrl_regset->regs = intr_ctrl_regs; + intr_ctrl_regset->nregs = ARRAY_SIZE(intr_ctrl_regs); + intr_ctrl_regset->base = &idev->intr_ctrl[intr->index]; + + debugfs_create_regset32("intr_ctrl", 0400, intr_dentry, + intr_ctrl_regset); + } + + return 0; +} + static int netdev_show(struct seq_file *seq, void *v) { struct net_device *netdev = seq->private; @@ -283,4 +425,11 @@ void ionic_debugfs_del_lif(struct lif *lif) debugfs_remove_recursive(lif->dentry); lif->dentry = NULL; } + +void ionic_debugfs_del_qcq(struct qcq *qcq) +{ + debugfs_remove_recursive(qcq->dentry); + qcq->dentry = NULL; +} + #endif diff --git a/drivers/net/ethernet/pensando/ionic/ionic_debugfs.h b/drivers/net/ethernet/pensando/ionic/ionic_debugfs.h index cb00166e7c30..fa5030d48763 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic_debugfs.h +++ b/drivers/net/ethernet/pensando/ionic/ionic_debugfs.h @@ -17,7 +17,9 @@ int ionic_debugfs_add_dev_cmd(struct ionic *ionic); int ionic_debugfs_add_ident(struct ionic *ionic); int ionic_debugfs_add_sizes(struct ionic *ionic); int ionic_debugfs_add_lif(struct lif *lif); +int ionic_debugfs_add_qcq(struct lif *lif, struct qcq *qcq); void ionic_debugfs_del_lif(struct lif *lif); +void ionic_debugfs_del_qcq(struct qcq *qcq); #else static inline void ionic_debugfs_create(void) { } static inline void ionic_debugfs_destroy(void) { } @@ -28,7 +30,9 @@ static inline int ionic_debugfs_add_dev_cmd(struct ionic *ionic) { return 0; } static inline int ionic_debugfs_add_ident(struct ionic *ionic) { return 0; } static inline int ionic_debugfs_add_sizes(struct ionic *ionic) { return 0; } static inline int ionic_debugfs_add_lif(struct lif *lif) { return 0; } +static inline int ionic_debugfs_add_qcq(struct lif *lif, struct qcq *qcq) { return 0; } static inline void ionic_debugfs_del_lif(struct lif *lif) { return 0; } +static inline void ionic_debugfs_del_qcq(struct qcq *qcq) { return 0; } #endif #endif /* _IONIC_DEBUGFS_H_ */ diff --git a/drivers/net/ethernet/pensando/ionic/ionic_dev.c b/drivers/net/ethernet/pensando/ionic/ionic_dev.c index 195f3de06b3b..3bb0be161621 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic_dev.c +++ b/drivers/net/ethernet/pensando/ionic/ionic_dev.c @@ -282,7 +282,254 @@ void ionic_dev_cmd_lif_reset(struct ionic_dev *idev, u16 lif_index) ionic_dev_cmd_go(idev, &cmd); } +void ionic_dev_cmd_adminq_init(struct ionic_dev *idev, struct qcq *qcq, + u16 lif_index, u16 intr_index) +{ + struct queue *q = &qcq->q; + struct cq *cq = &qcq->cq; + + union dev_cmd cmd = { + .q_init.opcode = CMD_OPCODE_Q_INIT, + .q_init.lif_index = cpu_to_le16(lif_index), + .q_init.type = q->type, + .q_init.index = cpu_to_le32(q->index), + .q_init.flags = cpu_to_le16(IONIC_QINIT_F_IRQ | + IONIC_QINIT_F_ENA), + .q_init.pid = cpu_to_le16(q->pid), + .q_init.intr_index = cpu_to_le16(intr_index), + .q_init.ring_size = ilog2(q->num_descs), + .q_init.ring_base = cpu_to_le64(q->base_pa), + .q_init.cq_ring_base = cpu_to_le64(cq->base_pa), + }; + + ionic_dev_cmd_go(idev, &cmd); +} + int ionic_db_page_num(struct lif *lif, int pid) { return (lif->hw_index * lif->dbid_count) + pid; } + +int ionic_cq_init(struct lif *lif, struct cq *cq, struct intr *intr, + unsigned int num_descs, size_t desc_size) +{ + unsigned int ring_size; + struct cq_info *cur; + unsigned int i; + + if (desc_size == 0 || !is_power_of_2(num_descs)) + return -EINVAL; + + ring_size = ilog2(num_descs); + if (ring_size < 2 || ring_size > 16) + return -EINVAL; + + cq->lif = lif; + cq->bound_intr = intr; + cq->num_descs = num_descs; + cq->desc_size = desc_size; + cq->tail = cq->info; + cq->done_color = 1; + + cur = cq->info; + + for (i = 0; i < num_descs; i++) { + if (i + 1 == num_descs) { + cur->next = cq->info; + cur->last = true; + } else { + cur->next = cur + 1; + } + cur->index = i; + cur++; + } + + return 0; +} + +void ionic_cq_map(struct cq *cq, void *base, dma_addr_t base_pa) +{ + struct cq_info *cur; + unsigned int i; + + cq->base = base; + cq->base_pa = base_pa; + + for (i = 0, cur = cq->info; i < cq->num_descs; i++, cur++) + cur->cq_desc = base + (i * cq->desc_size); +} + +void ionic_cq_bind(struct cq *cq, struct queue *q) +{ + cq->bound_q = q; +} + +unsigned int ionic_cq_service(struct cq *cq, unsigned int work_to_do, + ionic_cq_cb cb, ionic_cq_done_cb done_cb, + void *done_arg) +{ + unsigned int work_done = 0; + + if (work_to_do == 0) + return 0; + + while (cb(cq, cq->tail)) { + if (cq->tail->last) + cq->done_color = !cq->done_color; + cq->tail = cq->tail->next; + DEBUG_STATS_CQE_CNT(cq); + + if (++work_done >= work_to_do) + break; + } + + if (work_done && done_cb) + done_cb(done_arg); + + return work_done; +} + +int ionic_q_init(struct lif *lif, struct ionic_dev *idev, struct queue *q, + unsigned int index, const char *name, unsigned int num_descs, + size_t desc_size, size_t sg_desc_size, unsigned int pid) +{ + unsigned int ring_size; + struct desc_info *cur; + unsigned int i; + + if (desc_size == 0 || !is_power_of_2(num_descs)) + return -EINVAL; + + ring_size = ilog2(num_descs); + if (ring_size < 2 || ring_size > 16) + return -EINVAL; + + q->lif = lif; + q->idev = idev; + q->index = index; + q->num_descs = num_descs; + q->desc_size = desc_size; + q->sg_desc_size = sg_desc_size; + q->tail = q->info; + q->head = q->tail; + q->pid = pid; + + snprintf(q->name, sizeof(q->name), "L%d-%s%u", lif->index, name, index); + + cur = q->info; + + for (i = 0; i < num_descs; i++) { + if (i + 1 == num_descs) + cur->next = q->info; + else + cur->next = cur + 1; + cur->index = i; + cur->left = num_descs - i; + cur++; + } + + return 0; +} + +void ionic_q_map(struct queue *q, void *base, dma_addr_t base_pa) +{ + struct desc_info *cur; + unsigned int i; + + q->base = base; + q->base_pa = base_pa; + + for (i = 0, cur = q->info; i < q->num_descs; i++, cur++) + cur->desc = base + (i * q->desc_size); +} + +void ionic_q_sg_map(struct queue *q, void *base, dma_addr_t base_pa) +{ + struct desc_info *cur; + unsigned int i; + + q->sg_base = base; + q->sg_base_pa = base_pa; + + for (i = 0, cur = q->info; i < q->num_descs; i++, cur++) + cur->sg_desc = base + (i * q->sg_desc_size); +} + +void ionic_q_post(struct queue *q, bool ring_doorbell, desc_cb cb, + void *cb_arg) +{ + struct device *dev = q->lif->ionic->dev; + struct lif *lif = q->lif; + + q->head->cb = cb; + q->head->cb_arg = cb_arg; + q->head = q->head->next; + + dev_dbg(dev, "lif=%d qname=%s qid=%d qtype=%d p_index=%d ringdb=%d\n", + q->lif->index, q->name, q->hw_type, q->hw_index, + q->head->index, ring_doorbell); + + if (ring_doorbell) + ionic_dbell_ring(lif->kern_dbpage, q->hw_type, + q->dbval | q->head->index); +} + +unsigned int ionic_q_space_avail(struct queue *q) +{ + unsigned int avail = q->tail->index; + + if (q->head->index >= avail) + avail += q->head->left - 1; + else + avail -= q->head->index + 1; + + return avail; +} + +bool ionic_q_has_space(struct queue *q, unsigned int want) +{ + return ionic_q_space_avail(q) >= want; +} + +static bool ionic_q_is_posted(struct queue *q, unsigned int pos) +{ + unsigned int mask, tail, head; + + mask = q->num_descs - 1; + tail = q->tail->index; + head = q->head->index; + + return ((pos - tail) & mask) < ((head - tail) & mask); +} + +void ionic_q_service(struct queue *q, struct cq_info *cq_info, + unsigned int stop_index) +{ + struct desc_info *desc_info; + void *cb_arg; + desc_cb cb; + + /* check for empty queue */ + if (q->tail->index == q->head->index) + return; + + /* stop index must be for a descriptor that is not yet completed */ + if (unlikely(!ionic_q_is_posted(q, stop_index))) + dev_err(q->lif->ionic->dev, + "ionic stop is not posted %s stop %u tail %u head %u\n", + q->name, stop_index, q->tail->index, q->head->index); + + do { + desc_info = q->tail; + q->tail = desc_info->next; + + cb = desc_info->cb; + cb_arg = desc_info->cb_arg; + + desc_info->cb = NULL; + desc_info->cb_arg = NULL; + + if (cb) + cb(q, desc_info, cq_info, cb_arg); + } while (desc_info->index != stop_index); +} diff --git a/drivers/net/ethernet/pensando/ionic/ionic_dev.h b/drivers/net/ethernet/pensando/ionic/ionic_dev.h index 6d30adeab8c5..7014acd70b98 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic_dev.h +++ b/drivers/net/ethernet/pensando/ionic/ionic_dev.h @@ -135,6 +135,59 @@ struct ionic_dev { #define INTR_INDEX_NOT_ASSIGNED -1 #define INTR_NAME_MAX_SZ 32 +struct cq_info { + void *cq_desc; + struct cq_info *next; + unsigned int index; + bool last; +}; + +struct queue; +struct qcq; +struct desc_info; + +typedef void (*desc_cb)(struct queue *q, struct desc_info *desc_info, + struct cq_info *cq_info, void *cb_arg); + +struct desc_info { + void *desc; + void *sg_desc; + struct desc_info *next; + unsigned int index; + unsigned int left; + desc_cb cb; + void *cb_arg; +}; + +#define QUEUE_NAME_MAX_SZ 32 + +struct queue { + char name[QUEUE_NAME_MAX_SZ]; + struct ionic_dev *idev; + struct lif *lif; + unsigned int index; + unsigned int type; + unsigned int hw_index; + unsigned int hw_type; + u64 dbval; + void *base; + void *sg_base; + dma_addr_t base_pa; + dma_addr_t sg_base_pa; + struct desc_info *info; + struct desc_info *tail; + struct desc_info *head; + unsigned int num_descs; + unsigned int desc_size; + unsigned int sg_desc_size; + void *nop_desc; + unsigned int pid; + u64 dbell_count; + u64 drop; + u64 stop; + u64 wake; +}; + struct intr { char name[INTR_NAME_MAX_SZ]; unsigned int index; @@ -144,6 +197,20 @@ struct intr { cpumask_t affinity_mask; }; +struct cq { + void *base; + dma_addr_t base_pa; + struct lif *lif; + struct cq_info *info; + struct cq_info *tail; + struct queue *bound_q; + struct intr *bound_intr; + u64 compl_count; + unsigned int num_descs; + unsigned int desc_size; + bool done_color; +}; + struct ionic; static inline void ionic_intr_init(struct ionic_dev *idev, struct intr *intr, @@ -181,7 +248,32 @@ void ionic_dev_cmd_lif_identify(struct ionic_dev *idev, u8 type, u8 ver); void ionic_dev_cmd_lif_init(struct ionic_dev *idev, u16 lif_index, dma_addr_t addr); void ionic_dev_cmd_lif_reset(struct ionic_dev *idev, u16 lif_index); +void ionic_dev_cmd_adminq_init(struct ionic_dev *idev, struct qcq *qcq, + u16 lif_index, u16 intr_index); int ionic_db_page_num(struct lif *lif, int pid); +int ionic_cq_init(struct lif *lif, struct cq *cq, struct intr *intr, + unsigned int num_descs, size_t desc_size); +void ionic_cq_map(struct cq *cq, void *base, dma_addr_t base_pa); +void ionic_cq_bind(struct cq *cq, struct queue *q); +typedef bool (*ionic_cq_cb)(struct cq *cq, struct cq_info *cq_info); +typedef void (*ionic_cq_done_cb)(void *done_arg); +unsigned int ionic_cq_service(struct cq *cq, unsigned int work_to_do, + ionic_cq_cb cb, ionic_cq_done_cb done_cb, + void *done_arg); + +int ionic_q_init(struct lif *lif, struct ionic_dev *idev, struct queue *q, + unsigned int index, const char *name, unsigned int num_descs, + size_t desc_size, size_t sg_desc_size, unsigned int pid); +void ionic_q_map(struct queue *q, void *base, dma_addr_t base_pa); +void ionic_q_sg_map(struct queue *q, void *base, dma_addr_t base_pa); +void ionic_q_post(struct queue *q, bool ring_doorbell, desc_cb cb, + void *cb_arg); +void ionic_q_rewind(struct queue *q, struct desc_info *start); +unsigned int ionic_q_space_avail(struct queue *q); +bool ionic_q_has_space(struct queue *q, unsigned int want); +void ionic_q_service(struct queue *q, struct cq_info *cq_info, + unsigned int stop_index); + #endif /* _IONIC_DEV_H_ */ diff --git a/drivers/net/ethernet/pensando/ionic/ionic_lif.c b/drivers/net/ethernet/pensando/ionic/ionic_lif.c index fd106f415826..1cfc571dc13e 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic_lif.c +++ b/drivers/net/ethernet/pensando/ionic/ionic_lif.c @@ -12,6 +12,32 @@ #include "ionic_lif.h" #include "ionic_debugfs.h" +static bool ionic_adminq_service(struct cq *cq, struct cq_info *cq_info) +{ + struct admin_comp *comp = cq_info->cq_desc; + + if (!color_match(comp->color, cq->done_color)) + return false; + + ionic_q_service(cq->bound_q, cq_info, le16_to_cpu(comp->comp_index)); + + return true; +} + +static int ionic_adminq_napi(struct napi_struct *napi, int budget) +{ + return ionic_napi(napi, budget, ionic_adminq_service, NULL, NULL); +} + +static irqreturn_t ionic_isr(int irq, void *data) +{ + struct napi_struct *napi = data; + + napi_schedule_irqoff(napi); + + return IRQ_HANDLED; +} + static int ionic_intr_alloc(struct lif *lif, struct intr *intr) { struct ionic *ionic = lif->ionic; @@ -36,6 +62,191 @@ static void ionic_intr_free(struct lif *lif, int index) clear_bit(index, lif->ionic->intrs); } +static int ionic_qcq_alloc(struct lif *lif, unsigned int type, + unsigned int index, + const char *name, unsigned int flags, + unsigned int num_descs, unsigned int desc_size, + unsigned int cq_desc_size, + unsigned int sg_desc_size, + unsigned int pid, struct qcq **qcq) +{ + struct ionic_dev *idev = &lif->ionic->idev; + u32 q_size, cq_size, sg_size, total_size; + struct device *dev = lif->ionic->dev; + void *q_base, *cq_base, *sg_base; + dma_addr_t cq_base_pa = 0; + dma_addr_t sg_base_pa = 0; + dma_addr_t q_base_pa = 0; + struct qcq *new; + int err; + + *qcq = NULL; + + q_size = num_descs * desc_size; + cq_size = num_descs * cq_desc_size; + sg_size = num_descs * sg_desc_size; + + total_size = ALIGN(q_size, PAGE_SIZE) + ALIGN(cq_size, PAGE_SIZE); + /* Note: aligning q_size/cq_size is not enough due to cq_base + * address aligning as q_base could be not aligned to the page. + * Adding PAGE_SIZE. + */ + total_size += PAGE_SIZE; + if (flags & QCQ_F_SG) { + total_size += ALIGN(sg_size, PAGE_SIZE); + total_size += PAGE_SIZE; + } + + new = devm_kzalloc(dev, sizeof(*new), GFP_KERNEL); + if (!new) { + netdev_err(lif->netdev, "Cannot allocate queue structure\n"); + err = -ENOMEM; + goto err_out; + } + + new->flags = flags; + + new->q.info = devm_kzalloc(dev, sizeof(*new->q.info) * num_descs, + GFP_KERNEL); + if (!new->q.info) { + netdev_err(lif->netdev, "Cannot allocate queue info\n"); + err = -ENOMEM; + goto err_out; + } + + new->q.type = type; + + err = ionic_q_init(lif, idev, &new->q, index, name, num_descs, + desc_size, sg_desc_size, pid); + if (err) { + netdev_err(lif->netdev, "Cannot initialize queue\n"); + goto err_out; + } + + if (flags & QCQ_F_INTR) { + err = ionic_intr_alloc(lif, &new->intr); + if (err) { + netdev_warn(lif->netdev, "no intr for %s: %d\n", + name, err); + goto err_out; + } + + err = ionic_bus_get_irq(lif->ionic, new->intr.index); + if (err < 0) { + netdev_warn(lif->netdev, "no vector for %s: %d\n", + name, err); + goto err_out_free_intr; + } + new->intr.vector = err; + ionic_intr_mask_assert(idev->intr_ctrl, new->intr.index, + IONIC_INTR_MASK_SET); + + new->intr.cpu = new->intr.index % num_online_cpus(); + if (cpu_online(new->intr.cpu)) + cpumask_set_cpu(new->intr.cpu, + &new->intr.affinity_mask); + } else { + new->intr.index = INTR_INDEX_NOT_ASSIGNED; + } + + new->cq.info = devm_kzalloc(dev, sizeof(*new->cq.info) * num_descs, + GFP_KERNEL); + if (!new->cq.info) { + netdev_err(lif->netdev, "Cannot allocate completion queue info\n"); + err = -ENOMEM; + goto err_out_free_intr; + } + + err = ionic_cq_init(lif, &new->cq, &new->intr, num_descs, cq_desc_size); + if (err) { + netdev_err(lif->netdev, "Cannot initialize completion queue\n"); + goto err_out_free_intr; + } + + new->base = dma_alloc_coherent(dev, total_size, &new->base_pa, + GFP_KERNEL); + if (!new->base) { + netdev_err(lif->netdev, "Cannot allocate queue DMA memory\n"); + err = -ENOMEM; + goto err_out_free_intr; + } + + new->total_size = total_size; + + q_base = new->base; + q_base_pa = new->base_pa; + + cq_base = (void *)ALIGN((uintptr_t)q_base + q_size, PAGE_SIZE); + cq_base_pa = ALIGN(q_base_pa + q_size, PAGE_SIZE); + + if (flags & QCQ_F_SG) { + sg_base = (void *)ALIGN((uintptr_t)cq_base + cq_size, + PAGE_SIZE); + sg_base_pa = ALIGN(cq_base_pa + cq_size, PAGE_SIZE); + ionic_q_sg_map(&new->q, sg_base, sg_base_pa); + } + + ionic_q_map(&new->q, q_base, q_base_pa); + ionic_cq_map(&new->cq, cq_base, cq_base_pa); + ionic_cq_bind(&new->cq, &new->q); + + *qcq = new; + + return 0; + +err_out_free_intr: + ionic_intr_free(lif, new->intr.index); +err_out: + dev_err(dev, "qcq alloc of %s%d failed %d\n", name, index, err); + return err; +} + +static void ionic_qcq_free(struct lif *lif, struct qcq *qcq) +{ + struct device *dev = lif->ionic->dev; + + if (!qcq) + return; + + dma_free_coherent(dev, qcq->total_size, qcq->base, qcq->base_pa); + qcq->base = NULL; + qcq->base_pa = 0; + + if (qcq->flags & QCQ_F_INTR) + ionic_intr_free(lif, qcq->intr.index); + + devm_kfree(dev, qcq->cq.info); + qcq->cq.info = NULL; + devm_kfree(dev, qcq->q.info); + qcq->q.info = NULL; + devm_kfree(dev, qcq); +} + +static int ionic_qcqs_alloc(struct lif *lif) +{ + unsigned int flags; + int err; + + flags = QCQ_F_INTR; + err = ionic_qcq_alloc(lif, IONIC_QTYPE_ADMINQ, 0, "admin", flags, + IONIC_ADMINQ_LENGTH, + sizeof(struct admin_cmd), + sizeof(struct admin_comp), + 0, lif->kern_pid, &lif->adminqcq); + if (err) + return err; + + return 0; +} + +static void ionic_qcqs_free(struct lif *lif) +{ + if (lif->adminqcq) { + ionic_qcq_free(lif, lif->adminqcq); + lif->adminqcq = NULL; + } +} + static struct lif *ionic_lif_alloc(struct ionic *ionic, unsigned int index) { struct device *dev = ionic->dev; @@ -65,6 +276,8 @@ static struct lif *ionic_lif_alloc(struct ionic *ionic, unsigned int index) snprintf(lif->name, sizeof(lif->name), "lif%u", index); + spin_lock_init(&lif->adminq_lock); + /* allocate lif info */ lif->info_sz = ALIGN(sizeof(*lif->info), PAGE_SIZE); lif->info = dma_alloc_coherent(dev, lif->info_sz, @@ -75,10 +288,19 @@ static struct lif *ionic_lif_alloc(struct ionic *ionic, unsigned int index) goto err_out_free_netdev; } + /* allocate queues */ + err = ionic_qcqs_alloc(lif); + if (err) + goto err_out_free_lif_info; + list_add_tail(&lif->list, &ionic->lifs); return lif; +err_out_free_lif_info: + dma_free_coherent(dev, lif->info_sz, lif->info, lif->info_pa); + lif->info = NULL; + lif->info_pa = 0; err_out_free_netdev: free_netdev(lif->netdev); lif = NULL; @@ -113,6 +335,8 @@ static void ionic_lif_free(struct lif *lif) { struct device *dev = lif->ionic->dev; + /* free queues */ + ionic_qcqs_free(lif); ionic_lif_reset(lif); /* free lif info */ @@ -146,6 +370,30 @@ void ionic_lifs_free(struct ionic *ionic) } } +static void ionic_lif_qcq_deinit(struct lif *lif, struct qcq *qcq) +{ + struct ionic_dev *idev = &lif->ionic->idev; + struct device *dev = lif->ionic->dev; + + if (!qcq) + return; + + ionic_debugfs_del_qcq(qcq); + + if (!(qcq->flags & QCQ_F_INITED)) + return; + + if (qcq->flags & QCQ_F_INTR) { + ionic_intr_mask(idev->intr_ctrl, qcq->intr.index, + IONIC_INTR_MASK_SET); + synchronize_irq(qcq->intr.vector); + devm_free_irq(dev, qcq->intr.vector, &qcq->napi); + netif_napi_del(&qcq->napi); + } + + qcq->flags &= ~QCQ_F_INITED; +} + static void ionic_lif_deinit(struct lif *lif) { if (!test_bit(LIF_INITED, lif->state)) @@ -153,6 +401,9 @@ static void ionic_lif_deinit(struct lif *lif) clear_bit(LIF_INITED, lif->state); + napi_disable(&lif->adminqcq->napi); + ionic_lif_qcq_deinit(lif, lif->adminqcq); + ionic_lif_reset(lif); } @@ -167,6 +418,77 @@ void ionic_lifs_deinit(struct ionic *ionic) } } +static int ionic_request_irq(struct lif *lif, struct qcq *qcq) +{ + struct device *dev = lif->ionic->dev; + struct intr *intr = &qcq->intr; + struct queue *q = &qcq->q; + const char *name; + + if (lif->registered) + name = lif->netdev->name; + else + name = dev_name(dev); + + snprintf(intr->name, sizeof(intr->name), + "%s-%s-%s", DRV_NAME, name, q->name); + + return devm_request_irq(dev, intr->vector, ionic_isr, + 0, intr->name, &qcq->napi); +} + +static int ionic_lif_adminq_init(struct lif *lif) +{ + struct device *dev = lif->ionic->dev; + struct ionic_dev *idev = &lif->ionic->idev; + struct qcq *qcq = lif->adminqcq; + struct queue *q = &qcq->q; + struct q_init_comp comp; + int err; + + mutex_lock(&lif->ionic->dev_cmd_lock); + ionic_dev_cmd_adminq_init(idev, qcq, lif->index, qcq->intr.index); + err = ionic_dev_cmd_wait(lif->ionic, devcmd_timeout); + ionic_dev_cmd_comp(idev, (union dev_cmd_comp *)&comp); + mutex_unlock(&lif->ionic->dev_cmd_lock); + if (err) { + netdev_err(lif->netdev, "adminq init failed %d\n", err); + return err; + } + + q->hw_type = comp.hw_type; + q->hw_index = le32_to_cpu(comp.hw_index); + q->dbval = IONIC_DBELL_QID(q->hw_index); + + dev_dbg(dev, "adminq->hw_type %d\n", q->hw_type); + dev_dbg(dev, "adminq->hw_index %d\n", q->hw_index); + + netif_napi_add(lif->netdev, &qcq->napi, ionic_adminq_napi, + NAPI_POLL_WEIGHT); + + err = ionic_request_irq(lif, qcq); + if (err) { + netdev_warn(lif->netdev, "adminq irq request failed %d\n", err); + netif_napi_del(&qcq->napi); + return err; + } + + napi_enable(&qcq->napi); + + if (qcq->flags & QCQ_F_INTR) + ionic_intr_mask(idev->intr_ctrl, qcq->intr.index, + IONIC_INTR_MASK_CLEAR); + + qcq->flags |= QCQ_F_INITED; + + err = ionic_debugfs_add_qcq(lif, qcq); + if (err) + netdev_warn(lif->netdev, "debugfs add for adminq failed %d\n", + err); + + return 0; +} + static int ionic_lif_init(struct lif *lif) { struct ionic_dev *idev = &lif->ionic->idev; @@ -217,10 +539,19 @@ static int ionic_lif_init(struct lif *lif) goto err_out_free_dbid; } + err = ionic_lif_adminq_init(lif); + if (err) + goto err_out_adminq_deinit; + set_bit(LIF_INITED, lif->state); return 0; +err_out_adminq_deinit: + ionic_lif_qcq_deinit(lif, lif->adminqcq); + ionic_lif_reset(lif); + ionic_bus_unmap_dbpage(lif->ionic, lif->kern_dbpage); + lif->kern_dbpage = NULL; err_out_free_dbid: kfree(lif->dbid_inuse); lif->dbid_inuse = NULL; diff --git a/drivers/net/ethernet/pensando/ionic/ionic_lif.h b/drivers/net/ethernet/pensando/ionic/ionic_lif.h index 7fd47bb951d1..b9e2dd799a05 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic_lif.h +++ b/drivers/net/ethernet/pensando/ionic/ionic_lif.h @@ -6,6 +6,57 @@ #include +#define IONIC_ADMINQ_LENGTH 16 /* must be a power of two */ + +#define GET_NAPI_CNTR_IDX(work_done) (work_done) +#define MAX_NUM_NAPI_CNTR (NAPI_POLL_WEIGHT + 1) +#define GET_SG_CNTR_IDX(num_sg_elems) (num_sg_elems) +#define MAX_NUM_SG_CNTR (IONIC_TX_MAX_SG_ELEMS + 1) + +struct tx_stats { + u64 pkts; + u64 bytes; +}; + +struct rx_stats { + u64 pkts; + u64 bytes; +}; + +#define QCQ_F_INITED BIT(0) +#define QCQ_F_SG BIT(1) +#define QCQ_F_INTR BIT(2) + +struct napi_stats { + u64 poll_count; + u64 work_done_cntr[MAX_NUM_NAPI_CNTR]; +}; + +struct q_stats { + union { + struct tx_stats tx; + struct rx_stats rx; + }; +}; + +struct qcq { + void *base; + dma_addr_t base_pa; + unsigned int total_size; + struct queue q; + struct cq cq; + struct intr intr; + struct napi_struct napi; + struct napi_stats napi_stats; + struct q_stats *stats; + unsigned int flags; + struct dentry *dentry; +}; + +#define q_to_qcq(q) container_of(q, struct qcq, q) +#define napi_to_qcq(napi) container_of(napi, struct qcq, napi) +#define napi_to_cq(napi) (&napi_to_qcq(napi)->cq) + enum lif_state_flags { LIF_INITED, @@ -25,6 +76,8 @@ struct lif { unsigned int hw_index; unsigned int kern_pid; u64 __iomem *kern_dbpage; + spinlock_t adminq_lock; /* lock for AdminQ operations */ + struct qcq *adminqcq; unsigned int neqs; unsigned int nxqs; @@ -77,4 +130,23 @@ int ionic_lif_identify(struct ionic *ionic, u8 lif_type, union lif_identity *lif_ident); int ionic_lifs_size(struct ionic *ionic); +static inline void debug_stats_napi_poll(struct qcq *qcq, + unsigned int work_done) +{ + u32 napi_cntr_idx; + + qcq->napi_stats.poll_count++; + + napi_cntr_idx = GET_NAPI_CNTR_IDX(work_done); + if (napi_cntr_idx > (MAX_NUM_NAPI_CNTR - 1)) + napi_cntr_idx = MAX_NUM_NAPI_CNTR - 1; + + qcq->napi_stats.work_done_cntr[napi_cntr_idx]++; +} + +#define DEBUG_STATS_CQE_CNT(cq) ((cq)->compl_count++) +#define DEBUG_STATS_INTR_REARM(intr) ((intr)->rearm_count++) +#define DEBUG_STATS_NAPI_POLL(qcq, work_done) \ + debug_stats_napi_poll(qcq, work_done) + #endif /* _IONIC_LIF_H_ */ diff --git a/drivers/net/ethernet/pensando/ionic/ionic_main.c b/drivers/net/ethernet/pensando/ionic/ionic_main.c index e0c1977845dd..17d8802e69ae 100644 --- a/drivers/net/ethernet/pensando/ionic/ionic_main.c +++ b/drivers/net/ethernet/pensando/ionic/ionic_main.c @@ -169,6 +169,32 @@ static const char *ionic_opcode_to_str(enum cmd_opcode opcode) } } +int ionic_napi(struct napi_struct *napi, int budget, ionic_cq_cb cb, + ionic_cq_done_cb done_cb, void *done_arg) +{ + struct qcq *qcq = napi_to_qcq(napi); + struct cq *cq = &qcq->cq; + u32 work_done, flags = 0; + + work_done = ionic_cq_service(cq, budget, cb, done_cb, done_arg); + + if (work_done < budget && napi_complete_done(napi, work_done)) { + flags |= IONIC_INTR_CRED_UNMASK; + DEBUG_STATS_INTR_REARM(cq->bound_intr); + } + + if (work_done || flags) { + flags |= IONIC_INTR_CRED_RESET_COALESCE; + ionic_intr_credits(cq->lif->ionic->idev.intr_ctrl, + cq->bound_intr->index, + work_done, flags); + } + + DEBUG_STATS_NAPI_POLL(qcq, work_done); + + return work_done; +} + int ionic_dev_cmd_wait(struct ionic *ionic, unsigned long max_seconds) { struct ionic_dev *idev = &ionic->idev;