[linux-2.6-block.git] / drivers / nvme / target / fabrics-cmd.c

/*
 * NVMe Fabrics command implementation.
 * Copyright (c) 2015-2016 HGST, a Western Digital Company.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms and conditions of the GNU General Public License,
 * version 2, as published by the Free Software Foundation.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 */
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
#include <linux/blkdev.h>
#include "nvmet.h"

static void nvmet_execute_prop_set(struct nvmet_req *req)
{
	u16 status = 0;

	if (!(req->cmd->prop_set.attrib & 1)) {
		u64 val = le64_to_cpu(req->cmd->prop_set.value);

		switch (le32_to_cpu(req->cmd->prop_set.offset)) {
		case NVME_REG_CC:
			nvmet_update_cc(req->sq->ctrl, val);
			break;
		default:
			status = NVME_SC_INVALID_FIELD | NVME_SC_DNR;
			break;
		}
	} else {
		status = NVME_SC_INVALID_FIELD | NVME_SC_DNR;
	}

	nvmet_req_complete(req, status);
}

static void nvmet_execute_prop_get(struct nvmet_req *req)
{
	struct nvmet_ctrl *ctrl = req->sq->ctrl;
	u16 status = 0;
	u64 val = 0;

	if (req->cmd->prop_get.attrib & 1) {
		switch (le32_to_cpu(req->cmd->prop_get.offset)) {
		case NVME_REG_CAP:
			val = ctrl->cap;
			break;
		default:
			status = NVME_SC_INVALID_FIELD | NVME_SC_DNR;
			break;
		}
	} else {
		switch (le32_to_cpu(req->cmd->prop_get.offset)) {
		case NVME_REG_VS:
			val = ctrl->subsys->ver;
			break;
		case NVME_REG_CC:
			val = ctrl->cc;
			break;
		case NVME_REG_CSTS:
			val = ctrl->csts;
			break;
		default:
			status = NVME_SC_INVALID_FIELD | NVME_SC_DNR;
			break;
		}
	}

	req->rsp->result.u64 = cpu_to_le64(val);
	nvmet_req_complete(req, status);
}

u16 nvmet_parse_fabrics_cmd(struct nvmet_req *req)
{
	struct nvme_command *cmd = req->cmd;

	req->ns = NULL;

	switch (cmd->fabrics.fctype) {
	case nvme_fabrics_type_property_set:
		req->data_len = 0;
		req->execute = nvmet_execute_prop_set;
		break;
	case nvme_fabrics_type_property_get:
		req->data_len = 0;
		req->execute = nvmet_execute_prop_get;
		break;
	default:
		pr_err("received unknown capsule type 0x%x\n",
			cmd->fabrics.fctype);
		return NVME_SC_INVALID_OPCODE | NVME_SC_DNR;
	}

	return 0;
}

static u16 nvmet_install_queue(struct nvmet_ctrl *ctrl, struct nvmet_req *req)
{
	struct nvmf_connect_command *c = &req->cmd->connect;
	u16 qid = le16_to_cpu(c->qid);
	u16 sqsize = le16_to_cpu(c->sqsize);
	struct nvmet_ctrl *old;

	old = cmpxchg(&req->sq->ctrl, NULL, ctrl);
	if (old) {
		pr_warn("queue already connected!\n");
		return NVME_SC_CONNECT_CTRL_BUSY | NVME_SC_DNR;
	}
	if (!sqsize) {
		pr_warn("queue size zero!\n");
		return NVME_SC_CONNECT_INVALID_PARAM | NVME_SC_DNR;
	}

	/* note: convert queue size from 0's-based value to 1's-based value */
	nvmet_cq_setup(ctrl, req->cq, qid, sqsize + 1);
	nvmet_sq_setup(ctrl, req->sq, qid, sqsize + 1);
	return 0;
}

