[linux-block.git] / drivers / infiniband / hw / hns / hns_roce_srq.c

// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
/*
 * Copyright (c) 2018 Hisilicon Limited.
 */

#include <rdma/ib_umem.h>
#include <rdma/hns-abi.h>
#include "hns_roce_device.h"
#include "hns_roce_cmd.h"
#include "hns_roce_hem.h"

void hns_roce_srq_event(struct hns_roce_dev *hr_dev, u32 srqn, int event_type)
{
	struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
	struct hns_roce_srq *srq;

	xa_lock(&srq_table->xa);
	srq = xa_load(&srq_table->xa, srqn & (hr_dev->caps.num_srqs - 1));
	if (srq)
		atomic_inc(&srq->refcount);
	xa_unlock(&srq_table->xa);

	if (!srq) {
		dev_warn(hr_dev->dev, "Async event for bogus SRQ %08x\n", srqn);
		return;
	}

	srq->event(srq, event_type);

	if (atomic_dec_and_test(&srq->refcount))
		complete(&srq->free);
}

static void hns_roce_ib_srq_event(struct hns_roce_srq *srq,
				  enum hns_roce_event event_type)
{
	struct hns_roce_dev *hr_dev = to_hr_dev(srq->ibsrq.device);
	struct ib_srq *ibsrq = &srq->ibsrq;
	struct ib_event event;

	if (ibsrq->event_handler) {
		event.device      = ibsrq->device;
		event.element.srq = ibsrq;
		switch (event_type) {
		case HNS_ROCE_EVENT_TYPE_SRQ_LIMIT_REACH:
			event.event = IB_EVENT_SRQ_LIMIT_REACHED;
			break;
		case HNS_ROCE_EVENT_TYPE_SRQ_CATAS_ERROR:
			event.event = IB_EVENT_SRQ_ERR;
			break;
		default:
			dev_err(hr_dev->dev,
			   "hns_roce:Unexpected event type 0x%x on SRQ %06lx\n",
			   event_type, srq->srqn);
			return;
		}

		ibsrq->event_handler(&event, ibsrq->srq_context);
	}
}

static int hns_roce_hw_create_srq(struct hns_roce_dev *dev,
				  struct hns_roce_cmd_mailbox *mailbox,
				  unsigned long srq_num)
{
	return hns_roce_cmd_mbox(dev, mailbox->dma, 0, srq_num, 0,
				 HNS_ROCE_CMD_CREATE_SRQ,
				 HNS_ROCE_CMD_TIMEOUT_MSECS);
}

static int hns_roce_hw_destroy_srq(struct hns_roce_dev *dev,
				   struct hns_roce_cmd_mailbox *mailbox,
				   unsigned long srq_num)
{
	return hns_roce_cmd_mbox(dev, 0, mailbox ? mailbox->dma : 0, srq_num,
				 mailbox ? 0 : 1, HNS_ROCE_CMD_DESTROY_SRQ,
				 HNS_ROCE_CMD_TIMEOUT_MSECS);
}

