Fix DEBUG print formats so that pointers and 64-bit integer values display correctly for both 32-bit and 64-bit builds. Contributed-under: TianoCore Contribution Agreement 1.0 Signed-off-by: Scott Duplichan <scott@notabs.org> Reviewed-by: Prince Agyeman <prince.agyeman@intel.com> git-svn-id: https://svn.code.sf.net/p/edk2/code/trunk/edk2@17153 6f19259b-4bc3-4df7-8a09-765794883524
		
			
				
	
	
		
			558 lines
		
	
	
		
			16 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			558 lines
		
	
	
		
			16 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /** @file
 | |
|   This library will parse the coreboot table in memory and extract those required
 | |
|   information.
 | |
| 
 | |
|   Copyright (c) 2014, Intel Corporation. All rights reserved.<BR>
 | |
|   This program and the accompanying materials
 | |
|   are licensed and made available under the terms and conditions of the BSD License
 | |
|   which accompanies this distribution.  The full text of the license may be found at
 | |
|   http://opensource.org/licenses/bsd-license.php
 | |
| 
 | |
|   THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
 | |
|   WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
 | |
| 
 | |
| **/
 | |
| 
 | |
| #include <Uefi/UefiBaseType.h>
 | |
| #include <Library/BaseLib.h>
 | |
| #include <Library/BaseMemoryLib.h>
 | |
| #include <Library/DebugLib.h>
 | |
| #include <Library/PcdLib.h>
 | |
| #include <Library/CbParseLib.h>
 | |
| 
 | |
| #include <IndustryStandard/Acpi.h>
 | |
| 
 | |
| #include "Coreboot.h"
 | |
| 
 | |
| /* Helpful inlines */
 | |
| 
 | |
| static UINT64 cb_unpack64(struct cbuint64 val)
 | |
| {
 | |
|   return LShiftU64 (val.hi, 32) | val.lo;
 | |
| }
 | |
| 
 | |
| UINT16
 | |
| CbCheckSum16 (
 | |
|   IN UINT16   *Buffer,
 | |
|   IN UINTN    Length
 | |
|   )
 | |
| {
 | |
| 	UINT32 Sum, TmpValue;
 | |
| 	UINTN  Idx;
 | |
| 	UINT8  *TmpPtr;
 | |
| 	
 | |
| 	Sum = 0;
 | |
| 	TmpPtr = (UINT8 *)Buffer;
 | |
| 	for(Idx = 0; Idx < Length; Idx++) {
 | |
| 		TmpValue  = TmpPtr[Idx];
 | |
| 		if (Idx % 2 == 1) {
 | |
| 			TmpValue <<= 8;
 | |
| 		}
 | |
| 		
 | |
| 		Sum += TmpValue;
 | |
| 		
 | |
| 		// Wrap
 | |
| 		if (Sum >= 0x10000) {
 | |
| 			Sum = (Sum + (Sum >> 16)) & 0xFFFF;
 | |
| 		}
 | |
| 	}
 | |
| 	
 | |
| 	return (UINT16)((~Sum) & 0xFFFF);		
 | |
| }
 | |
| 
 | |
| VOID *
 | |
| FindCbTag (
 | |
|   IN  VOID    *Start,
 | |
|   IN  UINT32   Tag
 | |
|   )
 | |