static void nvmet_execute_admin_connect(struct nvmet_req *req)
{
	struct nvmf_connect_command *c = &req->cmd->connect;
	struct nvmf_connect_data *d;
	struct nvmet_ctrl *ctrl = NULL;
	u16 status = 0;

	d = kmalloc(sizeof(*d), GFP_KERNEL);
	if (!d) {
		status = NVME_SC_INTERNAL;
		goto complete;
	}

	status = nvmet_copy_from_sgl(req, 0, d, sizeof(*d));
	if (status)
		goto out;

	/* zero out initial completion result, assign values as needed */
	req->rsp->result.u32 = 0;

	if (c->recfmt != 0) {
		pr_warn("invalid connect version (%d).\n",
			le16_to_cpu(c->recfmt));
		status = NVME_SC_CONNECT_FORMAT | NVME_SC_DNR;
		goto out;
	}

	if (unlikely(d->cntlid != cpu_to_le16(0xffff))) {
		pr_warn("connect attempt for invalid controller ID %#x\n",
			d->cntlid);
		status = NVME_SC_CONNECT_INVALID_PARAM | NVME_SC_DNR;
		req->rsp->result.u32 = IPO_IATTR_CONNECT_DATA(cntlid);
		goto out;
	}

	status = nvmet_alloc_ctrl(d->subsysnqn, d->hostnqn, req,
				  le32_to_cpu(c->kato), &ctrl);
	if (status)
		goto out;
	uuid_copy(&ctrl->hostid, &d->hostid);

	status = nvmet_install_queue(ctrl, req);
	if (status) {
		nvmet_ctrl_put(ctrl);
		goto out;
	}

	pr_info("creating controller %d for subsystem %s for NQN %s.\n",
		ctrl->cntlid, ctrl->subsys->subsysnqn, ctrl->hostnqn);
	req->rsp->result.u16 = cpu_to_le16(ctrl->cntlid);

out:
	kfree(d);
complete:
	nvmet_req_complete(req, status);
}

static void nvmet_execute_io_connect(struct nvmet_req *req)
{
	struct nvmf_connect_command *c = &req->cmd->connect;
	struct nvmf_connect_data *d;
	struct nvmet_ctrl *ctrl = NULL;
	u16 qid = le16_to_cpu(c->qid);
	u16 status = 0;

	d = kmalloc(sizeof(*d), GFP_KERNEL);
	if (!d) {
		status = NVME_SC_INTERNAL;
		goto complete;
	}

	status = nvmet_copy_from_sgl(req, 0, d, sizeof(*d));
	if (status)
		goto out;

	/* zero out initial completion result, assign values as needed */
	req->rsp->result.u32 = 0;

	if (c->recfmt != 0) {
		pr_warn("invalid connect version (%d).\n",
			le16_to_cpu(c->recfmt));
		status = NVME_SC_CONNECT_FORMAT | NVME_SC_DNR;
		goto out;
	}

	status = nvmet_ctrl_find_get(d->subsysnqn, d->hostnqn,
				     le16_to_cpu(d->cntlid),
				     req, &ctrl);
	if (status)
		goto out;

	if (unlikely(qid > ctrl->subsys->max_qid)) {
		pr_warn("invalid queue id (%d)\n", qid);
		status = NVME_SC_CONNECT_INVALID_PARAM | NVME_SC_DNR;
		req->rsp->result.u32 = IPO_IATTR_CONNECT_SQE(qid);
		goto out_ctrl_put;
	}

	status = nvmet_install_queue(ctrl, req);
	if (status) {
		/* pass back cntlid that had the issue of installing queue */
		req->rsp->result.u16 = cpu_to_le16(ctrl->cntlid);
		goto out_ctrl_put;
	}

	pr_info("adding queue %d to ctrl %d.\n", qid, ctrl->cntlid);

out:
	kfree(d);
complete:
	nvmet_req_complete(req, status);
	return;

out_ctrl_put:
	nvmet_ctrl_put(ctrl);
	goto out;
}

