/*
 * Copyright (c) 2017, Mellanox Technologies, Ltd.  All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License as published by
 * the Free Software Foundation; either version 2.1 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public License
 * along with this program; if not, see <http://www.gnu.org/licenses/>.
 */

#include "rdma_offload.h"
#if defined(CONFIG_PPC) && defined(HAVE_PNV_PCI_SET_P2P)
#include <asm/pnv-pci.h>
#endif
#include <linux/sizes.h>

static unsigned int
__nvmet_rdma_peer_to_peer_sqe_inline_size(struct ib_nvmf_caps *nvmf_caps,
					  struct nvmet_port *nport);
static int nvmet_rdma_attach_xrq(struct nvmet_rdma_xrq *xrq,
				 struct nvmet_ctrl *ctrl);

static int nvmet_rdma_fill_srq_nvmf_attrs(struct ib_srq_init_attr *srq_attr,
					  struct nvmet_rdma_xrq *xrq)
{
	struct ib_nvmf_caps *nvmf_caps = &xrq->ndev->device->attrs.nvmf_caps;
	unsigned int sqe_inline_size = __nvmet_rdma_peer_to_peer_sqe_inline_size(nvmf_caps, xrq->port);

	srq_attr->ext.nvmf.type = IB_NVMF_READ_WRITE_FLUSH_OFFLOAD;
	if (xrq->port->offload_passthrough_sqe_rw)
		srq_attr->ext.nvmf.passthrough_sqe_rw_service_en = 1;
	srq_attr->ext.nvmf.log_max_namespace = ilog2(nvmf_caps->max_namespace);
	srq_attr->ext.nvmf.cmd_size = (sizeof(struct nvme_command) + sqe_inline_size) / 16;
	srq_attr->ext.nvmf.data_offset = 0;
	srq_attr->ext.nvmf.log_max_io_size = ilog2(nvmf_caps->max_io_sz);
	srq_attr->ext.nvmf.nvme_memory_log_page_size = 0;
	srq_attr->ext.nvmf.nvme_queue_size = clamp_t(u32,
						     xrq->port->offload_queue_size,
						     nvmf_caps->min_queue_sz,
						     nvmf_caps->max_queue_sz);
	srq_attr->ext.nvmf.staging_buffer_number_of_pages = xrq->st->num_pages;
	srq_attr->ext.nvmf.staging_buffer_log_page_size = ilog2(xrq->st->page_size >> 12); //4k granularity in PRM
	srq_attr->ext.nvmf.staging_buffer_pas = kzalloc(sizeof(dma_addr_t) * xrq->st->num_pages, GFP_KERNEL);
	if (!srq_attr->ext.nvmf.staging_buffer_pas)
		return -ENOMEM;

	return 0;
}

static void nvmet_rdma_free_st_buff(struct nvmet_rdma_staging_buf *st)
{
	if (st->dynamic)
		kfree(st->staging_pages);
	kfree(st->staging_dma_addrs);
	kfree(st);
}

/**
 * Called with nvmet_rdma_xrq_mutex held
 **/
static void nvmet_rdma_release_st_buff(struct nvmet_rdma_staging_buf *st)
{
	if (st->dynamic)
		nvmet_rdma_free_st_buff(st);
	else
		list_add_tail(&st->entry, &nvmet_rdma_st_pool.list);
}

static struct nvmet_rdma_staging_buf *nvmet_rdma_alloc_st_buff(u16 num_pages,
		unsigned int page_size_mb, bool dynamic)
{
	struct nvmet_rdma_staging_buf *st;

	st = kzalloc(sizeof(struct nvmet_rdma_staging_buf), GFP_KERNEL);
	if (!st)
		return NULL;

	st->staging_dma_addrs = kzalloc(sizeof(dma_addr_t) * num_pages, GFP_KERNEL);
	if (!st->staging_dma_addrs)
		goto free_st;

	if (dynamic) {
		/* only in dynamic allocation we use virtual addresses too */
		st->staging_pages = kzalloc(sizeof(void*) * num_pages, GFP_KERNEL);
		if (!st->staging_pages)
			goto free_st_dma_addrs;
	}

	st->num_pages = num_pages;
	st->page_size = page_size_mb * SZ_1M;
	st->dynamic = dynamic;

	return st;

free_st_dma_addrs:
	kfree(st->staging_dma_addrs);
free_st:
	kfree(st);

	return NULL;
}

static void nvmet_rdma_destroy_xrq(struct kref *ref)
{
	struct nvmet_rdma_xrq *xrq =
		container_of(ref, struct nvmet_rdma_xrq, ref);
	struct nvmet_rdma_device *ndev = xrq->ndev;
	struct nvmet_rdma_staging_buf *st = xrq->st;
	int i;

	pr_info("destroying XRQ %p port %p\n", xrq, xrq->port);

	mutex_lock(&nvmet_rdma_xrq_mutex);
	if (!list_empty(&xrq->entry))
		list_del_init(&xrq->entry);
	mutex_unlock(&nvmet_rdma_xrq_mutex);

	/* TODO: check if need to reduce refcound on pdev */
	nvmet_rdma_free_cmds(ndev, xrq->ofl_srq->cmds, xrq->ofl_srq_size, false);
	ib_destroy_srq(xrq->ofl_srq->srq);
	if (st->dynamic) {
		for (i = 0 ; i < st->num_pages ; i++)
			dma_free_coherent(ndev->device->dma_device,
					  st->page_size, st->staging_pages[i],
					  st->staging_dma_addrs[i]);
	}

	ib_free_cq(xrq->cq);
	nvmet_rdma_release_st_buff(st);
	kfree(xrq->ofl_srq);
	kfree(xrq);
	kref_put(&ndev->ref, nvmet_rdma_free_dev);
}

static int nvmet_rdma_init_xrq(struct nvmet_rdma_queue *queue,
			       struct nvmet_subsys *subsys)
{
	struct ib_srq_init_attr srq_attr = { NULL, };
	struct ib_srq *srq;
	int ret, i, j;
	struct nvmet_rdma_xrq *xrq;
	struct nvmet_rdma_staging_buf *st;
	struct nvmet_port *port = queue->port;
	size_t srq_size = port->offload_srq_size;
	struct nvmet_rdma_device *ndev = queue->dev;

