]>
Commit | Line | Data |
---|---|---|
112e584b SZ |
1 | /** @file\r |
2 | Provide functions to initialize NVME controller and perform NVME commands\r | |
3 | \r | |
4 | Copyright (c) 2016 - 2018, Intel Corporation. All rights reserved.<BR>\r | |
5 | This program and the accompanying materials\r | |
6 | are licensed and made available under the terms and conditions of the BSD License\r | |
7 | which accompanies this distribution. The full text of the license may be found at\r | |
8 | http://opensource.org/licenses/bsd-license.php\r | |
9 | \r | |
10 | THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r | |
11 | WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r | |
12 | \r | |
13 | **/\r | |
14 | \r | |
15 | #include "OpalPasswordPei.h"\r | |
16 | \r | |
17 | \r | |
18 | #define ALIGN(v, a) (UINTN)((((v) - 1) | ((a) - 1)) + 1)\r | |
19 | \r | |
20 | ///\r | |
21 | /// NVME Host controller registers operation\r | |
22 | ///\r | |
23 | #define NVME_GET_CAP(Nvme, Cap) NvmeMmioRead (Cap, Nvme->Nbar + NVME_CAP_OFFSET, sizeof (NVME_CAP))\r | |
24 | #define NVME_GET_CC(Nvme, Cc) NvmeMmioRead (Cc, Nvme->Nbar + NVME_CC_OFFSET, sizeof (NVME_CC))\r | |
25 | #define NVME_SET_CC(Nvme, Cc) NvmeMmioWrite (Nvme->Nbar + NVME_CC_OFFSET, Cc, sizeof (NVME_CC))\r | |
26 | #define NVME_GET_CSTS(Nvme, Csts) NvmeMmioRead (Csts, Nvme->Nbar + NVME_CSTS_OFFSET, sizeof (NVME_CSTS))\r | |
27 | #define NVME_GET_AQA(Nvme, Aqa) NvmeMmioRead (Aqa, Nvme->Nbar + NVME_AQA_OFFSET, sizeof (NVME_AQA))\r | |
28 | #define NVME_SET_AQA(Nvme, Aqa) NvmeMmioWrite (Nvme->Nbar + NVME_AQA_OFFSET, Aqa, sizeof (NVME_AQA))\r | |
29 | #define NVME_GET_ASQ(Nvme, Asq) NvmeMmioRead (Asq, Nvme->Nbar + NVME_ASQ_OFFSET, sizeof (NVME_ASQ))\r | |
30 | #define NVME_SET_ASQ(Nvme, Asq) NvmeMmioWrite (Nvme->Nbar + NVME_ASQ_OFFSET, Asq, sizeof (NVME_ASQ))\r | |
31 | #define NVME_GET_ACQ(Nvme, Acq) NvmeMmioRead (Acq, Nvme->Nbar + NVME_ACQ_OFFSET, sizeof (NVME_ACQ))\r | |
32 | #define NVME_SET_ACQ(Nvme, Acq) NvmeMmioWrite (Nvme->Nbar + NVME_ACQ_OFFSET, Acq, sizeof (NVME_ACQ))\r | |
33 | #define NVME_GET_VER(Nvme, Ver) NvmeMmioRead (Ver, Nvme->Nbar + NVME_VER_OFFSET, sizeof (NVME_VER))\r | |
34 | #define NVME_SET_SQTDBL(Nvme, Qid, Sqtdbl) NvmeMmioWrite (Nvme->Nbar + NVME_SQTDBL_OFFSET(Qid, Nvme->Cap.Dstrd), Sqtdbl, sizeof (NVME_SQTDBL))\r | |
35 | #define NVME_SET_CQHDBL(Nvme, Qid, Cqhdbl) NvmeMmioWrite (Nvme->Nbar + NVME_CQHDBL_OFFSET(Qid, Nvme->Cap.Dstrd), Cqhdbl, sizeof (NVME_CQHDBL))\r | |
36 | \r | |
37 | ///\r | |
38 | /// Base memory address\r | |
39 | ///\r | |
40 | enum {\r | |
41 | BASEMEM_CONTROLLER_DATA,\r | |
42 | BASEMEM_IDENTIFY_DATA,\r | |
43 | BASEMEM_ASQ,\r | |
44 | BASEMEM_ACQ,\r | |
45 | BASEMEM_SQ,\r | |
46 | BASEMEM_CQ,\r | |
47 | BASEMEM_PRP,\r | |
48 | BASEMEM_SECURITY,\r | |
49 | MAX_BASEMEM_COUNT\r | |
50 | };\r | |
51 | \r | |
52 | ///\r | |
53 | /// All of base memories are 4K(0x1000) alignment\r | |
54 | ///\r | |
55 | #define NVME_MEM_BASE(Nvme) ((UINTN)(Nvme->BaseMem))\r | |
56 | #define NVME_CONTROL_DATA_BASE(Nvme) (ALIGN (NVME_MEM_BASE(Nvme) + ((NvmeGetBaseMemPages (BASEMEM_CONTROLLER_DATA)) * EFI_PAGE_SIZE), EFI_PAGE_SIZE))\r | |
57 | #define NVME_NAMESPACE_DATA_BASE(Nvme) (ALIGN (NVME_MEM_BASE(Nvme) + ((NvmeGetBaseMemPages (BASEMEM_IDENTIFY_DATA)) * EFI_PAGE_SIZE), EFI_PAGE_SIZE))\r | |
58 | #define NVME_ASQ_BASE(Nvme) (ALIGN (NVME_MEM_BASE(Nvme) + ((NvmeGetBaseMemPages (BASEMEM_ASQ)) * EFI_PAGE_SIZE), EFI_PAGE_SIZE))\r | |
59 | #define NVME_ACQ_BASE(Nvme) (ALIGN (NVME_MEM_BASE(Nvme) + ((NvmeGetBaseMemPages (BASEMEM_ACQ)) * EFI_PAGE_SIZE), EFI_PAGE_SIZE))\r | |
60 | #define NVME_SQ_BASE(Nvme, index) (ALIGN (NVME_MEM_BASE(Nvme) + ((NvmeGetBaseMemPages (BASEMEM_SQ) + ((index)*(NVME_MAX_IO_QUEUES-1))) * EFI_PAGE_SIZE), EFI_PAGE_SIZE))\r | |
61 | #define NVME_CQ_BASE(Nvme, index) (ALIGN (NVME_MEM_BASE(Nvme) + ((NvmeGetBaseMemPages (BASEMEM_CQ) + ((index)*(NVME_MAX_IO_QUEUES-1))) * EFI_PAGE_SIZE), EFI_PAGE_SIZE))\r | |
62 | #define NVME_PRP_BASE(Nvme, index) (ALIGN (NVME_MEM_BASE(Nvme) + ((NvmeGetBaseMemPages (BASEMEM_PRP) + ((index)*NVME_PRP_SIZE)) * EFI_PAGE_SIZE), EFI_PAGE_SIZE))\r | |
63 | #define NVME_SEC_BASE(Nvme) (ALIGN (NVME_MEM_BASE(Nvme) + ((NvmeGetBaseMemPages (BASEMEM_SECURITY)) * EFI_PAGE_SIZE), EFI_PAGE_SIZE))\r | |
64 | \r | |
65 | /**\r | |
66 | Transfer MMIO Data to memory.\r | |
67 | \r | |
68 | @param[in,out] MemBuffer - Destination: Memory address\r | |
69 | @param[in] MmioAddr - Source: MMIO address\r | |
70 | @param[in] Size - Size for read\r | |
71 | \r | |
72 | @retval EFI_SUCCESS - MMIO read sucessfully\r | |
73 | **/\r | |
74 | EFI_STATUS\r | |
75 | NvmeMmioRead (\r | |
76 | IN OUT VOID *MemBuffer,\r | |
77 | IN UINTN MmioAddr,\r | |
78 | IN UINTN Size\r | |
79 | )\r | |
80 | {\r | |
81 | UINTN Offset;\r | |
82 | UINT8 Data;\r | |
83 | UINT8 *Ptr;\r | |
84 | \r | |
85 | // priority has adjusted\r | |
86 | switch (Size) {\r | |
87 | case 4:\r | |
88 | *((UINT32 *)MemBuffer) = MmioRead32 (MmioAddr);\r | |
89 | break;\r | |
90 | \r | |
91 | case 8:\r | |
92 | *((UINT64 *)MemBuffer) = MmioRead64 (MmioAddr);\r | |
93 | break;\r | |
94 | \r | |
95 | case 2:\r | |
96 | *((UINT16 *)MemBuffer) = MmioRead16 (MmioAddr);\r | |
97 | break;\r | |
98 | \r | |
99 | case 1:\r | |
100 | *((UINT8 *)MemBuffer) = MmioRead8 (MmioAddr);\r | |
101 | break;\r | |
102 | \r | |
103 | default:\r | |
104 | Ptr = (UINT8 *)MemBuffer;\r | |
105 | for (Offset = 0; Offset < Size; Offset += 1) {\r | |
106 | Data = MmioRead8 (MmioAddr + Offset);\r | |
107 | Ptr[Offset] = Data;\r | |
108 | }\r | |
109 | break;\r | |
110 | }\r | |
111 | \r | |
112 | return EFI_SUCCESS;\r | |
113 | }\r | |
114 | \r | |
115 | /**\r | |
116 | Transfer memory data to MMIO.\r | |
117 | \r | |
118 | @param[in,out] MmioAddr - Destination: MMIO address\r | |
119 | @param[in] MemBuffer - Source: Memory address\r | |
120 | @param[in] Size - Size for write\r | |
121 | \r | |
122 | @retval EFI_SUCCESS - MMIO write sucessfully\r | |
123 | **/\r | |
124 | EFI_STATUS\r | |
125 | NvmeMmioWrite (\r | |
126 | IN OUT UINTN MmioAddr,\r | |
127 | IN VOID *MemBuffer,\r | |
128 | IN UINTN Size\r | |
129 | )\r | |
130 | {\r | |
131 | UINTN Offset;\r | |
132 | UINT8 Data;\r | |
133 | UINT8 *Ptr;\r | |
134 | \r | |
135 | // priority has adjusted\r | |
136 | switch (Size) {\r | |
137 | case 4:\r | |
138 | MmioWrite32 (MmioAddr, *((UINT32 *)MemBuffer));\r | |
139 | break;\r | |
140 | \r | |
141 | case 8:\r | |
142 | MmioWrite64 (MmioAddr, *((UINT64 *)MemBuffer));\r | |
143 | break;\r | |
144 | \r | |
145 | case 2:\r | |
146 | MmioWrite16 (MmioAddr, *((UINT16 *)MemBuffer));\r | |
147 | break;\r | |
148 | \r | |
149 | case 1:\r | |
150 | MmioWrite8 (MmioAddr, *((UINT8 *)MemBuffer));\r | |
151 | break;\r | |
152 | \r | |
153 | default:\r | |
154 | Ptr = (UINT8 *)MemBuffer;\r | |
155 | for (Offset = 0; Offset < Size; Offset += 1) {\r | |
156 | Data = Ptr[Offset];\r | |
157 | MmioWrite8 (MmioAddr + Offset, Data);\r | |
158 | }\r | |
159 | break;\r | |
160 | }\r | |
161 | \r | |
162 | return EFI_SUCCESS;\r | |
163 | }\r | |
164 | \r | |
165 | /**\r | |
166 | Transfer MMIO data to memory.\r | |
167 | \r | |
168 | @param[in,out] MemBuffer - Destination: Memory address\r | |
169 | @param[in] MmioAddr - Source: MMIO address\r | |
170 | @param[in] Size - Size for read\r | |
171 | \r | |
172 | @retval EFI_SUCCESS - MMIO read sucessfully\r | |
173 | **/\r | |
174 | EFI_STATUS\r | |
175 | OpalPciRead (\r | |
176 | IN OUT VOID *MemBuffer,\r | |
177 | IN UINTN MmioAddr,\r | |
178 | IN UINTN Size\r | |
179 | )\r | |
180 | {\r | |
181 | UINTN Offset;\r | |
182 | UINT8 Data;\r | |
183 | UINT8 *Ptr;\r | |
184 | \r | |
185 | // priority has adjusted\r | |
186 | switch (Size) {\r | |
187 | case 4:\r | |
188 | *((UINT32 *)MemBuffer) = PciRead32 (MmioAddr);\r | |
189 | break;\r | |
190 | \r | |
191 | case 2:\r | |
192 | *((UINT16 *)MemBuffer) = PciRead16 (MmioAddr);\r | |
193 | break;\r | |
194 | \r | |
195 | case 1:\r | |
196 | *((UINT8 *)MemBuffer) = PciRead8 (MmioAddr);\r | |
197 | break;\r | |
198 | \r | |
199 | default:\r | |
200 | Ptr = (UINT8 *)MemBuffer;\r | |
201 | for (Offset = 0; Offset < Size; Offset += 1) {\r | |
202 | Data = PciRead8 (MmioAddr + Offset);\r | |
203 | Ptr[Offset] = Data;\r | |
204 | }\r | |
205 | break;\r | |
206 | }\r | |
207 | \r | |
208 | return EFI_SUCCESS;\r | |
209 | }\r | |
210 | \r | |
211 | /**\r | |
212 | Transfer memory data to MMIO.\r | |
213 | \r | |
214 | @param[in,out] MmioAddr - Destination: MMIO address\r | |
215 | @param[in] MemBuffer - Source: Memory address\r | |
216 | @param[in] Size - Size for write\r | |
217 | \r | |
218 | @retval EFI_SUCCESS - MMIO write sucessfully\r | |
219 | **/\r | |
220 | EFI_STATUS\r | |
221 | OpalPciWrite (\r | |
222 | IN OUT UINTN MmioAddr,\r | |
223 | IN VOID *MemBuffer,\r | |
224 | IN UINTN Size\r | |
225 | )\r | |
226 | {\r | |
227 | UINTN Offset;\r | |
228 | UINT8 Data;\r | |
229 | UINT8 *Ptr;\r | |
230 | \r | |
231 | // priority has adjusted\r | |
232 | switch (Size) {\r | |
233 | case 4:\r | |
234 | PciWrite32 (MmioAddr, *((UINT32 *)MemBuffer));\r | |
235 | break;\r | |
236 | \r | |
237 | case 2:\r | |
238 | PciWrite16 (MmioAddr, *((UINT16 *)MemBuffer));\r | |
239 | break;\r | |
240 | \r | |
241 | case 1:\r | |
242 | PciWrite8 (MmioAddr, *((UINT8 *)MemBuffer));\r | |
243 | break;\r | |
244 | \r | |
245 | default:\r | |
246 | Ptr = (UINT8 *)MemBuffer;\r | |
247 | for (Offset = 0; Offset < Size; Offset += 1) {\r | |
248 | Data = Ptr[Offset];\r | |
249 | PciWrite8 (MmioAddr + Offset, Data);\r | |
250 | }\r | |
251 | break;\r | |
252 | }\r | |
253 | \r | |
254 | return EFI_SUCCESS;\r | |
255 | }\r | |
256 | \r | |
257 | /**\r | |
258 | Get total pages for specific NVME based memory.\r | |
259 | \r | |
260 | @param[in] BaseMemIndex - The Index of BaseMem (0-based).\r | |
261 | \r | |
262 | @retval - The page count for specific BaseMem Index\r | |
263 | \r | |
264 | **/\r | |
265 | UINT32\r | |
266 | NvmeGetBaseMemPages (\r | |
267 | IN UINTN BaseMemIndex\r | |
268 | )\r | |
269 | {\r | |
270 | UINT32 Pages;\r | |
271 | UINTN Index;\r | |
272 | UINT32 PageSizeList[8];\r | |
273 | \r | |
274 | PageSizeList[0] = 1; /* Controller Data */\r | |
275 | PageSizeList[1] = 1; /* Identify Data */\r | |
276 | PageSizeList[2] = 1; /* ASQ */\r | |
277 | PageSizeList[3] = 1; /* ACQ */\r | |
278 | PageSizeList[4] = 1; /* SQs */\r | |
279 | PageSizeList[5] = 1; /* CQs */\r | |
280 | PageSizeList[6] = NVME_PRP_SIZE * NVME_CSQ_DEPTH; /* PRPs */\r | |
281 | PageSizeList[7] = 1; /* Security Commands */\r | |
282 | \r | |
283 | if (BaseMemIndex > MAX_BASEMEM_COUNT) {\r | |
284 | ASSERT (FALSE);\r | |
285 | return 0;\r | |
286 | }\r | |
287 | \r | |
288 | Pages = 0;\r | |
289 | for (Index = 0; Index < BaseMemIndex; Index++) {\r | |
290 | Pages += PageSizeList[Index];\r | |
291 | }\r | |
292 | \r | |
293 | return Pages;\r | |
294 | }\r | |
295 | \r | |
296 | /**\r | |
297 | Wait for NVME controller status to be ready or not.\r | |
298 | \r | |
299 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
300 | @param[in] WaitReady - Flag for waitting status ready or not\r | |
301 | \r | |
302 | @return EFI_SUCCESS - Successfully to wait specific status.\r | |
303 | @return others - Fail to wait for specific controller status.\r | |
304 | \r | |
305 | **/\r | |
306 | STATIC\r | |
307 | EFI_STATUS\r | |
308 | NvmeWaitController (\r | |
309 | IN NVME_CONTEXT *Nvme,\r | |
310 | IN BOOLEAN WaitReady\r | |
311 | )\r | |
312 | {\r | |
313 | NVME_CSTS Csts;\r | |
314 | EFI_STATUS Status;\r | |
315 | UINT32 Index;\r | |
316 | UINT8 Timeout;\r | |
317 | \r | |
318 | //\r | |
319 | // Cap.To specifies max delay time in 500ms increments for Csts.Rdy to set after\r | |
320 | // Cc.Enable. Loop produces a 1 millisecond delay per itteration, up to 500 * Cap.To.\r | |
321 | //\r | |
322 | if (Nvme->Cap.To == 0) {\r | |
323 | Timeout = 1;\r | |
324 | } else {\r | |
325 | Timeout = Nvme->Cap.To;\r | |
326 | }\r | |
327 | \r | |
328 | Status = EFI_SUCCESS;\r | |
329 | for(Index = (Timeout * 500); Index != 0; --Index) {\r | |
330 | MicroSecondDelay (1000);\r | |
331 | \r | |
332 | //\r | |
333 | // Check if the controller is initialized\r | |
334 | //\r | |
335 | Status = NVME_GET_CSTS (Nvme, &Csts);\r | |
336 | if (EFI_ERROR(Status)) {\r | |
337 | DEBUG ((DEBUG_ERROR, "NVME_GET_CSTS fail, Status = %r\n", Status));\r | |
338 | return Status;\r | |
339 | }\r | |
340 | \r | |
341 | if ((BOOLEAN) Csts.Rdy == WaitReady) {\r | |
342 | break;\r | |
343 | }\r | |
344 | }\r | |
345 | \r | |
346 | if (Index == 0) {\r | |
347 | Status = EFI_TIMEOUT;\r | |
348 | }\r | |
349 | \r | |
350 | return Status;\r | |
351 | }\r | |
352 | \r | |
353 | /**\r | |
354 | Disable the Nvm Express controller.\r | |
355 | \r | |
356 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
357 | \r | |
358 | @return EFI_SUCCESS - Successfully disable the controller.\r | |
359 | @return others - Fail to disable the controller.\r | |
360 | \r | |
361 | **/\r | |
362 | STATIC\r | |
363 | EFI_STATUS\r | |
364 | NvmeDisableController (\r | |
365 | IN NVME_CONTEXT *Nvme\r | |
366 | )\r | |
367 | {\r | |
368 | NVME_CC Cc;\r | |
369 | NVME_CSTS Csts;\r | |
370 | EFI_STATUS Status;\r | |
371 | \r | |
372 | Status = NVME_GET_CSTS (Nvme, &Csts);\r | |
373 | \r | |
374 | ///\r | |
375 | /// Read Controller Configuration Register.\r | |
376 | ///\r | |
377 | Status = NVME_GET_CC (Nvme, &Cc);\r | |
378 | if (EFI_ERROR(Status)) {\r | |
379 | DEBUG ((DEBUG_ERROR, "NVME_GET_CC fail, Status = %r\n", Status));\r | |
380 | goto Done;\r | |
381 | }\r | |
382 | \r | |
383 | if (Cc.En == 1) {\r | |
384 | Cc.En = 0;\r | |
385 | ///\r | |
386 | /// Disable the controller.\r | |
387 | ///\r | |
388 | Status = NVME_SET_CC (Nvme, &Cc);\r | |
389 | if (EFI_ERROR(Status)) {\r | |
390 | DEBUG ((DEBUG_ERROR, "NVME_SET_CC fail, Status = %r\n", Status));\r | |
391 | goto Done;\r | |
392 | }\r | |
393 | }\r | |
394 | \r | |
395 | Status = NvmeWaitController (Nvme, FALSE);\r | |
396 | if (EFI_ERROR(Status)) {\r | |
397 | DEBUG ((DEBUG_ERROR, "NvmeWaitController fail, Status = %r\n", Status));\r | |
398 | goto Done;\r | |
399 | }\r | |
400 | \r | |
401 | return EFI_SUCCESS;\r | |
402 | \r | |
403 | Done:\r | |
404 | DEBUG ((DEBUG_INFO, "NvmeDisableController fail, Status: %r\n", Status));\r | |
405 | return Status;\r | |
406 | }\r | |
407 | \r | |
408 | /**\r | |
409 | Enable the Nvm Express controller.\r | |
410 | \r | |
411 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
412 | \r | |
413 | @return EFI_SUCCESS - Successfully enable the controller.\r | |
414 | @return EFI_DEVICE_ERROR - Fail to enable the controller.\r | |
415 | @return EFI_TIMEOUT - Fail to enable the controller in given time slot.\r | |
416 | \r | |
417 | **/\r | |
418 | STATIC\r | |
419 | EFI_STATUS\r | |
420 | NvmeEnableController (\r | |
421 | IN NVME_CONTEXT *Nvme\r | |
422 | )\r | |
423 | {\r | |
424 | NVME_CC Cc;\r | |
425 | EFI_STATUS Status;\r | |
426 | \r | |
427 | //\r | |
428 | // Enable the controller\r | |
429 | //\r | |
430 | ZeroMem (&Cc, sizeof (NVME_CC));\r | |
431 | Cc.En = 1;\r | |
432 | Cc.Iosqes = 6;\r | |
433 | Cc.Iocqes = 4;\r | |
434 | Status = NVME_SET_CC (Nvme, &Cc);\r | |
435 | if (EFI_ERROR(Status)) {\r | |
436 | DEBUG ((DEBUG_ERROR, "NVME_SET_CC fail, Status = %r\n", Status));\r | |
437 | goto Done;\r | |
438 | }\r | |
439 | \r | |
440 | Status = NvmeWaitController (Nvme, TRUE);\r | |
441 | if (EFI_ERROR(Status)) {\r | |
442 | DEBUG ((DEBUG_ERROR, "NvmeWaitController fail, Status = %r\n", Status));\r | |
443 | goto Done;\r | |
444 | }\r | |
445 | \r | |
446 | return EFI_SUCCESS;\r | |
447 | \r | |
448 | Done:\r | |
449 | DEBUG ((DEBUG_INFO, "NvmeEnableController fail, Status: %r\n", Status));\r | |
450 | return Status;\r | |
451 | }\r | |
452 | \r | |
453 | /**\r | |
454 | Shutdown the Nvm Express controller.\r | |
455 | \r | |
456 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
457 | \r | |
458 | @return EFI_SUCCESS - Successfully shutdown the controller.\r | |
459 | @return EFI_DEVICE_ERROR - Fail to shutdown the controller.\r | |
460 | @return EFI_TIMEOUT - Fail to shutdown the controller in given time slot.\r | |
461 | \r | |
462 | **/\r | |
463 | STATIC\r | |
464 | EFI_STATUS\r | |
465 | NvmeShutdownController (\r | |
466 | IN NVME_CONTEXT *Nvme\r | |
467 | )\r | |
468 | {\r | |
469 | NVME_CC Cc;\r | |
470 | NVME_CSTS Csts;\r | |
471 | EFI_STATUS Status;\r | |
472 | UINT32 Index;\r | |
473 | UINTN Timeout;\r | |
474 | \r | |
475 | Status = NVME_GET_CC (Nvme, &Cc);\r | |
476 | if (EFI_ERROR(Status)) {\r | |
477 | DEBUG ((DEBUG_ERROR, "NVME_GET_CC fail, Status = %r\n", Status));\r | |
478 | return Status;\r | |
479 | }\r | |
480 | \r | |
481 | Cc.Shn = 1; // Normal shutdown\r | |
482 | \r | |
483 | Status = NVME_SET_CC (Nvme, &Cc);\r | |
484 | if (EFI_ERROR(Status)) {\r | |
485 | DEBUG ((DEBUG_ERROR, "NVME_SET_CC fail, Status = %r\n", Status));\r | |
486 | return Status;\r | |
487 | }\r | |
488 | \r | |
489 | Timeout = NVME_GENERIC_TIMEOUT/1000; // ms\r | |
490 | for(Index = (UINT32)(Timeout); Index != 0; --Index) {\r | |
491 | MicroSecondDelay (1000);\r | |
492 | \r | |
493 | Status = NVME_GET_CSTS (Nvme, &Csts);\r | |
494 | if (EFI_ERROR(Status)) {\r | |
495 | DEBUG ((DEBUG_ERROR, "NVME_GET_CSTS fail, Status = %r\n", Status));\r | |
496 | return Status;\r | |
497 | }\r | |
498 | \r | |
499 | if (Csts.Shst == 2) { // Shutdown processing complete\r | |
500 | break;\r | |
501 | }\r | |
502 | }\r | |
503 | \r | |
504 | if (Index == 0) {\r | |
505 | Status = EFI_TIMEOUT;\r | |
506 | }\r | |
507 | \r | |
508 | return Status;\r | |
509 | }\r | |
510 | \r | |
511 | /**\r | |
512 | Check the execution status from a given completion queue entry.\r | |
513 | \r | |
514 | @param[in] Cq - A pointer to the NVME_CQ item.\r | |
515 | \r | |
516 | **/\r | |
517 | EFI_STATUS\r | |
518 | NvmeCheckCqStatus (\r | |
519 | IN NVME_CQ *Cq\r | |
520 | )\r | |
521 | {\r | |
522 | if (Cq->Sct == 0x0 && Cq->Sc == 0x0) {\r | |
523 | return EFI_SUCCESS;\r | |
524 | }\r | |
525 | \r | |
526 | DEBUG ((DEBUG_INFO, "Dump NVMe Completion Entry Status from [0x%x]:\n", (UINTN)Cq));\r | |
527 | DEBUG ((DEBUG_INFO, " SQ Identifier : [0x%x], Phase Tag : [%d], Cmd Identifier : [0x%x]\n", Cq->Sqid, Cq->Pt, Cq->Cid));\r | |
528 | DEBUG ((DEBUG_INFO, " NVMe Cmd Execution Result - "));\r | |
529 | \r | |
530 | switch (Cq->Sct) {\r | |
531 | case 0x0:\r | |
532 | switch (Cq->Sc) {\r | |
533 | case 0x0:\r | |
534 | DEBUG ((DEBUG_INFO, "Successful Completion\n"));\r | |
535 | return EFI_SUCCESS;\r | |
536 | case 0x1:\r | |
537 | DEBUG ((DEBUG_INFO, "Invalid Command Opcode\n"));\r | |
538 | break;\r | |
539 | case 0x2:\r | |
540 | DEBUG ((DEBUG_INFO, "Invalid Field in Command\n"));\r | |
541 | break;\r | |
542 | case 0x3:\r | |
543 | DEBUG ((DEBUG_INFO, "Command ID Conflict\n"));\r | |
544 | break;\r | |
545 | case 0x4:\r | |
546 | DEBUG ((DEBUG_INFO, "Data Transfer Error\n"));\r | |
547 | break;\r | |
548 | case 0x5:\r | |
549 | DEBUG ((DEBUG_INFO, "Commands Aborted due to Power Loss Notification\n"));\r | |
550 | break;\r | |
551 | case 0x6:\r | |
552 | DEBUG ((DEBUG_INFO, "Internal Device Error\n"));\r | |
553 | break;\r | |
554 | case 0x7:\r | |
555 | DEBUG ((DEBUG_INFO, "Command Abort Requested\n"));\r | |
556 | break;\r | |
557 | case 0x8:\r | |
558 | DEBUG ((DEBUG_INFO, "Command Aborted due to SQ Deletion\n"));\r | |
559 | break;\r | |
560 | case 0x9:\r | |
561 | DEBUG ((DEBUG_INFO, "Command Aborted due to Failed Fused Command\n"));\r | |
562 | break;\r | |
563 | case 0xA:\r | |
564 | DEBUG ((DEBUG_INFO, "Command Aborted due to Missing Fused Command\n"));\r | |
565 | break;\r | |
566 | case 0xB:\r | |
567 | DEBUG ((DEBUG_INFO, "Invalid Namespace or Format\n"));\r | |
568 | break;\r | |
569 | case 0xC:\r | |
570 | DEBUG ((DEBUG_INFO, "Command Sequence Error\n"));\r | |
571 | break;\r | |
572 | case 0xD:\r | |
573 | DEBUG ((DEBUG_INFO, "Invalid SGL Last Segment Descriptor\n"));\r | |
574 | break;\r | |
575 | case 0xE:\r | |
576 | DEBUG ((DEBUG_INFO, "Invalid Number of SGL Descriptors\n"));\r | |
577 | break;\r | |
578 | case 0xF:\r | |
579 | DEBUG ((DEBUG_INFO, "Data SGL Length Invalid\n"));\r | |
580 | break;\r | |
581 | case 0x10:\r | |
582 | DEBUG ((DEBUG_INFO, "Metadata SGL Length Invalid\n"));\r | |
583 | break;\r | |
584 | case 0x11:\r | |
585 | DEBUG ((DEBUG_INFO, "SGL Descriptor Type Invalid\n"));\r | |
586 | break;\r | |
587 | case 0x80:\r | |
588 | DEBUG ((DEBUG_INFO, "LBA Out of Range\n"));\r | |
589 | break;\r | |
590 | case 0x81:\r | |
591 | DEBUG ((DEBUG_INFO, "Capacity Exceeded\n"));\r | |
592 | break;\r | |
593 | case 0x82:\r | |
594 | DEBUG ((DEBUG_INFO, "Namespace Not Ready\n"));\r | |
595 | break;\r | |
596 | case 0x83:\r | |
597 | DEBUG ((DEBUG_INFO, "Reservation Conflict\n"));\r | |
598 | break;\r | |
599 | }\r | |
600 | break;\r | |
601 | \r | |
602 | case 0x1:\r | |
603 | switch (Cq->Sc) {\r | |
604 | case 0x0:\r | |
605 | DEBUG ((DEBUG_INFO, "Completion Queue Invalid\n"));\r | |
606 | break;\r | |
607 | case 0x1:\r | |
608 | DEBUG ((DEBUG_INFO, "Invalid Queue Identifier\n"));\r | |
609 | break;\r | |
610 | case 0x2:\r | |
611 | DEBUG ((DEBUG_INFO, "Maximum Queue Size Exceeded\n"));\r | |
612 | break;\r | |
613 | case 0x3:\r | |
614 | DEBUG ((DEBUG_INFO, "Abort Command Limit Exceeded\n"));\r | |
615 | break;\r | |
616 | case 0x5:\r | |
617 | DEBUG ((DEBUG_INFO, "Asynchronous Event Request Limit Exceeded\n"));\r | |
618 | break;\r | |
619 | case 0x6:\r | |
620 | DEBUG ((DEBUG_INFO, "Invalid Firmware Slot\n"));\r | |
621 | break;\r | |
622 | case 0x7:\r | |
623 | DEBUG ((DEBUG_INFO, "Invalid Firmware Image\n"));\r | |
624 | break;\r | |
625 | case 0x8:\r | |
626 | DEBUG ((DEBUG_INFO, "Invalid Interrupt Vector\n"));\r | |
627 | break;\r | |
628 | case 0x9:\r | |
629 | DEBUG ((DEBUG_INFO, "Invalid Log Page\n"));\r | |
630 | break;\r | |
631 | case 0xA:\r | |
632 | DEBUG ((DEBUG_INFO, "Invalid Format\n"));\r | |
633 | break;\r | |
634 | case 0xB:\r | |
635 | DEBUG ((DEBUG_INFO, "Firmware Application Requires Conventional Reset\n"));\r | |
636 | break;\r | |
637 | case 0xC:\r | |
638 | DEBUG ((DEBUG_INFO, "Invalid Queue Deletion\n"));\r | |
639 | break;\r | |
640 | case 0xD:\r | |
641 | DEBUG ((DEBUG_INFO, "Feature Identifier Not Saveable\n"));\r | |
642 | break;\r | |
643 | case 0xE:\r | |
644 | DEBUG ((DEBUG_INFO, "Feature Not Changeable\n"));\r | |
645 | break;\r | |
646 | case 0xF:\r | |
647 | DEBUG ((DEBUG_INFO, "Feature Not Namespace Specific\n"));\r | |
648 | break;\r | |
649 | case 0x10:\r | |
650 | DEBUG ((DEBUG_INFO, "Firmware Application Requires NVM Subsystem Reset\n"));\r | |
651 | break;\r | |
652 | case 0x80:\r | |
653 | DEBUG ((DEBUG_INFO, "Conflicting Attributes\n"));\r | |
654 | break;\r | |
655 | case 0x81:\r | |
656 | DEBUG ((DEBUG_INFO, "Invalid Protection Information\n"));\r | |
657 | break;\r | |
658 | case 0x82:\r | |
659 | DEBUG ((DEBUG_INFO, "Attempted Write to Read Only Range\n"));\r | |
660 | break;\r | |
661 | }\r | |
662 | break;\r | |
663 | \r | |
664 | case 0x2:\r | |
665 | switch (Cq->Sc) {\r | |
666 | case 0x80:\r | |
667 | DEBUG ((DEBUG_INFO, "Write Fault\n"));\r | |
668 | break;\r | |
669 | case 0x81:\r | |
670 | DEBUG ((DEBUG_INFO, "Unrecovered Read Error\n"));\r | |
671 | break;\r | |
672 | case 0x82:\r | |
673 | DEBUG ((DEBUG_INFO, "End-to-end Guard Check Error\n"));\r | |
674 | break;\r | |
675 | case 0x83:\r | |
676 | DEBUG ((DEBUG_INFO, "End-to-end Application Tag Check Error\n"));\r | |
677 | break;\r | |
678 | case 0x84:\r | |
679 | DEBUG ((DEBUG_INFO, "End-to-end Reference Tag Check Error\n"));\r | |
680 | break;\r | |
681 | case 0x85:\r | |
682 | DEBUG ((DEBUG_INFO, "Compare Failure\n"));\r | |
683 | break;\r | |
684 | case 0x86:\r | |
685 | DEBUG ((DEBUG_INFO, "Access Denied\n"));\r | |
686 | break;\r | |
687 | }\r | |
688 | break;\r | |
689 | \r | |
690 | default:\r | |
691 | DEBUG ((DEBUG_INFO, "Unknown error\n"));\r | |
692 | break;\r | |
693 | }\r | |
694 | \r | |
695 | return EFI_DEVICE_ERROR;\r | |
696 | }\r | |
697 | \r | |
698 | /**\r | |
699 | Create PRP lists for Data transfer which is larger than 2 memory pages.\r | |
700 | Note here we calcuate the number of required PRP lists and allocate them at one time.\r | |
701 | \r | |
702 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
703 | @param[in] SqId - The SQ index for this PRP\r | |
704 | @param[in] PhysicalAddr - The physical base address of Data Buffer.\r | |
705 | @param[in] Pages - The number of pages to be transfered.\r | |
706 | @param[out] PrpListHost - The host base address of PRP lists.\r | |
707 | @param[in,out] PrpListNo - The number of PRP List.\r | |
708 | \r | |
709 | @retval The pointer Value to the first PRP List of the PRP lists.\r | |
710 | \r | |
711 | **/\r | |
712 | STATIC\r | |
713 | UINT64\r | |
714 | NvmeCreatePrpList (\r | |
715 | IN NVME_CONTEXT *Nvme,\r | |
716 | IN UINT16 SqId,\r | |
717 | IN EFI_PHYSICAL_ADDRESS PhysicalAddr,\r | |
718 | IN UINTN Pages,\r | |
719 | OUT VOID **PrpListHost,\r | |
720 | IN OUT UINTN *PrpListNo\r | |
721 | )\r | |
722 | {\r | |
723 | UINTN PrpEntryNo;\r | |
724 | UINT64 PrpListBase;\r | |
725 | UINTN PrpListIndex;\r | |
726 | UINTN PrpEntryIndex;\r | |
727 | UINT64 Remainder;\r | |
728 | EFI_PHYSICAL_ADDRESS PrpListPhyAddr;\r | |
729 | UINTN Bytes;\r | |
730 | UINT8 *PrpEntry;\r | |
731 | EFI_PHYSICAL_ADDRESS NewPhyAddr;\r | |
732 | \r | |
733 | ///\r | |
734 | /// The number of Prp Entry in a memory page.\r | |
735 | ///\r | |
736 | PrpEntryNo = EFI_PAGE_SIZE / sizeof (UINT64);\r | |
737 | \r | |
738 | ///\r | |
739 | /// Calculate total PrpList number.\r | |
740 | ///\r | |
741 | *PrpListNo = (UINTN) DivU64x64Remainder ((UINT64)Pages, (UINT64)PrpEntryNo, &Remainder);\r | |
742 | if (Remainder != 0) {\r | |
743 | *PrpListNo += 1;\r | |
744 | }\r | |
745 | \r | |
746 | if (*PrpListNo > NVME_PRP_SIZE) {\r | |
747 | DEBUG ((DEBUG_INFO, "NvmeCreatePrpList (PhysicalAddr: %lx, Pages: %x) PrpEntryNo: %x\n",\r | |
748 | PhysicalAddr, Pages, PrpEntryNo));\r | |
749 | DEBUG ((DEBUG_INFO, "*PrpListNo: %x, Remainder: %lx", *PrpListNo, Remainder));\r | |
750 | ASSERT (FALSE);\r | |
751 | }\r | |
752 | *PrpListHost = (VOID *)(UINTN) NVME_PRP_BASE (Nvme, SqId);\r | |
753 | \r | |
754 | Bytes = EFI_PAGES_TO_SIZE (*PrpListNo);\r | |
755 | PrpListPhyAddr = (UINT64)(UINTN)(*PrpListHost);\r | |
756 | \r | |
757 | ///\r | |
758 | /// Fill all PRP lists except of last one.\r | |
759 | ///\r | |
760 | ZeroMem (*PrpListHost, Bytes);\r | |
761 | for (PrpListIndex = 0; PrpListIndex < *PrpListNo - 1; ++PrpListIndex) {\r | |
762 | PrpListBase = *(UINT64*)PrpListHost + PrpListIndex * EFI_PAGE_SIZE;\r | |
763 | \r | |
764 | for (PrpEntryIndex = 0; PrpEntryIndex < PrpEntryNo; ++PrpEntryIndex) {\r | |
765 | PrpEntry = (UINT8 *)(UINTN) (PrpListBase + PrpEntryIndex * sizeof(UINT64));\r | |
766 | if (PrpEntryIndex != PrpEntryNo - 1) {\r | |
767 | ///\r | |
768 | /// Fill all PRP entries except of last one.\r | |
769 | ///\r | |
770 | CopyMem (PrpEntry, (VOID *)(UINTN) (&PhysicalAddr), sizeof (UINT64));\r | |
771 | PhysicalAddr += EFI_PAGE_SIZE;\r | |
772 | } else {\r | |
773 | ///\r | |
774 | /// Fill last PRP entries with next PRP List pointer.\r | |
775 | ///\r | |
776 | NewPhyAddr = (PrpListPhyAddr + (PrpListIndex + 1) * EFI_PAGE_SIZE);\r | |
777 | CopyMem (PrpEntry, (VOID *)(UINTN) (&NewPhyAddr), sizeof (UINT64));\r | |
778 | }\r | |
779 | }\r | |
780 | }\r | |
781 | \r | |
782 | ///\r | |
783 | /// Fill last PRP list.\r | |
784 | ///\r | |
785 | PrpListBase = *(UINT64*)PrpListHost + PrpListIndex * EFI_PAGE_SIZE;\r | |
786 | for (PrpEntryIndex = 0; PrpEntryIndex < ((Remainder != 0) ? Remainder : PrpEntryNo); ++PrpEntryIndex) {\r | |
787 | PrpEntry = (UINT8 *)(UINTN) (PrpListBase + PrpEntryIndex * sizeof(UINT64));\r | |
788 | CopyMem (PrpEntry, (VOID *)(UINTN) (&PhysicalAddr), sizeof (UINT64));\r | |
789 | \r | |
790 | PhysicalAddr += EFI_PAGE_SIZE;\r | |
791 | }\r | |
792 | \r | |
793 | return PrpListPhyAddr;\r | |
794 | }\r | |
795 | \r | |
112e584b SZ |
796 | /**\r |
797 | Waits until all NVME commands completed.\r | |
798 | \r | |
799 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
800 | @param[in] Qid - Queue index\r | |
801 | \r | |
802 | @retval EFI_SUCCESS - All NVME commands have completed\r | |
803 | @retval EFI_TIMEOUT - Timeout occured\r | |
804 | @retval EFI_NOT_READY - Not all NVME commands have completed\r | |
805 | @retval others - Error occurred on device side.\r | |
806 | **/\r | |
807 | EFI_STATUS\r | |
808 | NvmeWaitAllComplete (\r | |
809 | IN NVME_CONTEXT *Nvme,\r | |
810 | IN UINT8 Qid\r | |
811 | )\r | |
812 | {\r | |
813 | return EFI_SUCCESS;\r | |
814 | }\r | |
815 | \r | |
816 | /**\r | |
817 | Sends an NVM Express Command Packet to an NVM Express controller or namespace. This function supports\r | |
818 | both blocking I/O and nonblocking I/O. The blocking I/O functionality is required, and the nonblocking\r | |
819 | I/O functionality is optional.\r | |
820 | \r | |
821 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
822 | @param[in] NamespaceId - Is a 32 bit Namespace ID to which the Express HCI command packet will be sent.\r | |
823 | A Value of 0 denotes the NVM Express controller, a Value of all 0FFh in the namespace\r | |
824 | ID specifies that the command packet should be sent to all valid namespaces.\r | |
825 | @param[in] NamespaceUuid - Is a 64 bit Namespace UUID to which the Express HCI command packet will be sent.\r | |
826 | A Value of 0 denotes the NVM Express controller, a Value of all 0FFh in the namespace\r | |
827 | UUID specifies that the command packet should be sent to all valid namespaces.\r | |
828 | @param[in,out] Packet - A pointer to the NVM Express HCI Command Packet to send to the NVMe namespace specified\r | |
829 | by NamespaceId.\r | |
830 | \r | |
831 | @retval EFI_SUCCESS - The NVM Express Command Packet was sent by the host. TransferLength bytes were transferred\r | |
832 | to, or from DataBuffer.\r | |
833 | @retval EFI_NOT_READY - The NVM Express Command Packet could not be sent because the controller is not ready. The caller\r | |
834 | may retry again later.\r | |
835 | @retval EFI_DEVICE_ERROR - A device error occurred while attempting to send the NVM Express Command Packet.\r | |
836 | @retval EFI_INVALID_PARAMETER - Namespace, or the contents of NVM_EXPRESS_PASS_THRU_COMMAND_PACKET are invalid. The NVM\r | |
837 | Express Command Packet was not sent, so no additional status information is available.\r | |
838 | @retval EFI_UNSUPPORTED - The command described by the NVM Express Command Packet is not supported by the host adapter.\r | |
839 | The NVM Express Command Packet was not sent, so no additional status information is available.\r | |
840 | @retval EFI_TIMEOUT - A timeout occurred while waiting for the NVM Express Command Packet to execute.\r | |
841 | \r | |
842 | **/\r | |
843 | EFI_STATUS\r | |
844 | NvmePassThru (\r | |
845 | IN NVME_CONTEXT *Nvme,\r | |
846 | IN UINT32 NamespaceId,\r | |
847 | IN UINT64 NamespaceUuid,\r | |
848 | IN OUT NVM_EXPRESS_PASS_THRU_COMMAND_PACKET *Packet\r | |
849 | )\r | |
850 | {\r | |
851 | EFI_STATUS Status;\r | |
852 | NVME_SQ *Sq;\r | |
853 | NVME_CQ *Cq;\r | |
854 | UINT8 Qid;\r | |
855 | UINT32 Bytes;\r | |
856 | UINT32 Offset;\r | |
857 | EFI_PHYSICAL_ADDRESS PhyAddr;\r | |
858 | VOID *PrpListHost;\r | |
859 | UINTN PrpListNo;\r | |
860 | UINT32 Timer;\r | |
861 | UINTN SqSize;\r | |
862 | UINTN CqSize;\r | |
863 | \r | |
864 | ///\r | |
865 | /// check the Data fields in Packet parameter.\r | |
866 | ///\r | |
867 | if ((Nvme == NULL) || (Packet == NULL)) {\r | |
868 | DEBUG ((DEBUG_ERROR, "NvmePassThru, invalid parameter: Nvme(%x)/Packet(%x)\n",\r | |
869 | (UINTN)Nvme, (UINTN)Packet));\r | |
870 | return EFI_INVALID_PARAMETER;\r | |
871 | }\r | |
872 | \r | |
873 | if ((Packet->NvmeCmd == NULL) || (Packet->NvmeResponse == NULL)) {\r | |
874 | DEBUG ((DEBUG_ERROR, "NvmePassThru, invalid parameter: NvmeCmd(%x)/NvmeResponse(%x)\n",\r | |
875 | (UINTN)Packet->NvmeCmd, (UINTN)Packet->NvmeResponse));\r | |
876 | return EFI_INVALID_PARAMETER;\r | |
877 | }\r | |
878 | \r | |
879 | if (Packet->QueueId != NVME_ADMIN_QUEUE && Packet->QueueId != NVME_IO_QUEUE) {\r | |
880 | DEBUG ((DEBUG_ERROR, "NvmePassThru, invalid parameter: QueueId(%x)\n",\r | |
881 | Packet->QueueId));\r | |
882 | return EFI_INVALID_PARAMETER;\r | |
883 | }\r | |
884 | \r | |
885 | PrpListHost = NULL;\r | |
886 | PrpListNo = 0;\r | |
887 | Status = EFI_SUCCESS;\r | |
888 | \r | |
889 | Qid = Packet->QueueId;\r | |
890 | Sq = Nvme->SqBuffer[Qid] + Nvme->SqTdbl[Qid].Sqt;\r | |
891 | Cq = Nvme->CqBuffer[Qid] + Nvme->CqHdbl[Qid].Cqh;\r | |
892 | if (Qid == NVME_ADMIN_QUEUE) {\r | |
893 | SqSize = NVME_ASQ_SIZE + 1;\r | |
894 | CqSize = NVME_ACQ_SIZE + 1;\r | |
895 | } else {\r | |
896 | SqSize = NVME_CSQ_DEPTH;\r | |
897 | CqSize = NVME_CCQ_DEPTH;\r | |
898 | }\r | |
899 | \r | |
900 | if (Packet->NvmeCmd->Nsid != NamespaceId) {\r | |
901 | DEBUG ((DEBUG_ERROR, "NvmePassThru: Nsid mismatch (%x, %x)\n",\r | |
902 | Packet->NvmeCmd->Nsid, NamespaceId));\r | |
903 | return EFI_INVALID_PARAMETER;\r | |
904 | }\r | |
905 | \r | |
906 | ZeroMem (Sq, sizeof (NVME_SQ));\r | |
907 | Sq->Opc = Packet->NvmeCmd->Cdw0.Opcode;\r | |
908 | Sq->Fuse = Packet->NvmeCmd->Cdw0.FusedOperation;\r | |
909 | Sq->Cid = Packet->NvmeCmd->Cdw0.Cid;\r | |
910 | Sq->Nsid = Packet->NvmeCmd->Nsid;\r | |
911 | \r | |
912 | ///\r | |
913 | /// Currently we only support PRP for Data transfer, SGL is NOT supported.\r | |
914 | ///\r | |
915 | ASSERT (Sq->Psdt == 0);\r | |
916 | if (Sq->Psdt != 0) {\r | |
917 | DEBUG ((DEBUG_ERROR, "NvmePassThru: doesn't support SGL mechanism\n"));\r | |
918 | return EFI_UNSUPPORTED;\r | |
919 | }\r | |
920 | \r | |
921 | Sq->Prp[0] = Packet->TransferBuffer;\r | |
922 | Sq->Prp[1] = 0;\r | |
923 | \r | |
924 | if(Packet->MetadataBuffer != (UINT64)(UINTN)NULL) {\r | |
925 | Sq->Mptr = Packet->MetadataBuffer;\r | |
926 | }\r | |
927 | \r | |
928 | ///\r | |
929 | /// If the Buffer Size spans more than two memory pages (page Size as defined in CC.Mps),\r | |
930 | /// then build a PRP list in the second PRP submission queue entry.\r | |
931 | ///\r | |
932 | Offset = ((UINT32)Sq->Prp[0]) & (EFI_PAGE_SIZE - 1);\r | |
933 | Bytes = Packet->TransferLength;\r | |
934 | \r | |
935 | if ((Offset + Bytes) > (EFI_PAGE_SIZE * 2)) {\r | |
936 | ///\r | |
937 | /// Create PrpList for remaining Data Buffer.\r | |
938 | ///\r | |
939 | PhyAddr = (Sq->Prp[0] + EFI_PAGE_SIZE) & ~(EFI_PAGE_SIZE - 1);\r | |
940 | Sq->Prp[1] = NvmeCreatePrpList (Nvme, Nvme->SqTdbl[Qid].Sqt, PhyAddr, EFI_SIZE_TO_PAGES(Offset + Bytes) - 1, &PrpListHost, &PrpListNo);\r | |
941 | if (Sq->Prp[1] == 0) {\r | |
942 | Status = EFI_OUT_OF_RESOURCES;\r | |
943 | DEBUG ((DEBUG_ERROR, "NvmeCreatePrpList fail, Status: %r\n", Status));\r | |
944 | goto EXIT;\r | |
945 | }\r | |
946 | \r | |
947 | } else if ((Offset + Bytes) > EFI_PAGE_SIZE) {\r | |
948 | Sq->Prp[1] = (Sq->Prp[0] + EFI_PAGE_SIZE) & ~(EFI_PAGE_SIZE - 1);\r | |
949 | }\r | |
950 | \r | |
951 | if(Packet->NvmeCmd->Flags & CDW10_VALID) {\r | |
952 | Sq->Payload.Raw.Cdw10 = Packet->NvmeCmd->Cdw10;\r | |
953 | }\r | |
954 | if(Packet->NvmeCmd->Flags & CDW11_VALID) {\r | |
955 | Sq->Payload.Raw.Cdw11 = Packet->NvmeCmd->Cdw11;\r | |
956 | }\r | |
957 | if(Packet->NvmeCmd->Flags & CDW12_VALID) {\r | |
958 | Sq->Payload.Raw.Cdw12 = Packet->NvmeCmd->Cdw12;\r | |
959 | }\r | |
960 | if(Packet->NvmeCmd->Flags & CDW13_VALID) {\r | |
961 | Sq->Payload.Raw.Cdw13 = Packet->NvmeCmd->Cdw13;\r | |
962 | }\r | |
963 | if(Packet->NvmeCmd->Flags & CDW14_VALID) {\r | |
964 | Sq->Payload.Raw.Cdw14 = Packet->NvmeCmd->Cdw14;\r | |
965 | }\r | |
966 | if(Packet->NvmeCmd->Flags & CDW15_VALID) {\r | |
967 | Sq->Payload.Raw.Cdw15 = Packet->NvmeCmd->Cdw15;\r | |
968 | }\r | |
969 | \r | |
970 | ///\r | |
971 | /// Ring the submission queue doorbell.\r | |
972 | ///\r | |
973 | Nvme->SqTdbl[Qid].Sqt++;\r | |
974 | if(Nvme->SqTdbl[Qid].Sqt == SqSize) {\r | |
975 | Nvme->SqTdbl[Qid].Sqt = 0;\r | |
976 | }\r | |
977 | Status = NVME_SET_SQTDBL (Nvme, Qid, &Nvme->SqTdbl[Qid]);\r | |
978 | if (EFI_ERROR(Status)) {\r | |
979 | DEBUG ((DEBUG_ERROR, "NVME_SET_SQTDBL fail, Status: %r\n", Status));\r | |
980 | goto EXIT;\r | |
981 | }\r | |
982 | \r | |
983 | ///\r | |
984 | /// Wait for completion queue to get filled in.\r | |
985 | ///\r | |
986 | Status = EFI_TIMEOUT;\r | |
987 | Timer = 0;\r | |
988 | while (Timer < NVME_CMD_TIMEOUT) {\r | |
989 | //DEBUG ((DEBUG_VERBOSE, "Timer: %x, Cq:\n", Timer));\r | |
990 | //DumpMem (Cq, sizeof (NVME_CQ));\r | |
991 | if (Cq->Pt != Nvme->Pt[Qid]) {\r | |
992 | Status = EFI_SUCCESS;\r | |
993 | break;\r | |
994 | }\r | |
995 | \r | |
996 | MicroSecondDelay (NVME_CMD_WAIT);\r | |
997 | Timer += NVME_CMD_WAIT;\r | |
998 | }\r | |
999 | \r | |
1000 | Nvme->CqHdbl[Qid].Cqh++;\r | |
1001 | if (Nvme->CqHdbl[Qid].Cqh == CqSize) {\r | |
1002 | Nvme->CqHdbl[Qid].Cqh = 0;\r | |
1003 | Nvme->Pt[Qid] ^= 1;\r | |
1004 | }\r | |
1005 | \r | |
1006 | ///\r | |
1007 | /// Copy the Respose Queue entry for this command to the callers response Buffer\r | |
1008 | ///\r | |
1009 | CopyMem (Packet->NvmeResponse, Cq, sizeof(NVM_EXPRESS_RESPONSE));\r | |
1010 | \r | |
1011 | if (!EFI_ERROR(Status)) { // We still need to check CQ status if no timeout error occured\r | |
1012 | Status = NvmeCheckCqStatus (Cq);\r | |
1013 | }\r | |
1014 | NVME_SET_CQHDBL (Nvme, Qid, &Nvme->CqHdbl[Qid]);\r | |
1015 | \r | |
1016 | EXIT:\r | |
1017 | return Status;\r | |
1018 | }\r | |
1019 | \r | |
1020 | /**\r | |
1021 | Get identify controller Data.\r | |
1022 | \r | |
1023 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1024 | @param[in] Buffer - The Buffer used to store the identify controller Data.\r | |
1025 | \r | |
1026 | @return EFI_SUCCESS - Successfully get the identify controller Data.\r | |
1027 | @return others - Fail to get the identify controller Data.\r | |
1028 | \r | |
1029 | **/\r | |
1030 | STATIC\r | |
1031 | EFI_STATUS\r | |
1032 | NvmeIdentifyController (\r | |
1033 | IN NVME_CONTEXT *Nvme,\r | |
1034 | IN VOID *Buffer\r | |
1035 | )\r | |
1036 | {\r | |
1037 | NVM_EXPRESS_PASS_THRU_COMMAND_PACKET CommandPacket;\r | |
1038 | NVM_EXPRESS_COMMAND Command;\r | |
1039 | NVM_EXPRESS_RESPONSE Response;\r | |
1040 | EFI_STATUS Status;\r | |
1041 | \r | |
1042 | ZeroMem (&CommandPacket, sizeof(NVM_EXPRESS_PASS_THRU_COMMAND_PACKET));\r | |
1043 | ZeroMem (&Command, sizeof(NVM_EXPRESS_COMMAND));\r | |
1044 | ZeroMem (&Response, sizeof(NVM_EXPRESS_RESPONSE));\r | |
1045 | \r | |
1046 | Command.Cdw0.Opcode = NVME_ADMIN_IDENTIFY_OPC;\r | |
1047 | Command.Cdw0.Cid = Nvme->Cid[NVME_ADMIN_QUEUE]++;\r | |
1048 | //\r | |
1049 | // According to Nvm Express 1.1 spec Figure 38, When not used, the field shall be cleared to 0h.\r | |
1050 | // For the Identify command, the Namespace Identifier is only used for the Namespace Data structure.\r | |
1051 | //\r | |
1052 | Command.Nsid = 0;\r | |
1053 | \r | |
1054 | CommandPacket.NvmeCmd = &Command;\r | |
1055 | CommandPacket.NvmeResponse = &Response;\r | |
1056 | CommandPacket.TransferBuffer = (UINT64)(UINTN)Buffer;\r | |
1057 | CommandPacket.TransferLength = sizeof (NVME_ADMIN_CONTROLLER_DATA);\r | |
1058 | CommandPacket.CommandTimeout = NVME_GENERIC_TIMEOUT;\r | |
1059 | CommandPacket.QueueId = NVME_ADMIN_QUEUE;\r | |
1060 | //\r | |
1061 | // Set bit 0 (Cns bit) to 1 to identify a controller\r | |
1062 | //\r | |
1063 | Command.Cdw10 = 1;\r | |
1064 | Command.Flags = CDW10_VALID;\r | |
1065 | \r | |
1066 | Status = NvmePassThru (\r | |
1067 | Nvme,\r | |
1068 | NVME_CONTROLLER_ID,\r | |
1069 | 0,\r | |
1070 | &CommandPacket\r | |
1071 | );\r | |
1072 | if (!EFI_ERROR (Status)) {\r | |
1073 | Status = NvmeWaitAllComplete (Nvme, CommandPacket.QueueId);\r | |
1074 | }\r | |
1075 | \r | |
1076 | return Status;\r | |
1077 | }\r | |
1078 | \r | |
1079 | /**\r | |
1080 | Get specified identify namespace Data.\r | |
1081 | \r | |
1082 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1083 | @param[in] NamespaceId - The specified namespace identifier.\r | |
1084 | @param[in] Buffer - The Buffer used to store the identify namespace Data.\r | |
1085 | \r | |
1086 | @return EFI_SUCCESS - Successfully get the identify namespace Data.\r | |
1087 | @return others - Fail to get the identify namespace Data.\r | |
1088 | \r | |
1089 | **/\r | |
1090 | STATIC\r | |
1091 | EFI_STATUS\r | |
1092 | NvmeIdentifyNamespace (\r | |
1093 | IN NVME_CONTEXT *Nvme,\r | |
1094 | IN UINT32 NamespaceId,\r | |
1095 | IN VOID *Buffer\r | |
1096 | )\r | |
1097 | {\r | |
1098 | NVM_EXPRESS_PASS_THRU_COMMAND_PACKET CommandPacket;\r | |
1099 | NVM_EXPRESS_COMMAND Command;\r | |
1100 | NVM_EXPRESS_RESPONSE Response;\r | |
1101 | EFI_STATUS Status;\r | |
1102 | \r | |
1103 | ZeroMem (&CommandPacket, sizeof(NVM_EXPRESS_PASS_THRU_COMMAND_PACKET));\r | |
1104 | ZeroMem (&Command, sizeof(NVM_EXPRESS_COMMAND));\r | |
1105 | ZeroMem (&Response, sizeof(NVM_EXPRESS_RESPONSE));\r | |
1106 | \r | |
1107 | CommandPacket.NvmeCmd = &Command;\r | |
1108 | CommandPacket.NvmeResponse = &Response;\r | |
1109 | \r | |
1110 | Command.Cdw0.Opcode = NVME_ADMIN_IDENTIFY_OPC;\r | |
1111 | Command.Cdw0.Cid = Nvme->Cid[NVME_ADMIN_QUEUE]++;\r | |
1112 | Command.Nsid = NamespaceId;\r | |
1113 | CommandPacket.TransferBuffer = (UINT64)(UINTN)Buffer;\r | |
1114 | CommandPacket.TransferLength = sizeof (NVME_ADMIN_NAMESPACE_DATA);\r | |
1115 | CommandPacket.CommandTimeout = NVME_GENERIC_TIMEOUT;\r | |
1116 | CommandPacket.QueueId = NVME_ADMIN_QUEUE;\r | |
1117 | //\r | |
1118 | // Set bit 0 (Cns bit) to 1 to identify a namespace\r | |
1119 | //\r | |
1120 | CommandPacket.NvmeCmd->Cdw10 = 0;\r | |
1121 | CommandPacket.NvmeCmd->Flags = CDW10_VALID;\r | |
1122 | \r | |
1123 | Status = NvmePassThru (\r | |
1124 | Nvme,\r | |
1125 | NamespaceId,\r | |
1126 | 0,\r | |
1127 | &CommandPacket\r | |
1128 | );\r | |
1129 | if (!EFI_ERROR (Status)) {\r | |
1130 | Status = NvmeWaitAllComplete (Nvme, CommandPacket.QueueId);\r | |
1131 | }\r | |
1132 | \r | |
1133 | return Status;\r | |
1134 | }\r | |
1135 | \r | |
1136 | /**\r | |
1137 | Get Block Size for specific namespace of NVME.\r | |
1138 | \r | |
1139 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1140 | \r | |
1141 | @return - Block Size in bytes\r | |
1142 | \r | |
1143 | **/\r | |
1144 | STATIC\r | |
1145 | UINT32\r | |
1146 | NvmeGetBlockSize (\r | |
1147 | IN NVME_CONTEXT *Nvme\r | |
1148 | )\r | |
1149 | {\r | |
1150 | UINT32 BlockSize;\r | |
1151 | UINT32 Lbads;\r | |
1152 | UINT32 Flbas;\r | |
1153 | UINT32 LbaFmtIdx;\r | |
1154 | \r | |
1155 | Flbas = Nvme->NamespaceData->Flbas;\r | |
1156 | LbaFmtIdx = Flbas & 3;\r | |
1157 | Lbads = Nvme->NamespaceData->LbaFormat[LbaFmtIdx].Lbads;\r | |
1158 | \r | |
1159 | BlockSize = (UINT32)1 << Lbads;\r | |
1160 | return BlockSize;\r | |
1161 | }\r | |
1162 | \r | |
1163 | /**\r | |
1164 | Get last LBA for specific namespace of NVME.\r | |
1165 | \r | |
1166 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1167 | \r | |
1168 | @return - Last LBA address\r | |
1169 | \r | |
1170 | **/\r | |
1171 | STATIC\r | |
1172 | EFI_LBA\r | |
1173 | NvmeGetLastLba (\r | |
1174 | IN NVME_CONTEXT *Nvme\r | |
1175 | )\r | |
1176 | {\r | |
1177 | EFI_LBA LastBlock;\r | |
1178 | LastBlock = Nvme->NamespaceData->Nsze - 1;\r | |
1179 | return LastBlock;\r | |
1180 | }\r | |
1181 | \r | |
1182 | /**\r | |
1183 | Create io completion queue.\r | |
1184 | \r | |
1185 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1186 | \r | |
1187 | @return EFI_SUCCESS - Successfully create io completion queue.\r | |
1188 | @return others - Fail to create io completion queue.\r | |
1189 | \r | |
1190 | **/\r | |
1191 | STATIC\r | |
1192 | EFI_STATUS\r | |
1193 | NvmeCreateIoCompletionQueue (\r | |
1194 | IN NVME_CONTEXT *Nvme\r | |
1195 | )\r | |
1196 | {\r | |
1197 | NVM_EXPRESS_PASS_THRU_COMMAND_PACKET CommandPacket;\r | |
1198 | NVM_EXPRESS_COMMAND Command;\r | |
1199 | NVM_EXPRESS_RESPONSE Response;\r | |
1200 | EFI_STATUS Status;\r | |
1201 | NVME_ADMIN_CRIOCQ CrIoCq;\r | |
1202 | \r | |
1203 | ZeroMem (&CommandPacket, sizeof(NVM_EXPRESS_PASS_THRU_COMMAND_PACKET));\r | |
1204 | ZeroMem (&Command, sizeof(NVM_EXPRESS_COMMAND));\r | |
1205 | ZeroMem (&Response, sizeof(NVM_EXPRESS_RESPONSE));\r | |
1206 | ZeroMem (&CrIoCq, sizeof(NVME_ADMIN_CRIOCQ));\r | |
1207 | \r | |
1208 | CommandPacket.NvmeCmd = &Command;\r | |
1209 | CommandPacket.NvmeResponse = &Response;\r | |
1210 | \r | |
1211 | Command.Cdw0.Opcode = NVME_ADMIN_CRIOCQ_OPC;\r | |
1212 | Command.Cdw0.Cid = Nvme->Cid[NVME_ADMIN_QUEUE]++;\r | |
1213 | CommandPacket.TransferBuffer = (UINT64)(UINTN)Nvme->CqBuffer[NVME_IO_QUEUE];\r | |
1214 | CommandPacket.TransferLength = EFI_PAGE_SIZE;\r | |
1215 | CommandPacket.CommandTimeout = NVME_GENERIC_TIMEOUT;\r | |
1216 | CommandPacket.QueueId = NVME_ADMIN_QUEUE;\r | |
1217 | \r | |
1218 | CrIoCq.Qid = NVME_IO_QUEUE;\r | |
1219 | CrIoCq.Qsize = NVME_CCQ_SIZE;\r | |
1220 | CrIoCq.Pc = 1;\r | |
1221 | CopyMem (&CommandPacket.NvmeCmd->Cdw10, &CrIoCq, sizeof (NVME_ADMIN_CRIOCQ));\r | |
1222 | CommandPacket.NvmeCmd->Flags = CDW10_VALID | CDW11_VALID;\r | |
1223 | \r | |
1224 | Status = NvmePassThru (\r | |
1225 | Nvme,\r | |
1226 | NVME_CONTROLLER_ID,\r | |
1227 | 0,\r | |
1228 | &CommandPacket\r | |
1229 | );\r | |
1230 | if (!EFI_ERROR (Status)) {\r | |
1231 | Status = NvmeWaitAllComplete (Nvme, CommandPacket.QueueId);\r | |
1232 | }\r | |
1233 | \r | |
1234 | return Status;\r | |
1235 | }\r | |
1236 | \r | |
1237 | /**\r | |
1238 | Create io submission queue.\r | |
1239 | \r | |
1240 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1241 | \r | |
1242 | @return EFI_SUCCESS - Successfully create io submission queue.\r | |
1243 | @return others - Fail to create io submission queue.\r | |
1244 | \r | |
1245 | **/\r | |
1246 | STATIC\r | |
1247 | EFI_STATUS\r | |
1248 | NvmeCreateIoSubmissionQueue (\r | |
1249 | IN NVME_CONTEXT *Nvme\r | |
1250 | )\r | |
1251 | {\r | |
1252 | NVM_EXPRESS_PASS_THRU_COMMAND_PACKET CommandPacket;\r | |
1253 | NVM_EXPRESS_COMMAND Command;\r | |
1254 | NVM_EXPRESS_RESPONSE Response;\r | |
1255 | EFI_STATUS Status;\r | |
1256 | NVME_ADMIN_CRIOSQ CrIoSq;\r | |
1257 | \r | |
1258 | ZeroMem (&CommandPacket, sizeof(NVM_EXPRESS_PASS_THRU_COMMAND_PACKET));\r | |
1259 | ZeroMem (&Command, sizeof(NVM_EXPRESS_COMMAND));\r | |
1260 | ZeroMem (&Response, sizeof(NVM_EXPRESS_RESPONSE));\r | |
1261 | ZeroMem (&CrIoSq, sizeof(NVME_ADMIN_CRIOSQ));\r | |
1262 | \r | |
1263 | CommandPacket.NvmeCmd = &Command;\r | |
1264 | CommandPacket.NvmeResponse = &Response;\r | |
1265 | \r | |
1266 | Command.Cdw0.Opcode = NVME_ADMIN_CRIOSQ_OPC;\r | |
1267 | Command.Cdw0.Cid = Nvme->Cid[NVME_ADMIN_QUEUE]++;\r | |
1268 | CommandPacket.TransferBuffer = (UINT64)(UINTN)Nvme->SqBuffer[NVME_IO_QUEUE];\r | |
1269 | CommandPacket.TransferLength = EFI_PAGE_SIZE;\r | |
1270 | CommandPacket.CommandTimeout = NVME_GENERIC_TIMEOUT;\r | |
1271 | CommandPacket.QueueId = NVME_ADMIN_QUEUE;\r | |
1272 | \r | |
1273 | CrIoSq.Qid = NVME_IO_QUEUE;\r | |
1274 | CrIoSq.Qsize = NVME_CSQ_SIZE;\r | |
1275 | CrIoSq.Pc = 1;\r | |
1276 | CrIoSq.Cqid = NVME_IO_QUEUE;\r | |
1277 | CrIoSq.Qprio = 0;\r | |
1278 | CopyMem (&CommandPacket.NvmeCmd->Cdw10, &CrIoSq, sizeof (NVME_ADMIN_CRIOSQ));\r | |
1279 | CommandPacket.NvmeCmd->Flags = CDW10_VALID | CDW11_VALID;\r | |
1280 | \r | |
1281 | Status = NvmePassThru (\r | |
1282 | Nvme,\r | |
1283 | NVME_CONTROLLER_ID,\r | |
1284 | 0,\r | |
1285 | &CommandPacket\r | |
1286 | );\r | |
1287 | if (!EFI_ERROR (Status)) {\r | |
1288 | Status = NvmeWaitAllComplete (Nvme, CommandPacket.QueueId);\r | |
1289 | }\r | |
1290 | \r | |
1291 | return Status;\r | |
1292 | }\r | |
1293 | \r | |
1294 | /**\r | |
1295 | Security send and receive commands.\r | |
1296 | \r | |
1297 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1298 | @param[in] SendCommand - The flag to indicate the command type, TRUE for Send command and FALSE for receive command\r | |
1299 | @param[in] SecurityProtocol - Security Protocol\r | |
1300 | @param[in] SpSpecific - Security Protocol Specific\r | |
1301 | @param[in] TransferLength - Transfer Length of Buffer (in bytes) - always a multiple of 512\r | |
1302 | @param[in,out] TransferBuffer - Address of Data to transfer\r | |
1303 | \r | |
1304 | @return EFI_SUCCESS - Successfully create io submission queue.\r | |
1305 | @return others - Fail to send/receive commands.\r | |
1306 | \r | |
1307 | **/\r | |
1308 | EFI_STATUS\r | |
1309 | NvmeSecuritySendReceive (\r | |
1310 | IN NVME_CONTEXT *Nvme,\r | |
1311 | IN BOOLEAN SendCommand,\r | |
1312 | IN UINT8 SecurityProtocol,\r | |
1313 | IN UINT16 SpSpecific,\r | |
1314 | IN UINTN TransferLength,\r | |
1315 | IN OUT VOID *TransferBuffer\r | |
1316 | )\r | |
1317 | {\r | |
1318 | NVM_EXPRESS_PASS_THRU_COMMAND_PACKET CommandPacket;\r | |
1319 | NVM_EXPRESS_COMMAND Command;\r | |
1320 | NVM_EXPRESS_RESPONSE Response;\r | |
1321 | EFI_STATUS Status;\r | |
1322 | NVME_ADMIN_SECSEND SecSend;\r | |
1323 | OACS *Oacs;\r | |
1324 | UINT8 Opcode;\r | |
1325 | VOID* *SecBuff;\r | |
1326 | \r | |
1327 | Oacs = (OACS *)&Nvme->ControllerData->Oacs;\r | |
1328 | \r | |
1329 | //\r | |
1330 | // Verify security bit for Security Send/Receive commands\r | |
1331 | //\r | |
1332 | if (Oacs->Security == 0) {\r | |
1333 | DEBUG ((DEBUG_ERROR, "Security command doesn't support.\n"));\r | |
1334 | return EFI_NOT_READY;\r | |
1335 | }\r | |
1336 | \r | |
1337 | SecBuff = (VOID *)(UINTN) NVME_SEC_BASE (Nvme);\r | |
1338 | \r | |
1339 | //\r | |
1340 | // Actions for sending security command\r | |
1341 | //\r | |
1342 | if (SendCommand) {\r | |
1343 | CopyMem (SecBuff, TransferBuffer, TransferLength);\r | |
1344 | }\r | |
1345 | \r | |
1346 | ZeroMem (&CommandPacket, sizeof(NVM_EXPRESS_PASS_THRU_COMMAND_PACKET));\r | |
1347 | ZeroMem (&Command, sizeof(NVM_EXPRESS_COMMAND));\r | |
1348 | ZeroMem (&Response, sizeof(NVM_EXPRESS_RESPONSE));\r | |
1349 | ZeroMem (&SecSend, sizeof(NVME_ADMIN_SECSEND));\r | |
1350 | \r | |
1351 | CommandPacket.NvmeCmd = &Command;\r | |
1352 | CommandPacket.NvmeResponse = &Response;\r | |
1353 | \r | |
1354 | Opcode = (UINT8)(SendCommand ? NVME_ADMIN_SECURITY_SEND_OPC : NVME_ADMIN_SECURITY_RECV_OPC);\r | |
1355 | Command.Cdw0.Opcode = Opcode;\r | |
1356 | Command.Cdw0.Cid = Nvme->Cid[NVME_ADMIN_QUEUE]++;\r | |
1357 | CommandPacket.TransferBuffer = (UINT64)(UINTN)SecBuff;\r | |
1358 | CommandPacket.TransferLength = (UINT32)TransferLength;\r | |
1359 | CommandPacket.CommandTimeout = NVME_GENERIC_TIMEOUT;\r | |
1360 | CommandPacket.QueueId = NVME_ADMIN_QUEUE;\r | |
1361 | \r | |
1362 | SecSend.Spsp = SpSpecific;\r | |
1363 | SecSend.Secp = SecurityProtocol;\r | |
1364 | SecSend.Tl = (UINT32)TransferLength;\r | |
1365 | \r | |
1366 | CopyMem (&CommandPacket.NvmeCmd->Cdw10, &SecSend, sizeof (NVME_ADMIN_SECSEND));\r | |
1367 | CommandPacket.NvmeCmd->Flags = CDW10_VALID | CDW11_VALID;\r | |
1368 | \r | |
1369 | Status = NvmePassThru (\r | |
1370 | Nvme,\r | |
1371 | NVME_CONTROLLER_ID,\r | |
1372 | 0,\r | |
1373 | &CommandPacket\r | |
1374 | );\r | |
1375 | if (!EFI_ERROR (Status)) {\r | |
1376 | Status = NvmeWaitAllComplete (Nvme, CommandPacket.QueueId);\r | |
1377 | }\r | |
1378 | \r | |
1379 | //\r | |
1380 | // Actions for receiving security command\r | |
1381 | //\r | |
1382 | if (!SendCommand) {\r | |
1383 | CopyMem (TransferBuffer, SecBuff, TransferLength);\r | |
1384 | }\r | |
1385 | \r | |
1386 | return Status;\r | |
1387 | }\r | |
1388 | \r | |
1389 | /**\r | |
1390 | Destroy io completion queue.\r | |
1391 | \r | |
1392 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1393 | \r | |
1394 | @return EFI_SUCCESS - Successfully destroy io completion queue.\r | |
1395 | @return others - Fail to destroy io completion queue.\r | |
1396 | \r | |
1397 | **/\r | |
1398 | STATIC\r | |
1399 | EFI_STATUS\r | |
1400 | NvmeDestroyIoCompletionQueue (\r | |
1401 | IN NVME_CONTEXT *Nvme\r | |
1402 | )\r | |
1403 | {\r | |
1404 | NVM_EXPRESS_PASS_THRU_COMMAND_PACKET CommandPacket;\r | |
1405 | NVM_EXPRESS_COMMAND Command;\r | |
1406 | NVM_EXPRESS_RESPONSE Response;\r | |
1407 | EFI_STATUS Status;\r | |
1408 | NVME_ADMIN_DEIOCQ DelIoCq;\r | |
1409 | \r | |
1410 | ZeroMem (&CommandPacket, sizeof(NVM_EXPRESS_PASS_THRU_COMMAND_PACKET));\r | |
1411 | ZeroMem (&Command, sizeof(NVM_EXPRESS_COMMAND));\r | |
1412 | ZeroMem (&Response, sizeof(NVM_EXPRESS_RESPONSE));\r | |
1413 | ZeroMem (&DelIoCq, sizeof(NVME_ADMIN_DEIOCQ));\r | |
1414 | \r | |
1415 | CommandPacket.NvmeCmd = &Command;\r | |
1416 | CommandPacket.NvmeResponse = &Response;\r | |
1417 | \r | |
1418 | Command.Cdw0.Opcode = NVME_ADMIN_DELIOCQ_OPC;\r | |
1419 | Command.Cdw0.Cid = Nvme->Cid[NVME_ADMIN_QUEUE]++;\r | |
1420 | CommandPacket.TransferBuffer = (UINT64)(UINTN)Nvme->CqBuffer[NVME_IO_QUEUE];\r | |
1421 | CommandPacket.TransferLength = EFI_PAGE_SIZE;\r | |
1422 | CommandPacket.CommandTimeout = NVME_GENERIC_TIMEOUT;\r | |
1423 | CommandPacket.QueueId = NVME_ADMIN_QUEUE;\r | |
1424 | \r | |
1425 | DelIoCq.Qid = NVME_IO_QUEUE;\r | |
1426 | CopyMem (&CommandPacket.NvmeCmd->Cdw10, &DelIoCq, sizeof (NVME_ADMIN_DEIOCQ));\r | |
1427 | CommandPacket.NvmeCmd->Flags = CDW10_VALID | CDW11_VALID;\r | |
1428 | \r | |
1429 | Status = NvmePassThru (\r | |
1430 | Nvme,\r | |
1431 | NVME_CONTROLLER_ID,\r | |
1432 | 0,\r | |
1433 | &CommandPacket\r | |
1434 | );\r | |
1435 | if (!EFI_ERROR (Status)) {\r | |
1436 | Status = NvmeWaitAllComplete (Nvme, CommandPacket.QueueId);\r | |
1437 | }\r | |
1438 | \r | |
1439 | return Status;\r | |
1440 | }\r | |
1441 | \r | |
1442 | /**\r | |
1443 | Destroy io submission queue.\r | |
1444 | \r | |
1445 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1446 | \r | |
1447 | @return EFI_SUCCESS - Successfully destroy io submission queue.\r | |
1448 | @return others - Fail to destroy io submission queue.\r | |
1449 | \r | |
1450 | **/\r | |
1451 | STATIC\r | |
1452 | EFI_STATUS\r | |
1453 | NvmeDestroyIoSubmissionQueue (\r | |
1454 | IN NVME_CONTEXT *Nvme\r | |
1455 | )\r | |
1456 | {\r | |
1457 | NVM_EXPRESS_PASS_THRU_COMMAND_PACKET CommandPacket;\r | |
1458 | NVM_EXPRESS_COMMAND Command;\r | |
1459 | NVM_EXPRESS_RESPONSE Response;\r | |
1460 | EFI_STATUS Status;\r | |
1461 | NVME_ADMIN_DEIOSQ DelIoSq;\r | |
1462 | \r | |
1463 | ZeroMem (&CommandPacket, sizeof(NVM_EXPRESS_PASS_THRU_COMMAND_PACKET));\r | |
1464 | ZeroMem (&Command, sizeof(NVM_EXPRESS_COMMAND));\r | |
1465 | ZeroMem (&Response, sizeof(NVM_EXPRESS_RESPONSE));\r | |
1466 | ZeroMem (&DelIoSq, sizeof(NVME_ADMIN_DEIOSQ));\r | |
1467 | \r | |
1468 | CommandPacket.NvmeCmd = &Command;\r | |
1469 | CommandPacket.NvmeResponse = &Response;\r | |
1470 | \r | |
1471 | Command.Cdw0.Opcode = NVME_ADMIN_DELIOSQ_OPC;\r | |
1472 | Command.Cdw0.Cid = Nvme->Cid[NVME_ADMIN_QUEUE]++;\r | |
1473 | CommandPacket.TransferBuffer = (UINT64)(UINTN)Nvme->SqBuffer[NVME_IO_QUEUE];\r | |
1474 | CommandPacket.TransferLength = EFI_PAGE_SIZE;\r | |
1475 | CommandPacket.CommandTimeout = NVME_GENERIC_TIMEOUT;\r | |
1476 | CommandPacket.QueueId = NVME_ADMIN_QUEUE;\r | |
1477 | \r | |
1478 | DelIoSq.Qid = NVME_IO_QUEUE;\r | |
1479 | CopyMem (&CommandPacket.NvmeCmd->Cdw10, &DelIoSq, sizeof (NVME_ADMIN_DEIOSQ));\r | |
1480 | CommandPacket.NvmeCmd->Flags = CDW10_VALID | CDW11_VALID;\r | |
1481 | \r | |
1482 | Status = NvmePassThru (\r | |
1483 | Nvme,\r | |
1484 | NVME_CONTROLLER_ID,\r | |
1485 | 0,\r | |
1486 | &CommandPacket\r | |
1487 | );\r | |
1488 | if (!EFI_ERROR (Status)) {\r | |
1489 | Status = NvmeWaitAllComplete (Nvme, CommandPacket.QueueId);\r | |
1490 | }\r | |
1491 | \r | |
1492 | return Status;\r | |
1493 | }\r | |
1494 | \r | |
1495 | /**\r | |
1496 | Allocate transfer-related Data struct which is used at Nvme.\r | |
1497 | \r | |
1498 | @param[in, out] Nvme The pointer to the NVME_CONTEXT Data structure.\r | |
1499 | \r | |
1500 | @retval EFI_OUT_OF_RESOURCE No enough resource.\r | |
1501 | @retval EFI_SUCCESS Successful to allocate resource.\r | |
1502 | \r | |
1503 | **/\r | |
1504 | EFI_STATUS\r | |
1505 | EFIAPI\r | |
1506 | NvmeAllocateResource (\r | |
1507 | IN OUT NVME_CONTEXT *Nvme\r | |
1508 | )\r | |
1509 | {\r | |
1510 | EFI_STATUS Status;\r | |
1511 | EFI_PHYSICAL_ADDRESS DeviceAddress;\r | |
1512 | VOID *Base;\r | |
1513 | VOID *Mapping;\r | |
1514 | \r | |
1515 | //\r | |
1516 | // Allocate resources for DMA.\r | |
1517 | //\r | |
1518 | Status = IoMmuAllocateBuffer (\r | |
1519 | EFI_SIZE_TO_PAGES (NVME_MEM_MAX_SIZE),\r | |
1520 | &Base,\r | |
1521 | &DeviceAddress,\r | |
1522 | &Mapping\r | |
1523 | );\r | |
1524 | if (EFI_ERROR (Status)) {\r | |
1525 | return EFI_OUT_OF_RESOURCES;\r | |
1526 | }\r | |
1527 | ASSERT (DeviceAddress == ((EFI_PHYSICAL_ADDRESS) (UINTN) Base));\r | |
1528 | Nvme->BaseMemMapping = Mapping;\r | |
1529 | Nvme->BaseMem = Base;\r | |
1530 | ZeroMem (Nvme->BaseMem, EFI_PAGE_SIZE * EFI_SIZE_TO_PAGES (NVME_MEM_MAX_SIZE));\r | |
1531 | \r | |
1532 | DEBUG ((\r | |
1533 | DEBUG_INFO,\r | |
1534 | "%a() NvmeContext 0x%x\n",\r | |
1535 | __FUNCTION__,\r | |
1536 | Nvme->BaseMem\r | |
1537 | ));\r | |
1538 | \r | |
1539 | return EFI_SUCCESS;\r | |
1540 | }\r | |
1541 | \r | |
1542 | /**\r | |
1543 | Free allocated transfer-related Data struct which is used at NVMe.\r | |
1544 | \r | |
1545 | @param[in, out] Nvme The pointer to the NVME_CONTEXT Data structure.\r | |
1546 | \r | |
1547 | **/\r | |
1548 | VOID\r | |
1549 | EFIAPI\r | |
1550 | NvmeFreeResource (\r | |
1551 | IN OUT NVME_CONTEXT *Nvme\r | |
1552 | )\r | |
1553 | {\r | |
1554 | if (Nvme->BaseMem != NULL) {\r | |
1555 | IoMmuFreeBuffer (\r | |
1556 | EFI_SIZE_TO_PAGES (NVME_MEM_MAX_SIZE),\r | |
1557 | Nvme->BaseMem,\r | |
1558 | Nvme->BaseMemMapping\r | |
1559 | );\r | |
1560 | Nvme->BaseMem = NULL;\r | |
1561 | }\r | |
1562 | }\r | |
1563 | \r | |
1564 | /**\r | |
1565 | Initialize the Nvm Express controller.\r | |
1566 | \r | |
1567 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1568 | \r | |
1569 | @retval EFI_SUCCESS - The NVM Express Controller is initialized successfully.\r | |
1570 | @retval Others - A device error occurred while initializing the controller.\r | |
1571 | \r | |
1572 | **/\r | |
1573 | EFI_STATUS\r | |
1574 | NvmeControllerInit (\r | |
1575 | IN NVME_CONTEXT *Nvme\r | |
1576 | )\r | |
1577 | {\r | |
1578 | EFI_STATUS Status;\r | |
1579 | NVME_AQA Aqa;\r | |
1580 | NVME_ASQ Asq;\r | |
1581 | NVME_ACQ Acq;\r | |
1582 | NVME_VER Ver;\r | |
1583 | \r | |
1584 | UINT32 MlBAR;\r | |
1585 | UINT32 MuBAR;\r | |
1586 | \r | |
1587 | ///\r | |
1588 | /// Update PCIE BAR0/1 for NVME device\r | |
1589 | ///\r | |
1590 | MlBAR = Nvme->Nbar;\r | |
1591 | MuBAR = 0;\r | |
1592 | PciWrite32 (Nvme->PciBase + 0x10, MlBAR); // MLBAR (BAR0)\r | |
1593 | PciWrite32 (Nvme->PciBase + 0x14, MuBAR); // MUBAR (BAR1)\r | |
1594 | \r | |
1595 | ///\r | |
1596 | /// Enable PCIE decode\r | |
1597 | ///\r | |
1598 | PciWrite8 (Nvme->PciBase + NVME_PCIE_PCICMD, 0x6);\r | |
1599 | \r | |
1600 | // Version\r | |
1601 | NVME_GET_VER (Nvme, &Ver);\r | |
1602 | if (!(Ver.Mjr == 0x0001) && (Ver.Mnr == 0x0000)) {\r | |
1603 | DEBUG ((DEBUG_INFO, "\n!!!\n!!! NVME Version mismatch for the implementation !!!\n!!!\n"));\r | |
1604 | }\r | |
1605 | \r | |
1606 | ///\r | |
1607 | /// Read the Controller Capabilities register and verify that the NVM command set is supported\r | |
1608 | ///\r | |
1609 | Status = NVME_GET_CAP (Nvme, &Nvme->Cap);\r | |
1610 | if (EFI_ERROR (Status)) {\r | |
1611 | DEBUG ((DEBUG_ERROR, "NVME_GET_CAP fail, Status: %r\n", Status));\r | |
1612 | goto Done;\r | |
1613 | }\r | |
1614 | \r | |
1615 | if (Nvme->Cap.Css != 0x01) {\r | |
1616 | DEBUG ((DEBUG_ERROR, "NvmeControllerInit fail: the controller doesn't support NVMe command set\n"));\r | |
1617 | Status = EFI_UNSUPPORTED;\r | |
1618 | goto Done;\r | |
1619 | }\r | |
1620 | \r | |
1621 | ///\r | |
1622 | /// Currently the driver only supports 4k page Size.\r | |
1623 | ///\r | |
1624 | if ((Nvme->Cap.Mpsmin + 12) > EFI_PAGE_SHIFT) {\r | |
1625 | DEBUG ((DEBUG_ERROR, "NvmeControllerInit fail: only supports 4k page Size\n"));\r | |
1626 | ASSERT (FALSE);\r | |
1627 | Status = EFI_UNSUPPORTED;\r | |
1628 | goto Done;\r | |
1629 | }\r | |
1630 | \r | |
1631 | Nvme->Cid[0] = 0;\r | |
1632 | Nvme->Cid[1] = 0;\r | |
1633 | \r | |
1634 | Nvme->Pt[0] = 0;\r | |
1635 | Nvme->Pt[1] = 0;\r | |
1636 | \r | |
1637 | ZeroMem ((VOID *)(UINTN)(&(Nvme->SqTdbl[0])), sizeof (NVME_SQTDBL) * NVME_MAX_IO_QUEUES);\r | |
1638 | ZeroMem ((VOID *)(UINTN)(&(Nvme->CqHdbl[0])), sizeof (NVME_CQHDBL) * NVME_MAX_IO_QUEUES);\r | |
1639 | \r | |
1640 | ZeroMem (Nvme->BaseMem, NVME_MEM_MAX_SIZE);\r | |
1641 | \r | |
1642 | Status = NvmeDisableController (Nvme);\r | |
1643 | if (EFI_ERROR(Status)) {\r | |
1644 | DEBUG ((DEBUG_ERROR, "NvmeDisableController fail, Status: %r\n", Status));\r | |
1645 | goto Done;\r | |
1646 | }\r | |
1647 | \r | |
1648 | ///\r | |
1649 | /// set number of entries admin submission & completion queues.\r | |
1650 | ///\r | |
1651 | Aqa.Asqs = NVME_ASQ_SIZE;\r | |
1652 | Aqa.Rsvd1 = 0;\r | |
1653 | Aqa.Acqs = NVME_ACQ_SIZE;\r | |
1654 | Aqa.Rsvd2 = 0;\r | |
1655 | \r | |
1656 | ///\r | |
1657 | /// Address of admin submission queue.\r | |
1658 | ///\r | |
1659 | Asq = (UINT64)(UINTN)(NVME_ASQ_BASE (Nvme) & ~0xFFF);\r | |
1660 | \r | |
1661 | ///\r | |
1662 | /// Address of admin completion queue.\r | |
1663 | ///\r | |
1664 | Acq = (UINT64)(UINTN)(NVME_ACQ_BASE (Nvme) & ~0xFFF);\r | |
1665 | \r | |
1666 | ///\r | |
1667 | /// Address of I/O submission & completion queue.\r | |
1668 | ///\r | |
1669 | Nvme->SqBuffer[0] = (NVME_SQ *)(UINTN)NVME_ASQ_BASE (Nvme); // NVME_ADMIN_QUEUE\r | |
1670 | Nvme->CqBuffer[0] = (NVME_CQ *)(UINTN)NVME_ACQ_BASE (Nvme); // NVME_ADMIN_QUEUE\r | |
1671 | Nvme->SqBuffer[1] = (NVME_SQ *)(UINTN)NVME_SQ_BASE (Nvme, 0); // NVME_IO_QUEUE\r | |
1672 | Nvme->CqBuffer[1] = (NVME_CQ *)(UINTN)NVME_CQ_BASE (Nvme, 0); // NVME_IO_QUEUE\r | |
1673 | \r | |
1674 | DEBUG ((DEBUG_INFO, "Admin Submission Queue Size (Aqa.Asqs) = [%08X]\n", Aqa.Asqs));\r | |
1675 | DEBUG ((DEBUG_INFO, "Admin Completion Queue Size (Aqa.Acqs) = [%08X]\n", Aqa.Acqs));\r | |
1676 | DEBUG ((DEBUG_INFO, "Admin Submission Queue (SqBuffer[0]) = [%08X]\n", Nvme->SqBuffer[0]));\r | |
1677 | DEBUG ((DEBUG_INFO, "Admin Completion Queue (CqBuffer[0]) = [%08X]\n", Nvme->CqBuffer[0]));\r | |
1678 | DEBUG ((DEBUG_INFO, "I/O Submission Queue (SqBuffer[1]) = [%08X]\n", Nvme->SqBuffer[1]));\r | |
1679 | DEBUG ((DEBUG_INFO, "I/O Completion Queue (CqBuffer[1]) = [%08X]\n", Nvme->CqBuffer[1]));\r | |
1680 | \r | |
1681 | ///\r | |
1682 | /// Program admin queue attributes.\r | |
1683 | ///\r | |
1684 | Status = NVME_SET_AQA (Nvme, &Aqa);\r | |
1685 | if (EFI_ERROR(Status)) {\r | |
1686 | goto Done;\r | |
1687 | }\r | |
1688 | \r | |
1689 | ///\r | |
1690 | /// Program admin submission queue address.\r | |
1691 | ///\r | |
1692 | Status = NVME_SET_ASQ (Nvme, &Asq);\r | |
1693 | if (EFI_ERROR(Status)) {\r | |
1694 | goto Done;\r | |
1695 | }\r | |
1696 | \r | |
1697 | ///\r | |
1698 | /// Program admin completion queue address.\r | |
1699 | ///\r | |
1700 | Status = NVME_SET_ACQ (Nvme, &Acq);\r | |
1701 | if (EFI_ERROR(Status)) {\r | |
1702 | goto Done;\r | |
1703 | }\r | |
1704 | \r | |
1705 | Status = NvmeEnableController (Nvme);\r | |
1706 | if (EFI_ERROR(Status)) {\r | |
1707 | goto Done;\r | |
1708 | }\r | |
1709 | \r | |
1710 | ///\r | |
1711 | /// Create one I/O completion queue.\r | |
1712 | ///\r | |
1713 | Status = NvmeCreateIoCompletionQueue (Nvme);\r | |
1714 | if (EFI_ERROR(Status)) {\r | |
1715 | goto Done;\r | |
1716 | }\r | |
1717 | \r | |
1718 | ///\r | |
1719 | /// Create one I/O Submission queue.\r | |
1720 | ///\r | |
1721 | Status = NvmeCreateIoSubmissionQueue (Nvme);\r | |
1722 | if (EFI_ERROR(Status)) {\r | |
1723 | goto Done;\r | |
1724 | }\r | |
1725 | \r | |
1726 | ///\r | |
1727 | /// Get current Identify Controller Data\r | |
1728 | ///\r | |
1729 | Nvme->ControllerData = (NVME_ADMIN_CONTROLLER_DATA *)(UINTN) NVME_CONTROL_DATA_BASE (Nvme);\r | |
1730 | Status = NvmeIdentifyController (Nvme, Nvme->ControllerData);\r | |
1731 | if (EFI_ERROR(Status)) {\r | |
1732 | goto Done;\r | |
1733 | }\r | |
1734 | \r | |
1735 | ///\r | |
1736 | /// Dump NvmExpress Identify Controller Data\r | |
1737 | ///\r | |
1738 | Nvme->ControllerData->Sn[19] = 0;\r | |
1739 | Nvme->ControllerData->Mn[39] = 0;\r | |
1740 | //NvmeDumpIdentifyController (Nvme->ControllerData);\r | |
1741 | \r | |
1742 | ///\r | |
1743 | /// Get current Identify Namespace Data\r | |
1744 | ///\r | |
1745 | Nvme->NamespaceData = (NVME_ADMIN_NAMESPACE_DATA *)NVME_NAMESPACE_DATA_BASE (Nvme);\r | |
1746 | Status = NvmeIdentifyNamespace (Nvme, Nvme->Nsid, Nvme->NamespaceData);\r | |
1747 | if (EFI_ERROR(Status)) {\r | |
1748 | DEBUG ((DEBUG_ERROR, "NvmeIdentifyNamespace fail, Status = %r\n", Status));\r | |
1749 | goto Done;\r | |
1750 | }\r | |
1751 | \r | |
1752 | ///\r | |
1753 | /// Dump NvmExpress Identify Namespace Data\r | |
1754 | ///\r | |
1755 | if (Nvme->NamespaceData->Ncap == 0) {\r | |
1756 | DEBUG ((DEBUG_ERROR, "Invalid Namespace, Ncap: %lx\n", Nvme->NamespaceData->Ncap));\r | |
1757 | Status = EFI_DEVICE_ERROR;\r | |
1758 | goto Done;\r | |
1759 | }\r | |
1760 | \r | |
1761 | Nvme->BlockSize = NvmeGetBlockSize (Nvme);\r | |
1762 | Nvme->LastBlock = NvmeGetLastLba (Nvme);\r | |
1763 | \r | |
1764 | Nvme->State = NvmeStatusInit;\r | |
1765 | \r | |
1766 | return EFI_SUCCESS;\r | |
1767 | \r | |
1768 | Done:\r | |
1769 | return Status;\r | |
1770 | }\r | |
1771 | \r | |
1772 | /**\r | |
1773 | Un-initialize the Nvm Express controller.\r | |
1774 | \r | |
1775 | @param[in] Nvme - The pointer to the NVME_CONTEXT Data structure.\r | |
1776 | \r | |
1777 | @retval EFI_SUCCESS - The NVM Express Controller is un-initialized successfully.\r | |
1778 | @retval Others - A device error occurred while un-initializing the controller.\r | |
1779 | \r | |
1780 | **/\r | |
1781 | EFI_STATUS\r | |
1782 | NvmeControllerExit (\r | |
1783 | IN NVME_CONTEXT *Nvme\r | |
1784 | )\r | |
1785 | {\r | |
1786 | EFI_STATUS Status;\r | |
1787 | \r | |
1788 | Status = EFI_SUCCESS;\r | |
1789 | if (Nvme->State == NvmeStatusInit || Nvme->State == NvmeStatusMax) {\r | |
1790 | ///\r | |
1791 | /// Destroy I/O Submission queue.\r | |
1792 | ///\r | |
1793 | Status = NvmeDestroyIoSubmissionQueue (Nvme);\r | |
1794 | if (EFI_ERROR(Status)) {\r | |
1795 | DEBUG ((DEBUG_ERROR, "NvmeDestroyIoSubmissionQueue fail, Status = %r\n", Status));\r | |
1796 | return Status;\r | |
1797 | }\r | |
1798 | \r | |
1799 | ///\r | |
1800 | /// Destroy I/O completion queue.\r | |
1801 | ///\r | |
1802 | Status = NvmeDestroyIoCompletionQueue (Nvme);\r | |
1803 | if (EFI_ERROR(Status)) {\r | |
1804 | DEBUG ((DEBUG_ERROR, "NvmeDestroyIoCompletionQueue fail, Status = %r\n", Status));\r | |
1805 | return Status;\r | |
1806 | }\r | |
1807 | \r | |
1808 | Status = NvmeShutdownController (Nvme);\r | |
1809 | if (EFI_ERROR(Status)) {\r | |
1810 | DEBUG ((DEBUG_ERROR, "NvmeShutdownController fail, Status: %r\n", Status));\r | |
1811 | }\r | |
1812 | }\r | |
1813 | \r | |
1814 | ///\r | |
1815 | /// Disable PCIE decode\r | |
1816 | ///\r | |
1817 | PciWrite8 (Nvme->PciBase + NVME_PCIE_PCICMD, 0x0);\r | |
1818 | PciWrite32 (Nvme->PciBase + 0x10, 0); // MLBAR (BAR0)\r | |
1819 | PciWrite32 (Nvme->PciBase + 0x14, 0); // MUBAR (BAR1)\r | |
1820 | \r | |
1821 | Nvme->State = NvmeStatusUnknown;\r | |
1822 | return Status;\r | |
1823 | }\r |