| {
 | |
|   struct cb_header   *Header;
 | |
|   struct cb_record   *Record;
 | |
|   UINT8              *TmpPtr;  
 | |
|   UINT8              *TagPtr;  
 | |
|   UINTN              Idx;  
 | |
|   UINT16             CheckSum;
 | |
|       
 | |
|   Header = NULL;
 | |
|   TmpPtr = (UINT8 *)Start;
 | |
|   for (Idx = 0; Idx < 4096; Idx += 16, TmpPtr += 16) {
 | |
|     Header = (struct cb_header   *)TmpPtr;
 | |
|     if (Header->signature == CB_HEADER_SIGNATURE) {
 | |
|       break;
 | |
|     }
 | |
|   }
 | |
|   
 | |
|   if (Idx >= 4096)
 | |
|   	return NULL;
 | |
|   
 | |
|   if (Header == NULL || !Header->table_bytes)
 | |
|     return NULL;
 | |
|     
 | |
|   //
 | |
|   // Check the checksum of the coreboot table header
 | |
|   //
 | |
|   CheckSum = CbCheckSum16 ((UINT16 *)Header, sizeof (*Header));
 | |
|   if (CheckSum != 0) {
 | |
|   	DEBUG ((EFI_D_ERROR, "Invalid coreboot table header checksum\n"));
 | |
|   	return NULL;
 | |
|   }  
 | |
|   
 | |
|   CheckSum = CbCheckSum16 ((UINT16 *)(TmpPtr + sizeof (*Header)), Header->table_bytes);
 | |
|   if (CheckSum != Header->table_checksum) {
 | |
|   	DEBUG ((EFI_D_ERROR, "Incorrect checksum of all the coreboot table entries\n"));
 | |
|   	return NULL;
 | |
|   }
 | |
|      
 | |
|   TagPtr = NULL;
 | |
|   TmpPtr += Header->header_bytes;
 | |
|   for (Idx = 0; Idx < Header->table_entries; Idx++) {
 | |
|     Record = (struct cb_record *)TmpPtr;        
 | |
|     if (Record->tag == CB_TAG_FORWARD) {
 | |
|       TmpPtr = (VOID *)(UINTN)((struct cb_forward *)(UINTN)Record)->forward;
 | |
|       if (Tag == CB_TAG_FORWARD)
 | |
|         return TmpPtr;
 | |
|       else 
 | |
|         return FindCbTag (TmpPtr, Tag);
 | |
|     }       
 | |
|     if (Record->tag == Tag) {
 | |
|       TagPtr = TmpPtr;
 | |
|       break;
 | |
|     }
 | |
|     TmpPtr += Record->size;    
 | |
|   }
 | |
|     
 | |
|   return TagPtr;
 | |
| }
 | |
| 
 | |
| RETURN_STATUS
 | |
| FindCbMemTable (  
 | |
|   struct  cbmem_root  *root,
 | |
|   IN UINT32     TableId, 
 | |
|   IN VOID**     pMemTable,
 | |
|   IN UINT32*    pMemTableSize
 | |
| )
 | |
| {	
 | |
| 	UINTN Idx;
 | |
| 	
 | |
| 	if ((!root) || (!pMemTable))
 | |
| 		return RETURN_INVALID_PARAMETER;
 | |
| 		
 | |
| 	for (Idx = 0; Idx < root->num_entries; Idx++) {
 | |
|     if (root->entries[Idx].id == TableId) {
 | |
|     	*pMemTable = (VOID *) (UINTN)root->entries[Idx].start;
 | |
|     	if (pMemTableSize)
 | |
|     		*pMemTableSize = root->entries[Idx].size;
 | |
|     	
 | |
|     	DEBUG ((EFI_D_ERROR, "Find CbMemTable Id 0x%x, base %p, size 0x%x\n", TableId, *pMemTable, *pMemTableSize));
 | |
|     	return RETURN_SUCCESS;
 | |
|     }
 | |
|   }
 | |
|   
 | |
|   return RETURN_NOT_FOUND;	
 | |
| }
 | |
| 
 | |
| 
 | |
| /**
 | |
|   Acquire the memory information from the coreboot table in memory.
 | |
| 
 | |
|   @param  pLowMemorySize     Pointer to the variable of low memory size
 | |
|   @param  pHighMemorySize    Pointer to the variable of high memory size
 | |
| 
 | |
|   @retval RETURN_SUCCESS     Successfully find out the memory information.
 | |
|   @retval RETURN_INVALID_PARAMETER    Invalid input parameters.
 | |
|   @retval RETURN_NOT_FOUND   Failed to find the memory information.
 | |
| 
 | |
| **/
 | |
| RETURN_STATUS
 | |
| CbParseMemoryInfo (
 | |
|   IN UINT64*    pLowMemorySize,
 | |
|   IN UINT64*    pHighMemorySize
 | |
|   )
 | |