	xrq = kzalloc(sizeof(*xrq), GFP_KERNEL);
	if (!xrq)
		return -ENOMEM;

	xrq->ofl_srq = kzalloc(sizeof(*xrq->ofl_srq), GFP_KERNEL);
	if (!xrq->ofl_srq) {
		ret = -ENOMEM;
		goto free_xrq;
	}

	kref_init(&xrq->ref);
	mutex_init(&xrq->offload_ctrl_mutex);
	INIT_LIST_HEAD(&xrq->be_ctrls_list);
	mutex_init(&xrq->be_mutex);
	xrq->ndev = ndev;
	xrq->port = port;
	xrq->subsys = subsys;

	if (!list_empty(&nvmet_rdma_st_pool.list)) {
		st = list_first_entry(&nvmet_rdma_st_pool.list,
				      struct nvmet_rdma_staging_buf, entry);
		list_del(&st->entry);
	} else {
		u16 num_pages = nvmet_rdma_offload_buffer_size_mb /
				NVMET_DYNAMIC_STAGING_BUFFER_PAGE_SIZE_MB;
		st = nvmet_rdma_alloc_st_buff(num_pages,
				NVMET_DYNAMIC_STAGING_BUFFER_PAGE_SIZE_MB,
				true);
	}
	if (!st) {
		ret = -ENOMEM;
		goto free_ofl_srq;
	}
	xrq->st = st;

	pr_info("using %s staging buffer %p\n",
		st->dynamic ? "dynamic" : "static", st);

	/* This CQ is not associated to a specific queue */
	xrq->cq = ib_alloc_cq(ndev->device, NULL, 4096, 0, IB_POLL_WORKQUEUE);
	if (IS_ERR(xrq->cq)) {
		ret = PTR_ERR(xrq->cq);
		pr_err("failed to create CQ for xrq cqe= %d ret= %d\n",
		       4096, ret);
		goto free_xrq_st;
	}

	srq_attr.attr.max_wr = srq_size;
	srq_attr.attr.max_sge = 1 + ndev->inline_page_count;
	srq_attr.srq_type = IB_EXP_SRQT_NVMF;
	if (nvmet_rdma_fill_srq_nvmf_attrs(&srq_attr, xrq)) {
		ret = -ENOMEM;
		goto free_xrq_cq;
	}

	for (i = 0 ; i < st->num_pages ; i++) {
		if (st->dynamic) {
			st->staging_pages[i] =
				dma_alloc_coherent(ndev->device->dma_device,
						   st->page_size,
						   &st->staging_dma_addrs[i],
						   GFP_KERNEL);
			if (!st->staging_pages[i]) {
				ret = -ENOMEM;
				goto release_st_buf;
			}
		}
		memcpy(&srq_attr.ext.nvmf.staging_buffer_pas[i],
		       &st->staging_dma_addrs[i], sizeof(dma_addr_t));
	}

	srq_attr.ext.cq = xrq->cq;
	srq = ib_create_srq(ndev->pd, &srq_attr);
	if (IS_ERR(srq)) {
		pr_err("failed to create xrq SRQ");
		ret = PTR_ERR(srq);
		goto release_st_buf;
	}

	xrq->ofl_srq->cmds = nvmet_rdma_alloc_cmds(ndev, srq_size, false);
	if (IS_ERR(xrq->ofl_srq->cmds)) {
		ret = PTR_ERR(xrq->ofl_srq->cmds);
		goto out_destroy_srq;
	}

	if (!kref_get_unless_zero(&ndev->ref)) {
		ret = -EINVAL;
		goto out_free_cmds;
	}

	xrq->ofl_srq->srq = srq;
	xrq->ofl_srq->ndev = ndev;
	xrq->ofl_srq_size = srq_size;
	st->xrq = xrq;
	xrq->nvme_queue_depth = srq_attr.ext.nvmf.nvme_queue_size;
	queue->xrq = xrq;

	for (i = 0; i < srq_size; i++) {
		xrq->ofl_srq->cmds[i].queue = queue;
		xrq->ofl_srq->cmds[i].nsrq = xrq->ofl_srq;
		ret = nvmet_rdma_post_recv(ndev, &xrq->ofl_srq->cmds[i]);
		if (ret) {
			pr_err("initial post_recv failed on XRQ 0x%p\n", srq);
			goto out_kref_put;
		}
	}

	kfree(srq_attr.ext.nvmf.staging_buffer_pas);

	return 0;

out_kref_put:
	kref_put(&ndev->ref, nvmet_rdma_free_dev);
out_free_cmds:
	nvmet_rdma_free_cmds(ndev, xrq->ofl_srq->cmds, srq_size, false);
out_destroy_srq:
	ib_destroy_srq(srq);
release_st_buf:
	if (st->dynamic) {
		for (j = 0 ; j < i ; j++)
			dma_free_coherent(ndev->device->dma_device,
					  st->page_size, st->staging_pages[j],
					  st->staging_dma_addrs[j]);
	}
	kfree(srq_attr.ext.nvmf.staging_buffer_pas);
free_xrq_cq:
	ib_free_cq(xrq->cq);
free_xrq_st:
	nvmet_rdma_release_st_buff(st);
free_ofl_srq:
	kfree(xrq->ofl_srq);
free_xrq:
	kfree(xrq);

	return ret;
}

static int nvmet_rdma_find_get_xrq(struct nvmet_rdma_queue *queue,
				   struct nvmet_ctrl *ctrl)
{
	struct nvmet_rdma_xrq *xrq;
	struct nvmet_subsys *subsys = ctrl ? ctrl->subsys : NULL;
	int active_xrq = 0;
	uint min = UINT_MAX;
	int ret = 0;