static int alloc_srqc(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq,
		      u32 pdn, u32 cqn, u16 xrcd, u64 db_rec_addr)
{
	struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
	struct ib_device *ibdev = &hr_dev->ib_dev;
	struct hns_roce_cmd_mailbox *mailbox;
	u64 mtts_wqe[MTT_MIN_COUNT] = { 0 };
	u64 mtts_idx[MTT_MIN_COUNT] = { 0 };
	dma_addr_t dma_handle_wqe = 0;
	dma_addr_t dma_handle_idx = 0;
	int ret;

	/* Get the physical address of srq buf */
	ret = hns_roce_mtr_find(hr_dev, &srq->buf_mtr, 0, mtts_wqe,
				ARRAY_SIZE(mtts_wqe), &dma_handle_wqe);
	if (ret < 1) {
		ibdev_err(ibdev, "Failed to find mtr for SRQ WQE\n");
		return -ENOBUFS;
	}

	/* Get physical address of idx que buf */
	ret = hns_roce_mtr_find(hr_dev, &srq->idx_que.mtr, 0, mtts_idx,
				ARRAY_SIZE(mtts_idx), &dma_handle_idx);
	if (ret < 1) {
		ibdev_err(ibdev, "Failed to find mtr for SRQ idx\n");
		return -ENOBUFS;
	}

	ret = hns_roce_bitmap_alloc(&srq_table->bitmap, &srq->srqn);
	if (ret) {
		ibdev_err(ibdev, "Failed to alloc SRQ number, err %d\n", ret);
		return -ENOMEM;
	}

	ret = hns_roce_table_get(hr_dev, &srq_table->table, srq->srqn);
	if (ret) {
		ibdev_err(ibdev, "Failed to get SRQC table, err %d\n", ret);
		goto err_out;
	}

	ret = xa_err(xa_store(&srq_table->xa, srq->srqn, srq, GFP_KERNEL));
	if (ret) {
		ibdev_err(ibdev, "Failed to store SRQC, err %d\n", ret);
		goto err_put;
	}

	mailbox = hns_roce_alloc_cmd_mailbox(hr_dev);
	if (IS_ERR_OR_NULL(mailbox)) {
		ret = -ENOMEM;
		ibdev_err(ibdev, "Failed to alloc mailbox for SRQC\n");
		goto err_xa;
	}

	hr_dev->hw->write_srqc(hr_dev, srq, pdn, xrcd, cqn, mailbox->buf,
			       mtts_wqe, mtts_idx, dma_handle_wqe,
			       dma_handle_idx);

	ret = hns_roce_hw_create_srq(hr_dev, mailbox, srq->srqn);
	hns_roce_free_cmd_mailbox(hr_dev, mailbox);
	if (ret) {
		ibdev_err(ibdev, "Failed to config SRQC, err %d\n", ret);
		goto err_xa;
	}

	atomic_set(&srq->refcount, 1);
	init_completion(&srq->free);
	return ret;

err_xa:
	xa_erase(&srq_table->xa, srq->srqn);

err_put:
	hns_roce_table_put(hr_dev, &srq_table->table, srq->srqn);

err_out:
	hns_roce_bitmap_free(&srq_table->bitmap, srq->srqn, BITMAP_NO_RR);
	return ret;
}

static void free_srqc(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq)
{
	struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
	int ret;

	ret = hns_roce_hw_destroy_srq(hr_dev, NULL, srq->srqn);
	if (ret)
		dev_err(hr_dev->dev, "DESTROY_SRQ failed (%d) for SRQN %06lx\n",
			ret, srq->srqn);

	xa_erase(&srq_table->xa, srq->srqn);

	if (atomic_dec_and_test(&srq->refcount))
		complete(&srq->free);
	wait_for_completion(&srq->free);

	hns_roce_table_put(hr_dev, &srq_table->table, srq->srqn);
	hns_roce_bitmap_free(&srq_table->bitmap, srq->srqn, BITMAP_NO_RR);
}

static int alloc_srq_buf(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq,
			 struct ib_udata *udata, unsigned long addr)
{
	struct ib_device *ibdev = &hr_dev->ib_dev;
	struct hns_roce_buf_attr buf_attr = {};
	int err;

	srq->wqe_shift = ilog2(roundup_pow_of_two(max(HNS_ROCE_SGE_SIZE,
						      HNS_ROCE_SGE_SIZE *
						      srq->max_gs)));

	buf_attr.page_shift = hr_dev->caps.srqwqe_buf_pg_sz + HNS_HW_PAGE_SHIFT;
	buf_attr.region[0].size = to_hr_hem_entries_size(srq->wqe_cnt,
							 srq->wqe_shift);
	buf_attr.region[0].hopnum = hr_dev->caps.srqwqe_hop_num;
	buf_attr.region_count = 1;
	buf_attr.fixed_page = true;

	err = hns_roce_mtr_create(hr_dev, &srq->buf_mtr, &buf_attr,
				  hr_dev->caps.srqwqe_ba_pg_sz +
				  HNS_HW_PAGE_SHIFT, udata, addr);
	if (err)
		ibdev_err(ibdev, "Failed to alloc SRQ buf mtr, err %d\n", err);

	return err;
}

static void free_srq_buf(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq)
{
	hns_roce_mtr_destroy(hr_dev, &srq->buf_mtr);
}

static int alloc_srq_idx(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq,
			 struct ib_udata *udata, unsigned long addr)
{
	struct hns_roce_idx_que *idx_que = &srq->idx_que;
	struct ib_device *ibdev = &hr_dev->ib_dev;
	struct hns_roce_buf_attr buf_attr = {};
	int err;

	srq->idx_que.entry_shift = ilog2(HNS_ROCE_IDX_QUE_ENTRY_SZ);

	buf_attr.page_shift = hr_dev->caps.idx_buf_pg_sz + HNS_HW_PAGE_SHIFT;
	buf_attr.region[0].size = to_hr_hem_entries_size(srq->wqe_cnt,
					srq->idx_que.entry_shift);
	buf_attr.region[0].hopnum = hr_dev->caps.idx_hop_num;
	buf_attr.region_count = 1;
	buf_attr.fixed_page = true;