| {
 | |
| 	struct cb_memory*        rec;
 | |
| 	struct cb_memory_range*  Range;
 | |
|   UINT64                   Start;
 | |
|   UINT64                   Size;
 | |
| 	UINTN                    Index;
 | |
| 	
 | |
| 	if ((!pLowMemorySize) || (!pHighMemorySize))
 | |
| 		return RETURN_INVALID_PARAMETER;
 | |
| 	
 | |
| 	//
 | |
| 	// Get the coreboot memory table
 | |
| 	//
 | |
| 	rec = (struct cb_memory *)FindCbTag (0, CB_TAG_MEMORY);
 | |
| 	if (!rec) 
 | |
| 	  rec = (struct cb_memory *)FindCbTag ((VOID *)(UINTN)PcdGet32 (PcdCbHeaderPointer), CB_TAG_MEMORY);
 | |
| 		
 | |
| 	if (!rec) 
 | |
| 		return RETURN_NOT_FOUND;
 | |
| 		
 | |
| 	*pLowMemorySize = 0;
 | |
| 	*pHighMemorySize = 0;
 | |
| 		
 | |
| 	for (Index = 0; Index < MEM_RANGE_COUNT(rec); Index++) {
 | |
|     Range = MEM_RANGE_PTR(rec, Index);    
 | |
|     Start = cb_unpack64(Range->start);
 | |
|     Size = cb_unpack64(Range->size);
 | |
|     DEBUG ((EFI_D_ERROR, "%d. %016lx - %016lx [%02x]\n",
 | |
|       Index, Start, Start + Size - 1, Range->type));
 | |
|     
 | |
|     if (Range->type != CB_MEM_RAM) {
 | |
|       continue;
 | |
|     }
 | |
|       
 | |
|     if (Start + Size < 0x100000000ULL) {
 | |
|       *pLowMemorySize = Start + Size;
 | |
|     } else {      
 | |
|       *pHighMemorySize = Start + Size - 0x100000000ULL;
 | |
|     }
 | |
|   }
 | |
|   
 | |
|   DEBUG ((EFI_D_ERROR, "Low memory 0x%lx, High Memory 0x%lx\n", *pLowMemorySize, *pHighMemorySize));
 | |
|   
 | |
|   return RETURN_SUCCESS;	
 | |
| }
 | |
| 
 | |
| 
 | |
| /**
 | |
|   Acquire the coreboot memory table with the given table id
 | |
| 
 | |
|   @param  TableId            Table id to be searched
 | |
|   @param  pMemTable          Pointer to the base address of the memory table
 | |
|   @param  pMemTableSize      Pointer to the size of the memory table
 | |
| 
 | |
|   @retval RETURN_SUCCESS     Successfully find out the memory table.
 | |
|   @retval RETURN_INVALID_PARAMETER  Invalid input parameters.
 | |
|   @retval RETURN_NOT_FOUND   Failed to find the memory table.
 | |
| 
 | |
| **/
 | |
| RETURN_STATUS
 | |
| CbParseCbMemTable (
 | |
|   IN UINT32     TableId, 
 | |
|   IN VOID**     pMemTable,
 | |
|   IN UINT32*    pMemTableSize
 | |
|   )
 | |
| {
 | |
| 	struct cb_memory*        rec;
 | |
| 	struct cb_memory_range*  Range;
 | |
|   UINT64                   Start;
 | |
|   UINT64                   Size;
 | |
| 	UINTN                    Index;
 | |
| 	
 | |
| 	if (!pMemTable)
 | |
| 		return RETURN_INVALID_PARAMETER;
 | |
| 		
 | |
| 	*pMemTable = NULL;
 | |
| 	
 | |
| 	//
 | |
| 	// Get the coreboot memory table
 | |
| 	//
 | |
| 	rec = (struct cb_memory *)FindCbTag (0, CB_TAG_MEMORY);
 | |
| 	if (!rec)
 | |
| 		rec = (struct cb_memory *)FindCbTag ((VOID *)(UINTN)PcdGet32 (PcdCbHeaderPointer), CB_TAG_MEMORY);
 | |
| 		
 | |
| 	if (!rec)
 | |
| 		return RETURN_NOT_FOUND;
 | |
| 		
 | |
| 	for (Index = 0; Index < MEM_RANGE_COUNT(rec); Index++) {
 | |
|     Range = MEM_RANGE_PTR(rec, Index);    
 | |
|     Start = cb_unpack64(Range->start);
 | |
|     Size = cb_unpack64(Range->size);
 | |
|     
 | |
|     if ((Range->type == CB_MEM_TABLE) && (Start > 0x1000)) {
 | |
|         if (FindCbMemTable ((struct  cbmem_root *)(UINTN)(Start + Size - DYN_CBMEM_ALIGN_SIZE), TableId, pMemTable, pMemTableSize) == RETURN_SUCCESS)
 | |
|         	return RETURN_SUCCESS;
 | |
|     }
 | |
|   }
 | |
| 	
 | |
| 	return RETURN_NOT_FOUND;
 | |
| }
 | |