	mutex_lock(&nvmet_rdma_xrq_mutex);
	list_for_each_entry(xrq, &nvmet_rdma_xrq_list, entry) {
		if (xrq->port == queue->port &&
		    (!subsys || xrq->subsys == subsys)) {
			active_xrq++;
			if (kref_read(&xrq->ref) && kref_read(&xrq->ref) < min)
				min = kref_read(&xrq->ref);
		}
	}

	list_for_each_entry(xrq, &nvmet_rdma_xrq_list, entry) {
		if (xrq->port == queue->port &&
		    (!subsys || xrq->subsys == subsys) &&
		    active_xrq == queue->port->offload_queues &&
		    kref_read(&xrq->ref) == min &&
		    kref_get_unless_zero(&xrq->ref)) {
			queue->xrq = xrq;
			goto out_unlock;
		}
	}

	ret = nvmet_rdma_init_xrq(queue, subsys);
	if (ret)
		goto out_unlock;

	kref_get(&queue->xrq->ref);
	list_add_tail(&queue->xrq->entry, &nvmet_rdma_xrq_list);
	if (ctrl)
		ret = nvmet_rdma_attach_xrq(queue->xrq, ctrl);

out_unlock:
	mutex_unlock(&nvmet_rdma_xrq_mutex);
	return ret;
}

static u16 nvmet_rdma_install_offload_queue(struct nvmet_sq *sq)
{
	struct nvmet_rdma_queue *queue =
		container_of(sq, struct nvmet_rdma_queue, nvme_sq);
	int qp_attr_mask = IB_QP_STATE | IB_QP_OFFLOAD_TYPE;
	struct ib_qp_attr attr;
	int ret;

	if (!queue->offload)
		return 0;

	memset(&attr, 0, sizeof(attr));
	attr.qp_state = IB_QPS_RTS;
	attr.offload_type = IB_QP_OFFLOAD_NVMF;

	if (!queue->xrq) {
		WARN_ON_ONCE(!queue->dev->rts2rts_qp_rmp);
		ret = nvmet_rdma_find_get_xrq(queue, sq->ctrl);
		if (ret) {
			pr_err("failed to get XRQ for queue (%d)\n",
			       queue->host_qid);
			return NVME_SC_INTERNAL | NVME_SC_DNR;
		}
		qp_attr_mask |= IB_QP_RMPN_XRQN;
		attr.rmpn_xrqn = queue->xrq->ofl_srq->srq->ext.xrc.srq_num;
	}

	ret = ib_modify_qp(queue->cm_id->qp, &attr, qp_attr_mask);
	if (ret)
		return NVME_SC_INTERNAL | NVME_SC_DNR;
	return 0;
}

static void nvmet_rdma_free_be_ctrl(struct nvmet_rdma_backend_ctrl *be_ctrl)
{
	int ret;

#if defined(CONFIG_PPC) && defined(HAVE_PNV_PCI_SET_P2P)
	pnv_pci_set_p2p(container_of(be_ctrl->xrq->ndev->device->dev.parent,
				     struct pci_dev, dev),
			be_ctrl->pdev, OPAL_PCI_P2P_STORE);
#endif
	lockdep_assert_held(&be_ctrl->xrq->be_mutex);
	list_del_init(&be_ctrl->entry);
	be_ctrl->xrq->nr_be_ctrls--;
	ida_simple_remove(&nvmet_rdma_bectrl_ida, be_ctrl->offload_ctx.id);
	nvmet_offload_ctx_configfs_del(&be_ctrl->offload_ctx);

	if (be_ctrl->ibns) {
		ret = ib_detach_nvmf_ns(be_ctrl->ibns);
		if (ret) {
			/* Don't initialize a queue that the HW is using */
			be_ctrl->restart = false;
			pr_err("Failed to detach nvmf ns be_ctrl=%p ret = %d\n",
			       be_ctrl, ret);
		}
	}
	if (be_ctrl->ofl) {
		ret = nvme_peer_flush_resource(be_ctrl->ofl, be_ctrl->restart);
		if (ret) {
			/* Don't initialize a queue that we failed to destroy */
			be_ctrl->restart = false;
			pr_err("Failed to flush peer resource be_ctrl=%p ret = %d\n",
			       be_ctrl, ret);
		}
	}
	if (be_ctrl->ibctrl) {
		ret = ib_destroy_nvmf_backend_ctrl(be_ctrl->ibctrl);
		if (ret) {
			/* Don't initialize a queue that the HW is using */
			be_ctrl->restart = false;
			pr_err("Failed to destroy backend ctrl %p ret = %d\n",
			       be_ctrl, ret);
		}
	}
	if (be_ctrl->ofl)
		nvme_peer_put_resource(be_ctrl->ofl);
	kref_put(&be_ctrl->xrq->ref, nvmet_rdma_destroy_xrq);
	kfree(be_ctrl);
}

static void nvmet_rdma_release_be_ctrl(struct nvmet_rdma_backend_ctrl *be_ctrl)
{
	struct nvmet_rdma_xrq *xrq = be_ctrl->xrq;

	mutex_lock(&xrq->be_mutex);
	if (!list_empty(&be_ctrl->entry))
		nvmet_rdma_free_be_ctrl(be_ctrl);
	mutex_unlock(&xrq->be_mutex);
}

static void nvmet_rdma_stop_master_peer(void *priv)
{
	struct nvmet_rdma_backend_ctrl *be_ctrl = priv;

	dev_info(&be_ctrl->pdev->dev,
		 "Stopping master peer (be_ctrl %p)\n", be_ctrl);

	be_ctrl->restart = false;
	nvmet_rdma_release_be_ctrl(be_ctrl);
}

