nvme_qpair.c revision 252271
1/*-
2 * Copyright (C) 2012 Intel Corporation
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 *    notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 *    notice, this list of conditions and the following disclaimer in the
12 *    documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27#include <sys/cdefs.h>
28__FBSDID("$FreeBSD: head/sys/dev/nvme/nvme_qpair.c 252271 2013-06-26 23:27:17Z jimharris $");
29
30#include <sys/param.h>
31#include <sys/bus.h>
32
33#include <dev/pci/pcivar.h>
34
35#include "nvme_private.h"
36
37static void	_nvme_qpair_submit_request(struct nvme_qpair *qpair,
38					   struct nvme_request *req);
39
40struct nvme_opcode_string {
41
42	uint16_t	opc;
43	const char *	str;
44};
45
46static struct nvme_opcode_string admin_opcode[] = {
47	{ NVME_OPC_DELETE_IO_SQ, "DELETE IO SQ" },
48	{ NVME_OPC_CREATE_IO_SQ, "CREATE IO SQ" },
49	{ NVME_OPC_GET_LOG_PAGE, "GET LOG PAGE" },
50	{ NVME_OPC_DELETE_IO_CQ, "DELETE IO CQ" },
51	{ NVME_OPC_CREATE_IO_CQ, "CREATE IO CQ" },
52	{ NVME_OPC_IDENTIFY, "IDENTIFY" },
53	{ NVME_OPC_ABORT, "ABORT" },
54	{ NVME_OPC_SET_FEATURES, "SET FEATURES" },
55	{ NVME_OPC_GET_FEATURES, "GET FEATURES" },
56	{ NVME_OPC_ASYNC_EVENT_REQUEST, "ASYNC EVENT REQUEST" },
57	{ NVME_OPC_FIRMWARE_ACTIVATE, "FIRMWARE ACTIVATE" },
58	{ NVME_OPC_FIRMWARE_IMAGE_DOWNLOAD, "FIRMWARE IMAGE DOWNLOAD" },
59	{ NVME_OPC_FORMAT_NVM, "FORMAT NVM" },
60	{ NVME_OPC_SECURITY_SEND, "SECURITY SEND" },
61	{ NVME_OPC_SECURITY_RECEIVE, "SECURITY RECEIVE" },
62	{ 0xFFFF, "ADMIN COMMAND" }
63};
64
65static struct nvme_opcode_string io_opcode[] = {
66	{ NVME_OPC_FLUSH, "FLUSH" },
67	{ NVME_OPC_WRITE, "WRITE" },
68	{ NVME_OPC_READ, "READ" },
69	{ NVME_OPC_WRITE_UNCORRECTABLE, "WRITE UNCORRECTABLE" },
70	{ NVME_OPC_COMPARE, "COMPARE" },
71	{ NVME_OPC_DATASET_MANAGEMENT, "DATASET MANAGEMENT" },
72	{ 0xFFFF, "IO COMMAND" }
73};
74
75static const char *
76get_admin_opcode_string(uint16_t opc)
77{
78	struct nvme_opcode_string *entry;
79
80	entry = admin_opcode;
81
82	while (entry->opc != 0xFFFF) {
83		if (entry->opc == opc)
84			return (entry->str);
85		entry++;
86	}
87	return (entry->str);
88}
89
90static const char *
91get_io_opcode_string(uint16_t opc)
92{
93	struct nvme_opcode_string *entry;
94
95	entry = io_opcode;
96
97	while (entry->opc != 0xFFFF) {
98		if (entry->opc == opc)
99			return (entry->str);
100		entry++;
101	}
102	return (entry->str);
103}
104
105
106static void
107nvme_admin_qpair_print_command(struct nvme_qpair *qpair,
108    struct nvme_command *cmd)
109{
110
111	nvme_printf(qpair->ctrlr, "%s (%02x) sqid:%d cid:%d nsid:%x "
112	    "cdw10:%08x cdw11:%08x\n",
113	    get_admin_opcode_string(cmd->opc), cmd->opc, qpair->id, cmd->cid,
114	    cmd->nsid, cmd->cdw10, cmd->cdw11);
115}
116
117static void
118nvme_io_qpair_print_command(struct nvme_qpair *qpair,
119    struct nvme_command *cmd)
120{
121
122	switch (cmd->opc) {
123	case NVME_OPC_WRITE:
124	case NVME_OPC_READ:
125	case NVME_OPC_WRITE_UNCORRECTABLE:
126	case NVME_OPC_COMPARE:
127		nvme_printf(qpair->ctrlr, "%s sqid:%d cid:%d nsid:%d "
128		    "lba:%llu len:%d\n",
129		    get_io_opcode_string(cmd->opc), qpair->id, cmd->cid,
130		    cmd->nsid,
131		    ((unsigned long long)cmd->cdw11 << 32) + cmd->cdw10,
132		    (cmd->cdw12 & 0xFFFF) + 1);
133		break;
134	case NVME_OPC_FLUSH:
135	case NVME_OPC_DATASET_MANAGEMENT:
136		nvme_printf(qpair->ctrlr, "%s sqid:%d cid:%d nsid:%d\n",
137		    get_io_opcode_string(cmd->opc), qpair->id, cmd->cid,
138		    cmd->nsid);
139		break;
140	default:
141		nvme_printf(qpair->ctrlr, "%s (%02x) sqid:%d cid:%d nsid:%d\n",
142		    get_io_opcode_string(cmd->opc), cmd->opc, qpair->id,
143		    cmd->cid, cmd->nsid);
144		break;
145	}
146}
147
148static void
149nvme_qpair_print_command(struct nvme_qpair *qpair, struct nvme_command *cmd)
150{
151	if (qpair->id == 0)
152		nvme_admin_qpair_print_command(qpair, cmd);
153	else
154		nvme_io_qpair_print_command(qpair, cmd);
155}
156
157struct nvme_status_string {
158
159	uint16_t	sc;
160	const char *	str;
161};
162
163static struct nvme_status_string generic_status[] = {
164	{ NVME_SC_SUCCESS, "SUCCESS" },
165	{ NVME_SC_INVALID_OPCODE, "INVALID OPCODE" },
166	{ NVME_SC_INVALID_FIELD, "INVALID_FIELD" },
167	{ NVME_SC_COMMAND_ID_CONFLICT, "COMMAND ID CONFLICT" },
168	{ NVME_SC_DATA_TRANSFER_ERROR, "DATA TRANSFER ERROR" },
169	{ NVME_SC_ABORTED_POWER_LOSS, "ABORTED - POWER LOSS" },
170	{ NVME_SC_INTERNAL_DEVICE_ERROR, "INTERNAL DEVICE ERROR" },
171	{ NVME_SC_ABORTED_BY_REQUEST, "ABORTED - BY REQUEST" },
172	{ NVME_SC_ABORTED_SQ_DELETION, "ABORTED - SQ DELETION" },
173	{ NVME_SC_ABORTED_FAILED_FUSED, "ABORTED - FAILED FUSED" },
174	{ NVME_SC_ABORTED_MISSING_FUSED, "ABORTED - MISSING FUSED" },
175	{ NVME_SC_INVALID_NAMESPACE_OR_FORMAT, "INVALID NAMESPACE OR FORMAT" },
176	{ NVME_SC_COMMAND_SEQUENCE_ERROR, "COMMAND SEQUENCE ERROR" },
177	{ NVME_SC_LBA_OUT_OF_RANGE, "LBA OUT OF RANGE" },
178	{ NVME_SC_CAPACITY_EXCEEDED, "CAPACITY EXCEEDED" },
179	{ NVME_SC_NAMESPACE_NOT_READY, "NAMESPACE NOT READY" },
180	{ 0xFFFF, "GENERIC" }
181};
182
183static struct nvme_status_string command_specific_status[] = {
184	{ NVME_SC_COMPLETION_QUEUE_INVALID, "INVALID COMPLETION QUEUE" },
185	{ NVME_SC_INVALID_QUEUE_IDENTIFIER, "INVALID QUEUE IDENTIFIER" },
186	{ NVME_SC_MAXIMUM_QUEUE_SIZE_EXCEEDED, "MAX QUEUE SIZE EXCEEDED" },
187	{ NVME_SC_ABORT_COMMAND_LIMIT_EXCEEDED, "ABORT CMD LIMIT EXCEEDED" },
188	{ NVME_SC_ASYNC_EVENT_REQUEST_LIMIT_EXCEEDED, "ASYNC LIMIT EXCEEDED" },
189	{ NVME_SC_INVALID_FIRMWARE_SLOT, "INVALID FIRMWARE SLOT" },
190	{ NVME_SC_INVALID_FIRMWARE_IMAGE, "INVALID FIRMWARE IMAGE" },
191	{ NVME_SC_INVALID_INTERRUPT_VECTOR, "INVALID INTERRUPT VECTOR" },
192	{ NVME_SC_INVALID_LOG_PAGE, "INVALID LOG PAGE" },
193	{ NVME_SC_INVALID_FORMAT, "INVALID FORMAT" },
194	{ NVME_SC_FIRMWARE_REQUIRES_RESET, "FIRMWARE REQUIRES RESET" },
195	{ NVME_SC_CONFLICTING_ATTRIBUTES, "CONFLICTING ATTRIBUTES" },
196	{ NVME_SC_INVALID_PROTECTION_INFO, "INVALID PROTECTION INFO" },
197	{ NVME_SC_ATTEMPTED_WRITE_TO_RO_PAGE, "WRITE TO RO PAGE" },
198	{ 0xFFFF, "COMMAND SPECIFIC" }
199};
200
201static struct nvme_status_string media_error_status[] = {
202	{ NVME_SC_WRITE_FAULTS, "WRITE FAULTS" },
203	{ NVME_SC_UNRECOVERED_READ_ERROR, "UNRECOVERED READ ERROR" },
204	{ NVME_SC_GUARD_CHECK_ERROR, "GUARD CHECK ERROR" },
205	{ NVME_SC_APPLICATION_TAG_CHECK_ERROR, "APPLICATION TAG CHECK ERROR" },
206	{ NVME_SC_REFERENCE_TAG_CHECK_ERROR, "REFERENCE TAG CHECK ERROR" },
207	{ NVME_SC_COMPARE_FAILURE, "COMPARE FAILURE" },
208	{ NVME_SC_ACCESS_DENIED, "ACCESS DENIED" },
209	{ 0xFFFF, "MEDIA ERROR" }
210};
211
212static const char *
213get_status_string(uint16_t sct, uint16_t sc)
214{
215	struct nvme_status_string *entry;
216
217	switch (sct) {
218	case NVME_SCT_GENERIC:
219		entry = generic_status;
220		break;
221	case NVME_SCT_COMMAND_SPECIFIC:
222		entry = command_specific_status;
223		break;
224	case NVME_SCT_MEDIA_ERROR:
225		entry = media_error_status;
226		break;
227	case NVME_SCT_VENDOR_SPECIFIC:
228		return ("VENDOR SPECIFIC");
229	default:
230		return ("RESERVED");
231	}
232
233	while (entry->sc != 0xFFFF) {
234		if (entry->sc == sc)
235			return (entry->str);
236		entry++;
237	}
238	return (entry->str);
239}
240
241static void
242nvme_qpair_print_completion(struct nvme_qpair *qpair,
243    struct nvme_completion *cpl)
244{
245	nvme_printf(qpair->ctrlr, "%s (%02x/%02x) sqid:%d cid:%d cdw0:%x\n",
246	    get_status_string(cpl->status.sct, cpl->status.sc),
247	    cpl->status.sct, cpl->status.sc, cpl->sqid, cpl->cid, cpl->cdw0);
248}
249
250static boolean_t
251nvme_completion_is_retry(const struct nvme_completion *cpl)
252{
253	/*
254	 * TODO: spec is not clear how commands that are aborted due
255	 *  to TLER will be marked.  So for now, it seems
256	 *  NAMESPACE_NOT_READY is the only case where we should
257	 *  look at the DNR bit.
258	 */
259	switch (cpl->status.sct) {
260	case NVME_SCT_GENERIC:
261		switch (cpl->status.sc) {
262		case NVME_SC_ABORTED_BY_REQUEST:
263		case NVME_SC_NAMESPACE_NOT_READY:
264			if (cpl->status.dnr)
265				return (0);
266			else
267				return (1);
268		case NVME_SC_INVALID_OPCODE:
269		case NVME_SC_INVALID_FIELD:
270		case NVME_SC_COMMAND_ID_CONFLICT:
271		case NVME_SC_DATA_TRANSFER_ERROR:
272		case NVME_SC_ABORTED_POWER_LOSS:
273		case NVME_SC_INTERNAL_DEVICE_ERROR:
274		case NVME_SC_ABORTED_SQ_DELETION:
275		case NVME_SC_ABORTED_FAILED_FUSED:
276		case NVME_SC_ABORTED_MISSING_FUSED:
277		case NVME_SC_INVALID_NAMESPACE_OR_FORMAT:
278		case NVME_SC_COMMAND_SEQUENCE_ERROR:
279		case NVME_SC_LBA_OUT_OF_RANGE:
280		case NVME_SC_CAPACITY_EXCEEDED:
281		default:
282			return (0);
283		}
284	case NVME_SCT_COMMAND_SPECIFIC:
285	case NVME_SCT_MEDIA_ERROR:
286	case NVME_SCT_VENDOR_SPECIFIC:
287	default:
288		return (0);
289	}
290}
291
292static void
293nvme_qpair_construct_tracker(struct nvme_qpair *qpair, struct nvme_tracker *tr,
294    uint16_t cid)
295{
296
297	bus_dmamap_create(qpair->dma_tag, 0, &tr->payload_dma_map);
298	bus_dmamap_create(qpair->dma_tag, 0, &tr->prp_dma_map);
299
300	bus_dmamap_load(qpair->dma_tag, tr->prp_dma_map, tr->prp,
301	    sizeof(tr->prp), nvme_single_map, &tr->prp_bus_addr, 0);
302
303	callout_init(&tr->timer, 1);
304	tr->cid = cid;
305	tr->qpair = qpair;
306}
307
308static void
309nvme_qpair_complete_tracker(struct nvme_qpair *qpair, struct nvme_tracker *tr,
310    struct nvme_completion *cpl, boolean_t print_on_error)
311{
312	struct nvme_request	*req;
313	boolean_t		retry, error;
314
315	req = tr->req;
316	error = nvme_completion_is_error(cpl);
317	retry = error && nvme_completion_is_retry(cpl) &&
318	   req->retries < nvme_retry_count;
319
320	if (error && print_on_error) {
321		nvme_qpair_print_command(qpair, &req->cmd);
322		nvme_qpair_print_completion(qpair, cpl);
323	}
324
325	qpair->act_tr[cpl->cid] = NULL;
326
327	KASSERT(cpl->cid == req->cmd.cid, ("cpl cid does not match cmd cid\n"));
328
329	if (req->cb_fn && !retry)
330		req->cb_fn(req->cb_arg, cpl);
331
332	mtx_lock(&qpair->lock);
333	callout_stop(&tr->timer);
334
335	if (retry) {
336		req->retries++;
337		nvme_qpair_submit_tracker(qpair, tr);
338	} else {
339		if (req->type != NVME_REQUEST_NULL)
340			bus_dmamap_unload(qpair->dma_tag,
341			    tr->payload_dma_map);
342
343		nvme_free_request(req);
344		tr->req = NULL;
345
346		TAILQ_REMOVE(&qpair->outstanding_tr, tr, tailq);
347		TAILQ_INSERT_HEAD(&qpair->free_tr, tr, tailq);
348
349		/*
350		 * If the controller is in the middle of resetting, don't
351		 *  try to submit queued requests here - let the reset logic
352		 *  handle that instead.
353		 */
354		if (!STAILQ_EMPTY(&qpair->queued_req) &&
355		    !qpair->ctrlr->is_resetting) {
356			req = STAILQ_FIRST(&qpair->queued_req);
357			STAILQ_REMOVE_HEAD(&qpair->queued_req, stailq);
358			_nvme_qpair_submit_request(qpair, req);
359		}
360	}
361
362	mtx_unlock(&qpair->lock);
363}
364
365static void
366nvme_qpair_manual_complete_tracker(struct nvme_qpair *qpair,
367    struct nvme_tracker *tr, uint32_t sct, uint32_t sc, uint32_t dnr,
368    boolean_t print_on_error)
369{
370	struct nvme_completion	cpl;
371
372	memset(&cpl, 0, sizeof(cpl));
373	cpl.sqid = qpair->id;
374	cpl.cid = tr->cid;
375	cpl.status.sct = sct;
376	cpl.status.sc = sc;
377	cpl.status.dnr = dnr;
378	nvme_qpair_complete_tracker(qpair, tr, &cpl, print_on_error);
379}
380
381void
382nvme_qpair_manual_complete_request(struct nvme_qpair *qpair,
383    struct nvme_request *req, uint32_t sct, uint32_t sc,
384    boolean_t print_on_error)
385{
386	struct nvme_completion	cpl;
387	boolean_t		error;
388
389	memset(&cpl, 0, sizeof(cpl));
390	cpl.sqid = qpair->id;
391	cpl.status.sct = sct;
392	cpl.status.sc = sc;
393
394	error = nvme_completion_is_error(&cpl);
395
396	if (error && print_on_error) {
397		nvme_qpair_print_command(qpair, &req->cmd);
398		nvme_qpair_print_completion(qpair, &cpl);
399	}
400
401	if (req->cb_fn)
402		req->cb_fn(req->cb_arg, &cpl);
403
404	nvme_free_request(req);
405}
406
407void
408nvme_qpair_process_completions(struct nvme_qpair *qpair)
409{
410	struct nvme_tracker	*tr;
411	struct nvme_completion	*cpl;
412
413	qpair->num_intr_handler_calls++;
414
415	if (!qpair->is_enabled)
416		/*
417		 * qpair is not enabled, likely because a controller reset is
418		 *  is in progress.  Ignore the interrupt - any I/O that was
419		 *  associated with this interrupt will get retried when the
420		 *  reset is complete.
421		 */
422		return;
423
424	while (1) {
425		cpl = &qpair->cpl[qpair->cq_head];
426
427		if (cpl->status.p != qpair->phase)
428			break;
429
430		tr = qpair->act_tr[cpl->cid];
431
432		if (tr != NULL) {
433			nvme_qpair_complete_tracker(qpair, tr, cpl, TRUE);
434			qpair->sq_head = cpl->sqhd;
435		} else {
436			nvme_printf(qpair->ctrlr,
437			    "cpl does not map to outstanding cmd\n");
438			nvme_dump_completion(cpl);
439			KASSERT(0, ("received completion for unknown cmd\n"));
440		}
441
442		if (++qpair->cq_head == qpair->num_entries) {
443			qpair->cq_head = 0;
444			qpair->phase = !qpair->phase;
445		}
446
447		nvme_mmio_write_4(qpair->ctrlr, doorbell[qpair->id].cq_hdbl,
448		    qpair->cq_head);
449	}
450}
451
452static void
453nvme_qpair_msix_handler(void *arg)
454{
455	struct nvme_qpair *qpair = arg;
456
457	nvme_qpair_process_completions(qpair);
458}
459
460void
461nvme_qpair_construct(struct nvme_qpair *qpair, uint32_t id,
462    uint16_t vector, uint32_t num_entries, uint32_t num_trackers,
463    struct nvme_controller *ctrlr)
464{
465	struct nvme_tracker	*tr;
466	uint32_t		i;
467
468	qpair->id = id;
469	qpair->vector = vector;
470	qpair->num_entries = num_entries;
471#ifdef CHATHAM2
472	/*
473	 * Chatham prototype board starts having issues at higher queue
474	 *  depths.  So use a conservative estimate here of no more than 64
475	 *  outstanding I/O per queue at any one point.
476	 */
477	if (pci_get_devid(ctrlr->dev) == CHATHAM_PCI_ID)
478		num_trackers = min(num_trackers, 64);
479#endif
480	qpair->num_trackers = num_trackers;
481	qpair->ctrlr = ctrlr;
482
483	if (ctrlr->msix_enabled) {
484
485		/*
486		 * MSI-X vector resource IDs start at 1, so we add one to
487		 *  the queue's vector to get the corresponding rid to use.
488		 */
489		qpair->rid = vector + 1;
490
491		qpair->res = bus_alloc_resource_any(ctrlr->dev, SYS_RES_IRQ,
492		    &qpair->rid, RF_ACTIVE);
493
494		bus_setup_intr(ctrlr->dev, qpair->res,
495		    INTR_TYPE_MISC | INTR_MPSAFE, NULL,
496		    nvme_qpair_msix_handler, qpair, &qpair->tag);
497	}
498
499	mtx_init(&qpair->lock, "nvme qpair lock", NULL, MTX_DEF);
500
501	bus_dma_tag_create(bus_get_dma_tag(ctrlr->dev),
502	    sizeof(uint64_t), PAGE_SIZE, BUS_SPACE_MAXADDR,
503	    BUS_SPACE_MAXADDR, NULL, NULL, NVME_MAX_XFER_SIZE,
504	    (NVME_MAX_XFER_SIZE/PAGE_SIZE)+1, PAGE_SIZE, 0,
505	    NULL, NULL, &qpair->dma_tag);
506
507	qpair->num_cmds = 0;
508	qpair->num_intr_handler_calls = 0;
509
510	qpair->cmd = contigmalloc(qpair->num_entries *
511	    sizeof(struct nvme_command), M_NVME, M_ZERO,
512	    0, BUS_SPACE_MAXADDR, PAGE_SIZE, 0);
513	qpair->cpl = contigmalloc(qpair->num_entries *
514	    sizeof(struct nvme_completion), M_NVME, M_ZERO,
515	    0, BUS_SPACE_MAXADDR, PAGE_SIZE, 0);
516
517	bus_dmamap_create(qpair->dma_tag, 0, &qpair->cmd_dma_map);
518	bus_dmamap_create(qpair->dma_tag, 0, &qpair->cpl_dma_map);
519
520	bus_dmamap_load(qpair->dma_tag, qpair->cmd_dma_map,
521	    qpair->cmd, qpair->num_entries * sizeof(struct nvme_command),
522	    nvme_single_map, &qpair->cmd_bus_addr, 0);
523	bus_dmamap_load(qpair->dma_tag, qpair->cpl_dma_map,
524	    qpair->cpl, qpair->num_entries * sizeof(struct nvme_completion),
525	    nvme_single_map, &qpair->cpl_bus_addr, 0);
526
527	qpair->sq_tdbl_off = nvme_mmio_offsetof(doorbell[id].sq_tdbl);
528	qpair->cq_hdbl_off = nvme_mmio_offsetof(doorbell[id].cq_hdbl);
529
530	TAILQ_INIT(&qpair->free_tr);
531	TAILQ_INIT(&qpair->outstanding_tr);
532	STAILQ_INIT(&qpair->queued_req);
533
534	for (i = 0; i < qpair->num_trackers; i++) {
535		tr = malloc(sizeof(*tr), M_NVME, M_ZERO | M_WAITOK);
536		nvme_qpair_construct_tracker(qpair, tr, i);
537		TAILQ_INSERT_HEAD(&qpair->free_tr, tr, tailq);
538	}
539
540	qpair->act_tr = malloc(sizeof(struct nvme_tracker *) * qpair->num_entries,
541	    M_NVME, M_ZERO | M_WAITOK);
542}
543
544static void
545nvme_qpair_destroy(struct nvme_qpair *qpair)
546{
547	struct nvme_tracker	*tr;
548
549	if (qpair->tag)
550		bus_teardown_intr(qpair->ctrlr->dev, qpair->res, qpair->tag);
551
552	if (qpair->res)
553		bus_release_resource(qpair->ctrlr->dev, SYS_RES_IRQ,
554		    rman_get_rid(qpair->res), qpair->res);
555
556	if (qpair->cmd) {
557		bus_dmamap_unload(qpair->dma_tag, qpair->cmd_dma_map);
558		bus_dmamap_destroy(qpair->dma_tag, qpair->cmd_dma_map);
559		contigfree(qpair->cmd,
560		    qpair->num_entries * sizeof(struct nvme_command), M_NVME);
561	}
562
563	if (qpair->cpl) {
564		bus_dmamap_unload(qpair->dma_tag, qpair->cpl_dma_map);
565		bus_dmamap_destroy(qpair->dma_tag, qpair->cpl_dma_map);
566		contigfree(qpair->cpl,
567		    qpair->num_entries * sizeof(struct nvme_completion),
568		    M_NVME);
569	}
570
571	if (qpair->dma_tag)
572		bus_dma_tag_destroy(qpair->dma_tag);
573
574	if (qpair->act_tr)
575		free(qpair->act_tr, M_NVME);
576
577	while (!TAILQ_EMPTY(&qpair->free_tr)) {
578		tr = TAILQ_FIRST(&qpair->free_tr);
579		TAILQ_REMOVE(&qpair->free_tr, tr, tailq);
580		bus_dmamap_destroy(qpair->dma_tag, tr->payload_dma_map);
581		bus_dmamap_destroy(qpair->dma_tag, tr->prp_dma_map);
582		free(tr, M_NVME);
583	}
584}
585
586static void
587nvme_admin_qpair_abort_aers(struct nvme_qpair *qpair)
588{
589	struct nvme_tracker	*tr;
590
591	tr = TAILQ_FIRST(&qpair->outstanding_tr);
592	while (tr != NULL) {
593		if (tr->req->cmd.opc == NVME_OPC_ASYNC_EVENT_REQUEST) {
594			nvme_qpair_manual_complete_tracker(qpair, tr,
595			    NVME_SCT_GENERIC, NVME_SC_ABORTED_SQ_DELETION, 0,
596			    FALSE);
597			tr = TAILQ_FIRST(&qpair->outstanding_tr);
598		} else {
599			tr = TAILQ_NEXT(tr, tailq);
600		}
601	}
602}
603
604void
605nvme_admin_qpair_destroy(struct nvme_qpair *qpair)
606{
607
608	nvme_admin_qpair_abort_aers(qpair);
609	nvme_qpair_destroy(qpair);
610}
611
612void
613nvme_io_qpair_destroy(struct nvme_qpair *qpair)
614{
615
616	nvme_qpair_destroy(qpair);
617}
618
619static void
620nvme_abort_complete(void *arg, const struct nvme_completion *status)
621{
622	struct nvme_tracker	*tr = arg;
623
624	/*
625	 * If cdw0 == 1, the controller was not able to abort the command
626	 *  we requested.  We still need to check the active tracker array,
627	 *  to cover race where I/O timed out at same time controller was
628	 *  completing the I/O.
629	 */
630	if (status->cdw0 == 1 && tr->qpair->act_tr[tr->cid] != NULL) {
631		/*
632		 * An I/O has timed out, and the controller was unable to
633		 *  abort it for some reason.  Construct a fake completion
634		 *  status, and then complete the I/O's tracker manually.
635		 */
636		nvme_printf(tr->qpair->ctrlr,
637		    "abort command failed, aborting command manually\n");
638		nvme_qpair_manual_complete_tracker(tr->qpair, tr,
639		    NVME_SCT_GENERIC, NVME_SC_ABORTED_BY_REQUEST, 0, TRUE);
640	}
641}
642
643static void
644nvme_timeout(void *arg)
645{
646	struct nvme_tracker	*tr = arg;
647	struct nvme_qpair	*qpair = tr->qpair;
648	struct nvme_controller	*ctrlr = qpair->ctrlr;
649	union csts_register	csts;
650
651	/* Read csts to get value of cfs - controller fatal status. */
652	csts.raw = nvme_mmio_read_4(ctrlr, csts);
653
654	if (ctrlr->enable_aborts && csts.bits.cfs == 0) {
655		/*
656		 * If aborts are enabled, only use them if the controller is
657		 *  not reporting fatal status.
658		 */
659		nvme_ctrlr_cmd_abort(ctrlr, tr->cid, qpair->id,
660		    nvme_abort_complete, tr);
661	} else
662		nvme_ctrlr_reset(ctrlr);
663}
664
665void
666nvme_qpair_submit_tracker(struct nvme_qpair *qpair, struct nvme_tracker *tr)
667{
668	struct nvme_request	*req;
669	struct nvme_controller	*ctrlr;
670
671	mtx_assert(&qpair->lock, MA_OWNED);
672
673	req = tr->req;
674	req->cmd.cid = tr->cid;
675	qpair->act_tr[tr->cid] = tr;
676	ctrlr = qpair->ctrlr;
677
678	if (req->timeout)
679#if __FreeBSD_version >= 800030
680		callout_reset_curcpu(&tr->timer, ctrlr->timeout_period * hz,
681		    nvme_timeout, tr);
682#else
683		callout_reset(&tr->timer, ctrlr->timeout_period * hz,
684		    nvme_timeout, tr);
685#endif
686
687	/* Copy the command from the tracker to the submission queue. */
688	memcpy(&qpair->cmd[qpair->sq_tail], &req->cmd, sizeof(req->cmd));
689
690	if (++qpair->sq_tail == qpair->num_entries)
691		qpair->sq_tail = 0;
692
693	wmb();
694	nvme_mmio_write_4(qpair->ctrlr, doorbell[qpair->id].sq_tdbl,
695	    qpair->sq_tail);
696
697	qpair->num_cmds++;
698}
699
700static void
701nvme_payload_map(void *arg, bus_dma_segment_t *seg, int nseg, int error)
702{
703	struct nvme_tracker 	*tr = arg;
704	uint32_t		cur_nseg;
705
706	/*
707	 * If the mapping operation failed, return immediately.  The caller
708	 *  is responsible for detecting the error status and failing the
709	 *  tracker manually.
710	 */
711	if (error != 0)
712		return;
713
714	/*
715	 * Note that we specified PAGE_SIZE for alignment and max
716	 *  segment size when creating the bus dma tags.  So here
717	 *  we can safely just transfer each segment to its
718	 *  associated PRP entry.
719	 */
720	tr->req->cmd.prp1 = seg[0].ds_addr;
721
722	if (nseg == 2) {
723		tr->req->cmd.prp2 = seg[1].ds_addr;
724	} else if (nseg > 2) {
725		cur_nseg = 1;
726		tr->req->cmd.prp2 = (uint64_t)tr->prp_bus_addr;
727		while (cur_nseg < nseg) {
728			tr->prp[cur_nseg-1] =
729			    (uint64_t)seg[cur_nseg].ds_addr;
730			cur_nseg++;
731		}
732	}
733
734	nvme_qpair_submit_tracker(tr->qpair, tr);
735}
736
737static void
738nvme_payload_map_uio(void *arg, bus_dma_segment_t *seg, int nseg,
739    bus_size_t mapsize, int error)
740{
741
742	nvme_payload_map(arg, seg, nseg, error);
743}
744
745static void
746_nvme_qpair_submit_request(struct nvme_qpair *qpair, struct nvme_request *req)
747{
748	struct nvme_tracker	*tr;
749	int			err = 0;
750
751	mtx_assert(&qpair->lock, MA_OWNED);
752
753	tr = TAILQ_FIRST(&qpair->free_tr);
754	req->qpair = qpair;
755
756	if (tr == NULL || !qpair->is_enabled) {
757		/*
758		 * No tracker is available, or the qpair is disabled due to
759		 *  an in-progress controller-level reset or controller
760		 *  failure.
761		 */
762
763		if (qpair->ctrlr->is_failed) {
764			/*
765			 * The controller has failed.  Post the request to a
766			 *  task where it will be aborted, so that we do not
767			 *  invoke the request's callback in the context
768			 *  of the submission.
769			 */
770			nvme_ctrlr_post_failed_request(qpair->ctrlr, req);
771		} else {
772			/*
773			 * Put the request on the qpair's request queue to be
774			 *  processed when a tracker frees up via a command
775			 *  completion or when the controller reset is
776			 *  completed.
777			 */
778			STAILQ_INSERT_TAIL(&qpair->queued_req, req, stailq);
779		}
780		return;
781	}
782
783	TAILQ_REMOVE(&qpair->free_tr, tr, tailq);
784	TAILQ_INSERT_TAIL(&qpair->outstanding_tr, tr, tailq);
785	tr->req = req;
786
787	switch (req->type) {
788	case NVME_REQUEST_VADDR:
789		err = bus_dmamap_load(tr->qpair->dma_tag, tr->payload_dma_map,
790		    req->u.payload, req->payload_size, nvme_payload_map, tr, 0);
791		if (err != 0)
792			nvme_printf(qpair->ctrlr,
793			    "bus_dmamap_load returned 0x%x!\n", err);
794		break;
795	case NVME_REQUEST_NULL:
796		nvme_qpair_submit_tracker(tr->qpair, tr);
797		break;
798	case NVME_REQUEST_UIO:
799		err = bus_dmamap_load_uio(tr->qpair->dma_tag,
800		    tr->payload_dma_map, req->u.uio, nvme_payload_map_uio,
801		    tr, 0);
802		if (err != 0)
803			nvme_printf(qpair->ctrlr,
804			    "bus_dmamap_load_uio returned 0x%x!\n", err);
805		break;
806#ifdef NVME_UNMAPPED_BIO_SUPPORT
807	case NVME_REQUEST_BIO:
808		err = bus_dmamap_load_bio(tr->qpair->dma_tag,
809		    tr->payload_dma_map, req->u.bio, nvme_payload_map, tr, 0);
810		if (err != 0)
811			nvme_printf(qpair->ctrlr,
812			    "bus_dmamap_load_bio returned 0x%x!\n", err);
813		break;
814#endif
815	default:
816		panic("unknown nvme request type 0x%x\n", req->type);
817		break;
818	}
819
820	if (err != 0) {
821		/*
822		 * The dmamap operation failed, so we manually fail the
823		 *  tracker here with DATA_TRANSFER_ERROR status.
824		 *
825		 * nvme_qpair_manual_complete_tracker must not be called
826		 *  with the qpair lock held.
827		 */
828		mtx_unlock(&qpair->lock);
829		nvme_qpair_manual_complete_tracker(qpair, tr, NVME_SCT_GENERIC,
830		    NVME_SC_DATA_TRANSFER_ERROR, 1 /* do not retry */, TRUE);
831		mtx_lock(&qpair->lock);
832	}
833}
834
835void
836nvme_qpair_submit_request(struct nvme_qpair *qpair, struct nvme_request *req)
837{
838
839	mtx_lock(&qpair->lock);
840	_nvme_qpair_submit_request(qpair, req);
841	mtx_unlock(&qpair->lock);
842}
843
844static void
845nvme_qpair_enable(struct nvme_qpair *qpair)
846{
847
848	qpair->is_enabled = TRUE;
849}
850
851void
852nvme_qpair_reset(struct nvme_qpair *qpair)
853{
854
855	qpair->sq_head = qpair->sq_tail = qpair->cq_head = 0;
856
857	/*
858	 * First time through the completion queue, HW will set phase
859	 *  bit on completions to 1.  So set this to 1 here, indicating
860	 *  we're looking for a 1 to know which entries have completed.
861	 *  we'll toggle the bit each time when the completion queue
862	 *  rolls over.
863	 */
864	qpair->phase = 1;
865
866	memset(qpair->cmd, 0,
867	    qpair->num_entries * sizeof(struct nvme_command));
868	memset(qpair->cpl, 0,
869	    qpair->num_entries * sizeof(struct nvme_completion));
870}
871
872void
873nvme_admin_qpair_enable(struct nvme_qpair *qpair)
874{
875	struct nvme_tracker		*tr;
876	struct nvme_tracker		*tr_temp;
877
878	/*
879	 * Manually abort each outstanding admin command.  Do not retry
880	 *  admin commands found here, since they will be left over from
881	 *  a controller reset and its likely the context in which the
882	 *  command was issued no longer applies.
883	 */
884	TAILQ_FOREACH_SAFE(tr, &qpair->outstanding_tr, tailq, tr_temp) {
885		nvme_printf(qpair->ctrlr,
886		    "aborting outstanding admin command\n");
887		nvme_qpair_manual_complete_tracker(qpair, tr, NVME_SCT_GENERIC,
888		    NVME_SC_ABORTED_BY_REQUEST, 1 /* do not retry */, TRUE);
889	}
890
891	nvme_qpair_enable(qpair);
892}
893
894void
895nvme_io_qpair_enable(struct nvme_qpair *qpair)
896{
897	STAILQ_HEAD(, nvme_request)	temp;
898	struct nvme_tracker		*tr;
899	struct nvme_tracker		*tr_temp;
900	struct nvme_request		*req;
901
902	/*
903	 * Manually abort each outstanding I/O.  This normally results in a
904	 *  retry, unless the retry count on the associated request has
905	 *  reached its limit.
906	 */
907	TAILQ_FOREACH_SAFE(tr, &qpair->outstanding_tr, tailq, tr_temp) {
908		nvme_printf(qpair->ctrlr, "aborting outstanding i/o\n");
909		nvme_qpair_manual_complete_tracker(qpair, tr, NVME_SCT_GENERIC,
910		    NVME_SC_ABORTED_BY_REQUEST, 0, TRUE);
911	}
912
913	mtx_lock(&qpair->lock);
914
915	nvme_qpair_enable(qpair);
916
917	STAILQ_INIT(&temp);
918	STAILQ_SWAP(&qpair->queued_req, &temp, nvme_request);
919
920	while (!STAILQ_EMPTY(&temp)) {
921		req = STAILQ_FIRST(&temp);
922		STAILQ_REMOVE_HEAD(&temp, stailq);
923		nvme_printf(qpair->ctrlr, "resubmitting queued i/o\n");
924		nvme_qpair_print_command(qpair, &req->cmd);
925		_nvme_qpair_submit_request(qpair, req);
926	}
927
928	mtx_unlock(&qpair->lock);
929}
930
931static void
932nvme_qpair_disable(struct nvme_qpair *qpair)
933{
934	struct nvme_tracker *tr;
935
936	qpair->is_enabled = FALSE;
937	mtx_lock(&qpair->lock);
938	TAILQ_FOREACH(tr, &qpair->outstanding_tr, tailq)
939		callout_stop(&tr->timer);
940	mtx_unlock(&qpair->lock);
941}
942
943void
944nvme_admin_qpair_disable(struct nvme_qpair *qpair)
945{
946
947	nvme_qpair_disable(qpair);
948	nvme_admin_qpair_abort_aers(qpair);
949}
950
951void
952nvme_io_qpair_disable(struct nvme_qpair *qpair)
953{
954
955	nvme_qpair_disable(qpair);
956}
957
958void
959nvme_qpair_fail(struct nvme_qpair *qpair)
960{
961	struct nvme_tracker		*tr;
962	struct nvme_request		*req;
963
964	mtx_lock(&qpair->lock);
965
966	while (!STAILQ_EMPTY(&qpair->queued_req)) {
967		req = STAILQ_FIRST(&qpair->queued_req);
968		STAILQ_REMOVE_HEAD(&qpair->queued_req, stailq);
969		nvme_printf(qpair->ctrlr, "failing queued i/o\n");
970		mtx_unlock(&qpair->lock);
971		nvme_qpair_manual_complete_request(qpair, req, NVME_SCT_GENERIC,
972		    NVME_SC_ABORTED_BY_REQUEST, TRUE);
973		mtx_lock(&qpair->lock);
974	}
975
976	/* Manually abort each outstanding I/O. */
977	while (!TAILQ_EMPTY(&qpair->outstanding_tr)) {
978		tr = TAILQ_FIRST(&qpair->outstanding_tr);
979		/*
980		 * Do not remove the tracker.  The abort_tracker path will
981		 *  do that for us.
982		 */
983		nvme_printf(qpair->ctrlr, "failing outstanding i/o\n");
984		mtx_unlock(&qpair->lock);
985		nvme_qpair_manual_complete_tracker(qpair, tr, NVME_SCT_GENERIC,
986		    NVME_SC_ABORTED_BY_REQUEST, 1 /* do not retry */, TRUE);
987		mtx_lock(&qpair->lock);
988	}
989
990	mtx_unlock(&qpair->lock);
991}
992
993