	err = hns_roce_mtr_create(hr_dev, &idx_que->mtr, &buf_attr,
				  hr_dev->caps.idx_ba_pg_sz + HNS_HW_PAGE_SHIFT,
				  udata, addr);
	if (err) {
		ibdev_err(ibdev, "Failed to alloc SRQ idx mtr, err %d\n", err);
		return err;
	}

	if (!udata) {
		idx_que->bitmap = bitmap_zalloc(srq->wqe_cnt, GFP_KERNEL);
		if (!idx_que->bitmap) {
			ibdev_err(ibdev, "Failed to alloc SRQ idx bitmap\n");
			err = -ENOMEM;
			goto err_idx_mtr;
		}

	}

	return 0;
err_idx_mtr:
	hns_roce_mtr_destroy(hr_dev, &idx_que->mtr);

	return err;
}

static void free_srq_idx(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq)
{
	struct hns_roce_idx_que *idx_que = &srq->idx_que;

	bitmap_free(idx_que->bitmap);
	idx_que->bitmap = NULL;
	hns_roce_mtr_destroy(hr_dev, &idx_que->mtr);
}

static int alloc_srq_wrid(struct hns_roce_dev *hr_dev, struct hns_roce_srq *srq)
{
	srq->head = 0;
	srq->tail = srq->wqe_cnt - 1;
	srq->wrid = kvmalloc_array(srq->wqe_cnt, sizeof(u64), GFP_KERNEL);
	if (!srq->wrid)
		return -ENOMEM;

	return 0;
}

static void free_srq_wrid(struct hns_roce_srq *srq)
{
	kfree(srq->wrid);
	srq->wrid = NULL;
}

int hns_roce_create_srq(struct ib_srq *ib_srq,
			struct ib_srq_init_attr *init_attr,
			struct ib_udata *udata)
{
	struct hns_roce_dev *hr_dev = to_hr_dev(ib_srq->device);
	struct hns_roce_ib_create_srq_resp resp = {};
	struct hns_roce_srq *srq = to_hr_srq(ib_srq);
	struct ib_device *ibdev = &hr_dev->ib_dev;
	struct hns_roce_ib_create_srq ucmd = {};
	int ret = 0;
	u32 cqn;

	/* Check the actual SRQ wqe and SRQ sge num */
	if (init_attr->attr.max_wr >= hr_dev->caps.max_srq_wrs ||
	    init_attr->attr.max_sge > hr_dev->caps.max_srq_sges)
		return -EINVAL;

	mutex_init(&srq->mutex);
	spin_lock_init(&srq->lock);

	srq->wqe_cnt = roundup_pow_of_two(init_attr->attr.max_wr + 1);
	srq->max_gs = init_attr->attr.max_sge + HNS_ROCE_RESERVED_SGE;

	if (udata) {
		ret = ib_copy_from_udata(&ucmd, udata, sizeof(ucmd));
		if (ret) {
			ibdev_err(ibdev, "Failed to copy SRQ udata, err %d\n",
				  ret);
			return ret;
		}
	}

	ret = alloc_srq_buf(hr_dev, srq, udata, ucmd.buf_addr);
	if (ret) {
		ibdev_err(ibdev, "Failed to alloc SRQ buffer, err %d\n", ret);
		return ret;
	}

	ret = alloc_srq_idx(hr_dev, srq, udata, ucmd.que_addr);
	if (ret) {
		ibdev_err(ibdev, "Failed to alloc SRQ idx, err %d\n", ret);
		goto err_buf_alloc;
	}

	if (!udata) {
		ret = alloc_srq_wrid(hr_dev, srq);
		if (ret) {
			ibdev_err(ibdev, "Failed to alloc SRQ wrid, err %d\n",
				  ret);
			goto err_idx_alloc;
		}
	}

	cqn = ib_srq_has_cq(init_attr->srq_type) ?
	      to_hr_cq(init_attr->ext.cq)->cqn : 0;
	srq->db_reg_l = hr_dev->reg_base + SRQ_DB_REG;

	ret = alloc_srqc(hr_dev, srq, to_hr_pd(ib_srq->pd)->pdn, cqn, 0, 0);
	if (ret) {
		ibdev_err(ibdev, "Failed to alloc SRQ context, err %d\n", ret);
		goto err_wrid_alloc;
	}

	srq->event = hns_roce_ib_srq_event;
	resp.srqn = srq->srqn;