static void nvmet_rdma_backend_ctrl_event(struct ib_event *event, void *priv)
{
	struct nvmet_rdma_backend_ctrl *be_ctrl = priv;

	switch (event->event) {
	case IB_EVENT_XRQ_NVMF_BACKEND_CTRL_PCI_ERR:
		be_ctrl->restart = false;
		queue_work(nvmet_wq, &be_ctrl->release_work);
		break;
	case IB_EVENT_XRQ_NVMF_BACKEND_CTRL_TO_ERR:
		be_ctrl->restart = true;
		queue_work(nvmet_wq, &be_ctrl->release_work);
		break;
	default:
		break;
	}

	dev_err(&be_ctrl->pdev->dev,
		"received IB Backend ctrl event: %s (%d) be_ctrl %p id %d\n",
		ib_event_msg(event->event), event->event, be_ctrl,
		be_ctrl->offload_ctx.id);
}

static int nvmet_rdma_init_be_ctrl_attr(struct ib_nvmf_backend_ctrl_init_attr *attr,
					struct nvmet_rdma_backend_ctrl *be_ctrl,
					struct ib_nvmf_caps *nvmf_caps)
{
	struct nvme_peer_resource *ofl = be_ctrl->ofl;
	unsigned int nvme_cq_depth, nvme_sq_depth;

	nvme_sq_depth = ofl->nvme_sq_size / sizeof(struct nvme_command);
	nvme_cq_depth = ofl->nvme_cq_size / sizeof(struct nvme_completion);

	if (nvme_sq_depth != be_ctrl->xrq->nvme_queue_depth) {
		pr_err("nvme SQ depth for offload is %u, actual is %u\n",
		       be_ctrl->xrq->nvme_queue_depth, nvme_sq_depth);
		return -EINVAL;
	}

	if (nvme_cq_depth != be_ctrl->xrq->nvme_queue_depth) {
		pr_err("nvme CQ depth for offload is %u, actual is %u\n",
		       be_ctrl->xrq->nvme_queue_depth, nvme_cq_depth);
		return -EINVAL;
	}

	memset(attr, 0, sizeof(*attr));

	attr->be_context = be_ctrl;
	attr->event_handler = nvmet_rdma_backend_ctrl_event;
	attr->cq_page_offset = 0;
	attr->sq_page_offset = 0;
	attr->cq_log_page_size = ilog2(max_t(u32, ofl->nvme_cq_size >> 12, 1));
	attr->sq_log_page_size = ilog2(max_t(u32, ofl->nvme_sq_size >> 12, 1));
	attr->initial_cqh_db_value = 0;
	attr->initial_sqt_db_value = 0;
	if (nvmf_caps->min_cmd_timeout_us && nvmf_caps->max_cmd_timeout_us)
		attr->cmd_timeout_us = clamp_t(u32,
					       be_ctrl->ns->offload_cmd_tmo_us,
					       nvmf_caps->min_cmd_timeout_us,
					       nvmf_caps->max_cmd_timeout_us);
	else
		attr->cmd_timeout_us = 0;
	if (be_ctrl->ns->offload_cmd_tmo_us != attr->cmd_timeout_us) {
		pr_warn("Clamping offload_cmd_tmo_us to %u\n",
			attr->cmd_timeout_us);
		be_ctrl->ns->offload_cmd_tmo_us = attr->cmd_timeout_us;
	}
	attr->cqh_dbr_addr = ofl->cqh_dbr_addr;
	attr->sqt_dbr_addr = ofl->sqt_dbr_addr;
	attr->cq_pas = ofl->cq_dma_addr;
	attr->sq_pas = ofl->sq_dma_addr;

	return 0;
}

static void nvmet_rdma_init_ns_attr(struct ib_nvmf_ns_init_attr *attr,
				    u32 frontend_namespace,
				    u32 backend_namespace,
				    u16 lba_data_size,
				    u16 backend_ctrl_id)
{
	memset(attr, 0, sizeof(*attr));

	attr->frontend_namespace = frontend_namespace;
	attr->backend_namespace = backend_namespace;
	attr->lba_data_size = lba_data_size;
	attr->backend_ctrl_id = backend_ctrl_id;
}

static void nvmet_release_backend_ctrl_work(struct work_struct *w)
{
	struct nvmet_rdma_backend_ctrl *be_ctrl =
		container_of(w, struct nvmet_rdma_backend_ctrl, release_work);

	nvmet_rdma_release_be_ctrl(be_ctrl);
}

static u8 nvmet_rdma_peer_to_peer_mdts(struct nvmet_port *nport)
{
	struct nvmet_rdma_port *port = nport->priv;
	struct rdma_cm_id *cm_id = port->cm_id;

	/* we assume ctrl page_size is 4K */
	return ilog2(cm_id->device->attrs.nvmf_caps.max_io_sz / SZ_4K);
}

static struct nvmet_rdma_backend_ctrl *
nvmet_rdma_create_be_ctrl(struct nvmet_rdma_xrq *xrq,
			  struct nvmet_ns *ns)
{
	struct nvmet_rdma_backend_ctrl *be_ctrl;
	struct ib_nvmf_backend_ctrl_init_attr init_attr;
	struct ib_nvmf_ns_init_attr ns_init_attr;
	struct ib_nvmf_caps *nvmf_caps = &xrq->ndev->device->attrs.nvmf_caps;
	int p2p_mdts = nvmet_rdma_peer_to_peer_mdts(xrq->port);
	int mdts = ilog2(queue_max_hw_sectors(ns->bdev->bd_disk->queue) >> 3);
	int err;
	unsigned be_nsid;

	if (p2p_mdts > mdts) {
		pr_err("Device %s MDTS %d is smaller than P2P MDTS %d\n",
		       ns->device_path, mdts, p2p_mdts);
		return ERR_PTR(-EINVAL);
	}

	mutex_lock(&xrq->be_mutex);
	if (xrq->nr_be_ctrls == nvmf_caps->max_be_ctrl) {
		pr_err("Reached max number of supported be ctrl per XRQ (%u)\n",
		       nvmf_caps->max_be_ctrl);
		mutex_unlock(&xrq->be_mutex);
		return ERR_PTR(-EINVAL);
	}
	mutex_unlock(&xrq->be_mutex);

#if defined(CONFIG_PPC) && defined(HAVE_PNV_PCI_SET_P2P)
	err = pnv_pci_set_p2p(container_of(xrq->ndev->device->dev.parent,
					   struct pci_dev, dev),
			      ns->pdev,
			      OPAL_PCI_P2P_STORE | OPAL_PCI_P2P_ENABLE);
	if (err)
		return ERR_PTR(err);
#endif