| 
 | |
| 
 | |
| /**
 | |
|   Acquire the acpi table from coreboot
 | |
| 
 | |
|   @param  pMemTable          Pointer to the base address of the memory table
 | |
|   @param  pMemTableSize      Pointer to the size of the memory table
 | |
| 
 | |
|   @retval RETURN_SUCCESS     Successfully find out the memory table.
 | |
|   @retval RETURN_INVALID_PARAMETER  Invalid input parameters.
 | |
|   @retval RETURN_NOT_FOUND   Failed to find the memory table.
 | |
| 
 | |
| **/
 | |
| RETURN_STATUS
 | |
| CbParseAcpiTable (
 | |
|   IN VOID*      pMemTable,
 | |
|   IN UINT32*    pMemTableSize
 | |
|   )
 | |
| {
 | |
| 	return CbParseCbMemTable (SIGNATURE_32 ('I', 'P', 'C', 'A'), (VOID **)pMemTable, pMemTableSize);	
 | |
| }
 | |
| 
 | |
| /**
 | |
|   Acquire the smbios table from coreboot
 | |
| 
 | |
|   @param  pMemTable          Pointer to the base address of the memory table
 | |
|   @param  pMemTableSize      Pointer to the size of the memory table
 | |
| 
 | |
|   @retval RETURN_SUCCESS     Successfully find out the memory table.
 | |
|   @retval RETURN_INVALID_PARAMETER  Invalid input parameters.
 | |
|   @retval RETURN_NOT_FOUND   Failed to find the memory table.
 | |
| 
 | |
| **/
 | |
| RETURN_STATUS
 | |
| CbParseSmbiosTable (
 | |
|   IN VOID**     pMemTable,
 | |
|   IN UINT32*    pMemTableSize
 | |
|   )
 | |
| {
 | |
| 	return CbParseCbMemTable (SIGNATURE_32 ('T', 'B', 'M', 'S'), pMemTable, pMemTableSize);	
 | |
| }
 | |
| 
 | |
| /**
 | |
|   Find the required fadt information
 | |
| 
 | |
|   @param  pPmCtrlReg         Pointer to the address of power management control register
 | |
|   @param  pPmTimerReg        Pointer to the address of power management timer register
 | |
|   @param  pResetReg          Pointer to the address of system reset register
 | |
|   @param  pResetValue        Pointer to the value to be writen to the system reset register
 | |
| 
 | |
|   @retval RETURN_SUCCESS     Successfully find out all the required fadt information.
 | |
|   @retval RETURN_NOT_FOUND   Failed to find the fadt table.
 | |
| 
 | |
| **/
 | |
| RETURN_STATUS
 | |
| CbParseFadtInfo (
 | |
|   IN UINTN*     pPmCtrlReg,
 | |
|   IN UINTN*     pPmTimerReg,
 | |
|   IN UINTN*     pResetReg,
 | |
|   IN UINTN*     pResetValue
 | |
|   )
 | |