	if (udata) {
		if (ib_copy_to_udata(udata, &resp,
				     min(udata->outlen, sizeof(resp)))) {
			ret = -EFAULT;
			goto err_srqc_alloc;
		}
	}

	return 0;

err_srqc_alloc:
	free_srqc(hr_dev, srq);
err_wrid_alloc:
	free_srq_wrid(srq);
err_idx_alloc:
	free_srq_idx(hr_dev, srq);
err_buf_alloc:
	free_srq_buf(hr_dev, srq);
	return ret;
}

void hns_roce_destroy_srq(struct ib_srq *ibsrq, struct ib_udata *udata)
{
	struct hns_roce_dev *hr_dev = to_hr_dev(ibsrq->device);
	struct hns_roce_srq *srq = to_hr_srq(ibsrq);

	free_srqc(hr_dev, srq);
	free_srq_idx(hr_dev, srq);
	free_srq_wrid(srq);
	free_srq_buf(hr_dev, srq);
}

int hns_roce_init_srq_table(struct hns_roce_dev *hr_dev)
{
	struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;

	xa_init(&srq_table->xa);

	return hns_roce_bitmap_init(&srq_table->bitmap, hr_dev->caps.num_srqs,
				    hr_dev->caps.num_srqs - 1,
				    hr_dev->caps.reserved_srqs, 0);
}

void hns_roce_cleanup_srq_table(struct hns_roce_dev *hr_dev)
{
	hns_roce_bitmap_cleanup(&hr_dev->srq_table.bitmap);
}
Commit	Line	Data
5c1f167a LO	1	// SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB
	2	/*
	3	* Copyright (c) 2018 Hisilicon Limited.
	4	*/
	5
	6	#include <rdma/ib_umem.h>
	7	#include <rdma/hns-abi.h>
	8	#include "hns_roce_device.h"
	9	#include "hns_roce_cmd.h"
	10	#include "hns_roce_hem.h"
	11
81fce629 LO	12	void hns_roce_srq_event(struct hns_roce_dev *hr_dev, u32 srqn, int event_type)
	13	{
	14	struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
	15	struct hns_roce_srq *srq;
	16
	17	xa_lock(&srq_table->xa);
	18	srq = xa_load(&srq_table->xa, srqn & (hr_dev->caps.num_srqs - 1));
	19	if (srq)
	20	atomic_inc(&srq->refcount);
	21	xa_unlock(&srq_table->xa);
	22
	23	if (!srq) {
	24	dev_warn(hr_dev->dev, "Async event for bogus SRQ %08x\n", srqn);
	25	return;
	26	}
	27
	28	srq->event(srq, event_type);
	29
	30	if (atomic_dec_and_test(&srq->refcount))
	31	complete(&srq->free);
	32	}
81fce629	33
c7bcb134 LO	34	static void hns_roce_ib_srq_event(struct hns_roce_srq *srq,
	35	enum hns_roce_event event_type)
	36	{
	37	struct hns_roce_dev *hr_dev = to_hr_dev(srq->ibsrq.device);
	38	struct ib_srq *ibsrq = &srq->ibsrq;
	39	struct ib_event event;
	40
	41	if (ibsrq->event_handler) {
	42	event.device = ibsrq->device;
	43	event.element.srq = ibsrq;
	44	switch (event_type) {
	45	case HNS_ROCE_EVENT_TYPE_SRQ_LIMIT_REACH:
	46	event.event = IB_EVENT_SRQ_LIMIT_REACHED;
	47	break;
	48	case HNS_ROCE_EVENT_TYPE_SRQ_CATAS_ERROR:
	49	event.event = IB_EVENT_SRQ_ERR;
	50	break;
	51	default:
	52	dev_err(hr_dev->dev,
	53	"hns_roce:Unexpected event type 0x%x on SRQ %06lx\n",
	54	event_type, srq->srqn);
	55	return;
	56	}
	57
	58	ibsrq->event_handler(&event, ibsrq->srq_context);
	59	}
	60	}
	61
6eef5242 YL	62	static int hns_roce_hw_create_srq(struct hns_roce_dev *dev,
	63	struct hns_roce_cmd_mailbox *mailbox,
	64	unsigned long srq_num)
c7bcb134 LO	65	{
c7bcb134 LO	66	return hns_roce_cmd_mbox(dev, mailbox->dma, 0, srq_num, 0,
6eef5242	67	HNS_ROCE_CMD_CREATE_SRQ,
c7bcb134 LO	68	HNS_ROCE_CMD_TIMEOUT_MSECS);
	69	}
	70