	be_ctrl = kzalloc(sizeof(*be_ctrl), GFP_KERNEL);
	if (!be_ctrl) {
		err = -ENOMEM;
		goto out_err;
	}

	INIT_WORK(&be_ctrl->release_work,
		  nvmet_release_backend_ctrl_work);

	kref_get(&xrq->ref);

	be_ctrl->ofl = nvme_peer_get_resource(ns->pdev,
			NVME_PEER_SQT_DBR      |
			NVME_PEER_CQH_DBR      |
			NVME_PEER_SQ_PAS       |
			NVME_PEER_CQ_PAS       |
			NVME_PEER_SQ_SZ        |
			NVME_PEER_CQ_SZ        |
			NVME_PEER_MEM_LOG_PG_SZ,
			nvmet_rdma_stop_master_peer, be_ctrl);
	if (!be_ctrl->ofl) {
		dev_err(&ns->pdev->dev,
			"Failed to get peer resource xrq=%p be_ctrl=%p\n",
			xrq, be_ctrl);
		err = -ENODEV;
		goto out_free_be_ctrl;
	}
	be_ctrl->restart = true;
	be_ctrl->pdev = ns->pdev;
	be_ctrl->ns = ns;
	be_ctrl->xrq = xrq;

	err = nvmet_rdma_init_be_ctrl_attr(&init_attr, be_ctrl, nvmf_caps);
	if (err)
		goto out_put_resource;

	be_ctrl->ibctrl = ib_create_nvmf_backend_ctrl(xrq->ofl_srq->srq, &init_attr);
	if (IS_ERR(be_ctrl->ibctrl)) {
		dev_err(&ns->pdev->dev,
			"Failed to create nvmf backend ctrl xrq=%p\n", xrq);
		err = PTR_ERR(be_ctrl->ibctrl);
		goto out_put_resource;
	}

	be_nsid = nvme_find_ns_id_from_bdev(ns->bdev);
	if (!be_nsid) {
		err = -ENODEV;
		goto out_destroy_be_ctrl;
	}

	nvmet_rdma_init_ns_attr(&ns_init_attr, ns->nsid, be_nsid,
				max_t(u16, 1 << ns->blksize_shift, 512),
				be_ctrl->ibctrl->id);
	be_ctrl->ibns = ib_attach_nvmf_ns(be_ctrl->ibctrl, &ns_init_attr);
	if (IS_ERR(be_ctrl->ibns)) {
		dev_err(&ns->pdev->dev,
			"Failed to attach nvmf ns xrq=%p be_ctrl=%p\n",
			xrq, be_ctrl);
		err = PTR_ERR(be_ctrl->ibns);
		goto out_destroy_be_ctrl;
	}

	be_ctrl->offload_ctx.ctx = be_ctrl;
	be_ctrl->offload_ctx.port = xrq->port;
	be_ctrl->offload_ctx.ns = ns;
	be_ctrl->offload_ctx.id = ida_simple_get(&nvmet_rdma_bectrl_ida, 0, 0,
						 GFP_KERNEL);
	if (be_ctrl->offload_ctx.id < 0) {
		err = -ENOMEM;
		goto out_detach_ns;
	}

	err = nvmet_offload_ctx_configfs_create(&be_ctrl->offload_ctx);
	if (err)
		goto out_ida_remove;

	mutex_lock(&xrq->be_mutex);
	list_add_tail(&be_ctrl->entry, &xrq->be_ctrls_list);
	xrq->nr_be_ctrls++;
	mutex_unlock(&xrq->be_mutex);

	return be_ctrl;

out_ida_remove:
	ida_simple_remove(&nvmet_rdma_bectrl_ida, be_ctrl->offload_ctx.id);
out_detach_ns:
	ib_detach_nvmf_ns(be_ctrl->ibns);
out_destroy_be_ctrl:
	ib_destroy_nvmf_backend_ctrl(be_ctrl->ibctrl);
out_put_resource:
	/*
	 * Flush the resource after destoying the backend controller is safe
	 * here, since there is no traffic on it.
	 */
	nvme_peer_flush_resource(be_ctrl->ofl, true);
	nvme_peer_put_resource(be_ctrl->ofl);
out_free_be_ctrl:
	kref_put(&xrq->ref, nvmet_rdma_destroy_xrq);
	kfree(be_ctrl);
out_err:
#if defined(CONFIG_PPC) && defined(HAVE_PNV_PCI_SET_P2P)
	pnv_pci_set_p2p(container_of(xrq->ndev->device->dev.parent,
				     struct pci_dev, dev),
			ns->pdev, OPAL_PCI_P2P_STORE);
#endif
	return ERR_PTR(err);
}

/**
 * Passing ns == NULL will destroy all the be ctrs for the given XRQ
 **/
static void nvmet_rdma_free_be_ctrls(struct nvmet_rdma_xrq *xrq,
				     struct nvmet_ns *ns)
{
	struct nvmet_rdma_backend_ctrl *be_ctrl, *next;

	mutex_lock(&xrq->be_mutex);
	list_for_each_entry_safe(be_ctrl, next, &xrq->be_ctrls_list, entry)
		if (!ns || be_ctrl->ns == ns)
			nvmet_rdma_free_be_ctrl(be_ctrl);
	mutex_unlock(&xrq->be_mutex);
}

static bool nvmet_rdma_ns_attached_to_xrq(struct nvmet_rdma_xrq *xrq,
					  struct nvmet_ns *ns)
{
	struct nvmet_rdma_backend_ctrl *be_ctrl;
	bool found = false;

	mutex_lock(&xrq->be_mutex);
	list_for_each_entry(be_ctrl, &xrq->be_ctrls_list, entry) {
		if (be_ctrl->ns == ns) {
			found = true;
			break;
		}
	}
	mutex_unlock(&xrq->be_mutex);