| {
 | |
| 	EFI_ACPI_3_0_ROOT_SYSTEM_DESCRIPTION_POINTER* Rsdp;
 | |
| 	EFI_ACPI_DESCRIPTION_HEADER*                  Rsdt;
 | |
|   UINT32*                                       Entry32;
 | |
|   UINTN                                         Entry32Num;
 | |
|   EFI_ACPI_3_0_FIXED_ACPI_DESCRIPTION_TABLE*    Fadt;
 | |
|   EFI_ACPI_DESCRIPTION_HEADER*                  Xsdt; 
 | |
|   UINT64*                                       Entry64;
 | |
|   UINTN                                         Entry64Num;
 | |
| 	UINTN                                         Idx;
 | |
| 	RETURN_STATUS                                 Status;
 | |
| 	
 | |
| 	Rsdp = NULL;
 | |
| 	Status = RETURN_SUCCESS;
 | |
| 	
 | |
| 	Status = CbParseAcpiTable (&Rsdp, NULL);
 | |
| 	if (RETURN_ERROR(Status))
 | |
| 		return Status;
 | |
| 		
 | |
| 	if (!Rsdp)
 | |
| 		return RETURN_NOT_FOUND;
 | |
| 		
 | |
| 	DEBUG ((EFI_D_ERROR, "Find Rsdp at %p\n", Rsdp));
 | |
| 	DEBUG ((EFI_D_ERROR, "Find Rsdt 0x%x, Xsdt 0x%lx\n", Rsdp->RsdtAddress, Rsdp->XsdtAddress));
 | |
| 	
 | |
| 	//
 | |
| 	// Search Rsdt First
 | |
| 	//
 | |
| 	Rsdt     = (EFI_ACPI_DESCRIPTION_HEADER *)(UINTN)(Rsdp->RsdtAddress);  
 | |
| 	if (Rsdt != NULL) {
 | |
| 	  Entry32  = (UINT32 *)(Rsdt + 1);
 | |
| 	  Entry32Num = (Rsdt->Length - sizeof(EFI_ACPI_DESCRIPTION_HEADER)) >> 2;
 | |
| 	  for (Idx = 0; Idx < Entry32Num; Idx++) {
 | |
| 	    if (*(UINT32 *)(UINTN)(Entry32[Idx]) == EFI_ACPI_3_0_FIXED_ACPI_DESCRIPTION_TABLE_SIGNATURE) {
 | |
| 	      Fadt = (EFI_ACPI_3_0_FIXED_ACPI_DESCRIPTION_TABLE *)(UINTN)(Entry32[Idx]);  
 | |
| 	      if (pPmCtrlReg)
 | |
| 	      	*pPmCtrlReg = Fadt->Pm1aCntBlk;	      	
 | |
| 	      DEBUG ((EFI_D_ERROR, "PmCtrl Reg 0x%x\n", Fadt->Pm1aCntBlk));
 | |
| 	      	
 | |
| 	      if (pPmTimerReg)   
 | |
| 	      	*pPmTimerReg = Fadt->PmTmrBlk; 
 | |
| 	      DEBUG ((EFI_D_ERROR, "PmTimer Reg 0x%x\n", Fadt->PmTmrBlk));
 | |
| 	      	
 | |
| 	      if (pResetReg)   
 | |
| 	      	*pResetReg = (UINTN)Fadt->ResetReg.Address; 
 | |
| 	      DEBUG ((EFI_D_ERROR, "Reset Reg 0x%lx\n", Fadt->ResetReg.Address));
 | |
| 	      	
 | |
| 	      if (pResetValue)   
 | |
| 	      	*pResetValue = Fadt->ResetValue;
 | |
| 	      DEBUG ((EFI_D_ERROR, "Reset Value 0x%x\n", Fadt->ResetValue));
 | |
| 	      	      	         
 | |
| 	      return RETURN_SUCCESS;        
 | |
| 	    }
 | |
| 	  }
 | |
| 	}
 | |
| 	
 | |
| 	//
 | |
| 	// Search Xsdt Second
 | |
| 	//
 | |
| 	Xsdt     = (EFI_ACPI_DESCRIPTION_HEADER *)(UINTN)(Rsdp->XsdtAddress);  
 | |
| 	if (Xsdt != NULL) {
 | |
| 	  Entry64  = (UINT64 *)(Xsdt + 1);
 | |
| 	  Entry64Num = (Xsdt->Length - sizeof(EFI_ACPI_DESCRIPTION_HEADER)) >> 3;
 | |
| 	  for (Idx = 0; Idx < Entry64Num; Idx++) {
 | |
| 	    if (*(UINT32 *)(UINTN)(Entry64[Idx]) == EFI_ACPI_3_0_FIXED_ACPI_DESCRIPTION_TABLE_SIGNATURE) {
 | |
| 	      Fadt = (EFI_ACPI_3_0_FIXED_ACPI_DESCRIPTION_TABLE *)(UINTN)(Entry64[Idx]);  
 | |
| 	      if (pPmCtrlReg)
 | |
| 	      	*pPmCtrlReg = Fadt->Pm1aCntBlk;	      	
 | |
| 	      DEBUG ((EFI_D_ERROR, "PmCtrl Reg 0x%x\n", Fadt->Pm1aCntBlk));
 | |
| 	      	
 | |
| 	      if (pPmTimerReg)   
 | |
| 	      	*pPmTimerReg = Fadt->PmTmrBlk; 
 | |
| 	      DEBUG ((EFI_D_ERROR, "PmTimer Reg 0x%x\n", Fadt->PmTmrBlk));
 | |
| 	      	
 | |
| 	      if (pResetReg)   
 | |
| 	      	*pResetReg = (UINTN)Fadt->ResetReg.Address; 
 | |
| 	      DEBUG ((EFI_D_ERROR, "Reset Reg 0x%lx\n", Fadt->ResetReg.Address));
 | |
| 	      	
 | |
| 	      if (pResetValue)   
 | |
| 	      	*pResetValue = Fadt->ResetValue;
 | |
| 	      DEBUG ((EFI_D_ERROR, "Reset Value 0x%x\n", Fadt->ResetValue));
 | |
| 	      	      	         
 | |
| 	      return RETURN_SUCCESS;        
 | |
| 	    }
 | |
| 	  }
 | |
| 	}	
 | |
| 	
 | |
| 	return RETURN_NOT_FOUND;
 | |
| }
 | |