6eef5242 YL	71	static int hns_roce_hw_destroy_srq(struct hns_roce_dev *dev,
	72	struct hns_roce_cmd_mailbox *mailbox,
	73	unsigned long srq_num)
c7bcb134 LO	74	{
c7bcb134 LO	75	return hns_roce_cmd_mbox(dev, 0, mailbox ? mailbox->dma : 0, srq_num,
6eef5242	76	mailbox ? 0 : 1, HNS_ROCE_CMD_DESTROY_SRQ,
c7bcb134 LO	77	HNS_ROCE_CMD_TIMEOUT_MSECS);
	78	}
	79
6fd610c5 XW	80	static int alloc_srqc(struct hns_roce_dev hr_dev, struct hns_roce_srq srq,
6fd610c5 XW	81	u32 pdn, u32 cqn, u16 xrcd, u64 db_rec_addr)
c7bcb134 LO	82	{
c7bcb134 LO	83	struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
6fd610c5	84	struct ib_device *ibdev = &hr_dev->ib_dev;
c7bcb134	85	struct hns_roce_cmd_mailbox *mailbox;
6fd610c5 XW	86	u64 mtts_wqe[MTT_MIN_COUNT] = { 0 };
	87	u64 mtts_idx[MTT_MIN_COUNT] = { 0 };
	88	dma_addr_t dma_handle_wqe = 0;
	89	dma_addr_t dma_handle_idx = 0;
c7bcb134 LO	90	int ret;
	91
	92	/* Get the physical address of srq buf */
6fd610c5 XW	93	ret = hns_roce_mtr_find(hr_dev, &srq->buf_mtr, 0, mtts_wqe,
	94	ARRAY_SIZE(mtts_wqe), &dma_handle_wqe);
	95	if (ret < 1) {
	96	ibdev_err(ibdev, "Failed to find mtr for SRQ WQE\n");
	97	return -ENOBUFS;
c7bcb134 LO	98	}
	99
	100	/* Get physical address of idx que buf */
6fd610c5 XW	101	ret = hns_roce_mtr_find(hr_dev, &srq->idx_que.mtr, 0, mtts_idx,
	102	ARRAY_SIZE(mtts_idx), &dma_handle_idx);
	103	if (ret < 1) {
	104	ibdev_err(ibdev, "Failed to find mtr for SRQ idx\n");
	105	return -ENOBUFS;
c7bcb134 LO	106	}
	107
	108	ret = hns_roce_bitmap_alloc(&srq_table->bitmap, &srq->srqn);
1ceb0b11	109	if (ret) {
6fd610c5	110	ibdev_err(ibdev, "Failed to alloc SRQ number, err %d\n", ret);
c7bcb134 LO	111	return -ENOMEM;
	112	}
	113
	114	ret = hns_roce_table_get(hr_dev, &srq_table->table, srq->srqn);
6fd610c5 XW	115	if (ret) {
6fd610c5 XW	116	ibdev_err(ibdev, "Failed to get SRQC table, err %d\n", ret);
c7bcb134	117	goto err_out;
6fd610c5	118	}
c7bcb134 LO	119
c7bcb134 LO	120	ret = xa_err(xa_store(&srq_table->xa, srq->srqn, srq, GFP_KERNEL));
6fd610c5 XW	121	if (ret) {
6fd610c5 XW	122	ibdev_err(ibdev, "Failed to store SRQC, err %d\n", ret);
c7bcb134	123	goto err_put;
6fd610c5	124	}
c7bcb134 LO	125
c7bcb134 LO	126	mailbox = hns_roce_alloc_cmd_mailbox(hr_dev);
6fd610c5 XW	127	if (IS_ERR_OR_NULL(mailbox)) {
	128	ret = -ENOMEM;
	129	ibdev_err(ibdev, "Failed to alloc mailbox for SRQC\n");
c7bcb134 LO	130	goto err_xa;
	131	}
	132
	133	hr_dev->hw->write_srqc(hr_dev, srq, pdn, xrcd, cqn, mailbox->buf,
	134	mtts_wqe, mtts_idx, dma_handle_wqe,
	135	dma_handle_idx);
	136
6eef5242	137	ret = hns_roce_hw_create_srq(hr_dev, mailbox, srq->srqn);
c7bcb134	138	hns_roce_free_cmd_mailbox(hr_dev, mailbox);
6fd610c5 XW	139	if (ret) {
6fd610c5 XW	140	ibdev_err(ibdev, "Failed to config SRQC, err %d\n", ret);
c7bcb134	141	goto err_xa;
6fd610c5	142	}
c7bcb134 LO	143
	144	atomic_set(&srq->refcount, 1);
	145	init_completion(&srq->free);
	146	return ret;
	147
	148	err_xa:
	149	xa_erase(&srq_table->xa, srq->srqn);
	150
	151	err_put:
	152	hns_roce_table_put(hr_dev, &srq_table->table, srq->srqn);
	153
	154	err_out:
	155	hns_roce_bitmap_free(&srq_table->bitmap, srq->srqn, BITMAP_NO_RR);
	156	return ret;
	157	}
	158