	return found;
}

static int nvmet_rdma_enable_offload_ns(struct nvmet_ctrl *ctrl,
					struct nvmet_ns *ns)
{
	struct nvmet_rdma_xrq *xrq;
	struct nvmet_rdma_backend_ctrl *be_ctrl;
	struct nvmet_rdma_offload_ctrl *offload_ctrl = ctrl->offload_ctrl;
	struct nvmet_rdma_offload_ctx *offload_ctx;
	int err = 0;

	mutex_lock(&offload_ctrl->ctx_mutex);
	list_for_each_entry(offload_ctx, &offload_ctrl->ctx_list, entry) {
		xrq = offload_ctx->xrq;
		if (!nvmet_rdma_ns_attached_to_xrq(xrq, ns)) {
			be_ctrl = nvmet_rdma_create_be_ctrl(xrq, ns);
			if (IS_ERR(be_ctrl)) {
				err = PTR_ERR(be_ctrl);
				goto out_free;
			}
		}
	}
	mutex_unlock(&offload_ctrl->ctx_mutex);

	return 0;

out_free:
	list_for_each_entry(offload_ctx, &offload_ctrl->ctx_list, entry)
		nvmet_rdma_free_be_ctrls(offload_ctx->xrq, ns);
	mutex_unlock(&offload_ctrl->ctx_mutex);

	return err;
}

static void nvmet_rdma_disable_offload_ns(struct nvmet_ctrl *ctrl,
					  struct nvmet_ns *ns)
{
	struct nvmet_rdma_offload_ctrl *offload_ctrl = ctrl->offload_ctrl;
	struct nvmet_rdma_offload_ctx *offload_ctx;

	mutex_lock(&offload_ctrl->ctx_mutex);
	list_for_each_entry(offload_ctx, &offload_ctrl->ctx_list, entry)
		nvmet_rdma_free_be_ctrls(offload_ctx->xrq, ns);
	mutex_unlock(&offload_ctrl->ctx_mutex);
}

/**
 * Called with offload_ctrl ctx_mutex held
 **/
static void nvmet_rdma_free_offload_ctx(struct nvmet_rdma_offload_ctx *offload_ctx)
{
	struct nvmet_rdma_xrq *xrq = offload_ctx->xrq;

	mutex_lock(&xrq->offload_ctrl_mutex);
	xrq->offload_ctrls_cnt--;
	if (!xrq->offload_ctrls_cnt)
		nvmet_rdma_free_be_ctrls(xrq, NULL);
	list_del_init(&offload_ctx->entry);
	mutex_unlock(&xrq->offload_ctrl_mutex);
	kfree(offload_ctx);
}

static void nvmet_rdma_free_offload_ctxs(struct nvmet_rdma_offload_ctrl *offload_ctrl)
{
	struct nvmet_rdma_offload_ctx *offload_ctx, *next;

	mutex_lock(&offload_ctrl->ctx_mutex);
	list_for_each_entry_safe(offload_ctx, next, &offload_ctrl->ctx_list, entry)
		nvmet_rdma_free_offload_ctx(offload_ctx);
	mutex_unlock(&offload_ctrl->ctx_mutex);
}

static int nvmet_rdma_attach_xrq(struct nvmet_rdma_xrq *xrq,
				 struct nvmet_ctrl *ctrl)
{
	struct nvmet_ns *ns;
	struct nvmet_rdma_offload_ctx *offload_ctx;
	unsigned long idx;
	struct nvmet_rdma_backend_ctrl *be_ctrl;
	struct nvmet_rdma_offload_ctrl *offload_ctrl = ctrl->offload_ctrl;
	int err;

	offload_ctx = kzalloc(sizeof(*offload_ctx), GFP_KERNEL);
	if (!offload_ctx)
		return -ENOMEM;
	offload_ctx->xrq = xrq;
	if (!xrq->subsys)
		xrq->subsys = ctrl->subsys;

	xa_for_each(&ctrl->subsys->namespaces, idx, ns) {
		if (!nvmet_rdma_ns_attached_to_xrq(xrq, ns)) {
			be_ctrl = nvmet_rdma_create_be_ctrl(xrq, ns);
			if (IS_ERR(be_ctrl)) {
				err = PTR_ERR(be_ctrl);
				goto out_free_offload_ctx;
			}
		}
	}

	mutex_lock(&xrq->offload_ctrl_mutex);
	xrq->offload_ctrls_cnt++;
	mutex_unlock(&xrq->offload_ctrl_mutex);
	mutex_lock(&offload_ctrl->ctx_mutex);
	list_add_tail(&offload_ctx->entry, &offload_ctrl->ctx_list);
	mutex_unlock(&offload_ctrl->ctx_mutex);

	return 0;

out_free_offload_ctx:
	nvmet_rdma_free_be_ctrls(xrq, NULL);
	kfree(offload_ctx);

	return err;
}

static int nvmet_rdma_create_offload_ctrl(struct nvmet_ctrl *ctrl)
{
	struct nvmet_rdma_xrq *xrq;
	struct nvmet_rdma_offload_ctrl *offload_ctrl;
	int err;

	offload_ctrl = kzalloc(sizeof(*offload_ctrl), GFP_KERNEL);
	if (!offload_ctrl)
		return -ENOMEM;

	ctrl->offload_ctrl = offload_ctrl;
	INIT_LIST_HEAD(&offload_ctrl->ctx_list);
	mutex_init(&offload_ctrl->ctx_mutex);

	mutex_lock(&nvmet_rdma_xrq_mutex);
	list_for_each_entry(xrq, &nvmet_rdma_xrq_list, entry) {
		if (xrq->port == ctrl->port &&
		    (!xrq->subsys || xrq->subsys == ctrl->subsys)) {
			err = nvmet_rdma_attach_xrq(xrq, ctrl);
			if (err)
				goto out_free;
		}
	}
	mutex_unlock(&nvmet_rdma_xrq_mutex);

	return 0;

out_free:
	nvmet_rdma_free_offload_ctxs(offload_ctrl);
	kfree(offload_ctrl);
	mutex_unlock(&nvmet_rdma_xrq_mutex);
	ctrl->offload_ctrl = NULL;

	return err;
}

