1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (c) 2022, Microsoft Corporation. All rights reserved.
  4 */
  5
  6#include "mana_ib.h"
  7
  8int mana_ib_create_cq(struct ib_cq *ibcq, const struct ib_cq_init_attr *attr,
  9		      struct uverbs_attr_bundle *attrs)
 10{
 11	struct ib_udata *udata = &attrs->driver_udata;
 12	struct mana_ib_cq *cq = container_of(ibcq, struct mana_ib_cq, ibcq);
 13	struct mana_ib_create_cq_resp resp = {};
 14	struct mana_ib_ucontext *mana_ucontext;
 15	struct ib_device *ibdev = ibcq->device;
 16	struct mana_ib_create_cq ucmd = {};
 17	struct mana_ib_dev *mdev;
 18	bool is_rnic_cq;
 19	u32 doorbell;
 20	int err;
 21
 22	mdev = container_of(ibdev, struct mana_ib_dev, ib_dev);
 23
 24	cq->comp_vector = attr->comp_vector % ibdev->num_comp_vectors;
 25	cq->cq_handle = INVALID_MANA_HANDLE;
 26
 27	if (udata->inlen < offsetof(struct mana_ib_create_cq, flags))
 28		return -EINVAL;
 29
 30	err = ib_copy_from_udata(&ucmd, udata, min(sizeof(ucmd), udata->inlen));
 31	if (err) {
 32		ibdev_dbg(ibdev,
 33			  "Failed to copy from udata for create cq, %d\n", err);
 34		return err;
 35	}
 36
 37	is_rnic_cq = !!(ucmd.flags & MANA_IB_CREATE_RNIC_CQ);
 38
 39	if (!is_rnic_cq && attr->cqe > mdev->adapter_caps.max_qp_wr) {
 40		ibdev_dbg(ibdev, "CQE %d exceeding limit\n", attr->cqe);
 41		return -EINVAL;
 42	}
 43
 44	cq->cqe = attr->cqe;
 45	err = mana_ib_create_queue(mdev, ucmd.buf_addr, cq->cqe * COMP_ENTRY_SIZE, &cq->queue);
 46	if (err) {
 47		ibdev_dbg(ibdev, "Failed to create queue for create cq, %d\n", err);
 48		return err;
 49	}
 50
 51	mana_ucontext = rdma_udata_to_drv_context(udata, struct mana_ib_ucontext,
 52						  ibucontext);
 53	doorbell = mana_ucontext->doorbell;
 54
 55	if (is_rnic_cq) {
 56		err = mana_ib_gd_create_cq(mdev, cq, doorbell);
 57		if (err) {
 58			ibdev_dbg(ibdev, "Failed to create RNIC cq, %d\n", err);
 59			goto err_destroy_queue;
 60		}
 61
 62		err = mana_ib_install_cq_cb(mdev, cq);
 63		if (err) {
 64			ibdev_dbg(ibdev, "Failed to install cq callback, %d\n", err);
 65			goto err_destroy_rnic_cq;
 66		}
 67	}
 68
 69	resp.cqid = cq->queue.id;
 70	err = ib_copy_to_udata(udata, &resp, min(sizeof(resp), udata->outlen));
 71	if (err) {
 72		ibdev_dbg(&mdev->ib_dev, "Failed to copy to udata, %d\n", err);
 73		goto err_remove_cq_cb;
 74	}
 75
 76	return 0;
 77
 78err_remove_cq_cb:
 79	mana_ib_remove_cq_cb(mdev, cq);
 80err_destroy_rnic_cq:
 81	mana_ib_gd_destroy_cq(mdev, cq);
 82err_destroy_queue:
 83	mana_ib_destroy_queue(mdev, &cq->queue);
 84
 85	return err;
 86}
 87
 88int mana_ib_destroy_cq(struct ib_cq *ibcq, struct ib_udata *udata)
 89{
 90	struct mana_ib_cq *cq = container_of(ibcq, struct mana_ib_cq, ibcq);
 91	struct ib_device *ibdev = ibcq->device;
 92	struct mana_ib_dev *mdev;
 93
 94	mdev = container_of(ibdev, struct mana_ib_dev, ib_dev);
 95
 96	mana_ib_remove_cq_cb(mdev, cq);
 97
 98	/* Ignore return code as there is not much we can do about it.
 99	 * The error message is printed inside.
100	 */
101	mana_ib_gd_destroy_cq(mdev, cq);
102
103	mana_ib_destroy_queue(mdev, &cq->queue);
104
105	return 0;
106}
107
108static void mana_ib_cq_handler(void *ctx, struct gdma_queue *gdma_cq)
109{
110	struct mana_ib_cq *cq = ctx;
111
112	if (cq->ibcq.comp_handler)
113		cq->ibcq.comp_handler(&cq->ibcq, cq->ibcq.cq_context);
114}
115
116int mana_ib_install_cq_cb(struct mana_ib_dev *mdev, struct mana_ib_cq *cq)
117{
118	struct gdma_context *gc = mdev_to_gc(mdev);
119	struct gdma_queue *gdma_cq;
120
121	if (cq->queue.id >= gc->max_num_cqs)
122		return -EINVAL;
123	/* Create CQ table entry */
124	WARN_ON(gc->cq_table[cq->queue.id]);
125	gdma_cq = kzalloc(sizeof(*gdma_cq), GFP_KERNEL);
126	if (!gdma_cq)
127		return -ENOMEM;
128
129	gdma_cq->cq.context = cq;
130	gdma_cq->type = GDMA_CQ;
131	gdma_cq->cq.callback = mana_ib_cq_handler;
132	gdma_cq->id = cq->queue.id;
133	gc->cq_table[cq->queue.id] = gdma_cq;
134	return 0;
135}
136
137void mana_ib_remove_cq_cb(struct mana_ib_dev *mdev, struct mana_ib_cq *cq)
138{
139	struct gdma_context *gc = mdev_to_gc(mdev);
140
141	if (cq->queue.id >= gc->max_num_cqs || cq->queue.id == INVALID_QUEUE_ID)
142		return;
143
144	kfree(gc->cq_table[cq->queue.id]);
145	gc->cq_table[cq->queue.id] = NULL;
146}