u16 nvmet_parse_connect_cmd(struct nvmet_req *req)
{
	struct nvme_command *cmd = req->cmd;

	req->ns = NULL;

	if (cmd->common.opcode != nvme_fabrics_command) {
		pr_err("invalid command 0x%x on unconnected queue.\n",
			cmd->fabrics.opcode);
		return NVME_SC_INVALID_OPCODE | NVME_SC_DNR;
	}
	if (cmd->fabrics.fctype != nvme_fabrics_type_connect) {
		pr_err("invalid capsule type 0x%x on unconnected queue.\n",
			cmd->fabrics.fctype);
		return NVME_SC_INVALID_OPCODE | NVME_SC_DNR;
	}

	req->data_len = sizeof(struct nvmf_connect_data);
	if (cmd->connect.qid == 0)
		req->execute = nvmet_execute_admin_connect;
	else
		req->execute = nvmet_execute_io_connect;
	return 0;
}
Commit	Line	Data
a07b4970 CH	1	/*
	2	* NVMe Fabrics command implementation.
	3	* Copyright (c) 2015-2016 HGST, a Western Digital Company.
	4	*
	5	* This program is free software; you can redistribute it and/or modify it
	6	* under the terms and conditions of the GNU General Public License,
	7	* version 2, as published by the Free Software Foundation.
	8	*
	9	* This program is distributed in the hope it will be useful, but WITHOUT
	10	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	11	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
	12	* more details.
	13	*/
	14	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
	15	#include <linux/blkdev.h>
	16	#include "nvmet.h"
	17
	18	static void nvmet_execute_prop_set(struct nvmet_req *req)
	19	{
	20	u16 status = 0;
	21
	22	if (!(req->cmd->prop_set.attrib & 1)) {
	23	u64 val = le64_to_cpu(req->cmd->prop_set.value);
	24
	25	switch (le32_to_cpu(req->cmd->prop_set.offset)) {
	26	case NVME_REG_CC:
	27	nvmet_update_cc(req->sq->ctrl, val);
	28	break;
	29	default:
	30	status = NVME_SC_INVALID_FIELD \| NVME_SC_DNR;
	31	break;
	32	}
	33	} else {
	34	status = NVME_SC_INVALID_FIELD \| NVME_SC_DNR;
	35	}
	36
	37	nvmet_req_complete(req, status);
	38	}
	39
	40	static void nvmet_execute_prop_get(struct nvmet_req *req)
	41	{
	42	struct nvmet_ctrl *ctrl = req->sq->ctrl;
	43	u16 status = 0;
	44	u64 val = 0;
	45
	46	if (req->cmd->prop_get.attrib & 1) {
	47	switch (le32_to_cpu(req->cmd->prop_get.offset)) {
	48	case NVME_REG_CAP:
	49	val = ctrl->cap;
	50	break;
	51	default:
	52	status = NVME_SC_INVALID_FIELD \| NVME_SC_DNR;
	53	break;
	54	}
	55	} else {
	56	switch (le32_to_cpu(req->cmd->prop_get.offset)) {
	57	case NVME_REG_VS:
	58	val = ctrl->subsys->ver;
	59	break;
	60	case NVME_REG_CC:
	61	val = ctrl->cc;
	62	break;
	63	case NVME_REG_CSTS:
	64	val = ctrl->csts;
65	break;
66	default:
67	status = NVME_SC_INVALID_FIELD \| NVME_SC_DNR;
68	break;
69	}
70	}
71
d49187e9	72	req->rsp->result.u64 = cpu_to_le64(val);
a07b4970 CH	73	nvmet_req_complete(req, status);
	74	}
	75