static void nvmet_rdma_destroy_offload_ctrl(struct nvmet_ctrl *ctrl)
{
	struct nvmet_rdma_offload_ctrl *offload_ctrl = ctrl->offload_ctrl;

	ctrl->offload_ctrl = NULL;
	nvmet_rdma_free_offload_ctxs(offload_ctrl);
	kfree(offload_ctrl);
}

static u64
nvmet_rdma_offload_subsys_unknown_ns_cmds(struct nvmet_subsys *subsys)
{
	struct nvmet_rdma_xrq *xrq;
	struct ib_srq_attr attr;
	u64 unknown_cmds = 0;
	int ret;

	mutex_lock(&nvmet_rdma_xrq_mutex);
	list_for_each_entry(xrq, &nvmet_rdma_xrq_list, entry) {
		if (xrq->subsys == subsys) {
			memset(&attr, 0, sizeof(attr));
			ret = ib_query_srq(xrq->ofl_srq->srq, &attr);
			if (!ret)
				unknown_cmds += attr.nvmf.cmd_unknown_namespace_cnt;
		}
	}
	mutex_unlock(&nvmet_rdma_xrq_mutex);

	return unknown_cmds;
}

static void
nvmet_rdma_update_counters(struct ib_nvmf_ns_attr *attr,
			   struct nvmet_ns_counters *counters)
{
	counters->num_read_cmd = attr->num_read_cmd;
	counters->num_read_blocks = attr->num_read_blocks;
	counters->num_write_cmd = attr->num_write_cmd;
	counters->num_write_blocks = attr->num_write_blocks;
	counters->num_write_inline_cmd = attr->num_write_inline_cmd;
	counters->num_flush_cmd = attr->num_flush_cmd;
	counters->num_error_cmd = attr->num_error_cmd;
	counters->num_backend_error_cmd = attr->num_backend_error_cmd;
	counters->last_read_latency = attr->last_read_latency;
	counters->last_write_latency = attr->last_write_latency;
	counters->queue_depth = attr->queue_depth;
}

static void
nvmet_rdma_offload_query_counters(void *ctx, struct nvmet_ns_counters *counters)
{
	struct nvmet_rdma_backend_ctrl *be_ctrl = ctx;
	struct ib_nvmf_ns_attr attr;
	int ret;

	memset(counters, 0, sizeof(*counters));
	memset(&attr, 0, sizeof(attr));
	ret = ib_query_nvmf_ns(be_ctrl->ibns, &attr);
	if (ret) {
		pr_err("Failed to query counters");
		return;
	}
	nvmet_rdma_update_counters(&attr, counters);
}

static u64
nvmet_rdma_query_ns_counter(struct nvmet_ns *ns,
			    enum nvmet_rdma_offload_ns_counter counter)
{
	struct nvmet_rdma_xrq *xrq;
	struct nvmet_rdma_backend_ctrl *be_ctrl;
	struct ib_nvmf_ns_attr attr;
	u64 cmds = 0;
	int ret;

	mutex_lock(&nvmet_rdma_xrq_mutex);
	list_for_each_entry(xrq, &nvmet_rdma_xrq_list, entry) {
		if (xrq->subsys == ns->subsys) {
			mutex_lock(&xrq->be_mutex);
			list_for_each_entry(be_ctrl, &xrq->be_ctrls_list, entry) {
				if (be_ctrl->ns == ns) {
					memset(&attr, 0, sizeof(attr));
					ret = ib_query_nvmf_ns(be_ctrl->ibns, &attr);
					if (!ret) {
						switch (counter) {
						case NVMET_RDMA_OFFLOAD_NS_READ_CMDS:
							cmds += attr.num_read_cmd;
							break;
						case NVMET_RDMA_OFFLOAD_NS_READ_BLOCKS:
							cmds += attr.num_read_blocks;
							break;
						case NVMET_RDMA_OFFLOAD_NS_WRITE_CMDS:
							cmds += attr.num_write_cmd;
							break;
						case NVMET_RDMA_OFFLOAD_NS_WRITE_BLOCKS:
							cmds += attr.num_write_blocks;
							break;
						case NVMET_RDMA_OFFLOAD_NS_WRITE_INLINE_CMDS:
							cmds += attr.num_write_inline_cmd;
							break;
						case NVMET_RDMA_OFFLOAD_NS_FLUSH_CMDS:
							cmds += attr.num_flush_cmd;
							break;
						case NVMET_RDMA_OFFLOAD_NS_ERROR_CMDS:
							cmds += attr.num_error_cmd;
							break;
						case NVMET_RDMA_OFFLOAD_NS_BACKEND_ERROR_CMDS:
							cmds += attr.num_backend_error_cmd;
							break;
						default:
							pr_err("received unknown counter for offloaded namespace query (%d)\n",
							       counter);
							break;
						}
					}
				}
			}
			mutex_unlock(&xrq->be_mutex);
		}
	}
	mutex_unlock(&nvmet_rdma_xrq_mutex);

	return cmds;
}

static u64 nvmet_rdma_offload_ns_read_cmds(struct nvmet_ns *ns)
{
	return nvmet_rdma_query_ns_counter(ns,
					   NVMET_RDMA_OFFLOAD_NS_READ_CMDS);
}

static u64 nvmet_rdma_offload_ns_read_blocks(struct nvmet_ns *ns)
{
	return nvmet_rdma_query_ns_counter(ns,
					   NVMET_RDMA_OFFLOAD_NS_READ_BLOCKS);
}

static u64 nvmet_rdma_offload_ns_write_cmds(struct nvmet_ns *ns)
{
	return nvmet_rdma_query_ns_counter(ns,
					   NVMET_RDMA_OFFLOAD_NS_WRITE_CMDS);
}

