]> git.proxmox.com Git - mirror_edk2.git/blob - MdeModulePkg/Bus/Pci/SdMmcPciHcDxe/SdMmcPciHci.c
projects / mirror_edk2.git / blob
? search:


1fa6823cbb18b3963e38a7470475723831fde9c7
[mirror_edk2.git] / MdeModulePkg / Bus / Pci / SdMmcPciHcDxe / SdMmcPciHci.c
1 /** @file
2 This driver is used to manage SD/MMC PCI host controllers which are compliance
3 with SD Host Controller Simplified Specification version 3.00 plus the 64-bit
4 System Addressing support in SD Host Controller Simplified Specification version
5 4.20.
6
7 It would expose EFI_SD_MMC_PASS_THRU_PROTOCOL for upper layer use.
8
9 Copyright (c) 2018-2019, NVIDIA CORPORATION. All rights reserved.
10 Copyright (c) 2015 - 2020, Intel Corporation. All rights reserved.<BR>
11 SPDX-License-Identifier: BSD-2-Clause-Patent
12
13 **/
14
15 #include "SdMmcPciHcDxe.h"
16
17 /**
18 Dump the content of SD/MMC host controller's Capability Register.
19
20 @param[in] Slot The slot number of the SD card to send the command to.
21 @param[in] Capability The buffer to store the capability data.
22
23 **/
24 VOID
25 DumpCapabilityReg (
26 IN UINT8 Slot,
27 IN SD_MMC_HC_SLOT_CAP *Capability
28 )
29 {
30 //
31 // Dump Capability Data
32 //
33 DEBUG ((DEBUG_INFO, " == Slot [%d] Capability is 0x%x ==\n", Slot, Capability));
34 DEBUG ((DEBUG_INFO, " Timeout Clk Freq %d%a\n", Capability->TimeoutFreq, (Capability->TimeoutUnit) ? "MHz" : "KHz"));
35 DEBUG ((DEBUG_INFO, " Base Clk Freq %dMHz\n", Capability->BaseClkFreq));
36 DEBUG ((DEBUG_INFO, " Max Blk Len %dbytes\n", 512 * (1 << Capability->MaxBlkLen)));
37 DEBUG ((DEBUG_INFO, " 8-bit Support %a\n", Capability->BusWidth8 ? "TRUE" : "FALSE"));
38 DEBUG ((DEBUG_INFO, " ADMA2 Support %a\n", Capability->Adma2 ? "TRUE" : "FALSE"));
39 DEBUG ((DEBUG_INFO, " HighSpeed Support %a\n", Capability->HighSpeed ? "TRUE" : "FALSE"));
40 DEBUG ((DEBUG_INFO, " SDMA Support %a\n", Capability->Sdma ? "TRUE" : "FALSE"));
41 DEBUG ((DEBUG_INFO, " Suspend/Resume %a\n", Capability->SuspRes ? "TRUE" : "FALSE"));
42 DEBUG ((DEBUG_INFO, " Voltage 3.3 %a\n", Capability->Voltage33 ? "TRUE" : "FALSE"));
43 DEBUG ((DEBUG_INFO, " Voltage 3.0 %a\n", Capability->Voltage30 ? "TRUE" : "FALSE"));
44 DEBUG ((DEBUG_INFO, " Voltage 1.8 %a\n", Capability->Voltage18 ? "TRUE" : "FALSE"));
45 DEBUG ((DEBUG_INFO, " V4 64-bit Sys Bus %a\n", Capability->SysBus64V4 ? "TRUE" : "FALSE"));
46 DEBUG ((DEBUG_INFO, " V3 64-bit Sys Bus %a\n", Capability->SysBus64V3 ? "TRUE" : "FALSE"));
47 DEBUG ((DEBUG_INFO, " Async Interrupt %a\n", Capability->AsyncInt ? "TRUE" : "FALSE"));
48 DEBUG ((DEBUG_INFO, " SlotType "));
49 if (Capability->SlotType == 0x00) {
50 DEBUG ((DEBUG_INFO, "%a\n", "Removable Slot"));
51 } else if (Capability->SlotType == 0x01) {
52 DEBUG ((DEBUG_INFO, "%a\n", "Embedded Slot"));
53 } else if (Capability->SlotType == 0x02) {
54 DEBUG ((DEBUG_INFO, "%a\n", "Shared Bus Slot"));
55 } else {
56 DEBUG ((DEBUG_INFO, "%a\n", "Reserved"));
57 }
58 DEBUG ((DEBUG_INFO, " SDR50 Support %a\n", Capability->Sdr50 ? "TRUE" : "FALSE"));
59 DEBUG ((DEBUG_INFO, " SDR104 Support %a\n", Capability->Sdr104 ? "TRUE" : "FALSE"));
60 DEBUG ((DEBUG_INFO, " DDR50 Support %a\n", Capability->Ddr50 ? "TRUE" : "FALSE"));
61 DEBUG ((DEBUG_INFO, " Driver Type A %a\n", Capability->DriverTypeA ? "TRUE" : "FALSE"));
62 DEBUG ((DEBUG_INFO, " Driver Type C %a\n", Capability->DriverTypeC ? "TRUE" : "FALSE"));
63 DEBUG ((DEBUG_INFO, " Driver Type D %a\n", Capability->DriverTypeD ? "TRUE" : "FALSE"));
64 DEBUG ((DEBUG_INFO, " Driver Type 4 %a\n", Capability->DriverType4 ? "TRUE" : "FALSE"));
65 if (Capability->TimerCount == 0) {
66 DEBUG ((DEBUG_INFO, " Retuning TimerCnt Disabled\n", 2 * (Capability->TimerCount - 1)));
67 } else {
68 DEBUG ((DEBUG_INFO, " Retuning TimerCnt %dseconds\n", 2 * (Capability->TimerCount - 1)));
69 }
70 DEBUG ((DEBUG_INFO, " SDR50 Tuning %a\n", Capability->TuningSDR50 ? "TRUE" : "FALSE"));
71 DEBUG ((DEBUG_INFO, " Retuning Mode Mode %d\n", Capability->RetuningMod + 1));
72 DEBUG ((DEBUG_INFO, " Clock Multiplier M = %d\n", Capability->ClkMultiplier + 1));
73 DEBUG ((DEBUG_INFO, " HS 400 %a\n", Capability->Hs400 ? "TRUE" : "FALSE"));
74 return;
75 }
76
77 /**
78 Read SlotInfo register from SD/MMC host controller pci config space.
79
80 @param[in] PciIo The PCI IO protocol instance.
81 @param[out] FirstBar The buffer to store the first BAR value.
82 @param[out] SlotNum The buffer to store the supported slot number.
83
84 @retval EFI_SUCCESS The operation succeeds.
85 @retval Others The operation fails.
86
87 **/
88 EFI_STATUS
89 EFIAPI
90 SdMmcHcGetSlotInfo (
91 IN EFI_PCI_IO_PROTOCOL *PciIo,
92 OUT UINT8 *FirstBar,
93 OUT UINT8 *SlotNum
94 )
95 {
96 EFI_STATUS Status;
97 SD_MMC_HC_SLOT_INFO SlotInfo;
98
99 Status = PciIo->Pci.Read (
100 PciIo,
101 EfiPciIoWidthUint8,
102 SD_MMC_HC_SLOT_OFFSET,
103 sizeof (SlotInfo),
104 &SlotInfo
105 );
106 if (EFI_ERROR (Status)) {
107 return Status;
108 }
109
110 *FirstBar = SlotInfo.FirstBar;
111 *SlotNum = SlotInfo.SlotNum + 1;
112 ASSERT ((*FirstBar + *SlotNum) < SD_MMC_HC_MAX_SLOT);
113 return EFI_SUCCESS;
114 }
115
116 /**
117 Read/Write specified SD/MMC host controller mmio register.
118
119 @param[in] PciIo The PCI IO protocol instance.
120 @param[in] BarIndex The BAR index of the standard PCI Configuration
121 header to use as the base address for the memory
122 operation to perform.
123 @param[in] Offset The offset within the selected BAR to start the
124 memory operation.
125 @param[in] Read A boolean to indicate it's read or write operation.
126 @param[in] Count The width of the mmio register in bytes.
127 Must be 1, 2 , 4 or 8 bytes.
128 @param[in, out] Data For read operations, the destination buffer to store
129 the results. For write operations, the source buffer
130 to write data from. The caller is responsible for
131 having ownership of the data buffer and ensuring its
132 size not less than Count bytes.
133
134 @retval EFI_INVALID_PARAMETER The PciIo or Data is NULL or the Count is not valid.
135 @retval EFI_SUCCESS The read/write operation succeeds.
136 @retval Others The read/write operation fails.
137
138 **/
139 EFI_STATUS
140 EFIAPI
141 SdMmcHcRwMmio (
142 IN EFI_PCI_IO_PROTOCOL *PciIo,
143 IN UINT8 BarIndex,
144 IN UINT32 Offset,
145 IN BOOLEAN Read,
146 IN UINT8 Count,
147 IN OUT VOID *Data
148 )
149 {
150 EFI_STATUS Status;
151 EFI_PCI_IO_PROTOCOL_WIDTH Width;
152
153 if ((PciIo == NULL) || (Data == NULL)) {
154 return EFI_INVALID_PARAMETER;
155 }
156
157 switch (Count) {
158 case 1:
159 Width = EfiPciIoWidthUint8;
160 break;
161 case 2:
162 Width = EfiPciIoWidthUint16;
163 Count = 1;
164 break;
165 case 4:
166 Width = EfiPciIoWidthUint32;
167 Count = 1;
168 break;
169 case 8:
170 Width = EfiPciIoWidthUint32;
171 Count = 2;
172 break;
173 default:
174 return EFI_INVALID_PARAMETER;
175 }
176
177 if (Read) {
178 Status = PciIo->Mem.Read (
179 PciIo,
180 Width,
181 BarIndex,
182 (UINT64) Offset,
183 Count,
184 Data
185 );
186 } else {
187 Status = PciIo->Mem.Write (
188 PciIo,
189 Width,
190 BarIndex,
191 (UINT64) Offset,
192 Count,
193 Data
194 );
195 }
196
197 return Status;
198 }
199
200 /**
201 Do OR operation with the value of the specified SD/MMC host controller mmio register.
202
203 @param[in] PciIo The PCI IO protocol instance.
204 @param[in] BarIndex The BAR index of the standard PCI Configuration
205 header to use as the base address for the memory
206 operation to perform.
207 @param[in] Offset The offset within the selected BAR to start the
208 memory operation.
209 @param[in] Count The width of the mmio register in bytes.
210 Must be 1, 2 , 4 or 8 bytes.
211 @param[in] OrData The pointer to the data used to do OR operation.
212 The caller is responsible for having ownership of
213 the data buffer and ensuring its size not less than
214 Count bytes.
215
216 @retval EFI_INVALID_PARAMETER The PciIo or OrData is NULL or the Count is not valid.
217 @retval EFI_SUCCESS The OR operation succeeds.
218 @retval Others The OR operation fails.
219
220 **/
221 EFI_STATUS
222 EFIAPI
223 SdMmcHcOrMmio (
224 IN EFI_PCI_IO_PROTOCOL *PciIo,
225 IN UINT8 BarIndex,
226 IN UINT32 Offset,
227 IN UINT8 Count,
228 IN VOID *OrData
229 )
230 {
231 EFI_STATUS Status;
232 UINT64 Data;
233 UINT64 Or;
234
235 Status = SdMmcHcRwMmio (PciIo, BarIndex, Offset, TRUE, Count, &Data);
236 if (EFI_ERROR (Status)) {
237 return Status;
238 }
239
240 if (Count == 1) {
241 Or = *(UINT8*) OrData;
242 } else if (Count == 2) {
243 Or = *(UINT16*) OrData;
244 } else if (Count == 4) {
245 Or = *(UINT32*) OrData;
246 } else if (Count == 8) {
247 Or = *(UINT64*) OrData;
248 } else {
249 return EFI_INVALID_PARAMETER;
250 }
251
252 Data |= Or;
253 Status = SdMmcHcRwMmio (PciIo, BarIndex, Offset, FALSE, Count, &Data);
254
255 return Status;
256 }
257
258 /**
259 Do AND operation with the value of the specified SD/MMC host controller mmio register.
260
261 @param[in] PciIo The PCI IO protocol instance.
262 @param[in] BarIndex The BAR index of the standard PCI Configuration
263 header to use as the base address for the memory
264 operation to perform.
265 @param[in] Offset The offset within the selected BAR to start the
266 memory operation.
267 @param[in] Count The width of the mmio register in bytes.
268 Must be 1, 2 , 4 or 8 bytes.
269 @param[in] AndData The pointer to the data used to do AND operation.
270 The caller is responsible for having ownership of
271 the data buffer and ensuring its size not less than
272 Count bytes.
273
274 @retval EFI_INVALID_PARAMETER The PciIo or AndData is NULL or the Count is not valid.
275 @retval EFI_SUCCESS The AND operation succeeds.
276 @retval Others The AND operation fails.
277
278 **/
279 EFI_STATUS
280 EFIAPI
281 SdMmcHcAndMmio (
282 IN EFI_PCI_IO_PROTOCOL *PciIo,
283 IN UINT8 BarIndex,
284 IN UINT32 Offset,
285 IN UINT8 Count,
286 IN VOID *AndData
287 )
288 {
289 EFI_STATUS Status;
290 UINT64 Data;
291 UINT64 And;
292
293 Status = SdMmcHcRwMmio (PciIo, BarIndex, Offset, TRUE, Count, &Data);
294 if (EFI_ERROR (Status)) {
295 return Status;
296 }
297
298 if (Count == 1) {
299 And = *(UINT8*) AndData;
300 } else if (Count == 2) {
301 And = *(UINT16*) AndData;
302 } else if (Count == 4) {
303 And = *(UINT32*) AndData;
304 } else if (Count == 8) {
305 And = *(UINT64*) AndData;
306 } else {
307 return EFI_INVALID_PARAMETER;
308 }
309
310 Data &= And;
311 Status = SdMmcHcRwMmio (PciIo, BarIndex, Offset, FALSE, Count, &Data);
312
313 return Status;
314 }
315
316 /**
317 Wait for the value of the specified MMIO register set to the test value.
318
319 @param[in] PciIo The PCI IO protocol instance.
320 @param[in] BarIndex The BAR index of the standard PCI Configuration
321 header to use as the base address for the memory
322 operation to perform.
323 @param[in] Offset The offset within the selected BAR to start the
324 memory operation.
325 @param[in] Count The width of the mmio register in bytes.
326 Must be 1, 2, 4 or 8 bytes.
327 @param[in] MaskValue The mask value of memory.
328 @param[in] TestValue The test value of memory.
329
330 @retval EFI_NOT_READY The MMIO register hasn't set to the expected value.
331 @retval EFI_SUCCESS The MMIO register has expected value.
332 @retval Others The MMIO operation fails.
333
334 **/
335 EFI_STATUS
336 EFIAPI
337 SdMmcHcCheckMmioSet (
338 IN EFI_PCI_IO_PROTOCOL *PciIo,
339 IN UINT8 BarIndex,
340 IN UINT32 Offset,
341 IN UINT8 Count,
342 IN UINT64 MaskValue,
343 IN UINT64 TestValue
344 )
345 {
346 EFI_STATUS Status;
347 UINT64 Value;
348
349 //
350 // Access PCI MMIO space to see if the value is the tested one.
351 //
352 Value = 0;
353 Status = SdMmcHcRwMmio (PciIo, BarIndex, Offset, TRUE, Count, &Value);
354 if (EFI_ERROR (Status)) {
355 return Status;
356 }
357
358 Value &= MaskValue;
359
360 if (Value == TestValue) {
361 return EFI_SUCCESS;
362 }
363
364 return EFI_NOT_READY;
365 }
366
367 /**
368 Wait for the value of the specified MMIO register set to the test value.
369
370 @param[in] PciIo The PCI IO protocol instance.
371 @param[in] BarIndex The BAR index of the standard PCI Configuration
372 header to use as the base address for the memory
373 operation to perform.
374 @param[in] Offset The offset within the selected BAR to start the
375 memory operation.
376 @param[in] Count The width of the mmio register in bytes.
377 Must be 1, 2, 4 or 8 bytes.
378 @param[in] MaskValue The mask value of memory.
379 @param[in] TestValue The test value of memory.
380 @param[in] Timeout The time out value for wait memory set, uses 1
381 microsecond as a unit.
382
383 @retval EFI_TIMEOUT The MMIO register hasn't expected value in timeout
384 range.
385 @retval EFI_SUCCESS The MMIO register has expected value.
386 @retval Others The MMIO operation fails.
387
388 **/
389 EFI_STATUS
390 EFIAPI
391 SdMmcHcWaitMmioSet (
392 IN EFI_PCI_IO_PROTOCOL *PciIo,
393 IN UINT8 BarIndex,
394 IN UINT32 Offset,
395 IN UINT8 Count,
396 IN UINT64 MaskValue,
397 IN UINT64 TestValue,
398 IN UINT64 Timeout
399 )
400 {
401 EFI_STATUS Status;
402 BOOLEAN InfiniteWait;
403
404 if (Timeout == 0) {
405 InfiniteWait = TRUE;
406 } else {
407 InfiniteWait = FALSE;
408 }
409
410 while (InfiniteWait || (Timeout > 0)) {
411 Status = SdMmcHcCheckMmioSet (
412 PciIo,
413 BarIndex,
414 Offset,
415 Count,
416 MaskValue,
417 TestValue
418 );
419 if (Status != EFI_NOT_READY) {
420 return Status;
421 }
422
423 //
424 // Stall for 1 microsecond.
425 //
426 gBS->Stall (1);
427
428 Timeout--;
429 }
430
431 return EFI_TIMEOUT;
432 }
433
434 /**
435 Get the controller version information from the specified slot.
436
437 @param[in] PciIo The PCI IO protocol instance.
438 @param[in] Slot The slot number of the SD card to send the command to.
439 @param[out] Version The buffer to store the version information.
440
441 @retval EFI_SUCCESS The operation executes successfully.
442 @retval Others The operation fails.
443
444 **/
445 EFI_STATUS
446 SdMmcHcGetControllerVersion (
447 IN EFI_PCI_IO_PROTOCOL *PciIo,
448 IN UINT8 Slot,
449 OUT UINT16 *Version
450 )
451 {
452 EFI_STATUS Status;
453
454 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_CTRL_VER, TRUE, sizeof (UINT16), Version);
455 if (EFI_ERROR (Status)) {
456 return Status;
457 }
458
459 *Version &= 0xFF;
460
461 return EFI_SUCCESS;
462 }
463
464 /**
465 Software reset the specified SD/MMC host controller and enable all interrupts.
466
467 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
468 @param[in] Slot The slot number of the SD card to send the command to.
469
470 @retval EFI_SUCCESS The software reset executes successfully.
471 @retval Others The software reset fails.
472
473 **/
474 EFI_STATUS
475 SdMmcHcReset (
476 IN SD_MMC_HC_PRIVATE_DATA *Private,
477 IN UINT8 Slot
478 )
479 {
480 EFI_STATUS Status;
481 UINT8 SwReset;
482 EFI_PCI_IO_PROTOCOL *PciIo;
483
484 //
485 // Notify the SD/MMC override protocol that we are about to reset
486 // the SD/MMC host controller.
487 //
488 if (mOverride != NULL && mOverride->NotifyPhase != NULL) {
489 Status = mOverride->NotifyPhase (
490 Private->ControllerHandle,
491 Slot,
492 EdkiiSdMmcResetPre,
493 NULL);
494 if (EFI_ERROR (Status)) {
495 DEBUG ((DEBUG_WARN,
496 "%a: SD/MMC pre reset notifier callback failed - %r\n",
497 __FUNCTION__, Status));
498 return Status;
499 }
500 }
501
502 PciIo = Private->PciIo;
503 SwReset = BIT0;
504 Status = SdMmcHcOrMmio (PciIo, Slot, SD_MMC_HC_SW_RST, sizeof (SwReset), &SwReset);
505
506 if (EFI_ERROR (Status)) {
507 DEBUG ((DEBUG_ERROR, "SdMmcHcReset: write SW Reset for All fails: %r\n", Status));
508 return Status;
509 }
510
511 Status = SdMmcHcWaitMmioSet (
512 PciIo,
513 Slot,
514 SD_MMC_HC_SW_RST,
515 sizeof (SwReset),
516 BIT0,
517 0x00,
518 SD_MMC_HC_GENERIC_TIMEOUT
519 );
520 if (EFI_ERROR (Status)) {
521 DEBUG ((DEBUG_INFO, "SdMmcHcReset: reset done with %r\n", Status));
522 return Status;
523 }
524
525 //
526 // Enable all interrupt after reset all.
527 //
528 Status = SdMmcHcEnableInterrupt (PciIo, Slot);
529 if (EFI_ERROR (Status)) {
530 DEBUG ((DEBUG_INFO, "SdMmcHcReset: SdMmcHcEnableInterrupt done with %r\n",
531 Status));
532 return Status;
533 }
534
535 //
536 // Notify the SD/MMC override protocol that we have just reset
537 // the SD/MMC host controller.
538 //
539 if (mOverride != NULL && mOverride->NotifyPhase != NULL) {
540 Status = mOverride->NotifyPhase (
541 Private->ControllerHandle,
542 Slot,
543 EdkiiSdMmcResetPost,
544 NULL);
545 if (EFI_ERROR (Status)) {
546 DEBUG ((DEBUG_WARN,
547 "%a: SD/MMC post reset notifier callback failed - %r\n",
548 __FUNCTION__, Status));
549 }
550 }
551
552 return Status;
553 }
554
555 /**
556 Set all interrupt status bits in Normal and Error Interrupt Status Enable
557 register.
558
559 @param[in] PciIo The PCI IO protocol instance.
560 @param[in] Slot The slot number of the SD card to send the command to.
561
562 @retval EFI_SUCCESS The operation executes successfully.
563 @retval Others The operation fails.
564
565 **/
566 EFI_STATUS
567 SdMmcHcEnableInterrupt (
568 IN EFI_PCI_IO_PROTOCOL *PciIo,
569 IN UINT8 Slot
570 )
571 {
572 EFI_STATUS Status;
573 UINT16 IntStatus;
574
575 //
576 // Enable all bits in Error Interrupt Status Enable Register
577 //
578 IntStatus = 0xFFFF;
579 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_ERR_INT_STS_EN, FALSE, sizeof (IntStatus), &IntStatus);
580 if (EFI_ERROR (Status)) {
581 return Status;
582 }
583 //
584 // Enable all bits in Normal Interrupt Status Enable Register
585 //
586 IntStatus = 0xFFFF;
587 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_NOR_INT_STS_EN, FALSE, sizeof (IntStatus), &IntStatus);
588
589 return Status;
590 }
591
592 /**
593 Get the capability data from the specified slot.
594
595 @param[in] PciIo The PCI IO protocol instance.
596 @param[in] Slot The slot number of the SD card to send the command to.
597 @param[out] Capability The buffer to store the capability data.
598
599 @retval EFI_SUCCESS The operation executes successfully.
600 @retval Others The operation fails.
601
602 **/
603 EFI_STATUS
604 SdMmcHcGetCapability (
605 IN EFI_PCI_IO_PROTOCOL *PciIo,
606 IN UINT8 Slot,
607 OUT SD_MMC_HC_SLOT_CAP *Capability
608 )
609 {
610 EFI_STATUS Status;
611 UINT64 Cap;
612
613 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_CAP, TRUE, sizeof (Cap), &Cap);
614 if (EFI_ERROR (Status)) {
615 return Status;
616 }
617
618 CopyMem (Capability, &Cap, sizeof (Cap));
619
620 return EFI_SUCCESS;
621 }
622
623 /**
624 Get the maximum current capability data from the specified slot.
625
626 @param[in] PciIo The PCI IO protocol instance.
627 @param[in] Slot The slot number of the SD card to send the command to.
628 @param[out] MaxCurrent The buffer to store the maximum current capability data.
629
630 @retval EFI_SUCCESS The operation executes successfully.
631 @retval Others The operation fails.
632
633 **/
634 EFI_STATUS
635 SdMmcHcGetMaxCurrent (
636 IN EFI_PCI_IO_PROTOCOL *PciIo,
637 IN UINT8 Slot,
638 OUT UINT64 *MaxCurrent
639 )
640 {
641 EFI_STATUS Status;
642
643 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_MAX_CURRENT_CAP, TRUE, sizeof (UINT64), MaxCurrent);
644
645 return Status;
646 }
647
648 /**
649 Detect whether there is a SD/MMC card attached at the specified SD/MMC host controller
650 slot.
651
652 Refer to SD Host Controller Simplified spec 3.0 Section 3.1 for details.
653
654 @param[in] PciIo The PCI IO protocol instance.
655 @param[in] Slot The slot number of the SD card to send the command to.
656 @param[out] MediaPresent The pointer to the media present boolean value.
657
658 @retval EFI_SUCCESS There is no media change happened.
659 @retval EFI_MEDIA_CHANGED There is media change happened.
660 @retval Others The detection fails.
661
662 **/
663 EFI_STATUS
664 SdMmcHcCardDetect (
665 IN EFI_PCI_IO_PROTOCOL *PciIo,
666 IN UINT8 Slot,
667 OUT BOOLEAN *MediaPresent
668 )
669 {
670 EFI_STATUS Status;
671 UINT16 Data;
672 UINT32 PresentState;
673
674 //
675 // Check Present State Register to see if there is a card presented.
676 //
677 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_PRESENT_STATE, TRUE, sizeof (PresentState), &PresentState);
678 if (EFI_ERROR (Status)) {
679 return Status;
680 }
681
682 if ((PresentState & BIT16) != 0) {
683 *MediaPresent = TRUE;
684 } else {
685 *MediaPresent = FALSE;
686 }
687
688 //
689 // Check Normal Interrupt Status Register
690 //
691 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_NOR_INT_STS, TRUE, sizeof (Data), &Data);
692 if (EFI_ERROR (Status)) {
693 return Status;
694 }
695
696 if ((Data & (BIT6 | BIT7)) != 0) {
697 //
698 // Clear BIT6 and BIT7 by writing 1 to these two bits if set.
699 //
700 Data &= BIT6 | BIT7;
701 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_NOR_INT_STS, FALSE, sizeof (Data), &Data);
702 if (EFI_ERROR (Status)) {
703 return Status;
704 }
705
706 return EFI_MEDIA_CHANGED;
707 }
708
709 return EFI_SUCCESS;
710 }
711
712 /**
713 Stop SD/MMC card clock.
714
715 Refer to SD Host Controller Simplified spec 3.0 Section 3.2.2 for details.
716
717 @param[in] PciIo The PCI IO protocol instance.
718 @param[in] Slot The slot number of the SD card to send the command to.
719
720 @retval EFI_SUCCESS Succeed to stop SD/MMC clock.
721 @retval Others Fail to stop SD/MMC clock.
722
723 **/
724 EFI_STATUS
725 SdMmcHcStopClock (
726 IN EFI_PCI_IO_PROTOCOL *PciIo,
727 IN UINT8 Slot
728 )
729 {
730 EFI_STATUS Status;
731 UINT32 PresentState;
732 UINT16 ClockCtrl;
733
734 //
735 // Ensure no SD transactions are occurring on the SD Bus by
736 // waiting for Command Inhibit (DAT) and Command Inhibit (CMD)
737 // in the Present State register to be 0.
738 //
739 Status = SdMmcHcWaitMmioSet (
740 PciIo,
741 Slot,
742 SD_MMC_HC_PRESENT_STATE,
743 sizeof (PresentState),
744 BIT0 | BIT1,
745 0,
746 SD_MMC_HC_GENERIC_TIMEOUT
747 );
748 if (EFI_ERROR (Status)) {
749 return Status;
750 }
751
752 //
753 // Set SD Clock Enable in the Clock Control register to 0
754 //
755 ClockCtrl = (UINT16)~BIT2;
756 Status = SdMmcHcAndMmio (PciIo, Slot, SD_MMC_HC_CLOCK_CTRL, sizeof (ClockCtrl), &ClockCtrl);
757
758 return Status;
759 }
760
761 /**
762 Start the SD clock.
763
764 @param[in] PciIo The PCI IO protocol instance.
765 @param[in] Slot The slot number.
766
767 @retval EFI_SUCCESS Succeeded to start the SD clock.
768 @retval Others Failed to start the SD clock.
769 **/
770 EFI_STATUS
771 SdMmcHcStartSdClock (
772 IN EFI_PCI_IO_PROTOCOL *PciIo,
773 IN UINT8 Slot
774 )
775 {
776 UINT16 ClockCtrl;
777
778 //
779 // Set SD Clock Enable in the Clock Control register to 1
780 //
781 ClockCtrl = BIT2;
782 return SdMmcHcOrMmio (PciIo, Slot, SD_MMC_HC_CLOCK_CTRL, sizeof (ClockCtrl), &ClockCtrl);
783 }
784
785 /**
786 SD/MMC card clock supply.
787
788 Refer to SD Host Controller Simplified spec 3.0 Section 3.2.1 for details.
789
790 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
791 @param[in] Slot The slot number of the SD card to send the command to.
792 @param[in] BusTiming BusTiming at which the frequency change is done.
793 @param[in] FirstTimeSetup Flag to indicate whether the clock is being setup for the first time.
794 @param[in] ClockFreq The max clock frequency to be set. The unit is KHz.
795
796 @retval EFI_SUCCESS The clock is supplied successfully.
797 @retval Others The clock isn't supplied successfully.
798
799 **/
800 EFI_STATUS
801 SdMmcHcClockSupply (
802 IN SD_MMC_HC_PRIVATE_DATA *Private,
803 IN UINT8 Slot,
804 IN SD_MMC_BUS_MODE BusTiming,
805 IN BOOLEAN FirstTimeSetup,
806 IN UINT64 ClockFreq
807 )
808 {
809 EFI_STATUS Status;
810 UINT32 SettingFreq;
811 UINT32 Divisor;
812 UINT32 Remainder;
813 UINT16 ClockCtrl;
814 UINT32 BaseClkFreq;
815 UINT16 ControllerVer;
816 EFI_PCI_IO_PROTOCOL *PciIo;
817
818 PciIo = Private->PciIo;
819 BaseClkFreq = Private->BaseClkFreq[Slot];
820 ControllerVer = Private->ControllerVersion[Slot];
821
822 if (BaseClkFreq == 0 || ClockFreq == 0) {
823 return EFI_INVALID_PARAMETER;
824 }
825
826 if (ClockFreq > (BaseClkFreq * 1000)) {
827 ClockFreq = BaseClkFreq * 1000;
828 }
829
830 //
831 // Calculate the divisor of base frequency.
832 //
833 Divisor = 0;
834 SettingFreq = BaseClkFreq * 1000;
835 while (ClockFreq < SettingFreq) {
836 Divisor++;
837
838 SettingFreq = (BaseClkFreq * 1000) / (2 * Divisor);
839 Remainder = (BaseClkFreq * 1000) % (2 * Divisor);
840 if ((ClockFreq == SettingFreq) && (Remainder == 0)) {
841 break;
842 }
843 if ((ClockFreq == SettingFreq) && (Remainder != 0)) {
844 SettingFreq ++;
845 }
846 }
847
848 DEBUG ((DEBUG_INFO, "BaseClkFreq %dMHz Divisor %d ClockFreq %dKhz\n", BaseClkFreq, Divisor, ClockFreq));
849
850 //
851 // Set SDCLK Frequency Select and Internal Clock Enable fields in Clock Control register.
852 //
853 if ((ControllerVer >= SD_MMC_HC_CTRL_VER_300) &&
854 (ControllerVer <= SD_MMC_HC_CTRL_VER_420)) {
855 ASSERT (Divisor <= 0x3FF);
856 ClockCtrl = ((Divisor & 0xFF) << 8) | ((Divisor & 0x300) >> 2);
857 } else if ((ControllerVer == SD_MMC_HC_CTRL_VER_100) ||
858 (ControllerVer == SD_MMC_HC_CTRL_VER_200)) {
859 //
860 // Only the most significant bit can be used as divisor.
861 //
862 if (((Divisor - 1) & Divisor) != 0) {
863 Divisor = 1 << (HighBitSet32 (Divisor) + 1);
864 }
865 ASSERT (Divisor <= 0x80);
866 ClockCtrl = (Divisor & 0xFF) << 8;
867 } else {
868 DEBUG ((DEBUG_ERROR, "Unknown SD Host Controller Spec version [0x%x]!!!\n", ControllerVer));
869 return EFI_UNSUPPORTED;
870 }
871
872 //
873 // Stop bus clock at first
874 //
875 Status = SdMmcHcStopClock (PciIo, Slot);
876 if (EFI_ERROR (Status)) {
877 return Status;
878 }
879
880 //
881 // Supply clock frequency with specified divisor
882 //
883 ClockCtrl |= BIT0;
884 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_CLOCK_CTRL, FALSE, sizeof (ClockCtrl), &ClockCtrl);
885 if (EFI_ERROR (Status)) {
886 DEBUG ((DEBUG_ERROR, "Set SDCLK Frequency Select and Internal Clock Enable fields fails\n"));
887 return Status;
888 }
889
890 //
891 // Wait Internal Clock Stable in the Clock Control register to be 1
892 //
893 Status = SdMmcHcWaitMmioSet (
894 PciIo,
895 Slot,
896 SD_MMC_HC_CLOCK_CTRL,
897 sizeof (ClockCtrl),
898 BIT1,
899 BIT1,
900 SD_MMC_HC_GENERIC_TIMEOUT
901 );
902 if (EFI_ERROR (Status)) {
903 return Status;
904 }
905
906 Status = SdMmcHcStartSdClock (PciIo, Slot);
907 if (EFI_ERROR (Status)) {
908 return Status;
909 }
910
911 //
912 // We don't notify the platform on first time setup to avoid changing
913 // legacy behavior. During first time setup we also don't know what type
914 // of the card slot it is and which enum value of BusTiming applies.
915 //
916 if (!FirstTimeSetup && mOverride != NULL && mOverride->NotifyPhase != NULL) {
917 Status = mOverride->NotifyPhase (
918 Private->ControllerHandle,
919 Slot,
920 EdkiiSdMmcSwitchClockFreqPost,
921 &BusTiming
922 );
923 if (EFI_ERROR (Status)) {
924 DEBUG ((
925 DEBUG_ERROR,
926 "%a: SD/MMC switch clock freq post notifier callback failed - %r\n",
927 __FUNCTION__,
928 Status
929 ));
930 return Status;
931 }
932 }
933
934 Private->Slot[Slot].CurrentFreq = ClockFreq;
935
936 return Status;
937 }
938
939 /**
940 SD/MMC bus power control.
941
942 Refer to SD Host Controller Simplified spec 3.0 Section 3.3 for details.
943
944 @param[in] PciIo The PCI IO protocol instance.
945 @param[in] Slot The slot number of the SD card to send the command to.
946 @param[in] PowerCtrl The value setting to the power control register.
947
948 @retval TRUE There is a SD/MMC card attached.
949 @retval FALSE There is no a SD/MMC card attached.
950
951 **/
952 EFI_STATUS
953 SdMmcHcPowerControl (
954 IN EFI_PCI_IO_PROTOCOL *PciIo,
955 IN UINT8 Slot,
956 IN UINT8 PowerCtrl
957 )
958 {
959 EFI_STATUS Status;
960
961 //
962 // Clr SD Bus Power
963 //
964 PowerCtrl &= (UINT8)~BIT0;
965 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_POWER_CTRL, FALSE, sizeof (PowerCtrl), &PowerCtrl);
966 if (EFI_ERROR (Status)) {
967 return Status;
968 }
969
970 //
971 // Set SD Bus Voltage Select and SD Bus Power fields in Power Control Register
972 //
973 PowerCtrl |= BIT0;
974 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_POWER_CTRL, FALSE, sizeof (PowerCtrl), &PowerCtrl);
975
976 return Status;
977 }
978
979 /**
980 Set the SD/MMC bus width.
981
982 Refer to SD Host Controller Simplified spec 3.0 Section 3.4 for details.
983
984 @param[in] PciIo The PCI IO protocol instance.
985 @param[in] Slot The slot number of the SD card to send the command to.
986 @param[in] BusWidth The bus width used by the SD/MMC device, it must be 1, 4 or 8.
987
988 @retval EFI_SUCCESS The bus width is set successfully.
989 @retval Others The bus width isn't set successfully.
990
991 **/
992 EFI_STATUS
993 SdMmcHcSetBusWidth (
994 IN EFI_PCI_IO_PROTOCOL *PciIo,
995 IN UINT8 Slot,
996 IN UINT16 BusWidth
997 )
998 {
999 EFI_STATUS Status;
1000 UINT8 HostCtrl1;
1001
1002 if (BusWidth == 1) {
1003 HostCtrl1 = (UINT8)~(BIT5 | BIT1);
1004 Status = SdMmcHcAndMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL1, sizeof (HostCtrl1), &HostCtrl1);
1005 } else if (BusWidth == 4) {
1006 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL1, TRUE, sizeof (HostCtrl1), &HostCtrl1);
1007 if (EFI_ERROR (Status)) {
1008 return Status;
1009 }
1010 HostCtrl1 |= BIT1;
1011 HostCtrl1 &= (UINT8)~BIT5;
1012 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL1, FALSE, sizeof (HostCtrl1), &HostCtrl1);
1013 } else if (BusWidth == 8) {
1014 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL1, TRUE, sizeof (HostCtrl1), &HostCtrl1);
1015 if (EFI_ERROR (Status)) {
1016 return Status;
1017 }
1018 HostCtrl1 &= (UINT8)~BIT1;
1019 HostCtrl1 |= BIT5;
1020 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL1, FALSE, sizeof (HostCtrl1), &HostCtrl1);
1021 } else {
1022 ASSERT (FALSE);
1023 return EFI_INVALID_PARAMETER;
1024 }
1025
1026 return Status;
1027 }
1028
1029 /**
1030 Configure V4 controller enhancements at initialization.
1031
1032 @param[in] PciIo The PCI IO protocol instance.
1033 @param[in] Slot The slot number of the SD card to send the command to.
1034 @param[in] Capability The capability of the slot.
1035 @param[in] ControllerVer The version of host controller.
1036
1037 @retval EFI_SUCCESS The clock is supplied successfully.
1038
1039 **/
1040 EFI_STATUS
1041 SdMmcHcInitV4Enhancements (
1042 IN EFI_PCI_IO_PROTOCOL *PciIo,
1043 IN UINT8 Slot,
1044 IN SD_MMC_HC_SLOT_CAP Capability,
1045 IN UINT16 ControllerVer
1046 )
1047 {
1048 EFI_STATUS Status;
1049 UINT16 HostCtrl2;
1050
1051 //
1052 // Check if controller version V4 or higher
1053 //
1054 if (ControllerVer >= SD_MMC_HC_CTRL_VER_400) {
1055 HostCtrl2 = SD_MMC_HC_V4_EN;
1056 //
1057 // Check if controller version V4.0
1058 //
1059 if (ControllerVer == SD_MMC_HC_CTRL_VER_400) {
1060 //
1061 // Check if 64bit support is available
1062 //
1063 if (Capability.SysBus64V3 != 0) {
1064 HostCtrl2 |= SD_MMC_HC_64_ADDR_EN;
1065 DEBUG ((DEBUG_INFO, "Enabled V4 64 bit system bus support\n"));
1066 }
1067 }
1068 //
1069 // Check if controller version V4.10 or higher
1070 //
1071 else if (ControllerVer >= SD_MMC_HC_CTRL_VER_410) {
1072 //
1073 // Check if 64bit support is available
1074 //
1075 if (Capability.SysBus64V4 != 0) {
1076 HostCtrl2 |= SD_MMC_HC_64_ADDR_EN;
1077 DEBUG ((DEBUG_INFO, "Enabled V4 64 bit system bus support\n"));
1078 }
1079 HostCtrl2 |= SD_MMC_HC_26_DATA_LEN_ADMA_EN;
1080 DEBUG ((DEBUG_INFO, "Enabled V4 26 bit data length ADMA support\n"));
1081 }
1082 Status = SdMmcHcOrMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL2, sizeof (HostCtrl2), &HostCtrl2);
1083 if (EFI_ERROR (Status)) {
1084 return Status;
1085 }
1086 }
1087
1088 return EFI_SUCCESS;
1089 }
1090
1091 /**
1092 Supply SD/MMC card with maximum voltage at initialization.
1093
1094 Refer to SD Host Controller Simplified spec 3.0 Section 3.3 for details.
1095
1096 @param[in] PciIo The PCI IO protocol instance.
1097 @param[in] Slot The slot number of the SD card to send the command to.
1098 @param[in] Capability The capability of the slot.
1099
1100 @retval EFI_SUCCESS The voltage is supplied successfully.
1101 @retval Others The voltage isn't supplied successfully.
1102
1103 **/
1104 EFI_STATUS
1105 SdMmcHcInitPowerVoltage (
1106 IN EFI_PCI_IO_PROTOCOL *PciIo,
1107 IN UINT8 Slot,
1108 IN SD_MMC_HC_SLOT_CAP Capability
1109 )
1110 {
1111 EFI_STATUS Status;
1112 UINT8 MaxVoltage;
1113 UINT8 HostCtrl2;
1114
1115 //
1116 // Calculate supported maximum voltage according to SD Bus Voltage Select
1117 //
1118 if (Capability.Voltage33 != 0) {
1119 //
1120 // Support 3.3V
1121 //
1122 MaxVoltage = 0x0E;
1123 } else if (Capability.Voltage30 != 0) {
1124 //
1125 // Support 3.0V
1126 //
1127 MaxVoltage = 0x0C;
1128 } else if (Capability.Voltage18 != 0) {
1129 //
1130 // Support 1.8V
1131 //
1132 MaxVoltage = 0x0A;
1133 HostCtrl2 = BIT3;
1134 Status = SdMmcHcOrMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL2, sizeof (HostCtrl2), &HostCtrl2);
1135 gBS->Stall (5000);
1136 if (EFI_ERROR (Status)) {
1137 return Status;
1138 }
1139 } else {
1140 ASSERT (FALSE);
1141 return EFI_DEVICE_ERROR;
1142 }
1143
1144 //
1145 // Set SD Bus Voltage Select and SD Bus Power fields in Power Control Register
1146 //
1147 Status = SdMmcHcPowerControl (PciIo, Slot, MaxVoltage);
1148
1149 return Status;
1150 }
1151
1152 /**
1153 Initialize the Timeout Control register with most conservative value at initialization.
1154
1155 Refer to SD Host Controller Simplified spec 3.0 Section 2.2.15 for details.
1156
1157 @param[in] PciIo The PCI IO protocol instance.
1158 @param[in] Slot The slot number of the SD card to send the command to.
1159
1160 @retval EFI_SUCCESS The timeout control register is configured successfully.
1161 @retval Others The timeout control register isn't configured successfully.
1162
1163 **/
1164 EFI_STATUS
1165 SdMmcHcInitTimeoutCtrl (
1166 IN EFI_PCI_IO_PROTOCOL *PciIo,
1167 IN UINT8 Slot
1168 )
1169 {
1170 EFI_STATUS Status;
1171 UINT8 Timeout;
1172
1173 Timeout = 0x0E;
1174 Status = SdMmcHcRwMmio (PciIo, Slot, SD_MMC_HC_TIMEOUT_CTRL, FALSE, sizeof (Timeout), &Timeout);
1175
1176 return Status;
1177 }
1178
1179 /**
1180 Initial SD/MMC host controller with lowest clock frequency, max power and max timeout value
1181 at initialization.
1182
1183 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
1184 @param[in] Slot The slot number of the SD card to send the command to.
1185
1186 @retval EFI_SUCCESS The host controller is initialized successfully.
1187 @retval Others The host controller isn't initialized successfully.
1188
1189 **/
1190 EFI_STATUS
1191 SdMmcHcInitHost (
1192 IN SD_MMC_HC_PRIVATE_DATA *Private,
1193 IN UINT8 Slot
1194 )
1195 {
1196 EFI_STATUS Status;
1197 EFI_PCI_IO_PROTOCOL *PciIo;
1198 SD_MMC_HC_SLOT_CAP Capability;
1199
1200 //
1201 // Notify the SD/MMC override protocol that we are about to initialize
1202 // the SD/MMC host controller.
1203 //
1204 if (mOverride != NULL && mOverride->NotifyPhase != NULL) {
1205 Status = mOverride->NotifyPhase (
1206 Private->ControllerHandle,
1207 Slot,
1208 EdkiiSdMmcInitHostPre,
1209 NULL);
1210 if (EFI_ERROR (Status)) {
1211 DEBUG ((DEBUG_WARN,
1212 "%a: SD/MMC pre init notifier callback failed - %r\n",
1213 __FUNCTION__, Status));
1214 return Status;
1215 }
1216 }
1217
1218 PciIo = Private->PciIo;
1219 Capability = Private->Capability[Slot];
1220
1221 Status = SdMmcHcInitV4Enhancements (PciIo, Slot, Capability, Private->ControllerVersion[Slot]);
1222 if (EFI_ERROR (Status)) {
1223 return Status;
1224 }
1225
1226 //
1227 // Perform first time clock setup with 400 KHz frequency.
1228 // We send the 0 as the BusTiming value because at this time
1229 // we still do not know the slot type and which enum value will apply.
1230 // Since it is a first time setup SdMmcHcClockSupply won't notify
1231 // the platofrm driver anyway so it doesn't matter.
1232 //
1233 Status = SdMmcHcClockSupply (Private, Slot, 0, TRUE, 400);
1234 if (EFI_ERROR (Status)) {
1235 return Status;
1236 }
1237
1238 Status = SdMmcHcInitPowerVoltage (PciIo, Slot, Capability);
1239 if (EFI_ERROR (Status)) {
1240 return Status;
1241 }
1242
1243 Status = SdMmcHcInitTimeoutCtrl (PciIo, Slot);
1244 if (EFI_ERROR (Status)) {
1245 return Status;
1246 }
1247
1248 //
1249 // Notify the SD/MMC override protocol that we are have just initialized
1250 // the SD/MMC host controller.
1251 //
1252 if (mOverride != NULL && mOverride->NotifyPhase != NULL) {
1253 Status = mOverride->NotifyPhase (
1254 Private->ControllerHandle,
1255 Slot,
1256 EdkiiSdMmcInitHostPost,
1257 NULL);
1258 if (EFI_ERROR (Status)) {
1259 DEBUG ((DEBUG_WARN,
1260 "%a: SD/MMC post init notifier callback failed - %r\n",
1261 __FUNCTION__, Status));
1262 }
1263 }
1264 return Status;
1265 }
1266
1267 /**
1268 Set SD Host Controler control 2 registry according to selected speed.
1269
1270 @param[in] ControllerHandle The handle of the controller.
1271 @param[in] PciIo The PCI IO protocol instance.
1272 @param[in] Slot The slot number of the SD card to send the command to.
1273 @param[in] Timing The timing to select.
1274
1275 @retval EFI_SUCCESS The timing is set successfully.
1276 @retval Others The timing isn't set successfully.
1277 **/
1278 EFI_STATUS
1279 SdMmcHcUhsSignaling (
1280 IN EFI_HANDLE ControllerHandle,
1281 IN EFI_PCI_IO_PROTOCOL *PciIo,
1282 IN UINT8 Slot,
1283 IN SD_MMC_BUS_MODE Timing
1284 )
1285 {
1286 EFI_STATUS Status;
1287 UINT8 HostCtrl2;
1288
1289 HostCtrl2 = (UINT8)~SD_MMC_HC_CTRL_UHS_MASK;
1290 Status = SdMmcHcAndMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL2, sizeof (HostCtrl2), &HostCtrl2);
1291 if (EFI_ERROR (Status)) {
1292 return Status;
1293 }
1294
1295 switch (Timing) {
1296 case SdMmcUhsSdr12:
1297 HostCtrl2 = SD_MMC_HC_CTRL_UHS_SDR12;
1298 break;
1299 case SdMmcUhsSdr25:
1300 HostCtrl2 = SD_MMC_HC_CTRL_UHS_SDR25;
1301 break;
1302 case SdMmcUhsSdr50:
1303 HostCtrl2 = SD_MMC_HC_CTRL_UHS_SDR50;
1304 break;
1305 case SdMmcUhsSdr104:
1306 HostCtrl2 = SD_MMC_HC_CTRL_UHS_SDR104;
1307 break;
1308 case SdMmcUhsDdr50:
1309 HostCtrl2 = SD_MMC_HC_CTRL_UHS_DDR50;
1310 break;
1311 case SdMmcMmcLegacy:
1312 HostCtrl2 = SD_MMC_HC_CTRL_MMC_LEGACY;
1313 break;
1314 case SdMmcMmcHsSdr:
1315 HostCtrl2 = SD_MMC_HC_CTRL_MMC_HS_SDR;
1316 break;
1317 case SdMmcMmcHsDdr:
1318 HostCtrl2 = SD_MMC_HC_CTRL_MMC_HS_DDR;
1319 break;
1320 case SdMmcMmcHs200:
1321 HostCtrl2 = SD_MMC_HC_CTRL_MMC_HS200;
1322 break;
1323 case SdMmcMmcHs400:
1324 HostCtrl2 = SD_MMC_HC_CTRL_MMC_HS400;
1325 break;
1326 default:
1327 HostCtrl2 = 0;
1328 break;
1329 }
1330 Status = SdMmcHcOrMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL2, sizeof (HostCtrl2), &HostCtrl2);
1331 if (EFI_ERROR (Status)) {
1332 return Status;
1333 }
1334
1335 if (mOverride != NULL && mOverride->NotifyPhase != NULL) {
1336 Status = mOverride->NotifyPhase (
1337 ControllerHandle,
1338 Slot,
1339 EdkiiSdMmcUhsSignaling,
1340 &Timing
1341 );
1342 if (EFI_ERROR (Status)) {
1343 DEBUG ((
1344 DEBUG_ERROR,
1345 "%a: SD/MMC uhs signaling notifier callback failed - %r\n",
1346 __FUNCTION__,
1347 Status
1348 ));
1349 return Status;
1350 }
1351 }
1352
1353 return EFI_SUCCESS;
1354 }
1355
1356 /**
1357 Set driver strength in host controller.
1358
1359 @param[in] PciIo The PCI IO protocol instance.
1360 @param[in] SlotIndex The slot index of the card.
1361 @param[in] DriverStrength DriverStrength to set in the controller.
1362
1363 @retval EFI_SUCCESS Driver strength programmed successfully.
1364 @retval Others Failed to set driver strength.
1365 **/
1366 EFI_STATUS
1367 SdMmcSetDriverStrength (
1368 IN EFI_PCI_IO_PROTOCOL *PciIo,
1369 IN UINT8 SlotIndex,
1370 IN SD_DRIVER_STRENGTH_TYPE DriverStrength
1371 )
1372 {
1373 EFI_STATUS Status;
1374 UINT16 HostCtrl2;
1375
1376 if (DriverStrength == SdDriverStrengthIgnore) {
1377 return EFI_SUCCESS;
1378 }
1379
1380 HostCtrl2 = (UINT16)~SD_MMC_HC_CTRL_DRIVER_STRENGTH_MASK;
1381 Status = SdMmcHcAndMmio (PciIo, SlotIndex, SD_MMC_HC_HOST_CTRL2, sizeof (HostCtrl2), &HostCtrl2);
1382 if (EFI_ERROR (Status)) {
1383 return Status;
1384 }
1385
1386 HostCtrl2 = (DriverStrength << 4) & SD_MMC_HC_CTRL_DRIVER_STRENGTH_MASK;
1387 return SdMmcHcOrMmio (PciIo, SlotIndex, SD_MMC_HC_HOST_CTRL2, sizeof (HostCtrl2), &HostCtrl2);
1388 }
1389
1390 /**
1391 Turn on/off LED.
1392
1393 @param[in] PciIo The PCI IO protocol instance.
1394 @param[in] Slot The slot number of the SD card to send the command to.
1395 @param[in] On The boolean to turn on/off LED.
1396
1397 @retval EFI_SUCCESS The LED is turned on/off successfully.
1398 @retval Others The LED isn't turned on/off successfully.
1399
1400 **/
1401 EFI_STATUS
1402 SdMmcHcLedOnOff (
1403 IN EFI_PCI_IO_PROTOCOL *PciIo,
1404 IN UINT8 Slot,
1405 IN BOOLEAN On
1406 )
1407 {
1408 EFI_STATUS Status;
1409 UINT8 HostCtrl1;
1410
1411 if (On) {
1412 HostCtrl1 = BIT0;
1413 Status = SdMmcHcOrMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL1, sizeof (HostCtrl1), &HostCtrl1);
1414 } else {
1415 HostCtrl1 = (UINT8)~BIT0;
1416 Status = SdMmcHcAndMmio (PciIo, Slot, SD_MMC_HC_HOST_CTRL1, sizeof (HostCtrl1), &HostCtrl1);
1417 }
1418
1419 return Status;
1420 }
1421
1422 /**
1423 Build ADMA descriptor table for transfer.
1424
1425 Refer to SD Host Controller Simplified spec 4.2 Section 1.13 for details.
1426
1427 @param[in] Trb The pointer to the SD_MMC_HC_TRB instance.
1428 @param[in] ControllerVer The version of host controller.
1429
1430 @retval EFI_SUCCESS The ADMA descriptor table is created successfully.
1431 @retval Others The ADMA descriptor table isn't created successfully.
1432
1433 **/
1434 EFI_STATUS
1435 BuildAdmaDescTable (
1436 IN SD_MMC_HC_TRB *Trb,
1437 IN UINT16 ControllerVer
1438 )
1439 {
1440 EFI_PHYSICAL_ADDRESS Data;
1441 UINT64 DataLen;
1442 UINT64 Entries;
1443 UINT32 Index;
1444 UINT64 Remaining;
1445 UINT64 Address;
1446 UINTN TableSize;
1447 EFI_PCI_IO_PROTOCOL *PciIo;
1448 EFI_STATUS Status;
1449 UINTN Bytes;
1450 UINT32 AdmaMaxDataPerLine;
1451 UINT32 DescSize;
1452 VOID *AdmaDesc;
1453
1454 AdmaMaxDataPerLine = ADMA_MAX_DATA_PER_LINE_16B;
1455 DescSize = sizeof (SD_MMC_HC_ADMA_32_DESC_LINE);
1456 AdmaDesc = NULL;
1457
1458 Data = Trb->DataPhy;
1459 DataLen = Trb->DataLen;
1460 PciIo = Trb->Private->PciIo;
1461
1462 //
1463 // Check for valid ranges in 32bit ADMA Descriptor Table
1464 //
1465 if ((Trb->Mode == SdMmcAdma32bMode) &&
1466 ((Data >= 0x100000000ul) || ((Data + DataLen) > 0x100000000ul))) {
1467 return EFI_INVALID_PARAMETER;
1468 }
1469 //
1470 // Check address field alignment
1471 //
1472 if (Trb->Mode != SdMmcAdma32bMode) {
1473 //
1474 // Address field shall be set on 64-bit boundary (Lower 3-bit is always set to 0)
1475 //
1476 if ((Data & (BIT0 | BIT1 | BIT2)) != 0) {
1477 DEBUG ((DEBUG_INFO, "The buffer [0x%x] to construct ADMA desc is not aligned to 8 bytes boundary!\n", Data));
1478 }
1479 } else {
1480 //
1481 // Address field shall be set on 32-bit boundary (Lower 2-bit is always set to 0)
1482 //
1483 if ((Data & (BIT0 | BIT1)) != 0) {
1484 DEBUG ((DEBUG_INFO, "The buffer [0x%x] to construct ADMA desc is not aligned to 4 bytes boundary!\n", Data));
1485 }
1486 }
1487
1488 //
1489 // Configure 64b ADMA.
1490 //
1491 if (Trb->Mode == SdMmcAdma64bV3Mode) {
1492 DescSize = sizeof (SD_MMC_HC_ADMA_64_V3_DESC_LINE);
1493 }else if (Trb->Mode == SdMmcAdma64bV4Mode) {
1494 DescSize = sizeof (SD_MMC_HC_ADMA_64_V4_DESC_LINE);
1495 }
1496 //
1497 // Configure 26b data length.
1498 //
1499 if (Trb->AdmaLengthMode == SdMmcAdmaLen26b) {
1500 AdmaMaxDataPerLine = ADMA_MAX_DATA_PER_LINE_26B;
1501 }
1502
1503 Entries = DivU64x32 ((DataLen + AdmaMaxDataPerLine - 1), AdmaMaxDataPerLine);
1504 TableSize = (UINTN)MultU64x32 (Entries, DescSize);
1505 Trb->AdmaPages = (UINT32)EFI_SIZE_TO_PAGES (TableSize);
1506 Status = PciIo->AllocateBuffer (
1507 PciIo,
1508 AllocateAnyPages,
1509 EfiBootServicesData,
1510 EFI_SIZE_TO_PAGES (TableSize),
1511 (VOID **)&AdmaDesc,
1512 0
1513 );
1514 if (EFI_ERROR (Status)) {
1515 return EFI_OUT_OF_RESOURCES;
1516 }
1517 ZeroMem (AdmaDesc, TableSize);
1518 Bytes = TableSize;
1519 Status = PciIo->Map (
1520 PciIo,
1521 EfiPciIoOperationBusMasterCommonBuffer,
1522 AdmaDesc,
1523 &Bytes,
1524 &Trb->AdmaDescPhy,
1525 &Trb->AdmaMap
1526 );
1527
1528 if (EFI_ERROR (Status) || (Bytes != TableSize)) {
1529 //
1530 // Map error or unable to map the whole RFis buffer into a contiguous region.
1531 //
1532 PciIo->FreeBuffer (
1533 PciIo,
1534 EFI_SIZE_TO_PAGES (TableSize),
1535 AdmaDesc
1536 );
1537 return EFI_OUT_OF_RESOURCES;
1538 }
1539
1540 if ((Trb->Mode == SdMmcAdma32bMode) &&
1541 (UINT64)(UINTN)Trb->AdmaDescPhy > 0x100000000ul) {
1542 //
1543 // The ADMA doesn't support 64bit addressing.
1544 //
1545 PciIo->Unmap (
1546 PciIo,
1547 Trb->AdmaMap
1548 );
1549 Trb->AdmaMap = NULL;
1550
1551 PciIo->FreeBuffer (
1552 PciIo,
1553 EFI_SIZE_TO_PAGES (TableSize),
1554 AdmaDesc
1555 );
1556 return EFI_DEVICE_ERROR;
1557 }
1558
1559 Remaining = DataLen;
1560 Address = Data;
1561 if (Trb->Mode == SdMmcAdma32bMode) {
1562 Trb->Adma32Desc = AdmaDesc;
1563 } else if (Trb->Mode == SdMmcAdma64bV3Mode) {
1564 Trb->Adma64V3Desc = AdmaDesc;
1565 } else {
1566 Trb->Adma64V4Desc = AdmaDesc;
1567 }
1568
1569 for (Index = 0; Index < Entries; Index++) {
1570 if (Trb->Mode == SdMmcAdma32bMode) {
1571 if (Remaining <= AdmaMaxDataPerLine) {
1572 Trb->Adma32Desc[Index].Valid = 1;
1573 Trb->Adma32Desc[Index].Act = 2;
1574 if (Trb->AdmaLengthMode == SdMmcAdmaLen26b) {
1575 Trb->Adma32Desc[Index].UpperLength = (UINT16)RShiftU64 (Remaining, 16);
1576 }
1577 Trb->Adma32Desc[Index].LowerLength = (UINT16)(Remaining & MAX_UINT16);
1578 Trb->Adma32Desc[Index].Address = (UINT32)Address;
1579 break;
1580 } else {
1581 Trb->Adma32Desc[Index].Valid = 1;
1582 Trb->Adma32Desc[Index].Act = 2;
1583 if (Trb->AdmaLengthMode == SdMmcAdmaLen26b) {
1584 Trb->Adma32Desc[Index].UpperLength = 0;
1585 }
1586 Trb->Adma32Desc[Index].LowerLength = 0;
1587 Trb->Adma32Desc[Index].Address = (UINT32)Address;
1588 }
1589 } else if (Trb->Mode == SdMmcAdma64bV3Mode) {
1590 if (Remaining <= AdmaMaxDataPerLine) {
1591 Trb->Adma64V3Desc[Index].Valid = 1;
1592 Trb->Adma64V3Desc[Index].Act = 2;
1593 if (Trb->AdmaLengthMode == SdMmcAdmaLen26b) {
1594 Trb->Adma64V3Desc[Index].UpperLength = (UINT16)RShiftU64 (Remaining, 16);
1595 }
1596 Trb->Adma64V3Desc[Index].LowerLength = (UINT16)(Remaining & MAX_UINT16);
1597 Trb->Adma64V3Desc[Index].LowerAddress = (UINT32)Address;
1598 Trb->Adma64V3Desc[Index].UpperAddress = (UINT32)RShiftU64 (Address, 32);
1599 break;
1600 } else {
1601 Trb->Adma64V3Desc[Index].Valid = 1;
1602 Trb->Adma64V3Desc[Index].Act = 2;
1603 if (Trb->AdmaLengthMode == SdMmcAdmaLen26b) {
1604 Trb->Adma64V3Desc[Index].UpperLength = 0;
1605 }
1606 Trb->Adma64V3Desc[Index].LowerLength = 0;
1607 Trb->Adma64V3Desc[Index].LowerAddress = (UINT32)Address;
1608 Trb->Adma64V3Desc[Index].UpperAddress = (UINT32)RShiftU64 (Address, 32);
1609 }
1610 } else {
1611 if (Remaining <= AdmaMaxDataPerLine) {
1612 Trb->Adma64V4Desc[Index].Valid = 1;
1613 Trb->Adma64V4Desc[Index].Act = 2;
1614 if (Trb->AdmaLengthMode == SdMmcAdmaLen26b) {
1615 Trb->Adma64V4Desc[Index].UpperLength = (UINT16)RShiftU64 (Remaining, 16);
1616 }
1617 Trb->Adma64V4Desc[Index].LowerLength = (UINT16)(Remaining & MAX_UINT16);
1618 Trb->Adma64V4Desc[Index].LowerAddress = (UINT32)Address;
1619 Trb->Adma64V4Desc[Index].UpperAddress = (UINT32)RShiftU64 (Address, 32);
1620 break;
1621 } else {
1622 Trb->Adma64V4Desc[Index].Valid = 1;
1623 Trb->Adma64V4Desc[Index].Act = 2;
1624 if (Trb->AdmaLengthMode == SdMmcAdmaLen26b) {
1625 Trb->Adma64V4Desc[Index].UpperLength = 0;
1626 }
1627 Trb->Adma64V4Desc[Index].LowerLength = 0;
1628 Trb->Adma64V4Desc[Index].LowerAddress = (UINT32)Address;
1629 Trb->Adma64V4Desc[Index].UpperAddress = (UINT32)RShiftU64 (Address, 32);
1630 }
1631 }
1632
1633 Remaining -= AdmaMaxDataPerLine;
1634 Address += AdmaMaxDataPerLine;
1635 }
1636
1637 //
1638 // Set the last descriptor line as end of descriptor table
1639 //
1640 if (Trb->Mode == SdMmcAdma32bMode) {
1641 Trb->Adma32Desc[Index].End = 1;
1642 } else if (Trb->Mode == SdMmcAdma64bV3Mode) {
1643 Trb->Adma64V3Desc[Index].End = 1;
1644 } else {
1645 Trb->Adma64V4Desc[Index].End = 1;
1646 }
1647 return EFI_SUCCESS;
1648 }
1649
1650 /**
1651 Prints the contents of the command packet to the debug port.
1652
1653 @param[in] DebugLevel Debug level at which the packet should be printed.
1654 @param[in] Packet Pointer to packet to print.
1655 **/
1656 VOID
1657 SdMmcPrintPacket (
1658 IN UINT32 DebugLevel,
1659 IN EFI_SD_MMC_PASS_THRU_COMMAND_PACKET *Packet
1660 )
1661 {
1662 if (Packet == NULL) {
1663 return;
1664 }
1665
1666 DEBUG ((DebugLevel, "Printing EFI_SD_MMC_PASS_THRU_COMMAND_PACKET\n"));
1667 if (Packet->SdMmcCmdBlk != NULL) {
1668 DEBUG ((DebugLevel, "Command index: %d, argument: %X\n", Packet->SdMmcCmdBlk->CommandIndex, Packet->SdMmcCmdBlk->CommandArgument));
1669 DEBUG ((DebugLevel, "Command type: %d, response type: %d\n", Packet->SdMmcCmdBlk->CommandType, Packet->SdMmcCmdBlk->ResponseType));
1670 }
1671 if (Packet->SdMmcStatusBlk != NULL) {
1672 DEBUG ((DebugLevel, "Response 0: %X, 1: %X, 2: %X, 3: %X\n",
1673 Packet->SdMmcStatusBlk->Resp0,
1674 Packet->SdMmcStatusBlk->Resp1,
1675 Packet->SdMmcStatusBlk->Resp2,
1676 Packet->SdMmcStatusBlk->Resp3
1677 ));
1678 }
1679 DEBUG ((DebugLevel, "Timeout: %ld\n", Packet->Timeout));
1680 DEBUG ((DebugLevel, "InDataBuffer: %p\n", Packet->InDataBuffer));
1681 DEBUG ((DebugLevel, "OutDataBuffer: %p\n", Packet->OutDataBuffer));
1682 DEBUG ((DebugLevel, "InTransferLength: %d\n", Packet->InTransferLength));
1683 DEBUG ((DebugLevel, "OutTransferLength: %d\n", Packet->OutTransferLength));
1684 DEBUG ((DebugLevel, "TransactionStatus: %r\n", Packet->TransactionStatus));
1685 }
1686
1687 /**
1688 Prints the contents of the TRB to the debug port.
1689
1690 @param[in] DebugLevel Debug level at which the TRB should be printed.
1691 @param[in] Trb Pointer to the TRB structure.
1692 **/
1693 VOID
1694 SdMmcPrintTrb (
1695 IN UINT32 DebugLevel,
1696 IN SD_MMC_HC_TRB *Trb
1697 )
1698 {
1699 if (Trb == NULL) {
1700 return;
1701 }
1702
1703 DEBUG ((DebugLevel, "Printing SD_MMC_HC_TRB\n"));
1704 DEBUG ((DebugLevel, "Slot: %d\n", Trb->Slot));
1705 DEBUG ((DebugLevel, "BlockSize: %d\n", Trb->BlockSize));
1706 DEBUG ((DebugLevel, "Data: %p\n", Trb->Data));
1707 DEBUG ((DebugLevel, "DataLen: %d\n", Trb->DataLen));
1708 DEBUG ((DebugLevel, "Read: %d\n", Trb->Read));
1709 DEBUG ((DebugLevel, "DataPhy: %lX\n", Trb->DataPhy));
1710 DEBUG ((DebugLevel, "DataMap: %p\n", Trb->DataMap));
1711 DEBUG ((DebugLevel, "Mode: %d\n", Trb->Mode));
1712 DEBUG ((DebugLevel, "AdmaLengthMode: %d\n", Trb->AdmaLengthMode));
1713 DEBUG ((DebugLevel, "Event: %p\n", Trb->Event));
1714 DEBUG ((DebugLevel, "Started: %d\n", Trb->Started));
1715 DEBUG ((DebugLevel, "CommandComplete: %d\n", Trb->CommandComplete));
1716 DEBUG ((DebugLevel, "Timeout: %ld\n", Trb->Timeout));
1717 DEBUG ((DebugLevel, "Retries: %d\n", Trb->Retries));
1718 DEBUG ((DebugLevel, "Adma32Desc: %p\n", Trb->Adma32Desc));
1719 DEBUG ((DebugLevel, "Adma64V3Desc: %p\n", Trb->Adma64V3Desc));
1720 DEBUG ((DebugLevel, "Adma64V4Desc: %p\n", Trb->Adma64V4Desc));
1721 DEBUG ((DebugLevel, "AdmaMap: %p\n", Trb->AdmaMap));
1722 DEBUG ((DebugLevel, "AdmaPages: %X\n", Trb->AdmaPages));
1723
1724 SdMmcPrintPacket (DebugLevel, Trb->Packet);
1725 }
1726
1727 /**
1728 Create a new TRB for the SD/MMC cmd request.
1729
1730 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
1731 @param[in] Slot The slot number of the SD card to send the command to.
1732 @param[in] Packet A pointer to the SD command data structure.
1733 @param[in] Event If Event is NULL, blocking I/O is performed. If Event is
1734 not NULL, then nonblocking I/O is performed, and Event
1735 will be signaled when the Packet completes.
1736
1737 @return Created Trb or NULL.
1738
1739 **/
1740 SD_MMC_HC_TRB *
1741 SdMmcCreateTrb (
1742 IN SD_MMC_HC_PRIVATE_DATA *Private,
1743 IN UINT8 Slot,
1744 IN EFI_SD_MMC_PASS_THRU_COMMAND_PACKET *Packet,
1745 IN EFI_EVENT Event
1746 )
1747 {
1748 SD_MMC_HC_TRB *Trb;
1749 EFI_STATUS Status;
1750 EFI_TPL OldTpl;
1751 EFI_PCI_IO_PROTOCOL_OPERATION Flag;
1752 EFI_PCI_IO_PROTOCOL *PciIo;
1753 UINTN MapLength;
1754
1755 Trb = AllocateZeroPool (sizeof (SD_MMC_HC_TRB));
1756 if (Trb == NULL) {
1757 return NULL;
1758 }
1759
1760 Trb->Signature = SD_MMC_HC_TRB_SIG;
1761 Trb->Slot = Slot;
1762 Trb->BlockSize = 0x200;
1763 Trb->Packet = Packet;
1764 Trb->Event = Event;
1765 Trb->Started = FALSE;
1766 Trb->CommandComplete = FALSE;
1767 Trb->Timeout = Packet->Timeout;
1768 Trb->Retries = SD_MMC_TRB_RETRIES;
1769 Trb->Private = Private;
1770
1771 if ((Packet->InTransferLength != 0) && (Packet->InDataBuffer != NULL)) {
1772 Trb->Data = Packet->InDataBuffer;
1773 Trb->DataLen = Packet->InTransferLength;
1774 Trb->Read = TRUE;
1775 } else if ((Packet->OutTransferLength != 0) && (Packet->OutDataBuffer != NULL)) {
1776 Trb->Data = Packet->OutDataBuffer;
1777 Trb->DataLen = Packet->OutTransferLength;
1778 Trb->Read = FALSE;
1779 } else if ((Packet->InTransferLength == 0) && (Packet->OutTransferLength == 0)) {
1780 Trb->Data = NULL;
1781 Trb->DataLen = 0;
1782 } else {
1783 goto Error;
1784 }
1785
1786 if ((Trb->DataLen != 0) && (Trb->DataLen < Trb->BlockSize)) {
1787 Trb->BlockSize = (UINT16)Trb->DataLen;
1788 }
1789
1790 if (((Private->Slot[Trb->Slot].CardType == EmmcCardType) &&
1791 (Packet->SdMmcCmdBlk->CommandIndex == EMMC_SEND_TUNING_BLOCK)) ||
1792 ((Private->Slot[Trb->Slot].CardType == SdCardType) &&
1793 (Packet->SdMmcCmdBlk->CommandIndex == SD_SEND_TUNING_BLOCK))) {
1794 Trb->Mode = SdMmcPioMode;
1795 } else {
1796 if (Trb->Read) {
1797 Flag = EfiPciIoOperationBusMasterWrite;
1798 } else {
1799 Flag = EfiPciIoOperationBusMasterRead;
1800 }
1801
1802 PciIo = Private->PciIo;
1803 if (Trb->DataLen != 0) {
1804 MapLength = Trb->DataLen;
1805 Status = PciIo->Map (
1806 PciIo,
1807 Flag,
1808 Trb->Data,
1809 &MapLength,
1810 &Trb->DataPhy,
1811 &Trb->DataMap
1812 );
1813 if (EFI_ERROR (Status) || (Trb->DataLen != MapLength)) {
1814 Status = EFI_BAD_BUFFER_SIZE;
1815 goto Error;
1816 }
1817 }
1818
1819 if (Trb->DataLen == 0) {
1820 Trb->Mode = SdMmcNoData;
1821 } else if (Private->Capability[Slot].Adma2 != 0) {
1822 Trb->Mode = SdMmcAdma32bMode;
1823 Trb->AdmaLengthMode = SdMmcAdmaLen16b;
1824 if ((Private->ControllerVersion[Slot] == SD_MMC_HC_CTRL_VER_300) &&
1825 (Private->Capability[Slot].SysBus64V3 == 1)) {
1826 Trb->Mode = SdMmcAdma64bV3Mode;
1827 } else if (((Private->ControllerVersion[Slot] == SD_MMC_HC_CTRL_VER_400) &&
1828 (Private->Capability[Slot].SysBus64V3 == 1)) ||
1829 ((Private->ControllerVersion[Slot] >= SD_MMC_HC_CTRL_VER_410) &&
1830 (Private->Capability[Slot].SysBus64V4 == 1))) {
1831 Trb->Mode = SdMmcAdma64bV4Mode;
1832 }
1833 if (Private->ControllerVersion[Slot] >= SD_MMC_HC_CTRL_VER_410) {
1834 Trb->AdmaLengthMode = SdMmcAdmaLen26b;
1835 }
1836 Status = BuildAdmaDescTable (Trb, Private->ControllerVersion[Slot]);
1837 if (EFI_ERROR (Status)) {
1838 goto Error;
1839 }
1840 } else if (Private->Capability[Slot].Sdma != 0) {
1841 Trb->Mode = SdMmcSdmaMode;
1842 } else {
1843 Trb->Mode = SdMmcPioMode;
1844 }
1845 }
1846
1847 if (Event != NULL) {
1848 OldTpl = gBS->RaiseTPL (TPL_NOTIFY);
1849 InsertTailList (&Private->Queue, &Trb->TrbList);
1850 gBS->RestoreTPL (OldTpl);
1851 }
1852
1853 return Trb;
1854
1855 Error:
1856 SdMmcFreeTrb (Trb);
1857 return NULL;
1858 }
1859
1860 /**
1861 Free the resource used by the TRB.
1862
1863 @param[in] Trb The pointer to the SD_MMC_HC_TRB instance.
1864
1865 **/
1866 VOID
1867 SdMmcFreeTrb (
1868 IN SD_MMC_HC_TRB *Trb
1869 )
1870 {
1871 EFI_PCI_IO_PROTOCOL *PciIo;
1872
1873 PciIo = Trb->Private->PciIo;
1874
1875 if (Trb->AdmaMap != NULL) {
1876 PciIo->Unmap (
1877 PciIo,
1878 Trb->AdmaMap
1879 );
1880 }
1881 if (Trb->Adma32Desc != NULL) {
1882 PciIo->FreeBuffer (
1883 PciIo,
1884 Trb->AdmaPages,
1885 Trb->Adma32Desc
1886 );
1887 }
1888 if (Trb->Adma64V3Desc != NULL) {
1889 PciIo->FreeBuffer (
1890 PciIo,
1891 Trb->AdmaPages,
1892 Trb->Adma64V3Desc
1893 );
1894 }
1895 if (Trb->Adma64V4Desc != NULL) {
1896 PciIo->FreeBuffer (
1897 PciIo,
1898 Trb->AdmaPages,
1899 Trb->Adma64V4Desc
1900 );
1901 }
1902 if (Trb->DataMap != NULL) {
1903 PciIo->Unmap (
1904 PciIo,
1905 Trb->DataMap
1906 );
1907 }
1908 FreePool (Trb);
1909 return;
1910 }
1911
1912 /**
1913 Check if the env is ready for execute specified TRB.
1914
1915 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
1916 @param[in] Trb The pointer to the SD_MMC_HC_TRB instance.
1917
1918 @retval EFI_SUCCESS The env is ready for TRB execution.
1919 @retval EFI_NOT_READY The env is not ready for TRB execution.
1920 @retval Others Some erros happen.
1921
1922 **/
1923 EFI_STATUS
1924 SdMmcCheckTrbEnv (
1925 IN SD_MMC_HC_PRIVATE_DATA *Private,
1926 IN SD_MMC_HC_TRB *Trb
1927 )
1928 {
1929 EFI_STATUS Status;
1930 EFI_SD_MMC_PASS_THRU_COMMAND_PACKET *Packet;
1931 EFI_PCI_IO_PROTOCOL *PciIo;
1932 UINT32 PresentState;
1933
1934 Packet = Trb->Packet;
1935
1936 if ((Packet->SdMmcCmdBlk->CommandType == SdMmcCommandTypeAdtc) ||
1937 (Packet->SdMmcCmdBlk->ResponseType == SdMmcResponseTypeR1b) ||
1938 (Packet->SdMmcCmdBlk->ResponseType == SdMmcResponseTypeR5b)) {
1939 //
1940 // Wait Command Inhibit (CMD) and Command Inhibit (DAT) in
1941 // the Present State register to be 0
1942 //
1943 PresentState = BIT0 | BIT1;
1944 } else {
1945 //
1946 // Wait Command Inhibit (CMD) in the Present State register
1947 // to be 0
1948 //
1949 PresentState = BIT0;
1950 }
1951
1952 PciIo = Private->PciIo;
1953 Status = SdMmcHcCheckMmioSet (
1954 PciIo,
1955 Trb->Slot,
1956 SD_MMC_HC_PRESENT_STATE,
1957 sizeof (PresentState),
1958 PresentState,
1959 0
1960 );
1961
1962 return Status;
1963 }
1964
1965 /**
1966 Wait for the env to be ready for execute specified TRB.
1967
1968 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
1969 @param[in] Trb The pointer to the SD_MMC_HC_TRB instance.
1970
1971 @retval EFI_SUCCESS The env is ready for TRB execution.
1972 @retval EFI_TIMEOUT The env is not ready for TRB execution in time.
1973 @retval Others Some erros happen.
1974
1975 **/
1976 EFI_STATUS
1977 SdMmcWaitTrbEnv (
1978 IN SD_MMC_HC_PRIVATE_DATA *Private,
1979 IN SD_MMC_HC_TRB *Trb
1980 )
1981 {
1982 EFI_STATUS Status;
1983 EFI_SD_MMC_PASS_THRU_COMMAND_PACKET *Packet;
1984 UINT64 Timeout;
1985 BOOLEAN InfiniteWait;
1986
1987 //
1988 // Wait Command Complete Interrupt Status bit in Normal Interrupt Status Register
1989 //
1990 Packet = Trb->Packet;
1991 Timeout = Packet->Timeout;
1992 if (Timeout == 0) {
1993 InfiniteWait = TRUE;
1994 } else {
1995 InfiniteWait = FALSE;
1996 }
1997
1998 while (InfiniteWait || (Timeout > 0)) {
1999 //
2000 // Check Trb execution result by reading Normal Interrupt Status register.
2001 //
2002 Status = SdMmcCheckTrbEnv (Private, Trb);
2003 if (Status != EFI_NOT_READY) {
2004 return Status;
2005 }
2006 //
2007 // Stall for 1 microsecond.
2008 //
2009 gBS->Stall (1);
2010
2011 Timeout--;
2012 }
2013
2014 return EFI_TIMEOUT;
2015 }
2016
2017 /**
2018 Execute the specified TRB.
2019
2020 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
2021 @param[in] Trb The pointer to the SD_MMC_HC_TRB instance.
2022
2023 @retval EFI_SUCCESS The TRB is sent to host controller successfully.
2024 @retval Others Some erros happen when sending this request to the host controller.
2025
2026 **/
2027 EFI_STATUS
2028 SdMmcExecTrb (
2029 IN SD_MMC_HC_PRIVATE_DATA *Private,
2030 IN SD_MMC_HC_TRB *Trb
2031 )
2032 {
2033 EFI_STATUS Status;
2034 EFI_SD_MMC_PASS_THRU_COMMAND_PACKET *Packet;
2035 EFI_PCI_IO_PROTOCOL *PciIo;
2036 UINT16 Cmd;
2037 UINT16 IntStatus;
2038 UINT32 Argument;
2039 UINT32 BlkCount;
2040 UINT16 BlkSize;
2041 UINT16 TransMode;
2042 UINT8 HostCtrl1;
2043 UINT64 SdmaAddr;
2044 UINT64 AdmaAddr;
2045 BOOLEAN AddressingMode64;
2046
2047 AddressingMode64 = FALSE;
2048
2049 Packet = Trb->Packet;
2050 PciIo = Trb->Private->PciIo;
2051 //
2052 // Clear all bits in Error Interrupt Status Register
2053 //
2054 IntStatus = 0xFFFF;
2055 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_ERR_INT_STS, FALSE, sizeof (IntStatus), &IntStatus);
2056 if (EFI_ERROR (Status)) {
2057 return Status;
2058 }
2059 //
2060 // Clear all bits in Normal Interrupt Status Register excepts for Card Removal & Card Insertion bits.
2061 //
2062 IntStatus = 0xFF3F;
2063 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_NOR_INT_STS, FALSE, sizeof (IntStatus), &IntStatus);
2064 if (EFI_ERROR (Status)) {
2065 return Status;
2066 }
2067
2068 if (Private->ControllerVersion[Trb->Slot] >= SD_MMC_HC_CTRL_VER_400) {
2069 Status = SdMmcHcCheckMmioSet(PciIo, Trb->Slot, SD_MMC_HC_HOST_CTRL2, sizeof(UINT16),
2070 SD_MMC_HC_64_ADDR_EN, SD_MMC_HC_64_ADDR_EN);
2071 if (!EFI_ERROR (Status)) {
2072 AddressingMode64 = TRUE;
2073 }
2074 }
2075
2076 //
2077 // Set Host Control 1 register DMA Select field
2078 //
2079 if ((Trb->Mode == SdMmcAdma32bMode) ||
2080 (Trb->Mode == SdMmcAdma64bV4Mode)) {
2081 HostCtrl1 = BIT4;
2082 Status = SdMmcHcOrMmio (PciIo, Trb->Slot, SD_MMC_HC_HOST_CTRL1, sizeof (HostCtrl1), &HostCtrl1);
2083 if (EFI_ERROR (Status)) {
2084 return Status;
2085 }
2086 } else if (Trb->Mode == SdMmcAdma64bV3Mode) {
2087 HostCtrl1 = BIT4|BIT3;
2088 Status = SdMmcHcOrMmio (PciIo, Trb->Slot, SD_MMC_HC_HOST_CTRL1, sizeof (HostCtrl1), &HostCtrl1);
2089 if (EFI_ERROR (Status)) {
2090 return Status;
2091 }
2092 }
2093
2094 SdMmcHcLedOnOff (PciIo, Trb->Slot, TRUE);
2095
2096 if (Trb->Mode == SdMmcSdmaMode) {
2097 if ((!AddressingMode64) &&
2098 ((UINT64)(UINTN)Trb->DataPhy >= 0x100000000ul)) {
2099 return EFI_INVALID_PARAMETER;
2100 }
2101
2102 SdmaAddr = (UINT64)(UINTN)Trb->DataPhy;
2103
2104 if (Private->ControllerVersion[Trb->Slot] >= SD_MMC_HC_CTRL_VER_400) {
2105 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_ADMA_SYS_ADDR, FALSE, sizeof (UINT64), &SdmaAddr);
2106 } else {
2107 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_SDMA_ADDR, FALSE, sizeof (UINT32), &SdmaAddr);
2108 }
2109
2110 if (EFI_ERROR (Status)) {
2111 return Status;
2112 }
2113 } else if ((Trb->Mode == SdMmcAdma32bMode) ||
2114 (Trb->Mode == SdMmcAdma64bV3Mode) ||
2115 (Trb->Mode == SdMmcAdma64bV4Mode)) {
2116 AdmaAddr = (UINT64)(UINTN)Trb->AdmaDescPhy;
2117 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_ADMA_SYS_ADDR, FALSE, sizeof (AdmaAddr), &AdmaAddr);
2118 if (EFI_ERROR (Status)) {
2119 return Status;
2120 }
2121 }
2122
2123 BlkSize = Trb->BlockSize;
2124 if (Trb->Mode == SdMmcSdmaMode) {
2125 //
2126 // Set SDMA boundary to be 512K bytes.
2127 //
2128 BlkSize |= 0x7000;
2129 }
2130
2131 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_BLK_SIZE, FALSE, sizeof (BlkSize), &BlkSize);
2132 if (EFI_ERROR (Status)) {
2133 return Status;
2134 }
2135
2136 BlkCount = 0;
2137 if (Trb->Mode != SdMmcNoData) {
2138 //
2139 // Calcuate Block Count.
2140 //
2141 BlkCount = (Trb->DataLen / Trb->BlockSize);
2142 }
2143 if (Private->ControllerVersion[Trb->Slot] >= SD_MMC_HC_CTRL_VER_410) {
2144 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_SDMA_ADDR, FALSE, sizeof (UINT32), &BlkCount);
2145 } else {
2146 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_BLK_COUNT, FALSE, sizeof (UINT16), &BlkCount);
2147 }
2148 if (EFI_ERROR (Status)) {
2149 return Status;
2150 }
2151
2152 Argument = Packet->SdMmcCmdBlk->CommandArgument;
2153 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_ARG1, FALSE, sizeof (Argument), &Argument);
2154 if (EFI_ERROR (Status)) {
2155 return Status;
2156 }
2157
2158 TransMode = 0;
2159 if (Trb->Mode != SdMmcNoData) {
2160 if (Trb->Mode != SdMmcPioMode) {
2161 TransMode |= BIT0;
2162 }
2163 if (Trb->Read) {
2164 TransMode |= BIT4;
2165 }
2166 if (BlkCount > 1) {
2167 TransMode |= BIT5 | BIT1;
2168 }
2169 //
2170 // Only SD memory card needs to use AUTO CMD12 feature.
2171 //
2172 if (Private->Slot[Trb->Slot].CardType == SdCardType) {
2173 if (BlkCount > 1) {
2174 TransMode |= BIT2;
2175 }
2176 }
2177 }
2178
2179 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_TRANS_MOD, FALSE, sizeof (TransMode), &TransMode);
2180 if (EFI_ERROR (Status)) {
2181 return Status;
2182 }
2183
2184 Cmd = (UINT16)LShiftU64(Packet->SdMmcCmdBlk->CommandIndex, 8);
2185 if (Packet->SdMmcCmdBlk->CommandType == SdMmcCommandTypeAdtc) {
2186 Cmd |= BIT5;
2187 }
2188 //
2189 // Convert ResponseType to value
2190 //
2191 if (Packet->SdMmcCmdBlk->CommandType != SdMmcCommandTypeBc) {
2192 switch (Packet->SdMmcCmdBlk->ResponseType) {
2193 case SdMmcResponseTypeR1:
2194 case SdMmcResponseTypeR5:
2195 case SdMmcResponseTypeR6:
2196 case SdMmcResponseTypeR7:
2197 Cmd |= (BIT1 | BIT3 | BIT4);
2198 break;
2199 case SdMmcResponseTypeR2:
2200 Cmd |= (BIT0 | BIT3);
2201 break;
2202 case SdMmcResponseTypeR3:
2203 case SdMmcResponseTypeR4:
2204 Cmd |= BIT1;
2205 break;
2206 case SdMmcResponseTypeR1b:
2207 case SdMmcResponseTypeR5b:
2208 Cmd |= (BIT0 | BIT1 | BIT3 | BIT4);
2209 break;
2210 default:
2211 ASSERT (FALSE);
2212 break;
2213 }
2214 }
2215 //
2216 // Execute cmd
2217 //
2218 Status = SdMmcHcRwMmio (PciIo, Trb->Slot, SD_MMC_HC_COMMAND, FALSE, sizeof (Cmd), &Cmd);
2219 return Status;
2220 }
2221
2222 /**
2223 Performs SW reset based on passed error status mask.
2224
2225 @param[in] Private Pointer to driver private data.
2226 @param[in] Slot Index of the slot to reset.
2227 @param[in] ErrIntStatus Error interrupt status mask.
2228
2229 @retval EFI_SUCCESS Software reset performed successfully.
2230 @retval Other Software reset failed.
2231 **/
2232 EFI_STATUS
2233 SdMmcSoftwareReset (
2234 IN SD_MMC_HC_PRIVATE_DATA *Private,
2235 IN UINT8 Slot,
2236 IN UINT16 ErrIntStatus
2237 )
2238 {
2239 UINT8 SwReset;
2240 EFI_STATUS Status;
2241
2242 SwReset = 0;
2243 if ((ErrIntStatus & 0x0F) != 0) {
2244 SwReset |= BIT1;
2245 }
2246 if ((ErrIntStatus & 0x70) != 0) {
2247 SwReset |= BIT2;
2248 }
2249
2250 Status = SdMmcHcRwMmio (
2251 Private->PciIo,
2252 Slot,
2253 SD_MMC_HC_SW_RST,
2254 FALSE,
2255 sizeof (SwReset),
2256 &SwReset
2257 );
2258 if (EFI_ERROR (Status)) {
2259 return Status;
2260 }
2261
2262 Status = SdMmcHcWaitMmioSet (
2263 Private->PciIo,
2264 Slot,
2265 SD_MMC_HC_SW_RST,
2266 sizeof (SwReset),
2267 0xFF,
2268 0,
2269 SD_MMC_HC_GENERIC_TIMEOUT
2270 );
2271 if (EFI_ERROR (Status)) {
2272 return Status;
2273 }
2274
2275 return EFI_SUCCESS;
2276 }
2277
2278 /**
2279 Checks the error status in error status register
2280 and issues appropriate software reset as described in
2281 SD specification section 3.10.
2282
2283 @param[in] Private Pointer to driver private data.
2284 @param[in] Slot Index of the slot for device.
2285 @param[in] IntStatus Normal interrupt status mask.
2286
2287 @retval EFI_CRC_ERROR CRC error happened during CMD execution.
2288 @retval EFI_SUCCESS No error reported.
2289 @retval Others Some other error happened.
2290
2291 **/
2292 EFI_STATUS
2293 SdMmcCheckAndRecoverErrors (
2294 IN SD_MMC_HC_PRIVATE_DATA *Private,
2295 IN UINT8 Slot,
2296 IN UINT16 IntStatus
2297 )
2298 {
2299 UINT16 ErrIntStatus;
2300 EFI_STATUS Status;
2301 EFI_STATUS ErrorStatus;
2302
2303 if ((IntStatus & BIT15) == 0) {
2304 return EFI_SUCCESS;
2305 }
2306
2307 Status = SdMmcHcRwMmio (
2308 Private->PciIo,
2309 Slot,
2310 SD_MMC_HC_ERR_INT_STS,
2311 TRUE,
2312 sizeof (ErrIntStatus),
2313 &ErrIntStatus
2314 );
2315 if (EFI_ERROR (Status)) {
2316 return Status;
2317 }
2318
2319 DEBUG ((DEBUG_ERROR, "Error reported by SDHCI\n"));
2320 DEBUG ((DEBUG_ERROR, "Interrupt status = %X\n", IntStatus));
2321 DEBUG ((DEBUG_ERROR, "Error interrupt status = %X\n", ErrIntStatus));
2322
2323 //
2324 // If the data timeout error is reported
2325 // but data transfer is signaled as completed we
2326 // have to ignore data timeout. We also assume that no
2327 // other error is present on the link since data transfer
2328 // completed successfully. Error interrupt status
2329 // register is going to be reset when the next command
2330 // is started.
2331 //
2332 if (((ErrIntStatus & BIT4) != 0) && ((IntStatus & BIT1) != 0)) {
2333 return EFI_SUCCESS;
2334 }
2335
2336 //
2337 // We treat both CMD and DAT CRC errors and
2338 // end bits errors as EFI_CRC_ERROR. This will
2339 // let higher layer know that the error possibly
2340 // happened due to random bus condition and the
2341 // command can be retried.
2342 //
2343 if ((ErrIntStatus & (BIT1 | BIT2 | BIT5 | BIT6)) != 0) {
2344 ErrorStatus = EFI_CRC_ERROR;
2345 } else {
2346 ErrorStatus = EFI_DEVICE_ERROR;
2347 }
2348
2349 Status = SdMmcSoftwareReset (Private, Slot, ErrIntStatus);
2350 if (EFI_ERROR (Status)) {
2351 return Status;
2352 }
2353
2354 return ErrorStatus;
2355 }
2356
2357 /**
2358 Reads the response data into the TRB buffer.
2359 This function assumes that caller made sure that
2360 command has completed.
2361
2362 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
2363 @param[in] Trb The pointer to the SD_MMC_HC_TRB instance.
2364
2365 @retval EFI_SUCCESS Response read successfully.
2366 @retval Others Failed to get response.
2367 **/
2368 EFI_STATUS
2369 SdMmcGetResponse (
2370 IN SD_MMC_HC_PRIVATE_DATA *Private,
2371 IN SD_MMC_HC_TRB *Trb
2372 )
2373 {
2374 EFI_SD_MMC_PASS_THRU_COMMAND_PACKET *Packet;
2375 UINT8 Index;
2376 UINT32 Response[4];
2377 EFI_STATUS Status;
2378
2379 Packet = Trb->Packet;
2380
2381 if (Packet->SdMmcCmdBlk->CommandType == SdMmcCommandTypeBc) {
2382 return EFI_SUCCESS;
2383 }
2384
2385 for (Index = 0; Index < 4; Index++) {
2386 Status = SdMmcHcRwMmio (
2387 Private->PciIo,
2388 Trb->Slot,
2389 SD_MMC_HC_RESPONSE + Index * 4,
2390 TRUE,
2391 sizeof (UINT32),
2392 &Response[Index]
2393 );
2394 if (EFI_ERROR (Status)) {
2395 return Status;
2396 }
2397 }
2398 CopyMem (Packet->SdMmcStatusBlk, Response, sizeof (Response));
2399
2400 return EFI_SUCCESS;
2401 }
2402
2403 /**
2404 Checks if the command completed. If the command
2405 completed it gets the response and records the
2406 command completion in the TRB.
2407
2408 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
2409 @param[in] Trb The pointer to the SD_MMC_HC_TRB instance.
2410 @param[in] IntStatus Snapshot of the normal interrupt status register.
2411
2412 @retval EFI_SUCCESS Command completed successfully.
2413 @retval EFI_NOT_READY Command completion still pending.
2414 @retval Others Command failed to complete.
2415 **/
2416 EFI_STATUS
2417 SdMmcCheckCommandComplete (
2418 IN SD_MMC_HC_PRIVATE_DATA *Private,
2419 IN SD_MMC_HC_TRB *Trb,
2420 IN UINT16 IntStatus
2421 )
2422 {
2423 UINT16 Data16;
2424 EFI_STATUS Status;
2425
2426 if ((IntStatus & BIT0) != 0) {
2427 Data16 = BIT0;
2428 Status = SdMmcHcRwMmio (
2429 Private->PciIo,
2430 Trb->Slot,
2431 SD_MMC_HC_NOR_INT_STS,
2432 FALSE,
2433 sizeof (Data16),
2434 &Data16
2435 );
2436 if (EFI_ERROR (Status)) {
2437 return Status;
2438 }
2439 Status = SdMmcGetResponse (Private, Trb);
2440 if (EFI_ERROR (Status)) {
2441 return Status;
2442 }
2443 Trb->CommandComplete = TRUE;
2444 return EFI_SUCCESS;
2445 }
2446
2447 return EFI_NOT_READY;
2448 }
2449
2450 /**
2451 Check the TRB execution result.
2452
2453 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
2454 @param[in] Trb The pointer to the SD_MMC_HC_TRB instance.
2455
2456 @retval EFI_SUCCESS The TRB is executed successfully.
2457 @retval EFI_NOT_READY The TRB is not completed for execution.
2458 @retval Others Some erros happen when executing this request.
2459
2460 **/
2461 EFI_STATUS
2462 SdMmcCheckTrbResult (
2463 IN SD_MMC_HC_PRIVATE_DATA *Private,
2464 IN SD_MMC_HC_TRB *Trb
2465 )
2466 {
2467 EFI_STATUS Status;
2468 EFI_SD_MMC_PASS_THRU_COMMAND_PACKET *Packet;
2469 UINT16 IntStatus;
2470 UINT64 SdmaAddr;
2471 UINT32 PioLength;
2472
2473 Packet = Trb->Packet;
2474 //
2475 // Check Trb execution result by reading Normal Interrupt Status register.
2476 //
2477 Status = SdMmcHcRwMmio (
2478 Private->PciIo,
2479 Trb->Slot,
2480 SD_MMC_HC_NOR_INT_STS,
2481 TRUE,
2482 sizeof (IntStatus),
2483 &IntStatus
2484 );
2485 if (EFI_ERROR (Status)) {
2486 goto Done;
2487 }
2488
2489 //
2490 // Check if there are any errors reported by host controller
2491 // and if neccessary recover the controller before next command is executed.
2492 //
2493 Status = SdMmcCheckAndRecoverErrors (Private, Trb->Slot, IntStatus);
2494 if (EFI_ERROR (Status)) {
2495 goto Done;
2496 }
2497
2498 //
2499 // Tuning commands are the only ones that do not generate command
2500 // complete interrupt. Process them here before entering the code
2501 // that waits for command completion.
2502 //
2503 if (((Private->Slot[Trb->Slot].CardType == EmmcCardType) &&
2504 (Packet->SdMmcCmdBlk->CommandIndex == EMMC_SEND_TUNING_BLOCK)) ||
2505 ((Private->Slot[Trb->Slot].CardType == SdCardType) &&
2506 (Packet->SdMmcCmdBlk->CommandIndex == SD_SEND_TUNING_BLOCK))) {
2507 //
2508 // When performing tuning procedure (Execute Tuning is set to 1) through PIO mode,
2509 // wait Buffer Read Ready bit of Normal Interrupt Status Register to be 1.
2510 // Refer to SD Host Controller Simplified Specification 3.0 figure 2-29 for details.
2511 //
2512 if ((IntStatus & BIT5) == BIT5) {
2513 //
2514 // Clear Buffer Read Ready interrupt at first.
2515 //
2516 IntStatus = BIT5;
2517 SdMmcHcRwMmio (Private->PciIo, Trb->Slot, SD_MMC_HC_NOR_INT_STS, FALSE, sizeof (IntStatus), &IntStatus);
2518 //
2519 // Read data out from Buffer Port register
2520 //
2521 for (PioLength = 0; PioLength < Trb->DataLen; PioLength += 4) {
2522 SdMmcHcRwMmio (Private->PciIo, Trb->Slot, SD_MMC_HC_BUF_DAT_PORT, TRUE, 4, (UINT8*)Trb->Data + PioLength);
2523 }
2524 Status = EFI_SUCCESS;
2525 goto Done;
2526 }
2527 }
2528
2529 if (!Trb->CommandComplete) {
2530 Status = SdMmcCheckCommandComplete (Private, Trb, IntStatus);
2531 if (EFI_ERROR (Status)) {
2532 goto Done;
2533 } else {
2534 //
2535 // If the command doesn't require data transfer skip the transfer
2536 // complete checking.
2537 //
2538 if ((Packet->SdMmcCmdBlk->CommandType != SdMmcCommandTypeAdtc) &&
2539 (Packet->SdMmcCmdBlk->ResponseType != SdMmcResponseTypeR1b) &&
2540 (Packet->SdMmcCmdBlk->ResponseType != SdMmcResponseTypeR5b)) {
2541 goto Done;
2542 }
2543 }
2544 }
2545
2546 //
2547 // Check Transfer Complete bit is set or not.
2548 //
2549 if ((IntStatus & BIT1) == BIT1) {
2550 goto Done;
2551 }
2552
2553 //
2554 // Check if DMA interrupt is signalled for the SDMA transfer.
2555 //
2556 if ((Trb->Mode == SdMmcSdmaMode) && ((IntStatus & BIT3) == BIT3)) {
2557 //
2558 // Clear DMA interrupt bit.
2559 //
2560 IntStatus = BIT3;
2561 Status = SdMmcHcRwMmio (
2562 Private->PciIo,
2563 Trb->Slot,
2564 SD_MMC_HC_NOR_INT_STS,
2565 FALSE,
2566 sizeof (IntStatus),
2567 &IntStatus
2568 );
2569 if (EFI_ERROR (Status)) {
2570 goto Done;
2571 }
2572 //
2573 // Update SDMA Address register.
2574 //
2575 SdmaAddr = SD_MMC_SDMA_ROUND_UP ((UINTN)Trb->DataPhy, SD_MMC_SDMA_BOUNDARY);
2576
2577 if (Private->ControllerVersion[Trb->Slot] >= SD_MMC_HC_CTRL_VER_400) {
2578 Status = SdMmcHcRwMmio (
2579 Private->PciIo,
2580 Trb->Slot,
2581 SD_MMC_HC_ADMA_SYS_ADDR,
2582 FALSE,
2583 sizeof (UINT64),
2584 &SdmaAddr
2585 );
2586 } else {
2587 Status = SdMmcHcRwMmio (
2588 Private->PciIo,
2589 Trb->Slot,
2590 SD_MMC_HC_SDMA_ADDR,
2591 FALSE,
2592 sizeof (UINT32),
2593 &SdmaAddr
2594 );
2595 }
2596
2597 if (EFI_ERROR (Status)) {
2598 goto Done;
2599 }
2600 Trb->DataPhy = (UINT64)(UINTN)SdmaAddr;
2601 }
2602
2603
2604 Status = EFI_NOT_READY;
2605 Done:
2606
2607 if (Status != EFI_NOT_READY) {
2608 SdMmcHcLedOnOff (Private->PciIo, Trb->Slot, FALSE);
2609 if (EFI_ERROR (Status)) {
2610 DEBUG ((DEBUG_ERROR, "TRB failed with %r\n", Status));
2611 SdMmcPrintTrb (DEBUG_ERROR, Trb);
2612 } else {
2613 DEBUG ((DEBUG_VERBOSE, "TRB success\n"));
2614 SdMmcPrintTrb (DEBUG_VERBOSE, Trb);
2615 }
2616 }
2617
2618 return Status;
2619 }
2620
2621 /**
2622 Wait for the TRB execution result.
2623
2624 @param[in] Private A pointer to the SD_MMC_HC_PRIVATE_DATA instance.
2625 @param[in] Trb The pointer to the SD_MMC_HC_TRB instance.
2626
2627 @retval EFI_SUCCESS The TRB is executed successfully.
2628 @retval Others Some erros happen when executing this request.
2629
2630 **/
2631 EFI_STATUS
2632 SdMmcWaitTrbResult (
2633 IN SD_MMC_HC_PRIVATE_DATA *Private,
2634 IN SD_MMC_HC_TRB *Trb
2635 )
2636 {
2637 EFI_STATUS Status;
2638 EFI_SD_MMC_PASS_THRU_COMMAND_PACKET *Packet;
2639 UINT64 Timeout;
2640 BOOLEAN InfiniteWait;
2641
2642 Packet = Trb->Packet;
2643 //
2644 // Wait Command Complete Interrupt Status bit in Normal Interrupt Status Register
2645 //
2646 Timeout = Packet->Timeout;
2647 if (Timeout == 0) {
2648 InfiniteWait = TRUE;
2649 } else {
2650 InfiniteWait = FALSE;
2651 }
2652
2653 while (InfiniteWait || (Timeout > 0)) {
2654 //
2655 // Check Trb execution result by reading Normal Interrupt Status register.
2656 //
2657 Status = SdMmcCheckTrbResult (Private, Trb);
2658 if (Status != EFI_NOT_READY) {
2659 return Status;
2660 }
2661 //
2662 // Stall for 1 microsecond.
2663 //
2664 gBS->Stall (1);
2665
2666 Timeout--;
2667 }
2668
2669 return EFI_TIMEOUT;
2670 }
2671
EFI Development Kit II mirror for PVE