EFI_STATUS MmcIoBlocks ( IN EFI_BLOCK_IO_PROTOCOL *This, IN UINTN Transfer, IN UINT32 MediaId, IN EFI_LBA Lba, IN UINTN BufferSize, OUT VOID *Buffer ) { UINT32 Response[4]; EFI_STATUS Status; UINTN CmdArg; INTN Timeout; UINTN Cmd; MMC_HOST_INSTANCE *MmcHostInstance; EFI_MMC_HOST_PROTOCOL *MmcHost; UINTN BytesRemainingToBeTransfered; UINTN BlockCount; BlockCount = 1; MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS (This); ASSERT (MmcHostInstance != NULL); MmcHost = MmcHostInstance->MmcHost; ASSERT (MmcHost); if (This->Media->MediaId != MediaId) { return EFI_MEDIA_CHANGED; } if ((MmcHost == NULL) || (Buffer == NULL)) { return EFI_INVALID_PARAMETER; } // Check if a Card is Present if (!MmcHostInstance->BlockIo.Media->MediaPresent) { return EFI_NO_MEDIA; } // All blocks must be within the device if ((Lba + (BufferSize / This->Media->BlockSize)) > (This->Media->LastBlock + 1)) { return EFI_INVALID_PARAMETER; } if ((Transfer == MMC_IOBLOCKS_WRITE) && (This->Media->ReadOnly == TRUE)) { return EFI_WRITE_PROTECTED; } // Reading 0 Byte is valid if (BufferSize == 0) { return EFI_SUCCESS; } // The buffer size must be an exact multiple of the block size if ((BufferSize % This->Media->BlockSize) != 0) { return EFI_BAD_BUFFER_SIZE; } // Check the alignment if ((This->Media->IoAlign > 2) && (((UINTN)Buffer & (This->Media->IoAlign - 1)) != 0)) { return EFI_INVALID_PARAMETER; } BytesRemainingToBeTransfered = BufferSize; while (BytesRemainingToBeTransfered > 0) { // Check if the Card is in Ready status CmdArg = MmcHostInstance->CardInfo.RCA << 16; Response[0] = 0; Timeout = 20; while( (!(Response[0] & MMC_R0_READY_FOR_DATA)) && (MMC_R0_CURRENTSTATE (Response) != MMC_R0_STATE_TRAN) && Timeout--) { Status = MmcHost->SendCommand (MmcHost, MMC_CMD13, CmdArg); if (!EFI_ERROR (Status)) { MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1, Response); } } if (0 == Timeout) { DEBUG ((EFI_D_ERROR, "The Card is busy\n")); return EFI_NOT_READY; } //Set command argument based on the card access mode (Byte mode or Block mode) if (MmcHostInstance->CardInfo.OCRData.AccessMode & BIT1) { CmdArg = Lba; } else { CmdArg = Lba * This->Media->BlockSize; } if (Transfer == MMC_IOBLOCKS_READ) { // Read a single block Cmd = MMC_CMD17; } else { // Write a single block Cmd = MMC_CMD24; } Status = MmcHost->SendCommand (MmcHost, Cmd, CmdArg); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_ERROR, "MmcIoBlocks(MMC_CMD%d): Error %r\n", Cmd, Status)); return Status; } if (Transfer == MMC_IOBLOCKS_READ) { // Read one block of Data Status = MmcHost->ReadBlockData (MmcHost, Lba, This->Media->BlockSize, Buffer); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_BLKIO, "MmcIoBlocks(): Error Read Block Data and Status = %r\n", Status)); MmcStopTransmission (MmcHost); return Status; } Status = MmcNotifyState (MmcHostInstance, MmcProgrammingState); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_ERROR, "MmcIoBlocks() : Error MmcProgrammingState\n")); return Status; } } else { // Write one block of Data Status = MmcHost->WriteBlockData (MmcHost, Lba, This->Media->BlockSize, Buffer); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_BLKIO, "MmcIoBlocks(): Error Write Block Data and Status = %r\n", Status)); MmcStopTransmission (MmcHost); return Status; } } // Command 13 - Read status and wait for programming to complete (return to tran) Timeout = MMCI0_TIMEOUT; CmdArg = MmcHostInstance->CardInfo.RCA << 16; Response[0] = 0; while( (!(Response[0] & MMC_R0_READY_FOR_DATA)) && (MMC_R0_CURRENTSTATE (Response) != MMC_R0_STATE_TRAN) && Timeout--) { Status = MmcHost->SendCommand (MmcHost, MMC_CMD13, CmdArg); if (!EFI_ERROR (Status)) { MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1, Response); if ((Response[0] & MMC_R0_READY_FOR_DATA)) { break; // Prevents delay once finished } } gBS->Stall (1); } Status = MmcNotifyState (MmcHostInstance, MmcTransferState); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_ERROR, "MmcIoBlocks() : Error MmcTransferState\n")); return Status; } BytesRemainingToBeTransfered -= This->Media->BlockSize; Lba += BlockCount; Buffer = (UINT8 *)Buffer + This->Media->BlockSize; } return EFI_SUCCESS; }
STATIC EFI_STATUS MmcTransferBlock ( IN EFI_BLOCK_IO_PROTOCOL *This, IN UINTN Cmd, IN UINTN Transfer, IN UINT32 MediaId, IN EFI_LBA Lba, IN UINTN BufferSize, OUT VOID *Buffer ) { EFI_STATUS Status; UINTN CmdArg; INTN Timeout; UINT32 Response[4]; MMC_HOST_INSTANCE *MmcHostInstance; EFI_MMC_HOST_PROTOCOL *MmcHost; MmcHostInstance = MMC_HOST_INSTANCE_FROM_BLOCK_IO_THIS (This); MmcHost = MmcHostInstance->MmcHost; if (MmcHostInstance->CardInfo.CardType != EMMC_CARD) { //Set command argument based on the card capacity //if 0 : SDSC card //if 1 : SDXC/SDHC if (MmcHostInstance->CardInfo.OCRData.AccessMode & SD_CARD_CAPACITY) { CmdArg = Lba; } else { CmdArg = Lba * This->Media->BlockSize; } } else { //Set command argument based on the card access mode (Byte mode or Block mode) if ((MmcHostInstance->CardInfo.OCRData.AccessMode & MMC_OCR_ACCESS_MASK) == MMC_OCR_ACCESS_SECTOR) { CmdArg = Lba; } else { CmdArg = Lba * This->Media->BlockSize; } } Status = MmcHost->SendCommand (MmcHost, Cmd, CmdArg); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_ERROR, "%a(MMC_CMD%d): Error %r\n", __func__, Cmd, Status)); return Status; } if (Transfer == MMC_IOBLOCKS_READ) { // Read Data Status = MmcHost->ReadBlockData (MmcHost, Lba, BufferSize, Buffer); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_BLKIO, "%a(): Error Read Block Data and Status = %r\n", __func__, Status)); MmcStopTransmission (MmcHost); return Status; } Status = MmcNotifyState (MmcHostInstance, MmcProgrammingState); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_ERROR, "%a() : Error MmcProgrammingState\n", __func__)); return Status; } } else { // Write Data Status = MmcHost->WriteBlockData (MmcHost, Lba, BufferSize, Buffer); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_BLKIO, "%a(): Error Write Block Data and Status = %r\n", __func__, Status)); MmcStopTransmission (MmcHost); return Status; } } // Command 13 - Read status and wait for programming to complete (return to tran) Timeout = MMCI0_TIMEOUT; CmdArg = MmcHostInstance->CardInfo.RCA << 16; Response[0] = 0; while(!(Response[0] & MMC_R0_READY_FOR_DATA) && (MMC_R0_CURRENTSTATE (Response) != MMC_R0_STATE_TRAN) && Timeout--) { Status = MmcHost->SendCommand (MmcHost, MMC_CMD13, CmdArg); if (!EFI_ERROR (Status)) { MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1, Response); if (Response[0] & MMC_R0_READY_FOR_DATA) { break; // Prevents delay once finished } } } if (BufferSize > This->Media->BlockSize) { Status = MmcHost->SendCommand (MmcHost, MMC_CMD12, 0); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_BLKIO, "%a(): Error and Status:%r\n", __func__, Status)); } MmcHost->ReceiveResponse (MmcHost, MMC_RESPONSE_TYPE_R1b, Response); } Status = MmcNotifyState (MmcHostInstance, MmcTransferState); if (EFI_ERROR (Status)) { DEBUG ((EFI_D_ERROR, "MmcIoBlocks() : Error MmcTransferState\n")); return Status; } return Status; }