static u64 nvmet_rdma_offload_ns_write_blocks(struct nvmet_ns *ns)
{
	return nvmet_rdma_query_ns_counter(ns,
					   NVMET_RDMA_OFFLOAD_NS_WRITE_BLOCKS);
}

static u64 nvmet_rdma_offload_ns_write_inline_cmds(struct nvmet_ns *ns)
{
	return nvmet_rdma_query_ns_counter(ns,
					   NVMET_RDMA_OFFLOAD_NS_WRITE_INLINE_CMDS);
}

static u64 nvmet_rdma_offload_ns_flush_cmds(struct nvmet_ns *ns)
{
	return nvmet_rdma_query_ns_counter(ns,
					   NVMET_RDMA_OFFLOAD_NS_FLUSH_CMDS);

}

static u64 nvmet_rdma_offload_ns_error_cmds(struct nvmet_ns *ns)
{
	return nvmet_rdma_query_ns_counter(ns,
					   NVMET_RDMA_OFFLOAD_NS_ERROR_CMDS);
}

static u64 nvmet_rdma_offload_ns_backend_error_cmds(struct nvmet_ns *ns)
{
	return nvmet_rdma_query_ns_counter(ns,
					   NVMET_RDMA_OFFLOAD_NS_BACKEND_ERROR_CMDS);
}

static unsigned int __nvmet_rdma_peer_to_peer_sqe_inline_size(struct ib_nvmf_caps *nvmf_caps,
							      struct nvmet_port *nport)
{
	unsigned int sqe_inline_size = nport->inline_data_size;
	int p2p_sqe_inline_size = (nvmf_caps->max_cmd_size * 16) - sizeof(struct nvme_command);

	if (p2p_sqe_inline_size >= 0)
		sqe_inline_size = min_t(unsigned int,
					p2p_sqe_inline_size,
					sqe_inline_size);

	return sqe_inline_size;
}

static unsigned int nvmet_rdma_peer_to_peer_sqe_inline_size(struct nvmet_ctrl *ctrl)
{
	struct nvmet_rdma_port *port = ctrl->port->priv;
	struct rdma_cm_id *cm_id = port->cm_id;
	struct ib_nvmf_caps *nvmf_caps = &cm_id->device->attrs.nvmf_caps;

	return __nvmet_rdma_peer_to_peer_sqe_inline_size(nvmf_caps, ctrl->port);
}

static bool nvmet_rdma_peer_to_peer_capable(struct nvmet_port *nport)
{
	struct nvmet_rdma_port *port = nport->priv;
	struct rdma_cm_id *cm_id = port->cm_id;
	struct ib_nvmf_caps *nvmf_caps = &cm_id->device->attrs.nvmf_caps;

	if (!(cm_id->device->attrs.device_cap_flags &
	      IB_DEVICE_NVMF_TARGET_OFFLOAD))
		return false;

	if (!nvmf_caps->passthrough_sqe_rw_service &&
	    nport->offload_passthrough_sqe_rw) {
		pr_err("Offload passthrough is not supported by device %s\n",
		       cm_id->device->name);
		return false;
	}

	return true;
}

static bool nvmet_rdma_check_subsys_match_offload_port(struct nvmet_port *nport,
						struct nvmet_subsys *subsys)
{
	struct nvmet_rdma_port *port = nport->priv;
	struct rdma_cm_id *cm_id = port->cm_id;
	struct ib_nvmf_caps *nvmf_caps = &cm_id->device->attrs.nvmf_caps;
	struct nvmet_ns *ns;
	unsigned long idx;

	if (nvmf_caps->max_frontend_nsid) {
		xa_for_each(&subsys->namespaces, idx, ns) {
			if (ns->nsid > nvmf_caps->max_frontend_nsid) {
				pr_err("Reached maximal namespace ID (%u/%u)\n",
						ns->nsid, nvmf_caps->max_frontend_nsid);
				return false;
			}
		}
	}

	if (subsys->nr_namespaces > nvmf_caps->max_namespace) {
		pr_err("Reached max number of ns per offload subsys (%u/%u)\n",
		       subsys->nr_namespaces, nvmf_caps->max_namespace);
		return false;
	}

	/*
	 * Assume number of namespaces equals number of backend controllers,
	 * because in the current implementation a backend controller is created
	 * for each namespace.
	 */
	if (subsys->nr_namespaces > nvmf_caps->max_be_ctrl) {
		pr_err("Reached max number of supported be ctrl per XRQ (%u)\n",
		       nvmf_caps->max_be_ctrl);
		return false;
	}

	return true;
}

static int nvmet_rdma_init_st_pool(struct nvmet_rdma_staging_buf_pool *pool,
				   unsigned long long mem_start,
				   unsigned int mem_size,
				   unsigned int buffer_size)
{
	struct nvmet_rdma_staging_buf *st, *tmp;
	int i, err = -EINVAL;
	int size = mem_size / buffer_size;
	unsigned long start_pfn, end_pfn;

	if (!PAGE_ALIGNED(mem_start))
		goto out;

	start_pfn = PFN_DOWN(mem_start);
	end_pfn = PFN_DOWN(mem_start + mem_size * SZ_1M);
	for (; start_pfn < end_pfn; start_pfn++) {
		if (pfn_valid(start_pfn))
			goto out;
	}

	for (i = 0; i < size; i++) {
		st = nvmet_rdma_alloc_st_buff(1, buffer_size, false);
		if (!st) {
			err = -ENOMEM;
			goto error;
		}
		st->staging_dma_addrs[0] = mem_start + i * buffer_size * SZ_1M;
		pr_debug("pool_entry=%d staging_buffer_address=0x%llx\n", i, st->staging_dma_addrs[0]);
		list_add_tail(&st->entry, &pool->list);
		pool->size++;
	}

	pr_info("offload_mem_start=0x%llx pool_size=%d, buf_size=%u\n",
		mem_start,
		pool->size,
		buffer_size);

	return 0;

error:
	list_for_each_entry_safe(st, tmp, &pool->list, entry) {
		list_del(&st->entry);
		nvmet_rdma_free_st_buff(st);
	}
out:
	return err;
}