| 
 | |
| /**
 | |
|   Find the serial port information
 | |
| 
 | |
|   @param  pRegBase           Pointer to the base address of serial port registers
 | |
|   @param  pRegAccessType     Pointer to the access type of serial port registers
 | |
|   @param  pBaudrate          Pointer to the serial port baudrate
 | |
| 
 | |
|   @retval RETURN_SUCCESS     Successfully find the serial port information.
 | |
|   @retval RETURN_NOT_FOUND   Failed to find the serial port information .
 | |
| 
 | |
| **/
 | |
| RETURN_STATUS
 | |
| CbParseSerialInfo (
 | |
|   IN UINT32*     pRegBase,
 | |
|   IN UINT32*     pRegAccessType,
 | |
|   IN UINT32*     pBaudrate
 | |
|   )
 | |
| {
 | |
| 	struct cb_serial*   CbSerial;
 | |
| 	
 | |
| 	CbSerial = FindCbTag (0, CB_TAG_SERIAL);
 | |
| 	if (!CbSerial)
 | |
| 		CbSerial = FindCbTag ((VOID *)(UINTN)PcdGet32 (PcdCbHeaderPointer), CB_TAG_SERIAL);
 | |
| 	
 | |
| 	if (!CbSerial)
 | |
| 		return RETURN_NOT_FOUND;
 | |
| 		
 | |
| 	if (pRegBase)
 | |
| 		*pRegBase = CbSerial->baseaddr;
 | |
| 		
 | |
| 	if (pRegAccessType)
 | |
| 		*pRegAccessType = CbSerial->type;
 | |
| 		
 | |
| 	if (pBaudrate)
 | |
| 		*pBaudrate = CbSerial->baud;
 | |
| 			
 | |
| 	return RETURN_SUCCESS;
 | |
| }
 | |
| 
 | |
| /**
 | |
|   Search for the coreboot table header
 | |
| 
 | |
|   @param  Level              Level of the search depth
 | |
|   @param  HeaderPtr          Pointer to the pointer of coreboot table header
 | |
| 
 | |
|   @retval RETURN_SUCCESS     Successfully find the coreboot table header .
 | |
|   @retval RETURN_NOT_FOUND   Failed to find the coreboot table header .
 | |
| 
 | |
| **/
 | |
| RETURN_STATUS
 | |
| CbParseGetCbHeader (
 | |
|   IN UINTN  Level,
 | |
|   IN VOID** HeaderPtr
 | |
|   )
 | |
| {
 | |
| 	UINTN Index;
 | |
| 	VOID* TempPtr;
 | |
| 	
 | |
| 	if (!HeaderPtr)
 | |
| 		return RETURN_NOT_FOUND;
 | |
| 	
 | |
| 	TempPtr = NULL;	
 | |
| 	for (Index = 0; Index < Level; Index++) {
 | |
| 		TempPtr = FindCbTag (TempPtr, CB_TAG_FORWARD);
 | |
| 		if (!TempPtr)
 | |
| 			break;		
 | |
| 	}
 | |
| 	
 | |
| 	if ((Index >= Level) && (TempPtr != NULL)) {
 | |
| 		*HeaderPtr = TempPtr;
 | |
| 		return RETURN_SUCCESS;
 | |
| 	}
 | |
| 	
 | |
| 	return RETURN_NOT_FOUND;
 | |
| }
 | |
| 
 | |
| /**
 | |
|   Find the video frame buffer information
 | |
| 
 | |
|   @param  pFbInfo            Pointer to the FRAME_BUFFER_INFO structure
 | |
| 
 | |
|   @retval RETURN_SUCCESS     Successfully find the video frame buffer information.
 | |
|   @retval RETURN_NOT_FOUND   Failed to find the video frame buffer information .
 | |
| 
 | |
| **/
 | |