6fd610c5	159	static void free_srqc(struct hns_roce_dev hr_dev, struct hns_roce_srq srq)
c7bcb134 LO	160	{
	161	struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
	162	int ret;
	163
6eef5242	164	ret = hns_roce_hw_destroy_srq(hr_dev, NULL, srq->srqn);
c7bcb134	165	if (ret)
6eef5242	166	dev_err(hr_dev->dev, "DESTROY_SRQ failed (%d) for SRQN %06lx\n",
c7bcb134 LO	167	ret, srq->srqn);
	168
	169	xa_erase(&srq_table->xa, srq->srqn);
	170
	171	if (atomic_dec_and_test(&srq->refcount))
	172	complete(&srq->free);
	173	wait_for_completion(&srq->free);
	174
	175	hns_roce_table_put(hr_dev, &srq_table->table, srq->srqn);
	176	hns_roce_bitmap_free(&srq_table->bitmap, srq->srqn, BITMAP_NO_RR);
	177	}
	178
6fd610c5 XW	179	static int alloc_srq_buf(struct hns_roce_dev hr_dev, struct hns_roce_srq srq,
6fd610c5 XW	180	struct ib_udata *udata, unsigned long addr)
2a2f1887	181	{
6fd610c5 XW	182	struct ib_device *ibdev = &hr_dev->ib_dev;
6fd610c5 XW	183	struct hns_roce_buf_attr buf_attr = {};
6fd610c5	184	int err;
2a2f1887	185
67954a6e XW	186	srq->wqe_shift = ilog2(roundup_pow_of_two(max(HNS_ROCE_SGE_SIZE,
	187	HNS_ROCE_SGE_SIZE *
	188	srq->max_gs)));
2a2f1887	189
9581a356	190	buf_attr.page_shift = hr_dev->caps.srqwqe_buf_pg_sz + HNS_HW_PAGE_SHIFT;
67954a6e XW	191	buf_attr.region[0].size = to_hr_hem_entries_size(srq->wqe_cnt,
67954a6e XW	192	srq->wqe_shift);
6fd610c5 XW	193	buf_attr.region[0].hopnum = hr_dev->caps.srqwqe_hop_num;
	194	buf_attr.region_count = 1;
	195	buf_attr.fixed_page = true;
2a2f1887	196
6fd610c5 XW	197	err = hns_roce_mtr_create(hr_dev, &srq->buf_mtr, &buf_attr,
6fd610c5 XW	198	hr_dev->caps.srqwqe_ba_pg_sz +
9581a356	199	HNS_HW_PAGE_SHIFT, udata, addr);
6fd610c5 XW	200	if (err)
6fd610c5 XW	201	ibdev_err(ibdev, "Failed to alloc SRQ buf mtr, err %d\n", err);
2a2f1887	202
6fd610c5 XW	203	return err;
6fd610c5 XW	204	}
2a2f1887	205
6fd610c5 XW	206	static void free_srq_buf(struct hns_roce_dev hr_dev, struct hns_roce_srq srq)
	207	{
	208	hns_roce_mtr_destroy(hr_dev, &srq->buf_mtr);
2a2f1887 LO	209	}
2a2f1887 LO	210
6fd610c5 XW	211	static int alloc_srq_idx(struct hns_roce_dev hr_dev, struct hns_roce_srq srq,
6fd610c5 XW	212	struct ib_udata *udata, unsigned long addr)
c7bcb134	213	{
c7bcb134	214	struct hns_roce_idx_que *idx_que = &srq->idx_que;
6fd610c5 XW	215	struct ib_device *ibdev = &hr_dev->ib_dev;
	216	struct hns_roce_buf_attr buf_attr = {};
	217	int err;
c7bcb134	218
67954a6e	219	srq->idx_que.entry_shift = ilog2(HNS_ROCE_IDX_QUE_ENTRY_SZ);
6fd610c5	220
9581a356	221	buf_attr.page_shift = hr_dev->caps.idx_buf_pg_sz + HNS_HW_PAGE_SHIFT;
67954a6e XW	222	buf_attr.region[0].size = to_hr_hem_entries_size(srq->wqe_cnt,
67954a6e XW	223	srq->idx_que.entry_shift);
6fd610c5 XW	224	buf_attr.region[0].hopnum = hr_dev->caps.idx_hop_num;
	225	buf_attr.region_count = 1;
	226	buf_attr.fixed_page = true;
	227
	228	err = hns_roce_mtr_create(hr_dev, &idx_que->mtr, &buf_attr,
9581a356	229	hr_dev->caps.idx_ba_pg_sz + HNS_HW_PAGE_SHIFT,
6fd610c5 XW	230	udata, addr);
	231	if (err) {
	232	ibdev_err(ibdev, "Failed to alloc SRQ idx mtr, err %d\n", err);
	233	return err;
	234	}
c7bcb134	235
6fd610c5 XW	236	if (!udata) {
	237	idx_que->bitmap = bitmap_zalloc(srq->wqe_cnt, GFP_KERNEL);
	238	if (!idx_que->bitmap) {
	239	ibdev_err(ibdev, "Failed to alloc SRQ idx bitmap\n");
	240	err = -ENOMEM;
	241	goto err_idx_mtr;
	242	}
c7bcb134	243
c7bcb134 LO	244	}
c7bcb134 LO	245
c7bcb134	246	return 0;
6fd610c5 XW	247	err_idx_mtr:
	248	hns_roce_mtr_destroy(hr_dev, &idx_que->mtr);
	249
	250	return err;
c7bcb134 LO	251	}
c7bcb134 LO	252
6fd610c5	253	static void free_srq_idx(struct hns_roce_dev hr_dev, struct hns_roce_srq srq)
2a2f1887	254	{
6fd610c5	255	struct hns_roce_idx_que *idx_que = &srq->idx_que;
2a2f1887	256
6fd610c5 XW	257	bitmap_free(idx_que->bitmap);
	258	idx_que->bitmap = NULL;
	259	hns_roce_mtr_destroy(hr_dev, &idx_que->mtr);
	260	}