64a0ca88	76	u16 nvmet_parse_fabrics_cmd(struct nvmet_req *req)
a07b4970 CH	77	{
	78	struct nvme_command *cmd = req->cmd;
	79
	80	req->ns = NULL;
	81
	82	switch (cmd->fabrics.fctype) {
	83	case nvme_fabrics_type_property_set:
	84	req->data_len = 0;
	85	req->execute = nvmet_execute_prop_set;
	86	break;
	87	case nvme_fabrics_type_property_get:
	88	req->data_len = 0;
	89	req->execute = nvmet_execute_prop_get;
	90	break;
	91	default:
	92	pr_err("received unknown capsule type 0x%x\n",
	93	cmd->fabrics.fctype);
	94	return NVME_SC_INVALID_OPCODE \| NVME_SC_DNR;
	95	}
	96
	97	return 0;
	98	}
	99
	100	static u16 nvmet_install_queue(struct nvmet_ctrl ctrl, struct nvmet_req req)
	101	{
	102	struct nvmf_connect_command *c = &req->cmd->connect;
	103	u16 qid = le16_to_cpu(c->qid);
	104	u16 sqsize = le16_to_cpu(c->sqsize);
	105	struct nvmet_ctrl *old;
	106
	107	old = cmpxchg(&req->sq->ctrl, NULL, ctrl);
	108	if (old) {
	109	pr_warn("queue already connected!\n");
	110	return NVME_SC_CONNECT_CTRL_BUSY \| NVME_SC_DNR;
	111	}
bb1cc747 JS	112	if (!sqsize) {
	113	pr_warn("queue size zero!\n");
	114	return NVME_SC_CONNECT_INVALID_PARAM \| NVME_SC_DNR;
	115	}
a07b4970	116
bb1cc747 JS	117	/* note: convert queue size from 0's-based value to 1's-based value */
	118	nvmet_cq_setup(ctrl, req->cq, qid, sqsize + 1);
	119	nvmet_sq_setup(ctrl, req->sq, qid, sqsize + 1);
a07b4970 CH	120	return 0;
	121	}
	122
	123	static void nvmet_execute_admin_connect(struct nvmet_req *req)
	124	{
	125	struct nvmf_connect_command *c = &req->cmd->connect;
	126	struct nvmf_connect_data *d;
	127	struct nvmet_ctrl *ctrl = NULL;
	128	u16 status = 0;
	129
1c05cf90 LG	130	d = kmalloc(sizeof(*d), GFP_KERNEL);
	131	if (!d) {
	132	status = NVME_SC_INTERNAL;
	133	goto complete;
	134	}
	135
	136	status = nvmet_copy_from_sgl(req, 0, d, sizeof(*d));
	137	if (status)
	138	goto out;
a07b4970 CH	139
a07b4970 CH	140	/* zero out initial completion result, assign values as needed */
d49187e9	141	req->rsp->result.u32 = 0;
a07b4970 CH	142
	143	if (c->recfmt != 0) {
	144	pr_warn("invalid connect version (%d).\n",
	145	le16_to_cpu(c->recfmt));
	146	status = NVME_SC_CONNECT_FORMAT \| NVME_SC_DNR;
	147	goto out;
	148	}
	149
	150	if (unlikely(d->cntlid != cpu_to_le16(0xffff))) {
	151	pr_warn("connect attempt for invalid controller ID %#x\n",
	152	d->cntlid);
	153	status = NVME_SC_CONNECT_INVALID_PARAM \| NVME_SC_DNR;
d49187e9	154	req->rsp->result.u32 = IPO_IATTR_CONNECT_DATA(cntlid);
a07b4970 CH	155	goto out;
	156	}
	157
	158	status = nvmet_alloc_ctrl(d->subsysnqn, d->hostnqn, req,
1c05cf90	159	le32_to_cpu(c->kato), &ctrl);
a07b4970 CH	160	if (status)
a07b4970 CH	161	goto out;
28dd5cf7	162	uuid_copy(&ctrl->hostid, &d->hostid);
a07b4970 CH	163
	164	status = nvmet_install_queue(ctrl, req);
	165	if (status) {
	166	nvmet_ctrl_put(ctrl);
	167	goto out;
	168	}
	169
15fbad96 SG	170	pr_info("creating controller %d for subsystem %s for NQN %s.\n",
15fbad96 SG	171	ctrl->cntlid, ctrl->subsys->subsysnqn, ctrl->hostnqn);
d49187e9	172	req->rsp->result.u16 = cpu_to_le16(ctrl->cntlid);
a07b4970 CH	173
a07b4970 CH	174	out:
1c05cf90 LG	175	kfree(d);
1c05cf90 LG	176	complete:
a07b4970 CH	177	nvmet_req_complete(req, status);
	178	}
	179
	180	static void nvmet_execute_io_connect(struct nvmet_req *req)
	181	{
	182	struct nvmf_connect_command *c = &req->cmd->connect;
	183	struct nvmf_connect_data *d;
	184	struct nvmet_ctrl *ctrl = NULL;
	185	u16 qid = le16_to_cpu(c->qid);
	186	u16 status = 0;
	187
1c05cf90 LG	188	d = kmalloc(sizeof(*d), GFP_KERNEL);
	189	if (!d) {
	190	status = NVME_SC_INTERNAL;
	191	goto complete;
	192	}
	193
	194	status = nvmet_copy_from_sgl(req, 0, d, sizeof(*d));
	195	if (status)
	196	goto out;
a07b4970 CH	197
a07b4970 CH	198	/* zero out initial completion result, assign values as needed */
d49187e9	199	req->rsp->result.u32 = 0;
a07b4970 CH	200
	201	if (c->recfmt != 0) {
	202	pr_warn("invalid connect version (%d).\n",
	203	le16_to_cpu(c->recfmt));
	204	status = NVME_SC_CONNECT_FORMAT \| NVME_SC_DNR;
	205	goto out;
	206	}
	207
	208	status = nvmet_ctrl_find_get(d->subsysnqn, d->hostnqn,
1c05cf90 LG	209	le16_to_cpu(d->cntlid),
1c05cf90 LG	210	req, &ctrl);
a07b4970 CH	211	if (status)
	212	goto out;
	213
	214	if (unlikely(qid > ctrl->subsys->max_qid)) {
	215	pr_warn("invalid queue id (%d)\n", qid);
	216	status = NVME_SC_CONNECT_INVALID_PARAM \| NVME_SC_DNR;
d49187e9	217	req->rsp->result.u32 = IPO_IATTR_CONNECT_SQE(qid);
a07b4970 CH	218	goto out_ctrl_put;
	219	}
	220
	221	status = nvmet_install_queue(ctrl, req);
	222	if (status) {
	223	/* pass back cntlid that had the issue of installing queue */
d49187e9	224	req->rsp->result.u16 = cpu_to_le16(ctrl->cntlid);
a07b4970 CH	225	goto out_ctrl_put;
	226	}
	227
	228	pr_info("adding queue %d to ctrl %d.\n", qid, ctrl->cntlid);
	229
	230	out:
1c05cf90 LG	231	kfree(d);
1c05cf90 LG	232	complete:
a07b4970 CH	233	nvmet_req_complete(req, status);
	234	return;
	235
	236	out_ctrl_put:
	237	nvmet_ctrl_put(ctrl);
	238	goto out;
	239	}
	240
64a0ca88	241	u16 nvmet_parse_connect_cmd(struct nvmet_req *req)
a07b4970 CH	242	{
	243	struct nvme_command *cmd = req->cmd;
	244
	245	req->ns = NULL;
	246
2dbf5816	247	if (cmd->common.opcode != nvme_fabrics_command) {
a07b4970 CH	248	pr_err("invalid command 0x%x on unconnected queue.\n",
	249	cmd->fabrics.opcode);
	250	return NVME_SC_INVALID_OPCODE \| NVME_SC_DNR;
	251	}
	252	if (cmd->fabrics.fctype != nvme_fabrics_type_connect) {
	253	pr_err("invalid capsule type 0x%x on unconnected queue.\n",
	254	cmd->fabrics.fctype);
	255	return NVME_SC_INVALID_OPCODE \| NVME_SC_DNR;
	256	}
	257
	258	req->data_len = sizeof(struct nvmf_connect_data);
	259	if (cmd->connect.qid == 0)
	260	req->execute = nvmet_execute_admin_connect;
	261	else
	262	req->execute = nvmet_execute_io_connect;
	263	return 0;
	264	}