UefiCpuPkg: Move AsmRelocateApLoopStart from Mpfuncs.nasm to AmdSev.nasm

[mirror_edk2.git] / FatPkg / EnhancedFatDxe / DiskCache.c

/** @file\r
  Cache implementation for EFI FAT File system driver.\r
\r
Copyright (c) 2005 - 2013, Intel Corporation. All rights reserved.<BR>\r
SPDX-License-Identifier: BSD-2-Clause-Patent\r
\r
**/\r
\r
#include "Fat.h"\r
\r
/**\r
\r
  This function is used by the Data Cache.\r
\r
  When this function is called by write command, all entries in this range\r
  are older than the contents in disk, so they are invalid; just mark them invalid.\r
\r
  When this function is called by read command, if any entry in this range\r
  is dirty, it means that the relative info directly read from media is older than\r
  than the info in the cache; So need to update the relative info in the Buffer.\r
\r
  @param  Volume                - FAT file system volume.\r
  @param  IoMode                - This function is called by read command or write command\r
  @param  StartPageNo           - First PageNo to be checked in the cache.\r
  @param  EndPageNo             - Last PageNo to be checked in the cache.\r
  @param  Buffer                - The user buffer need to update. Only when doing the read command\r
                          and there is dirty cache in the cache range, this parameter will be used.\r
\r
**/\r
STATIC\r
VOID\r
FatFlushDataCacheRange (\r
  IN  FAT_VOLUME  *Volume,\r
  IN  IO_MODE     IoMode,\r
  IN  UINTN       StartPageNo,\r
  IN  UINTN       EndPageNo,\r
  OUT UINT8       *Buffer\r
  )\r
{\r
  UINTN       PageNo;\r
  UINTN       GroupNo;\r
  UINTN       GroupMask;\r
  UINTN       PageSize;\r
  UINT8       PageAlignment;\r
  DISK_CACHE  *DiskCache;\r
  CACHE_TAG   *CacheTag;\r
  UINT8       *BaseAddress;\r
\r
  DiskCache     = &Volume->DiskCache[CacheData];\r
  BaseAddress   = DiskCache->CacheBase;\r
  GroupMask     = DiskCache->GroupMask;\r
  PageAlignment = DiskCache->PageAlignment;\r
  PageSize      = (UINTN)1 << PageAlignment;\r
\r
  for (PageNo = StartPageNo; PageNo < EndPageNo; PageNo++) {\r
    GroupNo  = PageNo & GroupMask;\r
    CacheTag = &DiskCache->CacheTag[GroupNo];\r
    if ((CacheTag->RealSize > 0) && (CacheTag->PageNo == PageNo)) {\r
      //\r
      // When reading data form disk directly, if some dirty data\r
      // in cache is in this rang, this data in the Buffer need to\r
      // be updated with the cache's dirty data.\r
      //\r
      if (IoMode == ReadDisk) {\r
        if (CacheTag->Dirty) {\r
          CopyMem (\r
            Buffer + ((PageNo - StartPageNo) << PageAlignment),\r
            BaseAddress + (GroupNo << PageAlignment),\r
            PageSize\r
            );\r
        }\r
      } else {\r
        //\r
        // Make all valid entries in this range invalid.\r
        //\r
        CacheTag->RealSize = 0;\r
      }\r
    }\r
  }\r
}\r
\r
/**\r
\r
  Exchange the cache page with the image on the disk\r
\r
  @param  Volume                - FAT file system volume.\r
  @param  DataType              - Indicate the cache type.\r
  @param  IoMode                - Indicate whether to load this page from disk or store this page to disk.\r
  @param  CacheTag              - The Cache Tag for the current cache page.\r
  @param  Task                    point to task instance.\r
\r
  @retval EFI_SUCCESS           - Cache page exchanged successfully.\r
  @return Others                - An error occurred when exchanging cache page.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
FatExchangeCachePage (\r
  IN FAT_VOLUME       *Volume,\r
  IN CACHE_DATA_TYPE  DataType,\r
  IN IO_MODE          IoMode,\r
  IN CACHE_TAG        *CacheTag,\r
  IN FAT_TASK         *Task\r
  )\r
{\r
  EFI_STATUS  Status;\r
  UINTN       GroupNo;\r
  UINTN       PageNo;\r
  UINTN       WriteCount;\r
  UINTN       RealSize;\r
  UINT64      EntryPos;\r
  UINT64      MaxSize;\r
  DISK_CACHE  *DiskCache;\r
  VOID        *PageAddress;\r
  UINT8       PageAlignment;\r
\r
  DiskCache     = &Volume->DiskCache[DataType];\r
  PageNo        = CacheTag->PageNo;\r
  GroupNo       = PageNo & DiskCache->GroupMask;\r
  PageAlignment = DiskCache->PageAlignment;\r
  PageAddress   = DiskCache->CacheBase + (GroupNo << PageAlignment);\r
  EntryPos      = DiskCache->BaseAddress + LShiftU64 (PageNo, PageAlignment);\r
  RealSize      = CacheTag->RealSize;\r
  if (IoMode == ReadDisk) {\r
    RealSize = (UINTN)1 << PageAlignment;\r
    MaxSize  = DiskCache->LimitAddress - EntryPos;\r
    if (MaxSize < RealSize) {\r
      DEBUG ((DEBUG_INFO, "FatDiskIo: Cache Page OutBound occurred! \n"));\r
      RealSize = (UINTN)MaxSize;\r
    }\r
  }\r
\r
  WriteCount = 1;\r
  if ((DataType == CacheFat) && (IoMode == WriteDisk)) {\r
    WriteCount = Volume->NumFats;\r
  }\r
\r
  do {\r
    //\r
    // Only fat table writing will execute more than once\r
    //\r
    Status = FatDiskIo (Volume, IoMode, EntryPos, RealSize, PageAddress, Task);\r
    if (EFI_ERROR (Status)) {\r
      return Status;\r
    }\r
\r
    EntryPos += Volume->FatSize;\r
  } while (--WriteCount > 0);\r
\r
  CacheTag->Dirty    = FALSE;\r
  CacheTag->RealSize = RealSize;\r
  return EFI_SUCCESS;\r
}\r
\r
/**\r
\r
  Get one cache page by specified PageNo.\r
\r
  @param  Volume                - FAT file system volume.\r
  @param  CacheDataType         - The cache type: CACHE_FAT or CACHE_DATA.\r
  @param  PageNo                - PageNo to match with the cache.\r
  @param  CacheTag              - The Cache Tag for the current cache page.\r
\r
  @retval EFI_SUCCESS           - Get the cache page successfully.\r
  @return other                 - An error occurred when accessing data.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
FatGetCachePage (\r
  IN FAT_VOLUME       *Volume,\r
  IN CACHE_DATA_TYPE  CacheDataType,\r
  IN UINTN            PageNo,\r
  IN CACHE_TAG        *CacheTag\r
  )\r
{\r
  EFI_STATUS  Status;\r
  UINTN       OldPageNo;\r
\r
  OldPageNo = CacheTag->PageNo;\r
  if ((CacheTag->RealSize > 0) && (OldPageNo == PageNo)) {\r
    //\r
    // Cache Hit occurred\r
    //\r
    return EFI_SUCCESS;\r
  }\r
\r
  //\r
  // Write dirty cache page back to disk\r
  //\r
  if ((CacheTag->RealSize > 0) && CacheTag->Dirty) {\r
    Status = FatExchangeCachePage (Volume, CacheDataType, WriteDisk, CacheTag, NULL);\r
    if (EFI_ERROR (Status)) {\r
      return Status;\r
    }\r
  }\r
\r
  //\r
  // Load new data from disk;\r
  //\r
  CacheTag->PageNo = PageNo;\r
  Status           = FatExchangeCachePage (Volume, CacheDataType, ReadDisk, CacheTag, NULL);\r
\r
  return Status;\r
}\r
\r
/**\r
\r
  Read Length bytes from the position of Offset into Buffer, or\r
  write Length bytes from Buffer into the position of Offset.\r
\r
  @param  Volume                - FAT file system volume.\r
  @param  CacheDataType         - The type of cache: CACHE_DATA or CACHE_FAT.\r
  @param  IoMode                - Indicate the type of disk access.\r
  @param  PageNo                - The number of unaligned cache page.\r
  @param  Offset                - The starting byte of cache page.\r
  @param  Length                - The number of bytes that is read or written\r
  @param  Buffer                - Buffer containing cache data.\r
\r
  @retval EFI_SUCCESS           - The data was accessed correctly.\r
  @return Others                - An error occurred when accessing unaligned cache page.\r
\r
**/\r
STATIC\r
EFI_STATUS\r
FatAccessUnalignedCachePage (\r
  IN     FAT_VOLUME       *Volume,\r
  IN     CACHE_DATA_TYPE  CacheDataType,\r
  IN     IO_MODE          IoMode,\r
  IN     UINTN            PageNo,\r
  IN     UINTN            Offset,\r
  IN     UINTN            Length,\r
  IN OUT VOID             *Buffer\r
  )\r
{\r
  EFI_STATUS  Status;\r
  VOID        *Source;\r
  VOID        *Destination;\r
  DISK_CACHE  *DiskCache;\r
  CACHE_TAG   *CacheTag;\r
  UINTN       GroupNo;\r
\r
  DiskCache = &Volume->DiskCache[CacheDataType];\r
  GroupNo   = PageNo & DiskCache->GroupMask;\r
  CacheTag  = &DiskCache->CacheTag[GroupNo];\r
  Status    = FatGetCachePage (Volume, CacheDataType, PageNo, CacheTag);\r
  if (!EFI_ERROR (Status)) {\r
    Source      = DiskCache->CacheBase + (GroupNo << DiskCache->PageAlignment) + Offset;\r
    Destination = Buffer;\r
    if (IoMode != ReadDisk) {\r
      CacheTag->Dirty  = TRUE;\r
      DiskCache->Dirty = TRUE;\r
      Destination      = Source;\r
      Source           = Buffer;\r
    }\r
\r
    CopyMem (Destination, Source, Length);\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
\r
  Read BufferSize bytes from the position of Offset into Buffer,\r
  or write BufferSize bytes from Buffer into the position of Offset.\r
\r
  Base on the parameter of CACHE_DATA_TYPE, the data access will be divided into\r
  the access of FAT cache (CACHE_FAT) and the access of Data cache (CACHE_DATA):\r
\r
  1. Access of FAT cache (CACHE_FAT): Access the data in the FAT cache, if there is cache\r
     page hit, just return the cache page; else update the related cache page and return\r
     the right cache page.\r
  2. Access of Data cache (CACHE_DATA):\r
     The access data will be divided into UnderRun data, Aligned data and OverRun data;\r
     The UnderRun data and OverRun data will be accessed by the Data cache,\r
     but the Aligned data will be accessed with disk directly.\r
\r
  @param  Volume                - FAT file system volume.\r
  @param  CacheDataType         - The type of cache: CACHE_DATA or CACHE_FAT.\r
  @param  IoMode                - Indicate the type of disk access.\r
  @param  Offset                - The starting byte offset to read from.\r
  @param  BufferSize            - Size of Buffer.\r
  @param  Buffer                - Buffer containing cache data.\r
  @param  Task                    point to task instance.\r
\r
  @retval EFI_SUCCESS           - The data was accessed correctly.\r
  @retval EFI_MEDIA_CHANGED     - The MediaId does not match the current device.\r
  @return Others                - An error occurred when accessing cache.\r
\r
**/\r
EFI_STATUS\r
FatAccessCache (\r
  IN     FAT_VOLUME       *Volume,\r
  IN     CACHE_DATA_TYPE  CacheDataType,\r
  IN     IO_MODE          IoMode,\r
  IN     UINT64           Offset,\r
  IN     UINTN            BufferSize,\r
  IN OUT UINT8            *Buffer,\r
  IN     FAT_TASK         *Task\r
  )\r
{\r
  EFI_STATUS  Status;\r
  UINTN       PageSize;\r
  UINTN       UnderRun;\r
  UINTN       OverRun;\r
  UINTN       AlignedSize;\r
  UINTN       Length;\r
  UINTN       PageNo;\r
  UINTN       AlignedPageCount;\r
  UINTN       OverRunPageNo;\r
  DISK_CACHE  *DiskCache;\r
  UINT64      EntryPos;\r
  UINT8       PageAlignment;\r
\r
  ASSERT (Volume->CacheBuffer != NULL);\r
\r
  Status        = EFI_SUCCESS;\r
  DiskCache     = &Volume->DiskCache[CacheDataType];\r
  EntryPos      = Offset - DiskCache->BaseAddress;\r
  PageAlignment = DiskCache->PageAlignment;\r
  PageSize      = (UINTN)1 << PageAlignment;\r
  PageNo        = (UINTN)RShiftU64 (EntryPos, PageAlignment);\r
  UnderRun      = ((UINTN)EntryPos) & (PageSize - 1);\r
\r
  if (UnderRun > 0) {\r
    Length = PageSize - UnderRun;\r
    if (Length > BufferSize) {\r
      Length = BufferSize;\r
    }\r
\r
    Status = FatAccessUnalignedCachePage (Volume, CacheDataType, IoMode, PageNo, UnderRun, Length, Buffer);\r
    if (EFI_ERROR (Status)) {\r
      return Status;\r
    }\r
\r
    Buffer     += Length;\r
    BufferSize -= Length;\r
    PageNo++;\r
  }\r
\r
  AlignedPageCount = BufferSize >> PageAlignment;\r
  OverRunPageNo    = PageNo + AlignedPageCount;\r
  //\r
  // The access of the Aligned data\r
  //\r
  if (AlignedPageCount > 0) {\r
    //\r
    // Accessing fat table cannot have alignment data\r
    //\r
    ASSERT (CacheDataType == CacheData);\r
\r
    EntryPos    = Volume->RootPos + LShiftU64 (PageNo, PageAlignment);\r
    AlignedSize = AlignedPageCount << PageAlignment;\r
    Status      = FatDiskIo (Volume, IoMode, EntryPos, AlignedSize, Buffer, Task);\r
    if (EFI_ERROR (Status)) {\r
      return Status;\r
    }\r
\r
    //\r
    // If these access data over laps the relative cache range, these cache pages need\r
    // to be updated.\r
    //\r
    FatFlushDataCacheRange (Volume, IoMode, PageNo, OverRunPageNo, Buffer);\r
    Buffer     += AlignedSize;\r
    BufferSize -= AlignedSize;\r
  }\r
\r
  //\r
  // The access of the OverRun data\r
  //\r
  OverRun = BufferSize;\r
  if (OverRun > 0) {\r
    //\r
    // Last read is not a complete page\r
    //\r
    Status = FatAccessUnalignedCachePage (Volume, CacheDataType, IoMode, OverRunPageNo, 0, OverRun, Buffer);\r
  }\r
\r
  return Status;\r
}\r
\r
/**\r
\r
  Flush all the dirty cache back, include the FAT cache and the Data cache.\r
\r
  @param  Volume                - FAT file system volume.\r
  @param  Task                    point to task instance.\r
\r
  @retval EFI_SUCCESS           - Flush all the dirty cache back successfully\r
  @return other                 - An error occurred when writing the data into the disk\r
\r
**/\r
EFI_STATUS\r
FatVolumeFlushCache (\r
  IN FAT_VOLUME  *Volume,\r
  IN FAT_TASK    *Task\r
  )\r
{\r
  EFI_STATUS       Status;\r
  CACHE_DATA_TYPE  CacheDataType;\r
  UINTN            GroupIndex;\r
  UINTN            GroupMask;\r
  DISK_CACHE       *DiskCache;\r
  CACHE_TAG        *CacheTag;\r
\r
  for (CacheDataType = (CACHE_DATA_TYPE)0; CacheDataType < CacheMaxType; CacheDataType++) {\r
    DiskCache = &Volume->DiskCache[CacheDataType];\r
    if (DiskCache->Dirty) {\r
      //\r
      // Data cache or fat cache is dirty, write the dirty data back\r
      //\r
      GroupMask = DiskCache->GroupMask;\r
      for (GroupIndex = 0; GroupIndex <= GroupMask; GroupIndex++) {\r
        CacheTag = &DiskCache->CacheTag[GroupIndex];\r
        if ((CacheTag->RealSize > 0) && CacheTag->Dirty) {\r
          //\r
          // Write back all Dirty Data Cache Page to disk\r
          //\r
          Status = FatExchangeCachePage (Volume, CacheDataType, WriteDisk, CacheTag, Task);\r
          if (EFI_ERROR (Status)) {\r
            return Status;\r
          }\r
        }\r
      }\r
\r
      DiskCache->Dirty = FALSE;\r
    }\r
  }\r
\r
  //\r
  // Flush the block device.\r
  //\r
  Status = Volume->BlockIo->FlushBlocks (Volume->BlockIo);\r
  return Status;\r
}\r
\r
/**\r
\r
  Initialize the disk cache according to Volume's FatType.\r
\r
  @param  Volume                - FAT file system volume.\r
\r
  @retval EFI_SUCCESS           - The disk cache is successfully initialized.\r
  @retval EFI_OUT_OF_RESOURCES  - Not enough memory to allocate disk cache.\r
\r
**/\r
EFI_STATUS\r
FatInitializeDiskCache (\r
  IN FAT_VOLUME  *Volume\r
  )\r
{\r
  DISK_CACHE  *DiskCache;\r
  UINTN       FatCacheGroupCount;\r
  UINTN       DataCacheSize;\r
  UINTN       FatCacheSize;\r
  UINT8       *CacheBuffer;\r
\r
  DiskCache = Volume->DiskCache;\r
  //\r
  // Configure the parameters of disk cache\r
  //\r
  if (Volume->FatType == Fat12) {\r
    FatCacheGroupCount                 = FAT_FATCACHE_GROUP_MIN_COUNT;\r
    DiskCache[CacheFat].PageAlignment  = FAT_FATCACHE_PAGE_MIN_ALIGNMENT;\r
    DiskCache[CacheData].PageAlignment = FAT_DATACACHE_PAGE_MIN_ALIGNMENT;\r
  } else {\r
    FatCacheGroupCount                 = FAT_FATCACHE_GROUP_MAX_COUNT;\r
    DiskCache[CacheFat].PageAlignment  = FAT_FATCACHE_PAGE_MAX_ALIGNMENT;\r
    DiskCache[CacheData].PageAlignment = FAT_DATACACHE_PAGE_MAX_ALIGNMENT;\r
  }\r
\r
  DiskCache[CacheData].GroupMask    = FAT_DATACACHE_GROUP_COUNT - 1;\r
  DiskCache[CacheData].BaseAddress  = Volume->RootPos;\r
  DiskCache[CacheData].LimitAddress = Volume->VolumeSize;\r
  DiskCache[CacheFat].GroupMask     = FatCacheGroupCount - 1;\r
  DiskCache[CacheFat].BaseAddress   = Volume->FatPos;\r
  DiskCache[CacheFat].LimitAddress  = Volume->FatPos + Volume->FatSize;\r
  FatCacheSize                      = FatCacheGroupCount << DiskCache[CacheFat].PageAlignment;\r
  DataCacheSize                     = FAT_DATACACHE_GROUP_COUNT << DiskCache[CacheData].PageAlignment;\r
  //\r
  // Allocate the Fat Cache buffer\r
  //\r
  CacheBuffer = AllocateZeroPool (FatCacheSize + DataCacheSize);\r
  if (CacheBuffer == NULL) {\r
    return EFI_OUT_OF_RESOURCES;\r
  }\r
\r
  Volume->CacheBuffer            = CacheBuffer;\r
  DiskCache[CacheFat].CacheBase  = CacheBuffer;\r
  DiskCache[CacheData].CacheBase = CacheBuffer + FatCacheSize;\r
  return EFI_SUCCESS;\r
}\r