2a2f1887	261
6fd610c5 XW	262	static int alloc_srq_wrid(struct hns_roce_dev hr_dev, struct hns_roce_srq srq)
6fd610c5 XW	263	{
2a2f1887	264	srq->head = 0;
d938d785	265	srq->tail = srq->wqe_cnt - 1;
d938d785	266	srq->wrid = kvmalloc_array(srq->wqe_cnt, sizeof(u64), GFP_KERNEL);
6fd610c5 XW	267	if (!srq->wrid)
6fd610c5 XW	268	return -ENOMEM;
2a2f1887 LO	269
2a2f1887 LO	270	return 0;
2a2f1887 LO	271	}
2a2f1887 LO	272
f226f676	273	static void free_srq_wrid(struct hns_roce_srq *srq)
2a2f1887	274	{
6fd610c5 XW	275	kfree(srq->wrid);
6fd610c5 XW	276	srq->wrid = NULL;
2a2f1887 LO	277	}
2a2f1887 LO	278
68e326de	279	int hns_roce_create_srq(struct ib_srq *ib_srq,
d938d785	280	struct ib_srq_init_attr *init_attr,
68e326de	281	struct ib_udata *udata)
c7bcb134	282	{
68e326de	283	struct hns_roce_dev *hr_dev = to_hr_dev(ib_srq->device);
9d9d4ff7	284	struct hns_roce_ib_create_srq_resp resp = {};
68e326de	285	struct hns_roce_srq *srq = to_hr_srq(ib_srq);
6fd610c5 XW	286	struct ib_device *ibdev = &hr_dev->ib_dev;
6fd610c5 XW	287	struct hns_roce_ib_create_srq ucmd = {};
c7bcb134	288	int ret = 0;
c7bcb134 LO	289	u32 cqn;
	290
	291	/* Check the actual SRQ wqe and SRQ sge num */
d938d785 YL	292	if (init_attr->attr.max_wr >= hr_dev->caps.max_srq_wrs \|\|
d938d785 YL	293	init_attr->attr.max_sge > hr_dev->caps.max_srq_sges)
68e326de	294	return -EINVAL;
c7bcb134 LO	295
	296	mutex_init(&srq->mutex);
	297	spin_lock_init(&srq->lock);
	298
d938d785	299	srq->wqe_cnt = roundup_pow_of_two(init_attr->attr.max_wr + 1);
711195e5	300	srq->max_gs = init_attr->attr.max_sge + HNS_ROCE_RESERVED_SGE;
c7bcb134	301
c7bcb134	302	if (udata) {
6fd610c5	303	ret = ib_copy_from_udata(&ucmd, udata, sizeof(ucmd));
c7bcb134	304	if (ret) {
6fd610c5 XW	305	ibdev_err(ibdev, "Failed to copy SRQ udata, err %d\n",
	306	ret);
	307	return ret;
c7bcb134	308	}
6fd610c5 XW	309	}
	310
	311	ret = alloc_srq_buf(hr_dev, srq, udata, ucmd.buf_addr);
	312	if (ret) {
	313	ibdev_err(ibdev, "Failed to alloc SRQ buffer, err %d\n", ret);
	314	return ret;
	315	}
	316
	317	ret = alloc_srq_idx(hr_dev, srq, udata, ucmd.que_addr);
	318	if (ret) {
	319	ibdev_err(ibdev, "Failed to alloc SRQ idx, err %d\n", ret);
	320	goto err_buf_alloc;
	321	}
	322
	323	if (!udata) {
	324	ret = alloc_srq_wrid(hr_dev, srq);
c7bcb134	325	if (ret) {
6fd610c5 XW	326	ibdev_err(ibdev, "Failed to alloc SRQ wrid, err %d\n",
	327	ret);
	328	goto err_idx_alloc;
c7bcb134 LO	329	}
	330	}
	331
d938d785 YL	332	cqn = ib_srq_has_cq(init_attr->srq_type) ?
d938d785 YL	333	to_hr_cq(init_attr->ext.cq)->cqn : 0;
c7bcb134 LO	334	srq->db_reg_l = hr_dev->reg_base + SRQ_DB_REG;
c7bcb134 LO	335
6fd610c5 XW	336	ret = alloc_srqc(hr_dev, srq, to_hr_pd(ib_srq->pd)->pdn, cqn, 0, 0);
	337	if (ret) {
	338	ibdev_err(ibdev, "Failed to alloc SRQ context, err %d\n", ret);
	339	goto err_wrid_alloc;
	340	}
c7bcb134 LO	341
c7bcb134 LO	342	srq->event = hns_roce_ib_srq_event;
9d9d4ff7	343	resp.srqn = srq->srqn;
c7bcb134	344
e00b64f7	345	if (udata) {
9d9d4ff7 LO	346	if (ib_copy_to_udata(udata, &resp,
9d9d4ff7 LO	347	min(udata->outlen, sizeof(resp)))) {
c7bcb134	348	ret = -EFAULT;
9d9d4ff7	349	goto err_srqc_alloc;
c7bcb134 LO	350	}
	351	}
	352
68e326de	353	return 0;
c7bcb134	354
9d9d4ff7	355	err_srqc_alloc:
6fd610c5 XW	356	free_srqc(hr_dev, srq);
6fd610c5 XW	357	err_wrid_alloc:
f226f676	358	free_srq_wrid(srq);
6fd610c5 XW	359	err_idx_alloc:
	360	free_srq_idx(hr_dev, srq);
	361	err_buf_alloc:
	362	free_srq_buf(hr_dev, srq);
68e326de	363	return ret;
c7bcb134 LO	364	}
c7bcb134 LO	365
68e326de	366	void hns_roce_destroy_srq(struct ib_srq ibsrq, struct ib_udata udata)
c7bcb134 LO	367	{
	368	struct hns_roce_dev *hr_dev = to_hr_dev(ibsrq->device);
	369	struct hns_roce_srq *srq = to_hr_srq(ibsrq);
	370
6fd610c5 XW	371	free_srqc(hr_dev, srq);
6fd610c5 XW	372	free_srq_idx(hr_dev, srq);
f226f676	373	free_srq_wrid(srq);
6fd610c5	374	free_srq_buf(hr_dev, srq);
c7bcb134 LO	375	}
c7bcb134 LO	376
5c1f167a LO	377	int hns_roce_init_srq_table(struct hns_roce_dev *hr_dev)
	378	{
	379	struct hns_roce_srq_table *srq_table = &hr_dev->srq_table;
	380
	381	xa_init(&srq_table->xa);
	382
	383	return hns_roce_bitmap_init(&srq_table->bitmap, hr_dev->caps.num_srqs,
	384	hr_dev->caps.num_srqs - 1,
	385	hr_dev->caps.reserved_srqs, 0);
	386	}
	387
	388	void hns_roce_cleanup_srq_table(struct hns_roce_dev *hr_dev)
	389	{
	390	hns_roce_bitmap_cleanup(&hr_dev->srq_table.bitmap);
	391	}