| RETURN_STATUS
 | |
| CbParseFbInfo (
 | |
|   IN FRAME_BUFFER_INFO*     pFbInfo
 | |
|   )
 | |
| {
 | |
| 	struct cb_framebuffer*   CbFbRec;
 | |
| 	
 | |
| 	if (!pFbInfo)
 | |
| 		return RETURN_INVALID_PARAMETER;
 | |
| 	
 | |
| 	CbFbRec = FindCbTag (0, CB_TAG_FRAMEBUFFER);
 | |
| 	if (!CbFbRec)
 | |
| 		CbFbRec = FindCbTag ((VOID *)(UINTN)PcdGet32 (PcdCbHeaderPointer), CB_TAG_FRAMEBUFFER);
 | |
| 	
 | |
| 	if (!CbFbRec)
 | |
| 		return RETURN_NOT_FOUND;
 | |
| 		
 | |
|   DEBUG ((EFI_D_ERROR, "Found coreboot video frame buffer information\n"));
 | |
|   DEBUG ((EFI_D_ERROR, "physical_address: 0x%lx\n", CbFbRec->physical_address));
 | |
|   DEBUG ((EFI_D_ERROR, "x_resolution: 0x%x\n", CbFbRec->x_resolution));
 | |
|   DEBUG ((EFI_D_ERROR, "y_resolution: 0x%x\n", CbFbRec->y_resolution));
 | |
|   DEBUG ((EFI_D_ERROR, "bits_per_pixel: 0x%x\n", CbFbRec->bits_per_pixel));
 | |
|   DEBUG ((EFI_D_ERROR, "bytes_per_line: 0x%x\n", CbFbRec->bytes_per_line));
 | |
|   
 | |
|   DEBUG ((EFI_D_ERROR, "red_mask_size: 0x%x\n", CbFbRec->red_mask_size));
 | |
|   DEBUG ((EFI_D_ERROR, "red_mask_pos: 0x%x\n", CbFbRec->red_mask_pos));
 | |
|   DEBUG ((EFI_D_ERROR, "green_mask_size: 0x%x\n", CbFbRec->green_mask_size));
 | |
|   DEBUG ((EFI_D_ERROR, "green_mask_pos: 0x%x\n", CbFbRec->green_mask_pos));
 | |
|   DEBUG ((EFI_D_ERROR, "blue_mask_size: 0x%x\n", CbFbRec->blue_mask_size));
 | |
|   DEBUG ((EFI_D_ERROR, "blue_mask_pos: 0x%x\n", CbFbRec->blue_mask_pos));
 | |
|   DEBUG ((EFI_D_ERROR, "reserved_mask_size: 0x%x\n", CbFbRec->reserved_mask_size));
 | |
|   DEBUG ((EFI_D_ERROR, "reserved_mask_pos: 0x%x\n", CbFbRec->reserved_mask_pos));
 | |
| 	
 | |
|   pFbInfo->LinearFrameBuffer    = CbFbRec->physical_address;  
 | |
|   pFbInfo->HorizontalResolution = CbFbRec->x_resolution;
 | |
|   pFbInfo->VerticalResolution   = CbFbRec->y_resolution;
 | |
|   pFbInfo->BitsPerPixel         = CbFbRec->bits_per_pixel;
 | |
|   pFbInfo->BytesPerScanLine     = (UINT16)CbFbRec->bytes_per_line;
 | |
|   pFbInfo->Red.Mask             = (1 << CbFbRec->red_mask_size) - 1;
 | |
|   pFbInfo->Red.Position         = CbFbRec->red_mask_pos;
 | |
|   pFbInfo->Green.Mask           = (1 << CbFbRec->green_mask_size) - 1;
 | |
|   pFbInfo->Green.Position       = CbFbRec->green_mask_pos;
 | |
|   pFbInfo->Blue.Mask            = (1 << CbFbRec->blue_mask_size) - 1;
 | |
|   pFbInfo->Blue.Position        = CbFbRec->blue_mask_pos;
 | |
|   pFbInfo->Reserved.Mask        = (1 << CbFbRec->reserved_mask_size) - 1;
 | |
|   pFbInfo->Reserved.Position    = CbFbRec->reserved_mask_pos;  
 | |
|   			
 | |
| 	return RETURN_SUCCESS;
 | |
| }
 | |
| 
 | |
| 
 |