nvme.c revision 1.51 1 1.51 ryo /* $NetBSD: nvme.c,v 1.51 2020/09/24 09:59:11 ryo Exp $ */
2 1.1 nonaka /* $OpenBSD: nvme.c,v 1.49 2016/04/18 05:59:50 dlg Exp $ */
3 1.1 nonaka
4 1.1 nonaka /*
5 1.1 nonaka * Copyright (c) 2014 David Gwynne <dlg (at) openbsd.org>
6 1.1 nonaka *
7 1.1 nonaka * Permission to use, copy, modify, and distribute this software for any
8 1.1 nonaka * purpose with or without fee is hereby granted, provided that the above
9 1.1 nonaka * copyright notice and this permission notice appear in all copies.
10 1.1 nonaka *
11 1.1 nonaka * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12 1.1 nonaka * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13 1.1 nonaka * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14 1.1 nonaka * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15 1.1 nonaka * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16 1.1 nonaka * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17 1.1 nonaka * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 1.1 nonaka */
19 1.1 nonaka
20 1.1 nonaka #include <sys/cdefs.h>
21 1.51 ryo __KERNEL_RCSID(0, "$NetBSD: nvme.c,v 1.51 2020/09/24 09:59:11 ryo Exp $");
22 1.1 nonaka
23 1.1 nonaka #include <sys/param.h>
24 1.1 nonaka #include <sys/systm.h>
25 1.1 nonaka #include <sys/kernel.h>
26 1.1 nonaka #include <sys/atomic.h>
27 1.1 nonaka #include <sys/bus.h>
28 1.1 nonaka #include <sys/buf.h>
29 1.3 nonaka #include <sys/conf.h>
30 1.1 nonaka #include <sys/device.h>
31 1.1 nonaka #include <sys/kmem.h>
32 1.1 nonaka #include <sys/once.h>
33 1.3 nonaka #include <sys/proc.h>
34 1.1 nonaka #include <sys/queue.h>
35 1.1 nonaka #include <sys/mutex.h>
36 1.1 nonaka
37 1.3 nonaka #include <uvm/uvm_extern.h>
38 1.3 nonaka
39 1.1 nonaka #include <dev/ic/nvmereg.h>
40 1.1 nonaka #include <dev/ic/nvmevar.h>
41 1.3 nonaka #include <dev/ic/nvmeio.h>
42 1.1 nonaka
43 1.31 riastrad #include "ioconf.h"
44 1.31 riastrad
45 1.38 nonaka #define B4_CHK_RDY_DELAY_MS 2300 /* workaround controller bug */
46 1.38 nonaka
47 1.22 jdolecek int nvme_adminq_size = 32;
48 1.9 jdolecek int nvme_ioq_size = 1024;
49 1.1 nonaka
50 1.1 nonaka static int nvme_print(void *, const char *);
51 1.1 nonaka
52 1.1 nonaka static int nvme_ready(struct nvme_softc *, uint32_t);
53 1.1 nonaka static int nvme_enable(struct nvme_softc *, u_int);
54 1.1 nonaka static int nvme_disable(struct nvme_softc *);
55 1.1 nonaka static int nvme_shutdown(struct nvme_softc *);
56 1.1 nonaka
57 1.1 nonaka #ifdef NVME_DEBUG
58 1.1 nonaka static void nvme_dumpregs(struct nvme_softc *);
59 1.1 nonaka #endif
60 1.1 nonaka static int nvme_identify(struct nvme_softc *, u_int);
61 1.1 nonaka static void nvme_fill_identify(struct nvme_queue *, struct nvme_ccb *,
62 1.1 nonaka void *);
63 1.1 nonaka
64 1.20 jdolecek static int nvme_ccbs_alloc(struct nvme_queue *, uint16_t);
65 1.1 nonaka static void nvme_ccbs_free(struct nvme_queue *);
66 1.1 nonaka
67 1.1 nonaka static struct nvme_ccb *
68 1.34 jdolecek nvme_ccb_get(struct nvme_queue *, bool);
69 1.1 nonaka static void nvme_ccb_put(struct nvme_queue *, struct nvme_ccb *);
70 1.1 nonaka
71 1.1 nonaka static int nvme_poll(struct nvme_softc *, struct nvme_queue *,
72 1.1 nonaka struct nvme_ccb *, void (*)(struct nvme_queue *,
73 1.7 jdolecek struct nvme_ccb *, void *), int);
74 1.1 nonaka static void nvme_poll_fill(struct nvme_queue *, struct nvme_ccb *, void *);
75 1.1 nonaka static void nvme_poll_done(struct nvme_queue *, struct nvme_ccb *,
76 1.1 nonaka struct nvme_cqe *);
77 1.1 nonaka static void nvme_sqe_fill(struct nvme_queue *, struct nvme_ccb *, void *);
78 1.1 nonaka static void nvme_empty_done(struct nvme_queue *, struct nvme_ccb *,
79 1.1 nonaka struct nvme_cqe *);
80 1.1 nonaka
81 1.1 nonaka static struct nvme_queue *
82 1.1 nonaka nvme_q_alloc(struct nvme_softc *, uint16_t, u_int, u_int);
83 1.1 nonaka static int nvme_q_create(struct nvme_softc *, struct nvme_queue *);
84 1.1 nonaka static int nvme_q_delete(struct nvme_softc *, struct nvme_queue *);
85 1.1 nonaka static void nvme_q_submit(struct nvme_softc *, struct nvme_queue *,
86 1.1 nonaka struct nvme_ccb *, void (*)(struct nvme_queue *,
87 1.1 nonaka struct nvme_ccb *, void *));
88 1.1 nonaka static int nvme_q_complete(struct nvme_softc *, struct nvme_queue *q);
89 1.1 nonaka static void nvme_q_free(struct nvme_softc *, struct nvme_queue *);
90 1.34 jdolecek static void nvme_q_wait_complete(struct nvme_softc *, struct nvme_queue *,
91 1.34 jdolecek bool (*)(void *), void *);
92 1.1 nonaka
93 1.19 jdolecek static struct nvme_dmamem *
94 1.19 jdolecek nvme_dmamem_alloc(struct nvme_softc *, size_t);
95 1.1 nonaka static void nvme_dmamem_free(struct nvme_softc *, struct nvme_dmamem *);
96 1.19 jdolecek static void nvme_dmamem_sync(struct nvme_softc *, struct nvme_dmamem *,
97 1.19 jdolecek int);
98 1.1 nonaka
99 1.1 nonaka static void nvme_ns_io_fill(struct nvme_queue *, struct nvme_ccb *,
100 1.1 nonaka void *);
101 1.1 nonaka static void nvme_ns_io_done(struct nvme_queue *, struct nvme_ccb *,
102 1.1 nonaka struct nvme_cqe *);
103 1.1 nonaka static void nvme_ns_sync_fill(struct nvme_queue *, struct nvme_ccb *,
104 1.1 nonaka void *);
105 1.1 nonaka static void nvme_ns_sync_done(struct nvme_queue *, struct nvme_ccb *,
106 1.1 nonaka struct nvme_cqe *);
107 1.25 jdolecek static void nvme_getcache_fill(struct nvme_queue *, struct nvme_ccb *,
108 1.25 jdolecek void *);
109 1.25 jdolecek static void nvme_getcache_done(struct nvme_queue *, struct nvme_ccb *,
110 1.25 jdolecek struct nvme_cqe *);
111 1.1 nonaka
112 1.3 nonaka static void nvme_pt_fill(struct nvme_queue *, struct nvme_ccb *,
113 1.3 nonaka void *);
114 1.3 nonaka static void nvme_pt_done(struct nvme_queue *, struct nvme_ccb *,
115 1.3 nonaka struct nvme_cqe *);
116 1.3 nonaka static int nvme_command_passthrough(struct nvme_softc *,
117 1.3 nonaka struct nvme_pt_command *, uint16_t, struct lwp *, bool);
118 1.3 nonaka
119 1.47 nonaka static int nvme_set_number_of_queues(struct nvme_softc *, u_int, u_int *,
120 1.47 nonaka u_int *);
121 1.23 nonaka
122 1.7 jdolecek #define NVME_TIMO_QOP 5 /* queue create and delete timeout */
123 1.7 jdolecek #define NVME_TIMO_IDENT 10 /* probe identify timeout */
124 1.7 jdolecek #define NVME_TIMO_PT -1 /* passthrough cmd timeout */
125 1.13 jdolecek #define NVME_TIMO_SY 60 /* sync cache timeout */
126 1.7 jdolecek
127 1.1 nonaka #define nvme_read4(_s, _r) \
128 1.1 nonaka bus_space_read_4((_s)->sc_iot, (_s)->sc_ioh, (_r))
129 1.1 nonaka #define nvme_write4(_s, _r, _v) \
130 1.1 nonaka bus_space_write_4((_s)->sc_iot, (_s)->sc_ioh, (_r), (_v))
131 1.28 nonaka /*
132 1.28 nonaka * Some controllers, at least Apple NVMe, always require split
133 1.28 nonaka * transfers, so don't use bus_space_{read,write}_8() on LP64.
134 1.28 nonaka */
135 1.1 nonaka static inline uint64_t
136 1.1 nonaka nvme_read8(struct nvme_softc *sc, bus_size_t r)
137 1.1 nonaka {
138 1.1 nonaka uint64_t v;
139 1.1 nonaka uint32_t *a = (uint32_t *)&v;
140 1.1 nonaka
141 1.1 nonaka #if _BYTE_ORDER == _LITTLE_ENDIAN
142 1.1 nonaka a[0] = nvme_read4(sc, r);
143 1.1 nonaka a[1] = nvme_read4(sc, r + 4);
144 1.1 nonaka #else /* _BYTE_ORDER == _LITTLE_ENDIAN */
145 1.1 nonaka a[1] = nvme_read4(sc, r);
146 1.1 nonaka a[0] = nvme_read4(sc, r + 4);
147 1.1 nonaka #endif
148 1.1 nonaka
149 1.1 nonaka return v;
150 1.1 nonaka }
151 1.1 nonaka
152 1.1 nonaka static inline void
153 1.1 nonaka nvme_write8(struct nvme_softc *sc, bus_size_t r, uint64_t v)
154 1.1 nonaka {
155 1.1 nonaka uint32_t *a = (uint32_t *)&v;
156 1.1 nonaka
157 1.1 nonaka #if _BYTE_ORDER == _LITTLE_ENDIAN
158 1.1 nonaka nvme_write4(sc, r, a[0]);
159 1.1 nonaka nvme_write4(sc, r + 4, a[1]);
160 1.1 nonaka #else /* _BYTE_ORDER == _LITTLE_ENDIAN */
161 1.1 nonaka nvme_write4(sc, r, a[1]);
162 1.1 nonaka nvme_write4(sc, r + 4, a[0]);
163 1.1 nonaka #endif
164 1.1 nonaka }
165 1.1 nonaka #define nvme_barrier(_s, _r, _l, _f) \
166 1.1 nonaka bus_space_barrier((_s)->sc_iot, (_s)->sc_ioh, (_r), (_l), (_f))
167 1.1 nonaka
168 1.1 nonaka #ifdef NVME_DEBUG
169 1.6 jdolecek static __used void
170 1.1 nonaka nvme_dumpregs(struct nvme_softc *sc)
171 1.1 nonaka {
172 1.1 nonaka uint64_t r8;
173 1.1 nonaka uint32_t r4;
174 1.1 nonaka
175 1.1 nonaka #define DEVNAME(_sc) device_xname((_sc)->sc_dev)
176 1.1 nonaka r8 = nvme_read8(sc, NVME_CAP);
177 1.8 jdolecek printf("%s: cap 0x%016"PRIx64"\n", DEVNAME(sc), nvme_read8(sc, NVME_CAP));
178 1.1 nonaka printf("%s: mpsmax %u (%u)\n", DEVNAME(sc),
179 1.1 nonaka (u_int)NVME_CAP_MPSMAX(r8), (1 << NVME_CAP_MPSMAX(r8)));
180 1.1 nonaka printf("%s: mpsmin %u (%u)\n", DEVNAME(sc),
181 1.1 nonaka (u_int)NVME_CAP_MPSMIN(r8), (1 << NVME_CAP_MPSMIN(r8)));
182 1.8 jdolecek printf("%s: css %"PRIu64"\n", DEVNAME(sc), NVME_CAP_CSS(r8));
183 1.8 jdolecek printf("%s: nssrs %"PRIu64"\n", DEVNAME(sc), NVME_CAP_NSSRS(r8));
184 1.8 jdolecek printf("%s: dstrd %"PRIu64"\n", DEVNAME(sc), NVME_CAP_DSTRD(r8));
185 1.8 jdolecek printf("%s: to %"PRIu64" msec\n", DEVNAME(sc), NVME_CAP_TO(r8));
186 1.8 jdolecek printf("%s: ams %"PRIu64"\n", DEVNAME(sc), NVME_CAP_AMS(r8));
187 1.8 jdolecek printf("%s: cqr %"PRIu64"\n", DEVNAME(sc), NVME_CAP_CQR(r8));
188 1.8 jdolecek printf("%s: mqes %"PRIu64"\n", DEVNAME(sc), NVME_CAP_MQES(r8));
189 1.1 nonaka
190 1.1 nonaka printf("%s: vs 0x%04x\n", DEVNAME(sc), nvme_read4(sc, NVME_VS));
191 1.1 nonaka
192 1.1 nonaka r4 = nvme_read4(sc, NVME_CC);
193 1.1 nonaka printf("%s: cc 0x%04x\n", DEVNAME(sc), r4);
194 1.8 jdolecek printf("%s: iocqes %u (%u)\n", DEVNAME(sc), NVME_CC_IOCQES_R(r4),
195 1.8 jdolecek (1 << NVME_CC_IOCQES_R(r4)));
196 1.8 jdolecek printf("%s: iosqes %u (%u)\n", DEVNAME(sc), NVME_CC_IOSQES_R(r4),
197 1.8 jdolecek (1 << NVME_CC_IOSQES_R(r4)));
198 1.1 nonaka printf("%s: shn %u\n", DEVNAME(sc), NVME_CC_SHN_R(r4));
199 1.1 nonaka printf("%s: ams %u\n", DEVNAME(sc), NVME_CC_AMS_R(r4));
200 1.8 jdolecek printf("%s: mps %u (%u)\n", DEVNAME(sc), NVME_CC_MPS_R(r4),
201 1.8 jdolecek (1 << NVME_CC_MPS_R(r4)));
202 1.1 nonaka printf("%s: css %u\n", DEVNAME(sc), NVME_CC_CSS_R(r4));
203 1.6 jdolecek printf("%s: en %u\n", DEVNAME(sc), ISSET(r4, NVME_CC_EN) ? 1 : 0);
204 1.1 nonaka
205 1.8 jdolecek r4 = nvme_read4(sc, NVME_CSTS);
206 1.8 jdolecek printf("%s: csts 0x%08x\n", DEVNAME(sc), r4);
207 1.8 jdolecek printf("%s: rdy %u\n", DEVNAME(sc), r4 & NVME_CSTS_RDY);
208 1.8 jdolecek printf("%s: cfs %u\n", DEVNAME(sc), r4 & NVME_CSTS_CFS);
209 1.8 jdolecek printf("%s: shst %x\n", DEVNAME(sc), r4 & NVME_CSTS_SHST_MASK);
210 1.8 jdolecek
211 1.8 jdolecek r4 = nvme_read4(sc, NVME_AQA);
212 1.8 jdolecek printf("%s: aqa 0x%08x\n", DEVNAME(sc), r4);
213 1.8 jdolecek printf("%s: acqs %u\n", DEVNAME(sc), NVME_AQA_ACQS_R(r4));
214 1.8 jdolecek printf("%s: asqs %u\n", DEVNAME(sc), NVME_AQA_ASQS_R(r4));
215 1.8 jdolecek
216 1.8 jdolecek printf("%s: asq 0x%016"PRIx64"\n", DEVNAME(sc), nvme_read8(sc, NVME_ASQ));
217 1.8 jdolecek printf("%s: acq 0x%016"PRIx64"\n", DEVNAME(sc), nvme_read8(sc, NVME_ACQ));
218 1.1 nonaka #undef DEVNAME
219 1.1 nonaka }
220 1.1 nonaka #endif /* NVME_DEBUG */
221 1.1 nonaka
222 1.1 nonaka static int
223 1.1 nonaka nvme_ready(struct nvme_softc *sc, uint32_t rdy)
224 1.1 nonaka {
225 1.1 nonaka u_int i = 0;
226 1.1 nonaka
227 1.1 nonaka while ((nvme_read4(sc, NVME_CSTS) & NVME_CSTS_RDY) != rdy) {
228 1.1 nonaka if (i++ > sc->sc_rdy_to)
229 1.8 jdolecek return ENXIO;
230 1.1 nonaka
231 1.1 nonaka delay(1000);
232 1.1 nonaka nvme_barrier(sc, NVME_CSTS, 4, BUS_SPACE_BARRIER_READ);
233 1.1 nonaka }
234 1.1 nonaka
235 1.1 nonaka return 0;
236 1.1 nonaka }
237 1.1 nonaka
238 1.1 nonaka static int
239 1.1 nonaka nvme_enable(struct nvme_softc *sc, u_int mps)
240 1.1 nonaka {
241 1.8 jdolecek uint32_t cc, csts;
242 1.38 nonaka int error;
243 1.1 nonaka
244 1.1 nonaka cc = nvme_read4(sc, NVME_CC);
245 1.8 jdolecek csts = nvme_read4(sc, NVME_CSTS);
246 1.38 nonaka
247 1.38 nonaka /*
248 1.38 nonaka * See note in nvme_disable. Short circuit if we're already enabled.
249 1.38 nonaka */
250 1.7 jdolecek if (ISSET(cc, NVME_CC_EN)) {
251 1.8 jdolecek if (ISSET(csts, NVME_CSTS_RDY))
252 1.38 nonaka return 0;
253 1.8 jdolecek
254 1.8 jdolecek goto waitready;
255 1.38 nonaka } else {
256 1.38 nonaka /* EN == 0 already wait for RDY == 0 or fail */
257 1.38 nonaka error = nvme_ready(sc, 0);
258 1.38 nonaka if (error)
259 1.38 nonaka return error;
260 1.7 jdolecek }
261 1.1 nonaka
262 1.1 nonaka nvme_write8(sc, NVME_ASQ, NVME_DMA_DVA(sc->sc_admin_q->q_sq_dmamem));
263 1.1 nonaka nvme_barrier(sc, 0, sc->sc_ios, BUS_SPACE_BARRIER_WRITE);
264 1.8 jdolecek delay(5000);
265 1.1 nonaka nvme_write8(sc, NVME_ACQ, NVME_DMA_DVA(sc->sc_admin_q->q_cq_dmamem));
266 1.1 nonaka nvme_barrier(sc, 0, sc->sc_ios, BUS_SPACE_BARRIER_WRITE);
267 1.8 jdolecek delay(5000);
268 1.8 jdolecek
269 1.8 jdolecek nvme_write4(sc, NVME_AQA, NVME_AQA_ACQS(sc->sc_admin_q->q_entries) |
270 1.8 jdolecek NVME_AQA_ASQS(sc->sc_admin_q->q_entries));
271 1.8 jdolecek nvme_barrier(sc, 0, sc->sc_ios, BUS_SPACE_BARRIER_WRITE);
272 1.8 jdolecek delay(5000);
273 1.1 nonaka
274 1.1 nonaka CLR(cc, NVME_CC_IOCQES_MASK | NVME_CC_IOSQES_MASK | NVME_CC_SHN_MASK |
275 1.1 nonaka NVME_CC_AMS_MASK | NVME_CC_MPS_MASK | NVME_CC_CSS_MASK);
276 1.1 nonaka SET(cc, NVME_CC_IOSQES(ffs(64) - 1) | NVME_CC_IOCQES(ffs(16) - 1));
277 1.1 nonaka SET(cc, NVME_CC_SHN(NVME_CC_SHN_NONE));
278 1.1 nonaka SET(cc, NVME_CC_CSS(NVME_CC_CSS_NVM));
279 1.1 nonaka SET(cc, NVME_CC_AMS(NVME_CC_AMS_RR));
280 1.1 nonaka SET(cc, NVME_CC_MPS(mps));
281 1.1 nonaka SET(cc, NVME_CC_EN);
282 1.1 nonaka
283 1.1 nonaka nvme_write4(sc, NVME_CC, cc);
284 1.1 nonaka nvme_barrier(sc, 0, sc->sc_ios,
285 1.1 nonaka BUS_SPACE_BARRIER_READ | BUS_SPACE_BARRIER_WRITE);
286 1.1 nonaka
287 1.8 jdolecek waitready:
288 1.1 nonaka return nvme_ready(sc, NVME_CSTS_RDY);
289 1.1 nonaka }
290 1.1 nonaka
291 1.1 nonaka static int
292 1.1 nonaka nvme_disable(struct nvme_softc *sc)
293 1.1 nonaka {
294 1.1 nonaka uint32_t cc, csts;
295 1.38 nonaka int error;
296 1.1 nonaka
297 1.1 nonaka cc = nvme_read4(sc, NVME_CC);
298 1.8 jdolecek csts = nvme_read4(sc, NVME_CSTS);
299 1.8 jdolecek
300 1.38 nonaka /*
301 1.38 nonaka * Per 3.1.5 in NVME 1.3 spec, transitioning CC.EN from 0 to 1
302 1.38 nonaka * when CSTS.RDY is 1 or transitioning CC.EN from 1 to 0 when
303 1.38 nonaka * CSTS.RDY is 0 "has undefined results" So make sure that CSTS.RDY
304 1.38 nonaka * isn't the desired value. Short circuit if we're already disabled.
305 1.38 nonaka */
306 1.38 nonaka if (ISSET(cc, NVME_CC_EN)) {
307 1.38 nonaka if (!ISSET(csts, NVME_CSTS_RDY)) {
308 1.38 nonaka /* EN == 1, wait for RDY == 1 or fail */
309 1.38 nonaka error = nvme_ready(sc, NVME_CSTS_RDY);
310 1.38 nonaka if (error)
311 1.38 nonaka return error;
312 1.38 nonaka }
313 1.38 nonaka } else {
314 1.38 nonaka /* EN == 0 already wait for RDY == 0 */
315 1.38 nonaka if (!ISSET(csts, NVME_CSTS_RDY))
316 1.38 nonaka return 0;
317 1.38 nonaka
318 1.38 nonaka goto waitready;
319 1.38 nonaka }
320 1.1 nonaka
321 1.1 nonaka CLR(cc, NVME_CC_EN);
322 1.1 nonaka nvme_write4(sc, NVME_CC, cc);
323 1.8 jdolecek nvme_barrier(sc, 0, sc->sc_ios, BUS_SPACE_BARRIER_READ);
324 1.1 nonaka
325 1.38 nonaka /*
326 1.38 nonaka * Some drives have issues with accessing the mmio after we disable,
327 1.38 nonaka * so delay for a bit after we write the bit to cope with these issues.
328 1.38 nonaka */
329 1.38 nonaka if (ISSET(sc->sc_quirks, NVME_QUIRK_DELAY_B4_CHK_RDY))
330 1.38 nonaka delay(B4_CHK_RDY_DELAY_MS);
331 1.38 nonaka
332 1.38 nonaka waitready:
333 1.1 nonaka return nvme_ready(sc, 0);
334 1.1 nonaka }
335 1.1 nonaka
336 1.1 nonaka int
337 1.1 nonaka nvme_attach(struct nvme_softc *sc)
338 1.1 nonaka {
339 1.1 nonaka uint64_t cap;
340 1.1 nonaka uint32_t reg;
341 1.1 nonaka u_int dstrd;
342 1.1 nonaka u_int mps = PAGE_SHIFT;
343 1.47 nonaka u_int ncq, nsq;
344 1.20 jdolecek uint16_t adminq_entries = nvme_adminq_size;
345 1.20 jdolecek uint16_t ioq_entries = nvme_ioq_size;
346 1.1 nonaka int i;
347 1.1 nonaka
348 1.1 nonaka reg = nvme_read4(sc, NVME_VS);
349 1.1 nonaka if (reg == 0xffffffff) {
350 1.1 nonaka aprint_error_dev(sc->sc_dev, "invalid mapping\n");
351 1.1 nonaka return 1;
352 1.1 nonaka }
353 1.1 nonaka
354 1.27 nonaka if (NVME_VS_TER(reg) == 0)
355 1.27 nonaka aprint_normal_dev(sc->sc_dev, "NVMe %d.%d\n", NVME_VS_MJR(reg),
356 1.27 nonaka NVME_VS_MNR(reg));
357 1.27 nonaka else
358 1.27 nonaka aprint_normal_dev(sc->sc_dev, "NVMe %d.%d.%d\n", NVME_VS_MJR(reg),
359 1.27 nonaka NVME_VS_MNR(reg), NVME_VS_TER(reg));
360 1.1 nonaka
361 1.1 nonaka cap = nvme_read8(sc, NVME_CAP);
362 1.1 nonaka dstrd = NVME_CAP_DSTRD(cap);
363 1.1 nonaka if (NVME_CAP_MPSMIN(cap) > PAGE_SHIFT) {
364 1.1 nonaka aprint_error_dev(sc->sc_dev, "NVMe minimum page size %u "
365 1.1 nonaka "is greater than CPU page size %u\n",
366 1.1 nonaka 1 << NVME_CAP_MPSMIN(cap), 1 << PAGE_SHIFT);
367 1.1 nonaka return 1;
368 1.1 nonaka }
369 1.1 nonaka if (NVME_CAP_MPSMAX(cap) < mps)
370 1.1 nonaka mps = NVME_CAP_MPSMAX(cap);
371 1.15 nonaka if (ioq_entries > NVME_CAP_MQES(cap))
372 1.15 nonaka ioq_entries = NVME_CAP_MQES(cap);
373 1.1 nonaka
374 1.8 jdolecek /* set initial values to be used for admin queue during probe */
375 1.1 nonaka sc->sc_rdy_to = NVME_CAP_TO(cap);
376 1.1 nonaka sc->sc_mps = 1 << mps;
377 1.1 nonaka sc->sc_mdts = MAXPHYS;
378 1.43 mrg sc->sc_max_sgl = btoc(round_page(sc->sc_mdts));
379 1.1 nonaka
380 1.1 nonaka if (nvme_disable(sc) != 0) {
381 1.1 nonaka aprint_error_dev(sc->sc_dev, "unable to disable controller\n");
382 1.1 nonaka return 1;
383 1.1 nonaka }
384 1.1 nonaka
385 1.1 nonaka sc->sc_admin_q = nvme_q_alloc(sc, NVME_ADMIN_Q, adminq_entries, dstrd);
386 1.1 nonaka if (sc->sc_admin_q == NULL) {
387 1.1 nonaka aprint_error_dev(sc->sc_dev,
388 1.1 nonaka "unable to allocate admin queue\n");
389 1.1 nonaka return 1;
390 1.1 nonaka }
391 1.1 nonaka if (sc->sc_intr_establish(sc, NVME_ADMIN_Q, sc->sc_admin_q))
392 1.1 nonaka goto free_admin_q;
393 1.1 nonaka
394 1.1 nonaka if (nvme_enable(sc, mps) != 0) {
395 1.1 nonaka aprint_error_dev(sc->sc_dev, "unable to enable controller\n");
396 1.1 nonaka goto disestablish_admin_q;
397 1.1 nonaka }
398 1.1 nonaka
399 1.1 nonaka if (nvme_identify(sc, NVME_CAP_MPSMIN(cap)) != 0) {
400 1.1 nonaka aprint_error_dev(sc->sc_dev, "unable to identify controller\n");
401 1.1 nonaka goto disable;
402 1.1 nonaka }
403 1.46 nonaka if (sc->sc_nn == 0) {
404 1.46 nonaka aprint_error_dev(sc->sc_dev, "namespace not found\n");
405 1.46 nonaka goto disable;
406 1.46 nonaka }
407 1.1 nonaka
408 1.1 nonaka /* we know how big things are now */
409 1.1 nonaka sc->sc_max_sgl = sc->sc_mdts / sc->sc_mps;
410 1.1 nonaka
411 1.1 nonaka /* reallocate ccbs of admin queue with new max sgl. */
412 1.1 nonaka nvme_ccbs_free(sc->sc_admin_q);
413 1.1 nonaka nvme_ccbs_alloc(sc->sc_admin_q, sc->sc_admin_q->q_entries);
414 1.1 nonaka
415 1.23 nonaka if (sc->sc_use_mq) {
416 1.23 nonaka /* Limit the number of queues to the number allocated in HW */
417 1.47 nonaka if (nvme_set_number_of_queues(sc, sc->sc_nq, &ncq, &nsq) != 0) {
418 1.23 nonaka aprint_error_dev(sc->sc_dev,
419 1.23 nonaka "unable to get number of queues\n");
420 1.23 nonaka goto disable;
421 1.23 nonaka }
422 1.47 nonaka if (sc->sc_nq > ncq)
423 1.47 nonaka sc->sc_nq = ncq;
424 1.47 nonaka if (sc->sc_nq > nsq)
425 1.47 nonaka sc->sc_nq = nsq;
426 1.23 nonaka }
427 1.23 nonaka
428 1.1 nonaka sc->sc_q = kmem_zalloc(sizeof(*sc->sc_q) * sc->sc_nq, KM_SLEEP);
429 1.1 nonaka for (i = 0; i < sc->sc_nq; i++) {
430 1.1 nonaka sc->sc_q[i] = nvme_q_alloc(sc, i + 1, ioq_entries, dstrd);
431 1.1 nonaka if (sc->sc_q[i] == NULL) {
432 1.1 nonaka aprint_error_dev(sc->sc_dev,
433 1.1 nonaka "unable to allocate io queue\n");
434 1.1 nonaka goto free_q;
435 1.1 nonaka }
436 1.1 nonaka if (nvme_q_create(sc, sc->sc_q[i]) != 0) {
437 1.1 nonaka aprint_error_dev(sc->sc_dev,
438 1.1 nonaka "unable to create io queue\n");
439 1.1 nonaka nvme_q_free(sc, sc->sc_q[i]);
440 1.1 nonaka goto free_q;
441 1.1 nonaka }
442 1.1 nonaka }
443 1.1 nonaka
444 1.1 nonaka if (!sc->sc_use_mq)
445 1.1 nonaka nvme_write4(sc, NVME_INTMC, 1);
446 1.1 nonaka
447 1.9 jdolecek /* probe subdevices */
448 1.1 nonaka sc->sc_namespaces = kmem_zalloc(sizeof(*sc->sc_namespaces) * sc->sc_nn,
449 1.1 nonaka KM_SLEEP);
450 1.14 pgoyette nvme_rescan(sc->sc_dev, "nvme", &i);
451 1.1 nonaka
452 1.1 nonaka return 0;
453 1.1 nonaka
454 1.1 nonaka free_q:
455 1.1 nonaka while (--i >= 0) {
456 1.1 nonaka nvme_q_delete(sc, sc->sc_q[i]);
457 1.1 nonaka nvme_q_free(sc, sc->sc_q[i]);
458 1.1 nonaka }
459 1.1 nonaka disable:
460 1.1 nonaka nvme_disable(sc);
461 1.1 nonaka disestablish_admin_q:
462 1.1 nonaka sc->sc_intr_disestablish(sc, NVME_ADMIN_Q);
463 1.1 nonaka free_admin_q:
464 1.1 nonaka nvme_q_free(sc, sc->sc_admin_q);
465 1.1 nonaka
466 1.1 nonaka return 1;
467 1.1 nonaka }
468 1.1 nonaka
469 1.14 pgoyette int
470 1.14 pgoyette nvme_rescan(device_t self, const char *attr, const int *flags)
471 1.14 pgoyette {
472 1.14 pgoyette struct nvme_softc *sc = device_private(self);
473 1.14 pgoyette struct nvme_attach_args naa;
474 1.50 kardel struct nvm_namespace_format *f;
475 1.50 kardel struct nvme_namespace *ns;
476 1.15 nonaka uint64_t cap;
477 1.15 nonaka int ioq_entries = nvme_ioq_size;
478 1.15 nonaka int i;
479 1.50 kardel int error;
480 1.15 nonaka
481 1.15 nonaka cap = nvme_read8(sc, NVME_CAP);
482 1.15 nonaka if (ioq_entries > NVME_CAP_MQES(cap))
483 1.15 nonaka ioq_entries = NVME_CAP_MQES(cap);
484 1.14 pgoyette
485 1.50 kardel for (i = 1; i <= sc->sc_nn; i++) {
486 1.50 kardel if (sc->sc_namespaces[i - 1].dev)
487 1.50 kardel continue;
488 1.50 kardel
489 1.50 kardel /* identify to check for availability */
490 1.50 kardel error = nvme_ns_identify(sc, i);
491 1.50 kardel if (error) {
492 1.50 kardel aprint_error_dev(self, "couldn't identify namespace #%d\n", i);
493 1.50 kardel continue;
494 1.50 kardel }
495 1.50 kardel
496 1.50 kardel ns = nvme_ns_get(sc, i);
497 1.50 kardel KASSERT(ns);
498 1.50 kardel
499 1.50 kardel f = &ns->ident->lbaf[NVME_ID_NS_FLBAS(ns->ident->flbas)];
500 1.50 kardel
501 1.50 kardel /*
502 1.50 kardel * NVME1.0e 6.11 Identify command
503 1.50 kardel *
504 1.50 kardel * LBADS values smaller than 9 are not supported, a value
505 1.50 kardel * of zero means that the format is not used.
506 1.50 kardel */
507 1.50 kardel if (f->lbads < 9) {
508 1.50 kardel if (f->lbads > 0)
509 1.50 kardel aprint_error_dev(self,
510 1.50 kardel "unsupported logical data size %u\n", f->lbads);
511 1.14 pgoyette continue;
512 1.50 kardel }
513 1.50 kardel
514 1.14 pgoyette memset(&naa, 0, sizeof(naa));
515 1.50 kardel naa.naa_nsid = i;
516 1.21 jdolecek naa.naa_qentries = (ioq_entries - 1) * sc->sc_nq;
517 1.21 jdolecek naa.naa_maxphys = sc->sc_mdts;
518 1.42 mlelstv naa.naa_typename = sc->sc_modelname;
519 1.50 kardel sc->sc_namespaces[i - 1].dev = config_found(sc->sc_dev, &naa,
520 1.14 pgoyette nvme_print);
521 1.14 pgoyette }
522 1.14 pgoyette return 0;
523 1.14 pgoyette }
524 1.14 pgoyette
525 1.1 nonaka static int
526 1.1 nonaka nvme_print(void *aux, const char *pnp)
527 1.1 nonaka {
528 1.1 nonaka struct nvme_attach_args *naa = aux;
529 1.1 nonaka
530 1.1 nonaka if (pnp)
531 1.49 jdolecek aprint_normal("ld at %s", pnp);
532 1.1 nonaka
533 1.1 nonaka if (naa->naa_nsid > 0)
534 1.1 nonaka aprint_normal(" nsid %d", naa->naa_nsid);
535 1.1 nonaka
536 1.1 nonaka return UNCONF;
537 1.1 nonaka }
538 1.1 nonaka
539 1.1 nonaka int
540 1.1 nonaka nvme_detach(struct nvme_softc *sc, int flags)
541 1.1 nonaka {
542 1.1 nonaka int i, error;
543 1.1 nonaka
544 1.1 nonaka error = config_detach_children(sc->sc_dev, flags);
545 1.1 nonaka if (error)
546 1.1 nonaka return error;
547 1.1 nonaka
548 1.1 nonaka error = nvme_shutdown(sc);
549 1.1 nonaka if (error)
550 1.1 nonaka return error;
551 1.1 nonaka
552 1.9 jdolecek /* from now on we are committed to detach, following will never fail */
553 1.1 nonaka for (i = 0; i < sc->sc_nq; i++)
554 1.1 nonaka nvme_q_free(sc, sc->sc_q[i]);
555 1.1 nonaka kmem_free(sc->sc_q, sizeof(*sc->sc_q) * sc->sc_nq);
556 1.1 nonaka nvme_q_free(sc, sc->sc_admin_q);
557 1.1 nonaka
558 1.1 nonaka return 0;
559 1.1 nonaka }
560 1.1 nonaka
561 1.1 nonaka static int
562 1.1 nonaka nvme_shutdown(struct nvme_softc *sc)
563 1.1 nonaka {
564 1.1 nonaka uint32_t cc, csts;
565 1.1 nonaka bool disabled = false;
566 1.1 nonaka int i;
567 1.1 nonaka
568 1.1 nonaka if (!sc->sc_use_mq)
569 1.1 nonaka nvme_write4(sc, NVME_INTMS, 1);
570 1.1 nonaka
571 1.1 nonaka for (i = 0; i < sc->sc_nq; i++) {
572 1.1 nonaka if (nvme_q_delete(sc, sc->sc_q[i]) != 0) {
573 1.1 nonaka aprint_error_dev(sc->sc_dev,
574 1.1 nonaka "unable to delete io queue %d, disabling\n", i + 1);
575 1.1 nonaka disabled = true;
576 1.1 nonaka }
577 1.1 nonaka }
578 1.1 nonaka sc->sc_intr_disestablish(sc, NVME_ADMIN_Q);
579 1.1 nonaka if (disabled)
580 1.1 nonaka goto disable;
581 1.1 nonaka
582 1.1 nonaka cc = nvme_read4(sc, NVME_CC);
583 1.1 nonaka CLR(cc, NVME_CC_SHN_MASK);
584 1.1 nonaka SET(cc, NVME_CC_SHN(NVME_CC_SHN_NORMAL));
585 1.1 nonaka nvme_write4(sc, NVME_CC, cc);
586 1.1 nonaka
587 1.1 nonaka for (i = 0; i < 4000; i++) {
588 1.1 nonaka nvme_barrier(sc, 0, sc->sc_ios,
589 1.1 nonaka BUS_SPACE_BARRIER_READ | BUS_SPACE_BARRIER_WRITE);
590 1.1 nonaka csts = nvme_read4(sc, NVME_CSTS);
591 1.1 nonaka if ((csts & NVME_CSTS_SHST_MASK) == NVME_CSTS_SHST_DONE)
592 1.1 nonaka return 0;
593 1.1 nonaka
594 1.1 nonaka delay(1000);
595 1.1 nonaka }
596 1.1 nonaka
597 1.1 nonaka aprint_error_dev(sc->sc_dev, "unable to shudown, disabling\n");
598 1.1 nonaka
599 1.1 nonaka disable:
600 1.1 nonaka nvme_disable(sc);
601 1.1 nonaka return 0;
602 1.1 nonaka }
603 1.1 nonaka
604 1.1 nonaka void
605 1.1 nonaka nvme_childdet(device_t self, device_t child)
606 1.1 nonaka {
607 1.1 nonaka struct nvme_softc *sc = device_private(self);
608 1.1 nonaka int i;
609 1.1 nonaka
610 1.1 nonaka for (i = 0; i < sc->sc_nn; i++) {
611 1.1 nonaka if (sc->sc_namespaces[i].dev == child) {
612 1.1 nonaka /* Already freed ns->ident. */
613 1.1 nonaka sc->sc_namespaces[i].dev = NULL;
614 1.1 nonaka break;
615 1.1 nonaka }
616 1.1 nonaka }
617 1.1 nonaka }
618 1.1 nonaka
619 1.1 nonaka int
620 1.1 nonaka nvme_ns_identify(struct nvme_softc *sc, uint16_t nsid)
621 1.1 nonaka {
622 1.1 nonaka struct nvme_sqe sqe;
623 1.1 nonaka struct nvm_identify_namespace *identify;
624 1.19 jdolecek struct nvme_dmamem *mem;
625 1.1 nonaka struct nvme_ccb *ccb;
626 1.1 nonaka struct nvme_namespace *ns;
627 1.19 jdolecek int rv;
628 1.1 nonaka
629 1.1 nonaka KASSERT(nsid > 0);
630 1.1 nonaka
631 1.34 jdolecek ccb = nvme_ccb_get(sc->sc_admin_q, false);
632 1.11 jdolecek KASSERT(ccb != NULL); /* it's a bug if we don't have spare ccb here */
633 1.1 nonaka
634 1.19 jdolecek mem = nvme_dmamem_alloc(sc, sizeof(*identify));
635 1.32 christos if (mem == NULL) {
636 1.32 christos nvme_ccb_put(sc->sc_admin_q, ccb);
637 1.19 jdolecek return ENOMEM;
638 1.32 christos }
639 1.1 nonaka
640 1.1 nonaka memset(&sqe, 0, sizeof(sqe));
641 1.1 nonaka sqe.opcode = NVM_ADMIN_IDENTIFY;
642 1.1 nonaka htolem32(&sqe.nsid, nsid);
643 1.1 nonaka htolem64(&sqe.entry.prp[0], NVME_DMA_DVA(mem));
644 1.1 nonaka htolem32(&sqe.cdw10, 0);
645 1.1 nonaka
646 1.1 nonaka ccb->ccb_done = nvme_empty_done;
647 1.1 nonaka ccb->ccb_cookie = &sqe;
648 1.1 nonaka
649 1.1 nonaka nvme_dmamem_sync(sc, mem, BUS_DMASYNC_PREREAD);
650 1.19 jdolecek rv = nvme_poll(sc, sc->sc_admin_q, ccb, nvme_sqe_fill, NVME_TIMO_IDENT);
651 1.1 nonaka nvme_dmamem_sync(sc, mem, BUS_DMASYNC_POSTREAD);
652 1.1 nonaka
653 1.1 nonaka nvme_ccb_put(sc->sc_admin_q, ccb);
654 1.1 nonaka
655 1.19 jdolecek if (rv != 0) {
656 1.19 jdolecek rv = EIO;
657 1.1 nonaka goto done;
658 1.1 nonaka }
659 1.1 nonaka
660 1.1 nonaka /* commit */
661 1.1 nonaka
662 1.1 nonaka identify = kmem_zalloc(sizeof(*identify), KM_SLEEP);
663 1.19 jdolecek *identify = *((volatile struct nvm_identify_namespace *)NVME_DMA_KVA(mem));
664 1.39 nonaka
665 1.39 nonaka /* Convert data to host endian */
666 1.39 nonaka nvme_identify_namespace_swapbytes(identify);
667 1.1 nonaka
668 1.1 nonaka ns = nvme_ns_get(sc, nsid);
669 1.1 nonaka KASSERT(ns);
670 1.32 christos KASSERT(ns->ident == NULL);
671 1.1 nonaka ns->ident = identify;
672 1.1 nonaka
673 1.1 nonaka done:
674 1.19 jdolecek nvme_dmamem_free(sc, mem);
675 1.1 nonaka
676 1.19 jdolecek return rv;
677 1.1 nonaka }
678 1.1 nonaka
679 1.1 nonaka int
680 1.11 jdolecek nvme_ns_dobio(struct nvme_softc *sc, uint16_t nsid, void *cookie,
681 1.11 jdolecek struct buf *bp, void *data, size_t datasize,
682 1.11 jdolecek int secsize, daddr_t blkno, int flags, nvme_nnc_done nnc_done)
683 1.1 nonaka {
684 1.44 jmcneill struct nvme_queue *q = nvme_get_q(sc, bp, false);
685 1.1 nonaka struct nvme_ccb *ccb;
686 1.1 nonaka bus_dmamap_t dmap;
687 1.1 nonaka int i, error;
688 1.1 nonaka
689 1.34 jdolecek ccb = nvme_ccb_get(q, false);
690 1.1 nonaka if (ccb == NULL)
691 1.1 nonaka return EAGAIN;
692 1.1 nonaka
693 1.1 nonaka ccb->ccb_done = nvme_ns_io_done;
694 1.11 jdolecek ccb->ccb_cookie = cookie;
695 1.11 jdolecek
696 1.11 jdolecek /* namespace context */
697 1.11 jdolecek ccb->nnc_nsid = nsid;
698 1.11 jdolecek ccb->nnc_flags = flags;
699 1.11 jdolecek ccb->nnc_buf = bp;
700 1.11 jdolecek ccb->nnc_datasize = datasize;
701 1.11 jdolecek ccb->nnc_secsize = secsize;
702 1.11 jdolecek ccb->nnc_blkno = blkno;
703 1.11 jdolecek ccb->nnc_done = nnc_done;
704 1.1 nonaka
705 1.1 nonaka dmap = ccb->ccb_dmamap;
706 1.11 jdolecek error = bus_dmamap_load(sc->sc_dmat, dmap, data,
707 1.11 jdolecek datasize, NULL,
708 1.11 jdolecek (ISSET(flags, NVME_NS_CTX_F_POLL) ?
709 1.1 nonaka BUS_DMA_NOWAIT : BUS_DMA_WAITOK) |
710 1.11 jdolecek (ISSET(flags, NVME_NS_CTX_F_READ) ?
711 1.1 nonaka BUS_DMA_READ : BUS_DMA_WRITE));
712 1.1 nonaka if (error) {
713 1.1 nonaka nvme_ccb_put(q, ccb);
714 1.1 nonaka return error;
715 1.1 nonaka }
716 1.1 nonaka
717 1.1 nonaka bus_dmamap_sync(sc->sc_dmat, dmap, 0, dmap->dm_mapsize,
718 1.11 jdolecek ISSET(flags, NVME_NS_CTX_F_READ) ?
719 1.1 nonaka BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
720 1.1 nonaka
721 1.1 nonaka if (dmap->dm_nsegs > 2) {
722 1.1 nonaka for (i = 1; i < dmap->dm_nsegs; i++) {
723 1.1 nonaka htolem64(&ccb->ccb_prpl[i - 1],
724 1.1 nonaka dmap->dm_segs[i].ds_addr);
725 1.1 nonaka }
726 1.1 nonaka bus_dmamap_sync(sc->sc_dmat,
727 1.1 nonaka NVME_DMA_MAP(q->q_ccb_prpls),
728 1.1 nonaka ccb->ccb_prpl_off,
729 1.16 nonaka sizeof(*ccb->ccb_prpl) * (dmap->dm_nsegs - 1),
730 1.1 nonaka BUS_DMASYNC_PREWRITE);
731 1.1 nonaka }
732 1.1 nonaka
733 1.11 jdolecek if (ISSET(flags, NVME_NS_CTX_F_POLL)) {
734 1.7 jdolecek if (nvme_poll(sc, q, ccb, nvme_ns_io_fill, NVME_TIMO_PT) != 0)
735 1.1 nonaka return EIO;
736 1.1 nonaka return 0;
737 1.1 nonaka }
738 1.1 nonaka
739 1.1 nonaka nvme_q_submit(sc, q, ccb, nvme_ns_io_fill);
740 1.1 nonaka return 0;
741 1.1 nonaka }
742 1.1 nonaka
743 1.1 nonaka static void
744 1.1 nonaka nvme_ns_io_fill(struct nvme_queue *q, struct nvme_ccb *ccb, void *slot)
745 1.1 nonaka {
746 1.1 nonaka struct nvme_sqe_io *sqe = slot;
747 1.1 nonaka bus_dmamap_t dmap = ccb->ccb_dmamap;
748 1.1 nonaka
749 1.11 jdolecek sqe->opcode = ISSET(ccb->nnc_flags, NVME_NS_CTX_F_READ) ?
750 1.1 nonaka NVM_CMD_READ : NVM_CMD_WRITE;
751 1.11 jdolecek htolem32(&sqe->nsid, ccb->nnc_nsid);
752 1.1 nonaka
753 1.1 nonaka htolem64(&sqe->entry.prp[0], dmap->dm_segs[0].ds_addr);
754 1.1 nonaka switch (dmap->dm_nsegs) {
755 1.1 nonaka case 1:
756 1.1 nonaka break;
757 1.1 nonaka case 2:
758 1.1 nonaka htolem64(&sqe->entry.prp[1], dmap->dm_segs[1].ds_addr);
759 1.1 nonaka break;
760 1.1 nonaka default:
761 1.1 nonaka /* the prp list is already set up and synced */
762 1.1 nonaka htolem64(&sqe->entry.prp[1], ccb->ccb_prpl_dva);
763 1.1 nonaka break;
764 1.1 nonaka }
765 1.1 nonaka
766 1.11 jdolecek htolem64(&sqe->slba, ccb->nnc_blkno);
767 1.11 jdolecek
768 1.26 jdolecek if (ISSET(ccb->nnc_flags, NVME_NS_CTX_F_FUA))
769 1.26 jdolecek htolem16(&sqe->ioflags, NVM_SQE_IO_FUA);
770 1.26 jdolecek
771 1.11 jdolecek /* guaranteed by upper layers, but check just in case */
772 1.11 jdolecek KASSERT((ccb->nnc_datasize % ccb->nnc_secsize) == 0);
773 1.11 jdolecek htolem16(&sqe->nlb, (ccb->nnc_datasize / ccb->nnc_secsize) - 1);
774 1.1 nonaka }
775 1.1 nonaka
776 1.1 nonaka static void
777 1.1 nonaka nvme_ns_io_done(struct nvme_queue *q, struct nvme_ccb *ccb,
778 1.1 nonaka struct nvme_cqe *cqe)
779 1.1 nonaka {
780 1.1 nonaka struct nvme_softc *sc = q->q_sc;
781 1.1 nonaka bus_dmamap_t dmap = ccb->ccb_dmamap;
782 1.11 jdolecek void *nnc_cookie = ccb->ccb_cookie;
783 1.11 jdolecek nvme_nnc_done nnc_done = ccb->nnc_done;
784 1.11 jdolecek struct buf *bp = ccb->nnc_buf;
785 1.1 nonaka
786 1.1 nonaka if (dmap->dm_nsegs > 2) {
787 1.1 nonaka bus_dmamap_sync(sc->sc_dmat,
788 1.1 nonaka NVME_DMA_MAP(q->q_ccb_prpls),
789 1.1 nonaka ccb->ccb_prpl_off,
790 1.16 nonaka sizeof(*ccb->ccb_prpl) * (dmap->dm_nsegs - 1),
791 1.1 nonaka BUS_DMASYNC_POSTWRITE);
792 1.1 nonaka }
793 1.1 nonaka
794 1.1 nonaka bus_dmamap_sync(sc->sc_dmat, dmap, 0, dmap->dm_mapsize,
795 1.11 jdolecek ISSET(ccb->nnc_flags, NVME_NS_CTX_F_READ) ?
796 1.1 nonaka BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
797 1.1 nonaka
798 1.1 nonaka bus_dmamap_unload(sc->sc_dmat, dmap);
799 1.1 nonaka nvme_ccb_put(q, ccb);
800 1.1 nonaka
801 1.25 jdolecek nnc_done(nnc_cookie, bp, lemtoh16(&cqe->flags), lemtoh32(&cqe->cdw0));
802 1.25 jdolecek }
803 1.25 jdolecek
804 1.25 jdolecek /*
805 1.25 jdolecek * If there is no volatile write cache, it makes no sense to issue
806 1.25 jdolecek * flush commands or query for the status.
807 1.25 jdolecek */
808 1.34 jdolecek static bool
809 1.25 jdolecek nvme_has_volatile_write_cache(struct nvme_softc *sc)
810 1.25 jdolecek {
811 1.25 jdolecek /* sc_identify is filled during attachment */
812 1.25 jdolecek return ((sc->sc_identify.vwc & NVME_ID_CTRLR_VWC_PRESENT) != 0);
813 1.1 nonaka }
814 1.1 nonaka
815 1.34 jdolecek static bool
816 1.34 jdolecek nvme_ns_sync_finished(void *cookie)
817 1.34 jdolecek {
818 1.34 jdolecek int *result = cookie;
819 1.34 jdolecek
820 1.34 jdolecek return (*result != 0);
821 1.34 jdolecek }
822 1.34 jdolecek
823 1.1 nonaka int
824 1.34 jdolecek nvme_ns_sync(struct nvme_softc *sc, uint16_t nsid, int flags)
825 1.1 nonaka {
826 1.44 jmcneill struct nvme_queue *q = nvme_get_q(sc, NULL, true);
827 1.1 nonaka struct nvme_ccb *ccb;
828 1.34 jdolecek int result = 0;
829 1.34 jdolecek
830 1.34 jdolecek if (!nvme_has_volatile_write_cache(sc)) {
831 1.34 jdolecek /* cache not present, no value in trying to flush it */
832 1.34 jdolecek return 0;
833 1.34 jdolecek }
834 1.1 nonaka
835 1.34 jdolecek ccb = nvme_ccb_get(q, true);
836 1.44 jmcneill KASSERT(ccb != NULL);
837 1.1 nonaka
838 1.1 nonaka ccb->ccb_done = nvme_ns_sync_done;
839 1.34 jdolecek ccb->ccb_cookie = &result;
840 1.1 nonaka
841 1.11 jdolecek /* namespace context */
842 1.11 jdolecek ccb->nnc_nsid = nsid;
843 1.11 jdolecek ccb->nnc_flags = flags;
844 1.34 jdolecek ccb->nnc_done = NULL;
845 1.11 jdolecek
846 1.11 jdolecek if (ISSET(flags, NVME_NS_CTX_F_POLL)) {
847 1.7 jdolecek if (nvme_poll(sc, q, ccb, nvme_ns_sync_fill, NVME_TIMO_SY) != 0)
848 1.1 nonaka return EIO;
849 1.1 nonaka return 0;
850 1.1 nonaka }
851 1.1 nonaka
852 1.1 nonaka nvme_q_submit(sc, q, ccb, nvme_ns_sync_fill);
853 1.34 jdolecek
854 1.34 jdolecek /* wait for completion */
855 1.34 jdolecek nvme_q_wait_complete(sc, q, nvme_ns_sync_finished, &result);
856 1.34 jdolecek KASSERT(result != 0);
857 1.34 jdolecek
858 1.34 jdolecek return (result > 0) ? 0 : EIO;
859 1.1 nonaka }
860 1.1 nonaka
861 1.1 nonaka static void
862 1.1 nonaka nvme_ns_sync_fill(struct nvme_queue *q, struct nvme_ccb *ccb, void *slot)
863 1.1 nonaka {
864 1.1 nonaka struct nvme_sqe *sqe = slot;
865 1.1 nonaka
866 1.1 nonaka sqe->opcode = NVM_CMD_FLUSH;
867 1.11 jdolecek htolem32(&sqe->nsid, ccb->nnc_nsid);
868 1.1 nonaka }
869 1.1 nonaka
870 1.1 nonaka static void
871 1.1 nonaka nvme_ns_sync_done(struct nvme_queue *q, struct nvme_ccb *ccb,
872 1.1 nonaka struct nvme_cqe *cqe)
873 1.1 nonaka {
874 1.34 jdolecek int *result = ccb->ccb_cookie;
875 1.34 jdolecek uint16_t status = NVME_CQE_SC(lemtoh16(&cqe->flags));
876 1.34 jdolecek
877 1.34 jdolecek if (status == NVME_CQE_SC_SUCCESS)
878 1.34 jdolecek *result = 1;
879 1.34 jdolecek else
880 1.34 jdolecek *result = -1;
881 1.1 nonaka
882 1.1 nonaka nvme_ccb_put(q, ccb);
883 1.34 jdolecek }
884 1.34 jdolecek
885 1.34 jdolecek static bool
886 1.34 jdolecek nvme_getcache_finished(void *xc)
887 1.34 jdolecek {
888 1.34 jdolecek int *addr = xc;
889 1.1 nonaka
890 1.34 jdolecek return (*addr != 0);
891 1.25 jdolecek }
892 1.25 jdolecek
893 1.25 jdolecek /*
894 1.25 jdolecek * Get status of volatile write cache. Always asynchronous.
895 1.25 jdolecek */
896 1.25 jdolecek int
897 1.34 jdolecek nvme_admin_getcache(struct nvme_softc *sc, int *addr)
898 1.25 jdolecek {
899 1.25 jdolecek struct nvme_ccb *ccb;
900 1.25 jdolecek struct nvme_queue *q = sc->sc_admin_q;
901 1.34 jdolecek int result = 0, error;
902 1.25 jdolecek
903 1.34 jdolecek if (!nvme_has_volatile_write_cache(sc)) {
904 1.34 jdolecek /* cache simply not present */
905 1.34 jdolecek *addr = 0;
906 1.34 jdolecek return 0;
907 1.34 jdolecek }
908 1.34 jdolecek
909 1.34 jdolecek ccb = nvme_ccb_get(q, true);
910 1.34 jdolecek KASSERT(ccb != NULL);
911 1.25 jdolecek
912 1.25 jdolecek ccb->ccb_done = nvme_getcache_done;
913 1.34 jdolecek ccb->ccb_cookie = &result;
914 1.25 jdolecek
915 1.25 jdolecek /* namespace context */
916 1.25 jdolecek ccb->nnc_flags = 0;
917 1.34 jdolecek ccb->nnc_done = NULL;
918 1.25 jdolecek
919 1.25 jdolecek nvme_q_submit(sc, q, ccb, nvme_getcache_fill);
920 1.34 jdolecek
921 1.34 jdolecek /* wait for completion */
922 1.34 jdolecek nvme_q_wait_complete(sc, q, nvme_getcache_finished, &result);
923 1.34 jdolecek KASSERT(result != 0);
924 1.34 jdolecek
925 1.34 jdolecek if (result > 0) {
926 1.34 jdolecek *addr = result;
927 1.34 jdolecek error = 0;
928 1.34 jdolecek } else
929 1.34 jdolecek error = EINVAL;
930 1.34 jdolecek
931 1.34 jdolecek return error;
932 1.25 jdolecek }
933 1.25 jdolecek
934 1.25 jdolecek static void
935 1.25 jdolecek nvme_getcache_fill(struct nvme_queue *q, struct nvme_ccb *ccb, void *slot)
936 1.25 jdolecek {
937 1.25 jdolecek struct nvme_sqe *sqe = slot;
938 1.25 jdolecek
939 1.25 jdolecek sqe->opcode = NVM_ADMIN_GET_FEATURES;
940 1.39 nonaka htolem32(&sqe->cdw10, NVM_FEATURE_VOLATILE_WRITE_CACHE);
941 1.41 jdolecek htolem32(&sqe->cdw11, NVM_VOLATILE_WRITE_CACHE_WCE);
942 1.25 jdolecek }
943 1.25 jdolecek
944 1.25 jdolecek static void
945 1.25 jdolecek nvme_getcache_done(struct nvme_queue *q, struct nvme_ccb *ccb,
946 1.25 jdolecek struct nvme_cqe *cqe)
947 1.25 jdolecek {
948 1.34 jdolecek int *addr = ccb->ccb_cookie;
949 1.34 jdolecek uint16_t status = NVME_CQE_SC(lemtoh16(&cqe->flags));
950 1.34 jdolecek uint32_t cdw0 = lemtoh32(&cqe->cdw0);
951 1.34 jdolecek int result;
952 1.34 jdolecek
953 1.34 jdolecek if (status == NVME_CQE_SC_SUCCESS) {
954 1.34 jdolecek result = 0;
955 1.34 jdolecek
956 1.34 jdolecek /*
957 1.34 jdolecek * DPO not supported, Dataset Management (DSM) field doesn't
958 1.34 jdolecek * specify the same semantics. FUA is always supported.
959 1.34 jdolecek */
960 1.34 jdolecek result = DKCACHE_FUA;
961 1.34 jdolecek
962 1.41 jdolecek if (cdw0 & NVM_VOLATILE_WRITE_CACHE_WCE)
963 1.34 jdolecek result |= DKCACHE_WRITE;
964 1.34 jdolecek
965 1.34 jdolecek /*
966 1.34 jdolecek * If volatile write cache is present, the flag shall also be
967 1.34 jdolecek * settable.
968 1.34 jdolecek */
969 1.34 jdolecek result |= DKCACHE_WCHANGE;
970 1.41 jdolecek
971 1.41 jdolecek /*
972 1.41 jdolecek * ONCS field indicates whether the optional SAVE is also
973 1.41 jdolecek * supported for Set Features. According to spec v1.3,
974 1.41 jdolecek * Volatile Write Cache however doesn't support persistency
975 1.41 jdolecek * across power cycle/reset.
976 1.41 jdolecek */
977 1.41 jdolecek
978 1.34 jdolecek } else {
979 1.34 jdolecek result = -1;
980 1.34 jdolecek }
981 1.34 jdolecek
982 1.34 jdolecek *addr = result;
983 1.25 jdolecek
984 1.25 jdolecek nvme_ccb_put(q, ccb);
985 1.1 nonaka }
986 1.1 nonaka
987 1.41 jdolecek struct nvme_setcache_state {
988 1.41 jdolecek int dkcache;
989 1.41 jdolecek int result;
990 1.41 jdolecek };
991 1.41 jdolecek
992 1.41 jdolecek static bool
993 1.41 jdolecek nvme_setcache_finished(void *xc)
994 1.41 jdolecek {
995 1.41 jdolecek struct nvme_setcache_state *st = xc;
996 1.41 jdolecek
997 1.41 jdolecek return (st->result != 0);
998 1.41 jdolecek }
999 1.41 jdolecek
1000 1.41 jdolecek static void
1001 1.41 jdolecek nvme_setcache_fill(struct nvme_queue *q, struct nvme_ccb *ccb, void *slot)
1002 1.41 jdolecek {
1003 1.41 jdolecek struct nvme_sqe *sqe = slot;
1004 1.41 jdolecek struct nvme_setcache_state *st = ccb->ccb_cookie;
1005 1.41 jdolecek
1006 1.41 jdolecek sqe->opcode = NVM_ADMIN_SET_FEATURES;
1007 1.41 jdolecek htolem32(&sqe->cdw10, NVM_FEATURE_VOLATILE_WRITE_CACHE);
1008 1.41 jdolecek if (st->dkcache & DKCACHE_WRITE)
1009 1.41 jdolecek htolem32(&sqe->cdw11, NVM_VOLATILE_WRITE_CACHE_WCE);
1010 1.41 jdolecek }
1011 1.41 jdolecek
1012 1.41 jdolecek static void
1013 1.41 jdolecek nvme_setcache_done(struct nvme_queue *q, struct nvme_ccb *ccb,
1014 1.41 jdolecek struct nvme_cqe *cqe)
1015 1.41 jdolecek {
1016 1.41 jdolecek struct nvme_setcache_state *st = ccb->ccb_cookie;
1017 1.41 jdolecek uint16_t status = NVME_CQE_SC(lemtoh16(&cqe->flags));
1018 1.41 jdolecek
1019 1.41 jdolecek if (status == NVME_CQE_SC_SUCCESS) {
1020 1.41 jdolecek st->result = 1;
1021 1.41 jdolecek } else {
1022 1.41 jdolecek st->result = -1;
1023 1.41 jdolecek }
1024 1.41 jdolecek
1025 1.41 jdolecek nvme_ccb_put(q, ccb);
1026 1.41 jdolecek }
1027 1.41 jdolecek
1028 1.41 jdolecek /*
1029 1.41 jdolecek * Set status of volatile write cache. Always asynchronous.
1030 1.41 jdolecek */
1031 1.41 jdolecek int
1032 1.41 jdolecek nvme_admin_setcache(struct nvme_softc *sc, int dkcache)
1033 1.41 jdolecek {
1034 1.41 jdolecek struct nvme_ccb *ccb;
1035 1.41 jdolecek struct nvme_queue *q = sc->sc_admin_q;
1036 1.41 jdolecek int error;
1037 1.41 jdolecek struct nvme_setcache_state st;
1038 1.41 jdolecek
1039 1.41 jdolecek if (!nvme_has_volatile_write_cache(sc)) {
1040 1.41 jdolecek /* cache simply not present */
1041 1.41 jdolecek return EOPNOTSUPP;
1042 1.41 jdolecek }
1043 1.41 jdolecek
1044 1.41 jdolecek if (dkcache & ~(DKCACHE_WRITE)) {
1045 1.41 jdolecek /* unsupported parameters */
1046 1.41 jdolecek return EOPNOTSUPP;
1047 1.41 jdolecek }
1048 1.41 jdolecek
1049 1.41 jdolecek ccb = nvme_ccb_get(q, true);
1050 1.41 jdolecek KASSERT(ccb != NULL);
1051 1.41 jdolecek
1052 1.41 jdolecek memset(&st, 0, sizeof(st));
1053 1.41 jdolecek st.dkcache = dkcache;
1054 1.41 jdolecek
1055 1.41 jdolecek ccb->ccb_done = nvme_setcache_done;
1056 1.41 jdolecek ccb->ccb_cookie = &st;
1057 1.41 jdolecek
1058 1.41 jdolecek /* namespace context */
1059 1.41 jdolecek ccb->nnc_flags = 0;
1060 1.41 jdolecek ccb->nnc_done = NULL;
1061 1.41 jdolecek
1062 1.41 jdolecek nvme_q_submit(sc, q, ccb, nvme_setcache_fill);
1063 1.41 jdolecek
1064 1.41 jdolecek /* wait for completion */
1065 1.41 jdolecek nvme_q_wait_complete(sc, q, nvme_setcache_finished, &st);
1066 1.41 jdolecek KASSERT(st.result != 0);
1067 1.41 jdolecek
1068 1.41 jdolecek if (st.result > 0)
1069 1.41 jdolecek error = 0;
1070 1.41 jdolecek else
1071 1.41 jdolecek error = EINVAL;
1072 1.41 jdolecek
1073 1.41 jdolecek return error;
1074 1.41 jdolecek }
1075 1.41 jdolecek
1076 1.1 nonaka void
1077 1.1 nonaka nvme_ns_free(struct nvme_softc *sc, uint16_t nsid)
1078 1.1 nonaka {
1079 1.1 nonaka struct nvme_namespace *ns;
1080 1.1 nonaka struct nvm_identify_namespace *identify;
1081 1.1 nonaka
1082 1.1 nonaka ns = nvme_ns_get(sc, nsid);
1083 1.1 nonaka KASSERT(ns);
1084 1.1 nonaka
1085 1.1 nonaka identify = ns->ident;
1086 1.1 nonaka ns->ident = NULL;
1087 1.1 nonaka if (identify != NULL)
1088 1.1 nonaka kmem_free(identify, sizeof(*identify));
1089 1.1 nonaka }
1090 1.1 nonaka
1091 1.35 jdolecek struct nvme_pt_state {
1092 1.35 jdolecek struct nvme_pt_command *pt;
1093 1.35 jdolecek bool finished;
1094 1.35 jdolecek };
1095 1.35 jdolecek
1096 1.1 nonaka static void
1097 1.3 nonaka nvme_pt_fill(struct nvme_queue *q, struct nvme_ccb *ccb, void *slot)
1098 1.3 nonaka {
1099 1.3 nonaka struct nvme_softc *sc = q->q_sc;
1100 1.3 nonaka struct nvme_sqe *sqe = slot;
1101 1.35 jdolecek struct nvme_pt_state *state = ccb->ccb_cookie;
1102 1.35 jdolecek struct nvme_pt_command *pt = state->pt;
1103 1.3 nonaka bus_dmamap_t dmap = ccb->ccb_dmamap;
1104 1.3 nonaka int i;
1105 1.3 nonaka
1106 1.3 nonaka sqe->opcode = pt->cmd.opcode;
1107 1.3 nonaka htolem32(&sqe->nsid, pt->cmd.nsid);
1108 1.3 nonaka
1109 1.3 nonaka if (pt->buf != NULL && pt->len > 0) {
1110 1.3 nonaka htolem64(&sqe->entry.prp[0], dmap->dm_segs[0].ds_addr);
1111 1.3 nonaka switch (dmap->dm_nsegs) {
1112 1.3 nonaka case 1:
1113 1.3 nonaka break;
1114 1.3 nonaka case 2:
1115 1.3 nonaka htolem64(&sqe->entry.prp[1], dmap->dm_segs[1].ds_addr);
1116 1.3 nonaka break;
1117 1.3 nonaka default:
1118 1.3 nonaka for (i = 1; i < dmap->dm_nsegs; i++) {
1119 1.3 nonaka htolem64(&ccb->ccb_prpl[i - 1],
1120 1.3 nonaka dmap->dm_segs[i].ds_addr);
1121 1.3 nonaka }
1122 1.3 nonaka bus_dmamap_sync(sc->sc_dmat,
1123 1.3 nonaka NVME_DMA_MAP(q->q_ccb_prpls),
1124 1.3 nonaka ccb->ccb_prpl_off,
1125 1.16 nonaka sizeof(*ccb->ccb_prpl) * (dmap->dm_nsegs - 1),
1126 1.3 nonaka BUS_DMASYNC_PREWRITE);
1127 1.3 nonaka htolem64(&sqe->entry.prp[1], ccb->ccb_prpl_dva);
1128 1.3 nonaka break;
1129 1.3 nonaka }
1130 1.3 nonaka }
1131 1.3 nonaka
1132 1.3 nonaka htolem32(&sqe->cdw10, pt->cmd.cdw10);
1133 1.3 nonaka htolem32(&sqe->cdw11, pt->cmd.cdw11);
1134 1.3 nonaka htolem32(&sqe->cdw12, pt->cmd.cdw12);
1135 1.3 nonaka htolem32(&sqe->cdw13, pt->cmd.cdw13);
1136 1.3 nonaka htolem32(&sqe->cdw14, pt->cmd.cdw14);
1137 1.3 nonaka htolem32(&sqe->cdw15, pt->cmd.cdw15);
1138 1.3 nonaka }
1139 1.3 nonaka
1140 1.3 nonaka static void
1141 1.3 nonaka nvme_pt_done(struct nvme_queue *q, struct nvme_ccb *ccb, struct nvme_cqe *cqe)
1142 1.3 nonaka {
1143 1.3 nonaka struct nvme_softc *sc = q->q_sc;
1144 1.35 jdolecek struct nvme_pt_state *state = ccb->ccb_cookie;
1145 1.35 jdolecek struct nvme_pt_command *pt = state->pt;
1146 1.3 nonaka bus_dmamap_t dmap = ccb->ccb_dmamap;
1147 1.3 nonaka
1148 1.3 nonaka if (pt->buf != NULL && pt->len > 0) {
1149 1.3 nonaka if (dmap->dm_nsegs > 2) {
1150 1.3 nonaka bus_dmamap_sync(sc->sc_dmat,
1151 1.3 nonaka NVME_DMA_MAP(q->q_ccb_prpls),
1152 1.3 nonaka ccb->ccb_prpl_off,
1153 1.16 nonaka sizeof(*ccb->ccb_prpl) * (dmap->dm_nsegs - 1),
1154 1.3 nonaka BUS_DMASYNC_POSTWRITE);
1155 1.3 nonaka }
1156 1.3 nonaka
1157 1.3 nonaka bus_dmamap_sync(sc->sc_dmat, dmap, 0, dmap->dm_mapsize,
1158 1.3 nonaka pt->is_read ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
1159 1.3 nonaka bus_dmamap_unload(sc->sc_dmat, dmap);
1160 1.3 nonaka }
1161 1.3 nonaka
1162 1.23 nonaka pt->cpl.cdw0 = lemtoh32(&cqe->cdw0);
1163 1.23 nonaka pt->cpl.flags = lemtoh16(&cqe->flags) & ~NVME_CQE_PHASE;
1164 1.35 jdolecek
1165 1.35 jdolecek state->finished = true;
1166 1.35 jdolecek
1167 1.35 jdolecek nvme_ccb_put(q, ccb);
1168 1.35 jdolecek }
1169 1.35 jdolecek
1170 1.35 jdolecek static bool
1171 1.35 jdolecek nvme_pt_finished(void *cookie)
1172 1.35 jdolecek {
1173 1.35 jdolecek struct nvme_pt_state *state = cookie;
1174 1.35 jdolecek
1175 1.35 jdolecek return state->finished;
1176 1.3 nonaka }
1177 1.3 nonaka
1178 1.3 nonaka static int
1179 1.3 nonaka nvme_command_passthrough(struct nvme_softc *sc, struct nvme_pt_command *pt,
1180 1.3 nonaka uint16_t nsid, struct lwp *l, bool is_adminq)
1181 1.3 nonaka {
1182 1.3 nonaka struct nvme_queue *q;
1183 1.3 nonaka struct nvme_ccb *ccb;
1184 1.3 nonaka void *buf = NULL;
1185 1.35 jdolecek struct nvme_pt_state state;
1186 1.3 nonaka int error;
1187 1.3 nonaka
1188 1.9 jdolecek /* limit command size to maximum data transfer size */
1189 1.3 nonaka if ((pt->buf == NULL && pt->len > 0) ||
1190 1.9 jdolecek (pt->buf != NULL && (pt->len == 0 || pt->len > sc->sc_mdts)))
1191 1.3 nonaka return EINVAL;
1192 1.3 nonaka
1193 1.44 jmcneill q = is_adminq ? sc->sc_admin_q : nvme_get_q(sc, NULL, true);
1194 1.34 jdolecek ccb = nvme_ccb_get(q, true);
1195 1.34 jdolecek KASSERT(ccb != NULL);
1196 1.3 nonaka
1197 1.9 jdolecek if (pt->buf != NULL) {
1198 1.9 jdolecek KASSERT(pt->len > 0);
1199 1.3 nonaka buf = kmem_alloc(pt->len, KM_SLEEP);
1200 1.3 nonaka if (!pt->is_read) {
1201 1.3 nonaka error = copyin(pt->buf, buf, pt->len);
1202 1.3 nonaka if (error)
1203 1.3 nonaka goto kmem_free;
1204 1.3 nonaka }
1205 1.3 nonaka error = bus_dmamap_load(sc->sc_dmat, ccb->ccb_dmamap, buf,
1206 1.3 nonaka pt->len, NULL,
1207 1.3 nonaka BUS_DMA_WAITOK |
1208 1.3 nonaka (pt->is_read ? BUS_DMA_READ : BUS_DMA_WRITE));
1209 1.3 nonaka if (error)
1210 1.3 nonaka goto kmem_free;
1211 1.3 nonaka bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap,
1212 1.3 nonaka 0, ccb->ccb_dmamap->dm_mapsize,
1213 1.3 nonaka pt->is_read ? BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
1214 1.3 nonaka }
1215 1.3 nonaka
1216 1.35 jdolecek memset(&state, 0, sizeof(state));
1217 1.35 jdolecek state.pt = pt;
1218 1.35 jdolecek state.finished = false;
1219 1.35 jdolecek
1220 1.3 nonaka ccb->ccb_done = nvme_pt_done;
1221 1.35 jdolecek ccb->ccb_cookie = &state;
1222 1.3 nonaka
1223 1.3 nonaka pt->cmd.nsid = nsid;
1224 1.35 jdolecek
1225 1.35 jdolecek nvme_q_submit(sc, q, ccb, nvme_pt_fill);
1226 1.35 jdolecek
1227 1.35 jdolecek /* wait for completion */
1228 1.35 jdolecek nvme_q_wait_complete(sc, q, nvme_pt_finished, &state);
1229 1.35 jdolecek KASSERT(state.finished);
1230 1.3 nonaka
1231 1.3 nonaka error = 0;
1232 1.35 jdolecek
1233 1.3 nonaka if (buf != NULL) {
1234 1.3 nonaka if (error == 0 && pt->is_read)
1235 1.3 nonaka error = copyout(buf, pt->buf, pt->len);
1236 1.3 nonaka kmem_free:
1237 1.3 nonaka kmem_free(buf, pt->len);
1238 1.3 nonaka }
1239 1.35 jdolecek
1240 1.3 nonaka return error;
1241 1.3 nonaka }
1242 1.3 nonaka
1243 1.3 nonaka static void
1244 1.1 nonaka nvme_q_submit(struct nvme_softc *sc, struct nvme_queue *q, struct nvme_ccb *ccb,
1245 1.1 nonaka void (*fill)(struct nvme_queue *, struct nvme_ccb *, void *))
1246 1.1 nonaka {
1247 1.1 nonaka struct nvme_sqe *sqe = NVME_DMA_KVA(q->q_sq_dmamem);
1248 1.1 nonaka uint32_t tail;
1249 1.1 nonaka
1250 1.1 nonaka mutex_enter(&q->q_sq_mtx);
1251 1.1 nonaka tail = q->q_sq_tail;
1252 1.1 nonaka if (++q->q_sq_tail >= q->q_entries)
1253 1.1 nonaka q->q_sq_tail = 0;
1254 1.1 nonaka
1255 1.1 nonaka sqe += tail;
1256 1.1 nonaka
1257 1.1 nonaka bus_dmamap_sync(sc->sc_dmat, NVME_DMA_MAP(q->q_sq_dmamem),
1258 1.1 nonaka sizeof(*sqe) * tail, sizeof(*sqe), BUS_DMASYNC_POSTWRITE);
1259 1.1 nonaka memset(sqe, 0, sizeof(*sqe));
1260 1.1 nonaka (*fill)(q, ccb, sqe);
1261 1.39 nonaka htolem16(&sqe->cid, ccb->ccb_id);
1262 1.1 nonaka bus_dmamap_sync(sc->sc_dmat, NVME_DMA_MAP(q->q_sq_dmamem),
1263 1.1 nonaka sizeof(*sqe) * tail, sizeof(*sqe), BUS_DMASYNC_PREWRITE);
1264 1.1 nonaka
1265 1.1 nonaka nvme_write4(sc, q->q_sqtdbl, q->q_sq_tail);
1266 1.1 nonaka mutex_exit(&q->q_sq_mtx);
1267 1.1 nonaka }
1268 1.1 nonaka
1269 1.1 nonaka struct nvme_poll_state {
1270 1.1 nonaka struct nvme_sqe s;
1271 1.1 nonaka struct nvme_cqe c;
1272 1.34 jdolecek void *cookie;
1273 1.34 jdolecek void (*done)(struct nvme_queue *, struct nvme_ccb *, struct nvme_cqe *);
1274 1.1 nonaka };
1275 1.1 nonaka
1276 1.1 nonaka static int
1277 1.1 nonaka nvme_poll(struct nvme_softc *sc, struct nvme_queue *q, struct nvme_ccb *ccb,
1278 1.7 jdolecek void (*fill)(struct nvme_queue *, struct nvme_ccb *, void *), int timo_sec)
1279 1.1 nonaka {
1280 1.1 nonaka struct nvme_poll_state state;
1281 1.1 nonaka uint16_t flags;
1282 1.7 jdolecek int step = 10;
1283 1.7 jdolecek int maxloop = timo_sec * 1000000 / step;
1284 1.7 jdolecek int error = 0;
1285 1.1 nonaka
1286 1.1 nonaka memset(&state, 0, sizeof(state));
1287 1.1 nonaka (*fill)(q, ccb, &state.s);
1288 1.1 nonaka
1289 1.34 jdolecek state.done = ccb->ccb_done;
1290 1.34 jdolecek state.cookie = ccb->ccb_cookie;
1291 1.1 nonaka
1292 1.1 nonaka ccb->ccb_done = nvme_poll_done;
1293 1.1 nonaka ccb->ccb_cookie = &state;
1294 1.1 nonaka
1295 1.1 nonaka nvme_q_submit(sc, q, ccb, nvme_poll_fill);
1296 1.1 nonaka while (!ISSET(state.c.flags, htole16(NVME_CQE_PHASE))) {
1297 1.1 nonaka if (nvme_q_complete(sc, q) == 0)
1298 1.7 jdolecek delay(step);
1299 1.1 nonaka
1300 1.7 jdolecek if (timo_sec >= 0 && --maxloop <= 0) {
1301 1.7 jdolecek error = ETIMEDOUT;
1302 1.7 jdolecek break;
1303 1.7 jdolecek }
1304 1.1 nonaka }
1305 1.1 nonaka
1306 1.7 jdolecek if (error == 0) {
1307 1.7 jdolecek flags = lemtoh16(&state.c.flags);
1308 1.7 jdolecek return flags & ~NVME_CQE_PHASE;
1309 1.7 jdolecek } else {
1310 1.34 jdolecek /*
1311 1.34 jdolecek * If it succeds later, it would hit ccb which will have been
1312 1.34 jdolecek * already reused for something else. Not good. Cross
1313 1.34 jdolecek * fingers and hope for best. XXX do controller reset?
1314 1.34 jdolecek */
1315 1.34 jdolecek aprint_error_dev(sc->sc_dev, "polled command timed out\n");
1316 1.34 jdolecek
1317 1.34 jdolecek /* Invoke the callback to clean state anyway */
1318 1.34 jdolecek struct nvme_cqe cqe;
1319 1.34 jdolecek memset(&cqe, 0, sizeof(cqe));
1320 1.34 jdolecek ccb->ccb_done(q, ccb, &cqe);
1321 1.34 jdolecek
1322 1.7 jdolecek return 1;
1323 1.7 jdolecek }
1324 1.1 nonaka }
1325 1.1 nonaka
1326 1.1 nonaka static void
1327 1.1 nonaka nvme_poll_fill(struct nvme_queue *q, struct nvme_ccb *ccb, void *slot)
1328 1.1 nonaka {
1329 1.1 nonaka struct nvme_sqe *sqe = slot;
1330 1.1 nonaka struct nvme_poll_state *state = ccb->ccb_cookie;
1331 1.1 nonaka
1332 1.1 nonaka *sqe = state->s;
1333 1.1 nonaka }
1334 1.1 nonaka
1335 1.1 nonaka static void
1336 1.1 nonaka nvme_poll_done(struct nvme_queue *q, struct nvme_ccb *ccb,
1337 1.1 nonaka struct nvme_cqe *cqe)
1338 1.1 nonaka {
1339 1.1 nonaka struct nvme_poll_state *state = ccb->ccb_cookie;
1340 1.1 nonaka
1341 1.1 nonaka state->c = *cqe;
1342 1.45 nonaka SET(state->c.flags, htole16(NVME_CQE_PHASE));
1343 1.34 jdolecek
1344 1.34 jdolecek ccb->ccb_cookie = state->cookie;
1345 1.34 jdolecek state->done(q, ccb, &state->c);
1346 1.1 nonaka }
1347 1.1 nonaka
1348 1.1 nonaka static void
1349 1.1 nonaka nvme_sqe_fill(struct nvme_queue *q, struct nvme_ccb *ccb, void *slot)
1350 1.1 nonaka {
1351 1.1 nonaka struct nvme_sqe *src = ccb->ccb_cookie;
1352 1.1 nonaka struct nvme_sqe *dst = slot;
1353 1.1 nonaka
1354 1.1 nonaka *dst = *src;
1355 1.1 nonaka }
1356 1.1 nonaka
1357 1.1 nonaka static void
1358 1.1 nonaka nvme_empty_done(struct nvme_queue *q, struct nvme_ccb *ccb,
1359 1.1 nonaka struct nvme_cqe *cqe)
1360 1.1 nonaka {
1361 1.1 nonaka }
1362 1.1 nonaka
1363 1.1 nonaka static int
1364 1.1 nonaka nvme_q_complete(struct nvme_softc *sc, struct nvme_queue *q)
1365 1.1 nonaka {
1366 1.1 nonaka struct nvme_ccb *ccb;
1367 1.1 nonaka struct nvme_cqe *ring = NVME_DMA_KVA(q->q_cq_dmamem), *cqe;
1368 1.1 nonaka uint16_t flags;
1369 1.1 nonaka int rv = 0;
1370 1.1 nonaka
1371 1.9 jdolecek mutex_enter(&q->q_cq_mtx);
1372 1.1 nonaka
1373 1.1 nonaka nvme_dmamem_sync(sc, q->q_cq_dmamem, BUS_DMASYNC_POSTREAD);
1374 1.1 nonaka for (;;) {
1375 1.9 jdolecek cqe = &ring[q->q_cq_head];
1376 1.1 nonaka flags = lemtoh16(&cqe->flags);
1377 1.1 nonaka if ((flags & NVME_CQE_PHASE) != q->q_cq_phase)
1378 1.1 nonaka break;
1379 1.1 nonaka
1380 1.1 nonaka ccb = &q->q_ccbs[cqe->cid];
1381 1.1 nonaka
1382 1.9 jdolecek if (++q->q_cq_head >= q->q_entries) {
1383 1.9 jdolecek q->q_cq_head = 0;
1384 1.1 nonaka q->q_cq_phase ^= NVME_CQE_PHASE;
1385 1.1 nonaka }
1386 1.1 nonaka
1387 1.18 jdolecek #ifdef DEBUG
1388 1.18 jdolecek /*
1389 1.18 jdolecek * If we get spurious completion notification, something
1390 1.18 jdolecek * is seriously hosed up. Very likely DMA to some random
1391 1.18 jdolecek * memory place happened, so just bail out.
1392 1.18 jdolecek */
1393 1.18 jdolecek if ((intptr_t)ccb->ccb_cookie == NVME_CCB_FREE) {
1394 1.18 jdolecek panic("%s: invalid ccb detected",
1395 1.18 jdolecek device_xname(sc->sc_dev));
1396 1.18 jdolecek /* NOTREACHED */
1397 1.18 jdolecek }
1398 1.18 jdolecek #endif
1399 1.20 jdolecek
1400 1.20 jdolecek rv++;
1401 1.9 jdolecek
1402 1.9 jdolecek /*
1403 1.10 jdolecek * Unlock the mutex before calling the ccb_done callback
1404 1.9 jdolecek * and re-lock afterwards. The callback triggers lddone()
1405 1.9 jdolecek * which schedules another i/o, and also calls nvme_ccb_put().
1406 1.9 jdolecek * Unlock/relock avoids possibility of deadlock.
1407 1.9 jdolecek */
1408 1.9 jdolecek mutex_exit(&q->q_cq_mtx);
1409 1.9 jdolecek ccb->ccb_done(q, ccb, cqe);
1410 1.9 jdolecek mutex_enter(&q->q_cq_mtx);
1411 1.1 nonaka }
1412 1.1 nonaka nvme_dmamem_sync(sc, q->q_cq_dmamem, BUS_DMASYNC_PREREAD);
1413 1.1 nonaka
1414 1.1 nonaka if (rv)
1415 1.9 jdolecek nvme_write4(sc, q->q_cqhdbl, q->q_cq_head);
1416 1.9 jdolecek
1417 1.1 nonaka mutex_exit(&q->q_cq_mtx);
1418 1.1 nonaka
1419 1.1 nonaka return rv;
1420 1.1 nonaka }
1421 1.1 nonaka
1422 1.34 jdolecek static void
1423 1.34 jdolecek nvme_q_wait_complete(struct nvme_softc *sc,
1424 1.34 jdolecek struct nvme_queue *q, bool (*finished)(void *), void *cookie)
1425 1.34 jdolecek {
1426 1.34 jdolecek mutex_enter(&q->q_ccb_mtx);
1427 1.34 jdolecek if (finished(cookie))
1428 1.34 jdolecek goto out;
1429 1.34 jdolecek
1430 1.34 jdolecek for(;;) {
1431 1.34 jdolecek q->q_ccb_waiting = true;
1432 1.34 jdolecek cv_wait(&q->q_ccb_wait, &q->q_ccb_mtx);
1433 1.34 jdolecek
1434 1.34 jdolecek if (finished(cookie))
1435 1.34 jdolecek break;
1436 1.34 jdolecek }
1437 1.34 jdolecek
1438 1.34 jdolecek out:
1439 1.34 jdolecek mutex_exit(&q->q_ccb_mtx);
1440 1.34 jdolecek }
1441 1.34 jdolecek
1442 1.1 nonaka static int
1443 1.1 nonaka nvme_identify(struct nvme_softc *sc, u_int mps)
1444 1.1 nonaka {
1445 1.1 nonaka char sn[41], mn[81], fr[17];
1446 1.1 nonaka struct nvm_identify_controller *identify;
1447 1.19 jdolecek struct nvme_dmamem *mem;
1448 1.1 nonaka struct nvme_ccb *ccb;
1449 1.1 nonaka u_int mdts;
1450 1.19 jdolecek int rv = 1;
1451 1.1 nonaka
1452 1.34 jdolecek ccb = nvme_ccb_get(sc->sc_admin_q, false);
1453 1.11 jdolecek KASSERT(ccb != NULL); /* it's a bug if we don't have spare ccb here */
1454 1.1 nonaka
1455 1.19 jdolecek mem = nvme_dmamem_alloc(sc, sizeof(*identify));
1456 1.19 jdolecek if (mem == NULL)
1457 1.19 jdolecek return 1;
1458 1.1 nonaka
1459 1.1 nonaka ccb->ccb_done = nvme_empty_done;
1460 1.19 jdolecek ccb->ccb_cookie = mem;
1461 1.1 nonaka
1462 1.1 nonaka nvme_dmamem_sync(sc, mem, BUS_DMASYNC_PREREAD);
1463 1.19 jdolecek rv = nvme_poll(sc, sc->sc_admin_q, ccb, nvme_fill_identify,
1464 1.7 jdolecek NVME_TIMO_IDENT);
1465 1.1 nonaka nvme_dmamem_sync(sc, mem, BUS_DMASYNC_POSTREAD);
1466 1.1 nonaka
1467 1.1 nonaka nvme_ccb_put(sc->sc_admin_q, ccb);
1468 1.1 nonaka
1469 1.19 jdolecek if (rv != 0)
1470 1.1 nonaka goto done;
1471 1.1 nonaka
1472 1.1 nonaka identify = NVME_DMA_KVA(mem);
1473 1.39 nonaka sc->sc_identify = *identify;
1474 1.39 nonaka identify = NULL;
1475 1.39 nonaka
1476 1.39 nonaka /* Convert data to host endian */
1477 1.39 nonaka nvme_identify_controller_swapbytes(&sc->sc_identify);
1478 1.1 nonaka
1479 1.39 nonaka strnvisx(sn, sizeof(sn), (const char *)sc->sc_identify.sn,
1480 1.39 nonaka sizeof(sc->sc_identify.sn), VIS_TRIM|VIS_SAFE|VIS_OCTAL);
1481 1.39 nonaka strnvisx(mn, sizeof(mn), (const char *)sc->sc_identify.mn,
1482 1.39 nonaka sizeof(sc->sc_identify.mn), VIS_TRIM|VIS_SAFE|VIS_OCTAL);
1483 1.39 nonaka strnvisx(fr, sizeof(fr), (const char *)sc->sc_identify.fr,
1484 1.39 nonaka sizeof(sc->sc_identify.fr), VIS_TRIM|VIS_SAFE|VIS_OCTAL);
1485 1.1 nonaka aprint_normal_dev(sc->sc_dev, "%s, firmware %s, serial %s\n", mn, fr,
1486 1.1 nonaka sn);
1487 1.1 nonaka
1488 1.42 mlelstv strlcpy(sc->sc_modelname, mn, sizeof(sc->sc_modelname));
1489 1.42 mlelstv
1490 1.39 nonaka if (sc->sc_identify.mdts > 0) {
1491 1.39 nonaka mdts = (1 << sc->sc_identify.mdts) * (1 << mps);
1492 1.1 nonaka if (mdts < sc->sc_mdts)
1493 1.1 nonaka sc->sc_mdts = mdts;
1494 1.1 nonaka }
1495 1.1 nonaka
1496 1.39 nonaka sc->sc_nn = sc->sc_identify.nn;
1497 1.1 nonaka
1498 1.1 nonaka done:
1499 1.19 jdolecek nvme_dmamem_free(sc, mem);
1500 1.1 nonaka
1501 1.19 jdolecek return rv;
1502 1.1 nonaka }
1503 1.1 nonaka
1504 1.1 nonaka static int
1505 1.1 nonaka nvme_q_create(struct nvme_softc *sc, struct nvme_queue *q)
1506 1.1 nonaka {
1507 1.1 nonaka struct nvme_sqe_q sqe;
1508 1.1 nonaka struct nvme_ccb *ccb;
1509 1.1 nonaka int rv;
1510 1.1 nonaka
1511 1.9 jdolecek if (sc->sc_use_mq && sc->sc_intr_establish(sc, q->q_id, q) != 0)
1512 1.1 nonaka return 1;
1513 1.1 nonaka
1514 1.34 jdolecek ccb = nvme_ccb_get(sc->sc_admin_q, false);
1515 1.1 nonaka KASSERT(ccb != NULL);
1516 1.1 nonaka
1517 1.1 nonaka ccb->ccb_done = nvme_empty_done;
1518 1.1 nonaka ccb->ccb_cookie = &sqe;
1519 1.1 nonaka
1520 1.1 nonaka memset(&sqe, 0, sizeof(sqe));
1521 1.1 nonaka sqe.opcode = NVM_ADMIN_ADD_IOCQ;
1522 1.1 nonaka htolem64(&sqe.prp1, NVME_DMA_DVA(q->q_cq_dmamem));
1523 1.1 nonaka htolem16(&sqe.qsize, q->q_entries - 1);
1524 1.1 nonaka htolem16(&sqe.qid, q->q_id);
1525 1.1 nonaka sqe.qflags = NVM_SQE_CQ_IEN | NVM_SQE_Q_PC;
1526 1.1 nonaka if (sc->sc_use_mq)
1527 1.1 nonaka htolem16(&sqe.cqid, q->q_id); /* qid == vector */
1528 1.1 nonaka
1529 1.7 jdolecek rv = nvme_poll(sc, sc->sc_admin_q, ccb, nvme_sqe_fill, NVME_TIMO_QOP);
1530 1.1 nonaka if (rv != 0)
1531 1.1 nonaka goto fail;
1532 1.1 nonaka
1533 1.1 nonaka ccb->ccb_done = nvme_empty_done;
1534 1.1 nonaka ccb->ccb_cookie = &sqe;
1535 1.1 nonaka
1536 1.1 nonaka memset(&sqe, 0, sizeof(sqe));
1537 1.1 nonaka sqe.opcode = NVM_ADMIN_ADD_IOSQ;
1538 1.1 nonaka htolem64(&sqe.prp1, NVME_DMA_DVA(q->q_sq_dmamem));
1539 1.1 nonaka htolem16(&sqe.qsize, q->q_entries - 1);
1540 1.1 nonaka htolem16(&sqe.qid, q->q_id);
1541 1.1 nonaka htolem16(&sqe.cqid, q->q_id);
1542 1.1 nonaka sqe.qflags = NVM_SQE_Q_PC;
1543 1.1 nonaka
1544 1.7 jdolecek rv = nvme_poll(sc, sc->sc_admin_q, ccb, nvme_sqe_fill, NVME_TIMO_QOP);
1545 1.1 nonaka if (rv != 0)
1546 1.1 nonaka goto fail;
1547 1.1 nonaka
1548 1.40 jdolecek nvme_ccb_put(sc->sc_admin_q, ccb);
1549 1.40 jdolecek return 0;
1550 1.40 jdolecek
1551 1.1 nonaka fail:
1552 1.40 jdolecek if (sc->sc_use_mq)
1553 1.40 jdolecek sc->sc_intr_disestablish(sc, q->q_id);
1554 1.40 jdolecek
1555 1.1 nonaka nvme_ccb_put(sc->sc_admin_q, ccb);
1556 1.1 nonaka return rv;
1557 1.1 nonaka }
1558 1.1 nonaka
1559 1.1 nonaka static int
1560 1.1 nonaka nvme_q_delete(struct nvme_softc *sc, struct nvme_queue *q)
1561 1.1 nonaka {
1562 1.1 nonaka struct nvme_sqe_q sqe;
1563 1.1 nonaka struct nvme_ccb *ccb;
1564 1.1 nonaka int rv;
1565 1.1 nonaka
1566 1.34 jdolecek ccb = nvme_ccb_get(sc->sc_admin_q, false);
1567 1.1 nonaka KASSERT(ccb != NULL);
1568 1.1 nonaka
1569 1.1 nonaka ccb->ccb_done = nvme_empty_done;
1570 1.1 nonaka ccb->ccb_cookie = &sqe;
1571 1.1 nonaka
1572 1.1 nonaka memset(&sqe, 0, sizeof(sqe));
1573 1.1 nonaka sqe.opcode = NVM_ADMIN_DEL_IOSQ;
1574 1.1 nonaka htolem16(&sqe.qid, q->q_id);
1575 1.1 nonaka
1576 1.7 jdolecek rv = nvme_poll(sc, sc->sc_admin_q, ccb, nvme_sqe_fill, NVME_TIMO_QOP);
1577 1.1 nonaka if (rv != 0)
1578 1.1 nonaka goto fail;
1579 1.1 nonaka
1580 1.1 nonaka ccb->ccb_done = nvme_empty_done;
1581 1.1 nonaka ccb->ccb_cookie = &sqe;
1582 1.1 nonaka
1583 1.1 nonaka memset(&sqe, 0, sizeof(sqe));
1584 1.1 nonaka sqe.opcode = NVM_ADMIN_DEL_IOCQ;
1585 1.1 nonaka htolem16(&sqe.qid, q->q_id);
1586 1.1 nonaka
1587 1.7 jdolecek rv = nvme_poll(sc, sc->sc_admin_q, ccb, nvme_sqe_fill, NVME_TIMO_QOP);
1588 1.1 nonaka if (rv != 0)
1589 1.1 nonaka goto fail;
1590 1.1 nonaka
1591 1.1 nonaka fail:
1592 1.1 nonaka nvme_ccb_put(sc->sc_admin_q, ccb);
1593 1.1 nonaka
1594 1.1 nonaka if (rv == 0 && sc->sc_use_mq) {
1595 1.1 nonaka if (sc->sc_intr_disestablish(sc, q->q_id))
1596 1.1 nonaka rv = 1;
1597 1.1 nonaka }
1598 1.1 nonaka
1599 1.1 nonaka return rv;
1600 1.1 nonaka }
1601 1.1 nonaka
1602 1.1 nonaka static void
1603 1.1 nonaka nvme_fill_identify(struct nvme_queue *q, struct nvme_ccb *ccb, void *slot)
1604 1.1 nonaka {
1605 1.1 nonaka struct nvme_sqe *sqe = slot;
1606 1.1 nonaka struct nvme_dmamem *mem = ccb->ccb_cookie;
1607 1.1 nonaka
1608 1.1 nonaka sqe->opcode = NVM_ADMIN_IDENTIFY;
1609 1.19 jdolecek htolem64(&sqe->entry.prp[0], NVME_DMA_DVA(mem));
1610 1.1 nonaka htolem32(&sqe->cdw10, 1);
1611 1.1 nonaka }
1612 1.1 nonaka
1613 1.1 nonaka static int
1614 1.47 nonaka nvme_set_number_of_queues(struct nvme_softc *sc, u_int nq, u_int *ncqa,
1615 1.47 nonaka u_int *nsqa)
1616 1.23 nonaka {
1617 1.36 jdolecek struct nvme_pt_state state;
1618 1.23 nonaka struct nvme_pt_command pt;
1619 1.23 nonaka struct nvme_ccb *ccb;
1620 1.23 nonaka int rv;
1621 1.23 nonaka
1622 1.34 jdolecek ccb = nvme_ccb_get(sc->sc_admin_q, false);
1623 1.23 nonaka KASSERT(ccb != NULL); /* it's a bug if we don't have spare ccb here */
1624 1.23 nonaka
1625 1.23 nonaka memset(&pt, 0, sizeof(pt));
1626 1.47 nonaka pt.cmd.opcode = NVM_ADMIN_SET_FEATURES;
1627 1.51 ryo pt.cmd.cdw10 = NVM_FEATURE_NUMBER_OF_QUEUES;
1628 1.51 ryo pt.cmd.cdw11 = ((nq - 1) << 16) | (nq - 1);
1629 1.23 nonaka
1630 1.36 jdolecek memset(&state, 0, sizeof(state));
1631 1.36 jdolecek state.pt = &pt;
1632 1.36 jdolecek state.finished = false;
1633 1.36 jdolecek
1634 1.23 nonaka ccb->ccb_done = nvme_pt_done;
1635 1.36 jdolecek ccb->ccb_cookie = &state;
1636 1.23 nonaka
1637 1.23 nonaka rv = nvme_poll(sc, sc->sc_admin_q, ccb, nvme_pt_fill, NVME_TIMO_QOP);
1638 1.23 nonaka
1639 1.23 nonaka if (rv != 0) {
1640 1.47 nonaka *ncqa = *nsqa = 0;
1641 1.23 nonaka return EIO;
1642 1.23 nonaka }
1643 1.23 nonaka
1644 1.47 nonaka *ncqa = (pt.cpl.cdw0 >> 16) + 1;
1645 1.47 nonaka *nsqa = (pt.cpl.cdw0 & 0xffff) + 1;
1646 1.23 nonaka
1647 1.23 nonaka return 0;
1648 1.23 nonaka }
1649 1.23 nonaka
1650 1.23 nonaka static int
1651 1.20 jdolecek nvme_ccbs_alloc(struct nvme_queue *q, uint16_t nccbs)
1652 1.1 nonaka {
1653 1.1 nonaka struct nvme_softc *sc = q->q_sc;
1654 1.1 nonaka struct nvme_ccb *ccb;
1655 1.1 nonaka bus_addr_t off;
1656 1.1 nonaka uint64_t *prpl;
1657 1.1 nonaka u_int i;
1658 1.1 nonaka
1659 1.1 nonaka mutex_init(&q->q_ccb_mtx, MUTEX_DEFAULT, IPL_BIO);
1660 1.34 jdolecek cv_init(&q->q_ccb_wait, "nvmeqw");
1661 1.34 jdolecek q->q_ccb_waiting = false;
1662 1.1 nonaka SIMPLEQ_INIT(&q->q_ccb_list);
1663 1.1 nonaka
1664 1.1 nonaka q->q_ccbs = kmem_alloc(sizeof(*ccb) * nccbs, KM_SLEEP);
1665 1.1 nonaka
1666 1.1 nonaka q->q_nccbs = nccbs;
1667 1.19 jdolecek q->q_ccb_prpls = nvme_dmamem_alloc(sc,
1668 1.19 jdolecek sizeof(*prpl) * sc->sc_max_sgl * nccbs);
1669 1.1 nonaka
1670 1.1 nonaka prpl = NVME_DMA_KVA(q->q_ccb_prpls);
1671 1.1 nonaka off = 0;
1672 1.1 nonaka
1673 1.1 nonaka for (i = 0; i < nccbs; i++) {
1674 1.1 nonaka ccb = &q->q_ccbs[i];
1675 1.1 nonaka
1676 1.1 nonaka if (bus_dmamap_create(sc->sc_dmat, sc->sc_mdts,
1677 1.1 nonaka sc->sc_max_sgl + 1 /* we get a free prp in the sqe */,
1678 1.1 nonaka sc->sc_mps, sc->sc_mps, BUS_DMA_WAITOK | BUS_DMA_ALLOCNOW,
1679 1.1 nonaka &ccb->ccb_dmamap) != 0)
1680 1.1 nonaka goto free_maps;
1681 1.1 nonaka
1682 1.1 nonaka ccb->ccb_id = i;
1683 1.1 nonaka ccb->ccb_prpl = prpl;
1684 1.1 nonaka ccb->ccb_prpl_off = off;
1685 1.1 nonaka ccb->ccb_prpl_dva = NVME_DMA_DVA(q->q_ccb_prpls) + off;
1686 1.1 nonaka
1687 1.1 nonaka SIMPLEQ_INSERT_TAIL(&q->q_ccb_list, ccb, ccb_entry);
1688 1.1 nonaka
1689 1.1 nonaka prpl += sc->sc_max_sgl;
1690 1.1 nonaka off += sizeof(*prpl) * sc->sc_max_sgl;
1691 1.1 nonaka }
1692 1.1 nonaka
1693 1.1 nonaka return 0;
1694 1.1 nonaka
1695 1.1 nonaka free_maps:
1696 1.1 nonaka nvme_ccbs_free(q);
1697 1.1 nonaka return 1;
1698 1.1 nonaka }
1699 1.1 nonaka
1700 1.1 nonaka static struct nvme_ccb *
1701 1.34 jdolecek nvme_ccb_get(struct nvme_queue *q, bool wait)
1702 1.1 nonaka {
1703 1.20 jdolecek struct nvme_ccb *ccb = NULL;
1704 1.1 nonaka
1705 1.1 nonaka mutex_enter(&q->q_ccb_mtx);
1706 1.34 jdolecek again:
1707 1.33 jdolecek ccb = SIMPLEQ_FIRST(&q->q_ccb_list);
1708 1.33 jdolecek if (ccb != NULL) {
1709 1.1 nonaka SIMPLEQ_REMOVE_HEAD(&q->q_ccb_list, ccb_entry);
1710 1.18 jdolecek #ifdef DEBUG
1711 1.18 jdolecek ccb->ccb_cookie = NULL;
1712 1.18 jdolecek #endif
1713 1.34 jdolecek } else {
1714 1.34 jdolecek if (__predict_false(wait)) {
1715 1.34 jdolecek q->q_ccb_waiting = true;
1716 1.34 jdolecek cv_wait(&q->q_ccb_wait, &q->q_ccb_mtx);
1717 1.34 jdolecek goto again;
1718 1.34 jdolecek }
1719 1.18 jdolecek }
1720 1.1 nonaka mutex_exit(&q->q_ccb_mtx);
1721 1.1 nonaka
1722 1.1 nonaka return ccb;
1723 1.1 nonaka }
1724 1.1 nonaka
1725 1.1 nonaka static void
1726 1.1 nonaka nvme_ccb_put(struct nvme_queue *q, struct nvme_ccb *ccb)
1727 1.1 nonaka {
1728 1.1 nonaka
1729 1.1 nonaka mutex_enter(&q->q_ccb_mtx);
1730 1.18 jdolecek #ifdef DEBUG
1731 1.18 jdolecek ccb->ccb_cookie = (void *)NVME_CCB_FREE;
1732 1.18 jdolecek #endif
1733 1.1 nonaka SIMPLEQ_INSERT_HEAD(&q->q_ccb_list, ccb, ccb_entry);
1734 1.34 jdolecek
1735 1.34 jdolecek /* It's unlikely there are any waiters, it's not used for regular I/O */
1736 1.34 jdolecek if (__predict_false(q->q_ccb_waiting)) {
1737 1.34 jdolecek q->q_ccb_waiting = false;
1738 1.34 jdolecek cv_broadcast(&q->q_ccb_wait);
1739 1.34 jdolecek }
1740 1.34 jdolecek
1741 1.1 nonaka mutex_exit(&q->q_ccb_mtx);
1742 1.1 nonaka }
1743 1.1 nonaka
1744 1.1 nonaka static void
1745 1.1 nonaka nvme_ccbs_free(struct nvme_queue *q)
1746 1.1 nonaka {
1747 1.1 nonaka struct nvme_softc *sc = q->q_sc;
1748 1.1 nonaka struct nvme_ccb *ccb;
1749 1.1 nonaka
1750 1.1 nonaka mutex_enter(&q->q_ccb_mtx);
1751 1.1 nonaka while ((ccb = SIMPLEQ_FIRST(&q->q_ccb_list)) != NULL) {
1752 1.1 nonaka SIMPLEQ_REMOVE_HEAD(&q->q_ccb_list, ccb_entry);
1753 1.48 ryo /*
1754 1.48 ryo * bus_dmamap_destroy() may call vm_map_lock() and rw_enter()
1755 1.48 ryo * internally. don't hold spin mutex
1756 1.48 ryo */
1757 1.48 ryo mutex_exit(&q->q_ccb_mtx);
1758 1.1 nonaka bus_dmamap_destroy(sc->sc_dmat, ccb->ccb_dmamap);
1759 1.48 ryo mutex_enter(&q->q_ccb_mtx);
1760 1.1 nonaka }
1761 1.1 nonaka mutex_exit(&q->q_ccb_mtx);
1762 1.1 nonaka
1763 1.19 jdolecek nvme_dmamem_free(sc, q->q_ccb_prpls);
1764 1.1 nonaka kmem_free(q->q_ccbs, sizeof(*ccb) * q->q_nccbs);
1765 1.1 nonaka q->q_ccbs = NULL;
1766 1.34 jdolecek cv_destroy(&q->q_ccb_wait);
1767 1.1 nonaka mutex_destroy(&q->q_ccb_mtx);
1768 1.1 nonaka }
1769 1.1 nonaka
1770 1.1 nonaka static struct nvme_queue *
1771 1.1 nonaka nvme_q_alloc(struct nvme_softc *sc, uint16_t id, u_int entries, u_int dstrd)
1772 1.1 nonaka {
1773 1.1 nonaka struct nvme_queue *q;
1774 1.1 nonaka
1775 1.1 nonaka q = kmem_alloc(sizeof(*q), KM_SLEEP);
1776 1.1 nonaka q->q_sc = sc;
1777 1.19 jdolecek q->q_sq_dmamem = nvme_dmamem_alloc(sc,
1778 1.19 jdolecek sizeof(struct nvme_sqe) * entries);
1779 1.19 jdolecek if (q->q_sq_dmamem == NULL)
1780 1.1 nonaka goto free;
1781 1.1 nonaka
1782 1.19 jdolecek q->q_cq_dmamem = nvme_dmamem_alloc(sc,
1783 1.19 jdolecek sizeof(struct nvme_cqe) * entries);
1784 1.19 jdolecek if (q->q_cq_dmamem == NULL)
1785 1.1 nonaka goto free_sq;
1786 1.1 nonaka
1787 1.1 nonaka memset(NVME_DMA_KVA(q->q_sq_dmamem), 0, NVME_DMA_LEN(q->q_sq_dmamem));
1788 1.1 nonaka memset(NVME_DMA_KVA(q->q_cq_dmamem), 0, NVME_DMA_LEN(q->q_cq_dmamem));
1789 1.1 nonaka
1790 1.1 nonaka mutex_init(&q->q_sq_mtx, MUTEX_DEFAULT, IPL_BIO);
1791 1.1 nonaka mutex_init(&q->q_cq_mtx, MUTEX_DEFAULT, IPL_BIO);
1792 1.1 nonaka q->q_sqtdbl = NVME_SQTDBL(id, dstrd);
1793 1.1 nonaka q->q_cqhdbl = NVME_CQHDBL(id, dstrd);
1794 1.1 nonaka q->q_id = id;
1795 1.1 nonaka q->q_entries = entries;
1796 1.1 nonaka q->q_sq_tail = 0;
1797 1.1 nonaka q->q_cq_head = 0;
1798 1.1 nonaka q->q_cq_phase = NVME_CQE_PHASE;
1799 1.1 nonaka
1800 1.1 nonaka nvme_dmamem_sync(sc, q->q_sq_dmamem, BUS_DMASYNC_PREWRITE);
1801 1.1 nonaka nvme_dmamem_sync(sc, q->q_cq_dmamem, BUS_DMASYNC_PREREAD);
1802 1.1 nonaka
1803 1.20 jdolecek /*
1804 1.20 jdolecek * Due to definition of full and empty queue (queue is empty
1805 1.20 jdolecek * when head == tail, full when tail is one less then head),
1806 1.20 jdolecek * we can actually only have (entries - 1) in-flight commands.
1807 1.20 jdolecek */
1808 1.20 jdolecek if (nvme_ccbs_alloc(q, entries - 1) != 0) {
1809 1.1 nonaka aprint_error_dev(sc->sc_dev, "unable to allocate ccbs\n");
1810 1.1 nonaka goto free_cq;
1811 1.1 nonaka }
1812 1.1 nonaka
1813 1.1 nonaka return q;
1814 1.1 nonaka
1815 1.1 nonaka free_cq:
1816 1.19 jdolecek nvme_dmamem_free(sc, q->q_cq_dmamem);
1817 1.1 nonaka free_sq:
1818 1.19 jdolecek nvme_dmamem_free(sc, q->q_sq_dmamem);
1819 1.1 nonaka free:
1820 1.1 nonaka kmem_free(q, sizeof(*q));
1821 1.1 nonaka
1822 1.1 nonaka return NULL;
1823 1.1 nonaka }
1824 1.1 nonaka
1825 1.1 nonaka static void
1826 1.1 nonaka nvme_q_free(struct nvme_softc *sc, struct nvme_queue *q)
1827 1.1 nonaka {
1828 1.1 nonaka nvme_ccbs_free(q);
1829 1.9 jdolecek mutex_destroy(&q->q_sq_mtx);
1830 1.9 jdolecek mutex_destroy(&q->q_cq_mtx);
1831 1.1 nonaka nvme_dmamem_sync(sc, q->q_cq_dmamem, BUS_DMASYNC_POSTREAD);
1832 1.1 nonaka nvme_dmamem_sync(sc, q->q_sq_dmamem, BUS_DMASYNC_POSTWRITE);
1833 1.19 jdolecek nvme_dmamem_free(sc, q->q_cq_dmamem);
1834 1.19 jdolecek nvme_dmamem_free(sc, q->q_sq_dmamem);
1835 1.1 nonaka kmem_free(q, sizeof(*q));
1836 1.1 nonaka }
1837 1.1 nonaka
1838 1.1 nonaka int
1839 1.1 nonaka nvme_intr(void *xsc)
1840 1.1 nonaka {
1841 1.1 nonaka struct nvme_softc *sc = xsc;
1842 1.1 nonaka
1843 1.10 jdolecek /*
1844 1.10 jdolecek * INTx is level triggered, controller deasserts the interrupt only
1845 1.10 jdolecek * when we advance command queue head via write to the doorbell.
1846 1.17 jdolecek * Tell the controller to block the interrupts while we process
1847 1.17 jdolecek * the queue(s).
1848 1.10 jdolecek */
1849 1.17 jdolecek nvme_write4(sc, NVME_INTMS, 1);
1850 1.17 jdolecek
1851 1.17 jdolecek softint_schedule(sc->sc_softih[0]);
1852 1.17 jdolecek
1853 1.17 jdolecek /* don't know, might not have been for us */
1854 1.17 jdolecek return 1;
1855 1.17 jdolecek }
1856 1.17 jdolecek
1857 1.17 jdolecek void
1858 1.17 jdolecek nvme_softintr_intx(void *xq)
1859 1.17 jdolecek {
1860 1.17 jdolecek struct nvme_queue *q = xq;
1861 1.17 jdolecek struct nvme_softc *sc = q->q_sc;
1862 1.17 jdolecek
1863 1.17 jdolecek nvme_q_complete(sc, sc->sc_admin_q);
1864 1.1 nonaka if (sc->sc_q != NULL)
1865 1.17 jdolecek nvme_q_complete(sc, sc->sc_q[0]);
1866 1.1 nonaka
1867 1.17 jdolecek /*
1868 1.17 jdolecek * Processing done, tell controller to issue interrupts again. There
1869 1.17 jdolecek * is no race, as NVMe spec requires the controller to maintain state,
1870 1.17 jdolecek * and assert the interrupt whenever there are unacknowledged
1871 1.17 jdolecek * completion queue entries.
1872 1.17 jdolecek */
1873 1.17 jdolecek nvme_write4(sc, NVME_INTMC, 1);
1874 1.1 nonaka }
1875 1.1 nonaka
1876 1.1 nonaka int
1877 1.9 jdolecek nvme_intr_msi(void *xq)
1878 1.1 nonaka {
1879 1.1 nonaka struct nvme_queue *q = xq;
1880 1.1 nonaka
1881 1.9 jdolecek KASSERT(q && q->q_sc && q->q_sc->sc_softih
1882 1.9 jdolecek && q->q_sc->sc_softih[q->q_id]);
1883 1.1 nonaka
1884 1.17 jdolecek /*
1885 1.17 jdolecek * MSI/MSI-X are edge triggered, so can handover processing to softint
1886 1.17 jdolecek * without masking the interrupt.
1887 1.17 jdolecek */
1888 1.9 jdolecek softint_schedule(q->q_sc->sc_softih[q->q_id]);
1889 1.1 nonaka
1890 1.9 jdolecek return 1;
1891 1.1 nonaka }
1892 1.1 nonaka
1893 1.9 jdolecek void
1894 1.9 jdolecek nvme_softintr_msi(void *xq)
1895 1.1 nonaka {
1896 1.1 nonaka struct nvme_queue *q = xq;
1897 1.9 jdolecek struct nvme_softc *sc = q->q_sc;
1898 1.1 nonaka
1899 1.9 jdolecek nvme_q_complete(sc, q);
1900 1.1 nonaka }
1901 1.1 nonaka
1902 1.19 jdolecek static struct nvme_dmamem *
1903 1.19 jdolecek nvme_dmamem_alloc(struct nvme_softc *sc, size_t size)
1904 1.1 nonaka {
1905 1.19 jdolecek struct nvme_dmamem *ndm;
1906 1.1 nonaka int nsegs;
1907 1.1 nonaka
1908 1.19 jdolecek ndm = kmem_zalloc(sizeof(*ndm), KM_SLEEP);
1909 1.19 jdolecek if (ndm == NULL)
1910 1.19 jdolecek return NULL;
1911 1.19 jdolecek
1912 1.1 nonaka ndm->ndm_size = size;
1913 1.1 nonaka
1914 1.43 mrg if (bus_dmamap_create(sc->sc_dmat, size, btoc(round_page(size)), size, 0,
1915 1.1 nonaka BUS_DMA_WAITOK | BUS_DMA_ALLOCNOW, &ndm->ndm_map) != 0)
1916 1.1 nonaka goto ndmfree;
1917 1.1 nonaka
1918 1.1 nonaka if (bus_dmamem_alloc(sc->sc_dmat, size, sc->sc_mps, 0, &ndm->ndm_seg,
1919 1.1 nonaka 1, &nsegs, BUS_DMA_WAITOK) != 0)
1920 1.1 nonaka goto destroy;
1921 1.1 nonaka
1922 1.1 nonaka if (bus_dmamem_map(sc->sc_dmat, &ndm->ndm_seg, nsegs, size,
1923 1.1 nonaka &ndm->ndm_kva, BUS_DMA_WAITOK) != 0)
1924 1.1 nonaka goto free;
1925 1.1 nonaka memset(ndm->ndm_kva, 0, size);
1926 1.1 nonaka
1927 1.1 nonaka if (bus_dmamap_load(sc->sc_dmat, ndm->ndm_map, ndm->ndm_kva, size,
1928 1.1 nonaka NULL, BUS_DMA_WAITOK) != 0)
1929 1.1 nonaka goto unmap;
1930 1.1 nonaka
1931 1.19 jdolecek return ndm;
1932 1.1 nonaka
1933 1.1 nonaka unmap:
1934 1.1 nonaka bus_dmamem_unmap(sc->sc_dmat, ndm->ndm_kva, size);
1935 1.1 nonaka free:
1936 1.1 nonaka bus_dmamem_free(sc->sc_dmat, &ndm->ndm_seg, 1);
1937 1.1 nonaka destroy:
1938 1.1 nonaka bus_dmamap_destroy(sc->sc_dmat, ndm->ndm_map);
1939 1.1 nonaka ndmfree:
1940 1.19 jdolecek kmem_free(ndm, sizeof(*ndm));
1941 1.19 jdolecek return NULL;
1942 1.19 jdolecek }
1943 1.19 jdolecek
1944 1.19 jdolecek static void
1945 1.19 jdolecek nvme_dmamem_sync(struct nvme_softc *sc, struct nvme_dmamem *mem, int ops)
1946 1.19 jdolecek {
1947 1.19 jdolecek bus_dmamap_sync(sc->sc_dmat, NVME_DMA_MAP(mem),
1948 1.19 jdolecek 0, NVME_DMA_LEN(mem), ops);
1949 1.1 nonaka }
1950 1.1 nonaka
1951 1.1 nonaka void
1952 1.1 nonaka nvme_dmamem_free(struct nvme_softc *sc, struct nvme_dmamem *ndm)
1953 1.1 nonaka {
1954 1.1 nonaka bus_dmamap_unload(sc->sc_dmat, ndm->ndm_map);
1955 1.1 nonaka bus_dmamem_unmap(sc->sc_dmat, ndm->ndm_kva, ndm->ndm_size);
1956 1.1 nonaka bus_dmamem_free(sc->sc_dmat, &ndm->ndm_seg, 1);
1957 1.1 nonaka bus_dmamap_destroy(sc->sc_dmat, ndm->ndm_map);
1958 1.19 jdolecek kmem_free(ndm, sizeof(*ndm));
1959 1.1 nonaka }
1960 1.3 nonaka
1961 1.3 nonaka /*
1962 1.3 nonaka * ioctl
1963 1.3 nonaka */
1964 1.3 nonaka
1965 1.3 nonaka dev_type_open(nvmeopen);
1966 1.3 nonaka dev_type_close(nvmeclose);
1967 1.3 nonaka dev_type_ioctl(nvmeioctl);
1968 1.3 nonaka
1969 1.3 nonaka const struct cdevsw nvme_cdevsw = {
1970 1.3 nonaka .d_open = nvmeopen,
1971 1.3 nonaka .d_close = nvmeclose,
1972 1.3 nonaka .d_read = noread,
1973 1.3 nonaka .d_write = nowrite,
1974 1.3 nonaka .d_ioctl = nvmeioctl,
1975 1.3 nonaka .d_stop = nostop,
1976 1.3 nonaka .d_tty = notty,
1977 1.3 nonaka .d_poll = nopoll,
1978 1.3 nonaka .d_mmap = nommap,
1979 1.3 nonaka .d_kqfilter = nokqfilter,
1980 1.3 nonaka .d_discard = nodiscard,
1981 1.3 nonaka .d_flag = D_OTHER,
1982 1.3 nonaka };
1983 1.3 nonaka
1984 1.3 nonaka /*
1985 1.3 nonaka * Accept an open operation on the control device.
1986 1.3 nonaka */
1987 1.3 nonaka int
1988 1.3 nonaka nvmeopen(dev_t dev, int flag, int mode, struct lwp *l)
1989 1.3 nonaka {
1990 1.3 nonaka struct nvme_softc *sc;
1991 1.3 nonaka int unit = minor(dev) / 0x10000;
1992 1.3 nonaka int nsid = minor(dev) & 0xffff;
1993 1.3 nonaka int nsidx;
1994 1.3 nonaka
1995 1.3 nonaka if ((sc = device_lookup_private(&nvme_cd, unit)) == NULL)
1996 1.3 nonaka return ENXIO;
1997 1.3 nonaka if ((sc->sc_flags & NVME_F_ATTACHED) == 0)
1998 1.3 nonaka return ENXIO;
1999 1.3 nonaka
2000 1.5 nonaka if (nsid == 0) {
2001 1.5 nonaka /* controller */
2002 1.5 nonaka if (ISSET(sc->sc_flags, NVME_F_OPEN))
2003 1.5 nonaka return EBUSY;
2004 1.5 nonaka SET(sc->sc_flags, NVME_F_OPEN);
2005 1.5 nonaka } else {
2006 1.5 nonaka /* namespace */
2007 1.5 nonaka nsidx = nsid - 1;
2008 1.5 nonaka if (nsidx >= sc->sc_nn || sc->sc_namespaces[nsidx].dev == NULL)
2009 1.5 nonaka return ENXIO;
2010 1.5 nonaka if (ISSET(sc->sc_namespaces[nsidx].flags, NVME_NS_F_OPEN))
2011 1.5 nonaka return EBUSY;
2012 1.5 nonaka SET(sc->sc_namespaces[nsidx].flags, NVME_NS_F_OPEN);
2013 1.5 nonaka }
2014 1.3 nonaka return 0;
2015 1.3 nonaka }
2016 1.3 nonaka
2017 1.3 nonaka /*
2018 1.3 nonaka * Accept the last close on the control device.
2019 1.3 nonaka */
2020 1.3 nonaka int
2021 1.5 nonaka nvmeclose(dev_t dev, int flag, int mode, struct lwp *l)
2022 1.3 nonaka {
2023 1.3 nonaka struct nvme_softc *sc;
2024 1.3 nonaka int unit = minor(dev) / 0x10000;
2025 1.3 nonaka int nsid = minor(dev) & 0xffff;
2026 1.3 nonaka int nsidx;
2027 1.3 nonaka
2028 1.3 nonaka sc = device_lookup_private(&nvme_cd, unit);
2029 1.3 nonaka if (sc == NULL)
2030 1.3 nonaka return ENXIO;
2031 1.3 nonaka
2032 1.5 nonaka if (nsid == 0) {
2033 1.5 nonaka /* controller */
2034 1.5 nonaka CLR(sc->sc_flags, NVME_F_OPEN);
2035 1.5 nonaka } else {
2036 1.5 nonaka /* namespace */
2037 1.5 nonaka nsidx = nsid - 1;
2038 1.5 nonaka if (nsidx >= sc->sc_nn)
2039 1.5 nonaka return ENXIO;
2040 1.5 nonaka CLR(sc->sc_namespaces[nsidx].flags, NVME_NS_F_OPEN);
2041 1.5 nonaka }
2042 1.3 nonaka
2043 1.3 nonaka return 0;
2044 1.3 nonaka }
2045 1.3 nonaka
2046 1.3 nonaka /*
2047 1.3 nonaka * Handle control operations.
2048 1.3 nonaka */
2049 1.3 nonaka int
2050 1.5 nonaka nvmeioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
2051 1.3 nonaka {
2052 1.3 nonaka struct nvme_softc *sc;
2053 1.3 nonaka int unit = minor(dev) / 0x10000;
2054 1.3 nonaka int nsid = minor(dev) & 0xffff;
2055 1.5 nonaka struct nvme_pt_command *pt;
2056 1.3 nonaka
2057 1.3 nonaka sc = device_lookup_private(&nvme_cd, unit);
2058 1.3 nonaka if (sc == NULL)
2059 1.3 nonaka return ENXIO;
2060 1.3 nonaka
2061 1.3 nonaka switch (cmd) {
2062 1.3 nonaka case NVME_PASSTHROUGH_CMD:
2063 1.5 nonaka pt = data;
2064 1.5 nonaka return nvme_command_passthrough(sc, data,
2065 1.5 nonaka nsid == 0 ? pt->cmd.nsid : nsid, l, nsid == 0);
2066 1.3 nonaka }
2067 1.3 nonaka
2068 1.3 nonaka return ENOTTY;
2069 1.3 nonaka }
2070