| /* $NoKeywords:$ */ |
| /** |
| * @file |
| * |
| * Service procedure to access PCI config space registers |
| * |
| * |
| * |
| * @xrefitem bom "File Content Label" "Release Content" |
| * @e project: AGESA |
| * @e sub-project: GNB |
| * @e \$Revision: 84150 $ @e \$Date: 2012-12-12 15:46:25 -0600 (Wed, 12 Dec 2012) $ |
| * |
| */ |
| /* |
| ***************************************************************************** |
| * |
| * Copyright (c) 2008 - 2013, Advanced Micro Devices, Inc. |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are met: |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * * Neither the name of Advanced Micro Devices, Inc. nor the names of |
| * its contributors may be used to endorse or promote products derived |
| * from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND |
| * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
| * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
| * DISCLAIMED. IN NO EVENT SHALL ADVANCED MICRO DEVICES, INC. BE LIABLE FOR ANY |
| * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
| * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
| * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND |
| * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
| * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| * *************************************************************************** |
| * |
| */ |
| |
| /*---------------------------------------------------------------------------------------- |
| * M O D U L E S U S E D |
| *---------------------------------------------------------------------------------------- |
| */ |
| #include "AGESA.h" |
| #include "Ids.h" |
| #include "amdlib.h" |
| #include "cpuFamilyTranslation.h" |
| #include "Gnb.h" |
| #include "GnbPcieConfig.h" |
| #include "GnbLib.h" |
| #include "GnbTimerLib.h" |
| #include "GnbFamServices.h" |
| #include "GnbTable.h" |
| #include "Filecode.h" |
| #define FILECODE PROC_GNB_MODULES_GNBTABLE_GNBTABLE_FILECODE |
| /*---------------------------------------------------------------------------------------- |
| * D E F I N I T I O N S A N D M A C R O S |
| *---------------------------------------------------------------------------------------- |
| */ |
| |
| |
| /*---------------------------------------------------------------------------------------- |
| * T Y P E D E F S A N D S T R U C T U R E S |
| *---------------------------------------------------------------------------------------- |
| */ |
| |
| |
| /*---------------------------------------------------------------------------------------- |
| * P R O T O T Y P E S O F L O C A L F U N C T I O N S |
| *---------------------------------------------------------------------------------------- |
| */ |
| |
| VOID |
| STATIC |
| GnbProcessTableRegisterRmw ( |
| IN GNB_HANDLE *GnbHandle, |
| IN GNB_REGISTER_SERVICE *GnbRegisterAccessProtocol, |
| IN GNB_RMW_BLOCK *Data, |
| IN UINT32 Flags, |
| IN AMD_CONFIG_PARAMS *StdHeader |
| ); |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Process table |
| * |
| * @param[in] GnbHandle Gnb handle |
| * @param[in] Table Table pointer |
| * @param[in] Property Property |
| * @param[in] Flags Flags |
| * @param[in] StdHeader Standard configuration header |
| */ |
| |
| AGESA_STATUS |
| GnbProcessTable ( |
| IN GNB_HANDLE *GnbHandle, |
| IN GNB_TABLE *Table, |
| IN UINT32 Property, |
| IN UINT32 Flags, |
| IN AMD_CONFIG_PARAMS *StdHeader |
| ) |
| { |
| UINT8 *EntryPointer; |
| UINT64 Data; |
| UINT64 Temp; |
| UINT64 Mask; |
| UINT32 WriteAccFlags; |
| GNB_REGISTER_SERVICE *GnbRegisterAccessProtocol; |
| CPU_LOGICAL_ID LogicalId; |
| AGESA_STATUS Status; |
| |
| IDS_HDT_CONSOLE (GNB_TRACE, "GnbProcessTableExt Enter\n"); |
| IDS_HDT_CONSOLE (GNB_TRACE, " Property - 0x%08x\n", Property); |
| |
| GetLogicalIdOfSocket (GnbGetSocketId (GnbHandle), &LogicalId, StdHeader); |
| EntryPointer = (UINT8 *) Table; |
| WriteAccFlags = 0; |
| if ((Flags & GNB_TABLE_FLAGS_FORCE_S3_SAVE) != 0) { |
| WriteAccFlags |= GNB_REG_ACC_FLAG_S3SAVE; |
| } |
| |
| Status = GnbLibLocateService (GnbRegisterAccessService, GnbGetSocketId (GnbHandle), (CONST VOID **)&GnbRegisterAccessProtocol, StdHeader); |
| ASSERT (Status == AGESA_SUCCESS); |
| |
| while (*EntryPointer != GnbEntryTerminate) { |
| Data = 0; |
| Temp = 0; |
| switch (*EntryPointer) { |
| case GnbEntryWr: |
| GnbRegisterAccessProtocol->Write ( |
| GnbHandle, |
| ((GNB_TABLE_ENTRY_WR*) EntryPointer)->RegisterSpaceType, |
| ((GNB_TABLE_ENTRY_WR*) EntryPointer)->Address, |
| &((GNB_TABLE_ENTRY_WR*) EntryPointer)->Value, |
| WriteAccFlags, |
| StdHeader |
| ); |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_WR); |
| break; |
| case GnbEntryPropertyWr: |
| if ((Property & ((GNB_TABLE_ENTRY_PROPERTY_WR *) EntryPointer)->Property) != 0) { |
| GnbRegisterAccessProtocol->Write ( |
| GnbHandle, |
| ((GNB_TABLE_ENTRY_PROPERTY_WR *) EntryPointer)->RegisterSpaceType, |
| ((GNB_TABLE_ENTRY_PROPERTY_WR *) EntryPointer)->Address, |
| &((GNB_TABLE_ENTRY_PROPERTY_WR *) EntryPointer)->Value, |
| WriteAccFlags, |
| StdHeader |
| ); |
| } |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_PROPERTY_WR); |
| break; |
| case GnbEntryFullWr: |
| if ((Property & ((GNB_TABLE_ENTRY_FULL_WR*) EntryPointer)->Property) != 0) { |
| if ((LogicalId.Revision & ((GNB_TABLE_ENTRY_FULL_WR*) EntryPointer)->Revision) != 0) { |
| GnbRegisterAccessProtocol->Write ( |
| GnbHandle, |
| ((GNB_TABLE_ENTRY_FULL_WR*) EntryPointer)->RegisterSpaceType, |
| ((GNB_TABLE_ENTRY_FULL_WR*) EntryPointer)->Address, |
| &((GNB_TABLE_ENTRY_FULL_WR*) EntryPointer)->Value, |
| WriteAccFlags, |
| StdHeader |
| ); |
| } |
| } |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_FULL_WR); |
| break; |
| case GnbEntryRmw: |
| GnbProcessTableRegisterRmw ( |
| GnbHandle, |
| GnbRegisterAccessProtocol, |
| &((GNB_TABLE_ENTRY_RMW *) EntryPointer)->Data, |
| WriteAccFlags, |
| StdHeader |
| ); |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_RMW); |
| break; |
| case GnbEntryPropertyRmw: |
| if ((Property & ((GNB_TABLE_ENTRY_PROPERTY_RMW *) EntryPointer)->Property) != 0) { |
| GnbProcessTableRegisterRmw ( |
| GnbHandle, |
| GnbRegisterAccessProtocol, |
| &((GNB_TABLE_ENTRY_PROPERTY_RMW *) EntryPointer)->Data, |
| WriteAccFlags, |
| StdHeader |
| ); |
| } |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_PROPERTY_RMW); |
| break; |
| case GnbEntryRevRmw: |
| if ((LogicalId.Revision & ((GNB_TABLE_ENTRY_REV_RMW *) EntryPointer)->Revision) != 0) { |
| GnbProcessTableRegisterRmw ( |
| GnbHandle, |
| GnbRegisterAccessProtocol, |
| &((GNB_TABLE_ENTRY_REV_RMW *) EntryPointer)->Data, |
| WriteAccFlags, |
| StdHeader |
| ); |
| } |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_REV_RMW); |
| break; |
| case GnbEntryFullRmw: |
| if ((Property & ((GNB_TABLE_ENTRY_FULL_RMW *) EntryPointer)->Property) != 0) { |
| if ((LogicalId.Revision & ((GNB_TABLE_ENTRY_FULL_RMW *) EntryPointer)->Revision) != 0) { |
| GnbProcessTableRegisterRmw ( |
| GnbHandle, |
| GnbRegisterAccessProtocol, |
| &((GNB_TABLE_ENTRY_FULL_RMW *) EntryPointer)->Data, |
| WriteAccFlags, |
| StdHeader |
| ); |
| } |
| } |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_FULL_RMW); |
| break; |
| case GnbEntryPoll: |
| do { |
| GnbRegisterAccessProtocol->Read ( |
| GnbHandle, |
| ((GNB_TABLE_ENTRY_POLL *) EntryPointer)->RegisterSpaceType, |
| ((GNB_TABLE_ENTRY_POLL *) EntryPointer)->Address, |
| &Data, |
| 0, |
| StdHeader |
| ); |
| } while ((Data & ((GNB_TABLE_ENTRY_POLL*) EntryPointer)->AndMask) != ((GNB_TABLE_ENTRY_POLL*) EntryPointer)->CompareValue); |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_POLL); |
| break; |
| case GnbEntryPropertyPoll: |
| if ((Property & ((GNB_TABLE_ENTRY_PROPERTY_POLL *) EntryPointer)->Property) != 0) { |
| do { |
| GnbRegisterAccessProtocol->Read ( |
| GnbHandle, |
| ((GNB_TABLE_ENTRY_PROPERTY_POLL *) EntryPointer)->RegisterSpaceType, |
| ((GNB_TABLE_ENTRY_PROPERTY_POLL *) EntryPointer)->Address, |
| &Data, |
| 0, |
| StdHeader |
| ); |
| } while ((Data & ((GNB_TABLE_ENTRY_PROPERTY_POLL *) EntryPointer)->AndMask) != ((GNB_TABLE_ENTRY_PROPERTY_POLL *) EntryPointer)->CompareValue); |
| } |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_PROPERTY_POLL); |
| break; |
| case GnbEntryFullPoll: |
| if ((Property & ((GNB_TABLE_ENTRY_FULL_POLL *) EntryPointer)->Property) != 0) { |
| if ((LogicalId.Revision & ((GNB_TABLE_ENTRY_FULL_RMW *) EntryPointer)->Revision) != 0) { |
| do { |
| GnbRegisterAccessProtocol->Read ( |
| GnbHandle, |
| ((GNB_TABLE_ENTRY_FULL_POLL *) EntryPointer)->RegisterSpaceType, |
| ((GNB_TABLE_ENTRY_FULL_POLL *) EntryPointer)->Address, |
| &Data, |
| 0, |
| StdHeader |
| ); |
| } while ((Data & ((GNB_TABLE_ENTRY_FULL_POLL *) EntryPointer)->AndMask) != ((GNB_TABLE_ENTRY_FULL_POLL *) EntryPointer)->CompareValue); |
| } |
| } |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_FULL_POLL); |
| break; |
| case GnbEntryCopy: |
| GnbRegisterAccessProtocol->Read ( |
| GnbHandle, |
| ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->SrcRegisterSpaceType, |
| ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->SrcAddress, |
| &Data, |
| 0, |
| StdHeader |
| ); |
| Mask = (1ull << ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->SrcFieldWidth) - 1; |
| Data = (Data >> ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->SrcFieldOffset) & Mask; |
| GnbRegisterAccessProtocol->Read ( |
| GnbHandle, |
| ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->DestRegisterSpaceType, |
| ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->DestAddress, |
| &Temp, |
| 0, |
| StdHeader |
| ); |
| Mask = (1ull << ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->DestFieldWidth) - 1; |
| Temp = Temp & ( ~ (Mask << ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->DestFieldOffset)); |
| Temp = Temp | ((Data & Mask) << ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->DestFieldOffset); |
| GnbRegisterAccessProtocol->Write ( |
| GnbHandle, |
| ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->DestRegisterSpaceType, |
| ((GNB_TABLE_ENTRY_COPY*) EntryPointer)->DestAddress, |
| &Temp, |
| WriteAccFlags, |
| StdHeader |
| ); |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_COPY); |
| break; |
| case GnbEntryStall: |
| if ((WriteAccFlags & GNB_TABLE_FLAGS_FORCE_S3_SAVE) != 0) { |
| GnbLibStallS3Save (((GNB_TABLE_ENTRY_STALL*) EntryPointer)->Microsecond, StdHeader); |
| } else { |
| GnbLibStall (((GNB_TABLE_ENTRY_STALL*) EntryPointer)->Microsecond, StdHeader); |
| } |
| EntryPointer = EntryPointer + sizeof (GNB_TABLE_ENTRY_STALL); |
| break; |
| default: |
| ASSERT (FALSE); |
| IDS_HDT_CONSOLE (NB_MISC, " ERROR!!! Register table parse\n"); |
| return AGESA_ERROR; |
| } |
| } |
| IDS_HDT_CONSOLE (GNB_TRACE, "GnbProcessTableExt Exit\n"); |
| return AGESA_SUCCESS; |
| } |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Supporting function for register read modify write |
| * |
| * @param[in] GnbHandle Gnb handle |
| * @param[in] GnbRegisterAccessProtocol Register access protocol |
| * @param[in] Data Data pointer |
| * @param[in] Flags Flags |
| * @param[in] StdHeader Standard configuration header |
| */ |
| |
| VOID |
| STATIC |
| GnbProcessTableRegisterRmw ( |
| IN GNB_HANDLE *GnbHandle, |
| IN GNB_REGISTER_SERVICE *GnbRegisterAccessProtocol, |
| IN GNB_RMW_BLOCK *Data, |
| IN UINT32 Flags, |
| IN AMD_CONFIG_PARAMS *StdHeader |
| ) |
| { |
| UINT64 Value; |
| Value = 0; |
| GnbRegisterAccessProtocol->Read ( |
| GnbHandle, |
| Data->RegisterSpaceType, |
| Data->Address, |
| &Value, |
| 0, |
| StdHeader |
| ); |
| Value = (Value & (~ (UINT64) Data->AndMask)) | Data->OrMask; |
| GnbRegisterAccessProtocol->Write ( |
| GnbHandle, |
| Data->RegisterSpaceType, |
| Data->Address, |
| &Value, |
| Flags, |
| StdHeader |
| ); |
| } |