1 files changed, 201 insertions, 0 deletions
diff --git a/src/vendorcode/amd/cimx/rd890/nbDispatcher.c b/src/vendorcode/amd/cimx/rd890/nbDispatcher.c
new file mode 100644
index 0000000000..16e86a1aaa
--- /dev/null
+++ b/src/vendorcode/amd/cimx/rd890/nbDispatcher.c
@@ -0,0 +1,201 @@
+/**
+ * @file
+ *
+ *  Function dispatcher.
+ *
+ *
+ *
+ * @xrefitem bom "File Content Label" "Release Content"
+ * @e project:      CIMx-NB
+ * @e sub-project:
+ * @e \$Revision:$   @e \$Date:$
+ *
+ */
+/*****************************************************************************
+ *
+ * Copyright (C) 2012 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 "NbPlatform.h"
+
+/*----------------------------------------------------------------------------------------
+ *           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
+ *----------------------------------------------------------------------------------------
+ */
+
+extern AMD_MODULE_HEADER mNbModuleID;
+
+/*----------------------------------------------------------------------------------------
+ *                   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
+ *----------------------------------------------------------------------------------------
+ */
+
+/*----------------------------------------------------------------------------------------
+ *                          E X P O R T E D    F U N C T I O N S
+ *----------------------------------------------------------------------------------------
+ */
+
+AGESA_STATUS
+CALLCONV
+AmdNbDispatcher (
+  IN OUT   VOID*ConfigPtr
+  )
+{
+  AGESA_STATUS Status;
+  IMAGE_ENTRY ImageEntry;
+  ImageEntry = NULL;
+  Status = AGESA_UNSUPPORTED;
+  CIMX_INIT_TRACE ((ConfigPtr));
+  CIMX_TRACE ((TRACE_DATA (ConfigPtr, CIMX_TRACE_ALL), "CIMx - RD890 Entry \n"));
+  CIMX_TRACE ((TRACE_DATA (ConfigPtr, CIMX_TRACE_ALL), "    Funcid = %x Callout = %x\n", ((AMD_CONFIG_PARAMS*)ConfigPtr)->Func, ((AMD_CONFIG_PARAMS*)ConfigPtr)->CalloutPtr));
+
+#ifdef B1_IMAGE
+  // 1. Try to execute any B1 specific functions
+  switch (((AMD_CONFIG_PARAMS*)ConfigPtr)->Func) {
+    #ifdef B1_IMAGE
+    // B1 ONLY Functions
+    //
+    //
+    #endif
+  default:
+    break;
+  }
+#endif
+
+  // 2. If not B1 specific function but we are B1, see if we can find B2 instead
+#ifdef B1_IMAGE
+  if (Status == AGESA_UNSUPPORTED) {
+    UINTN ImageStart;
+    UINTN ImageEnd;
+    AMD_IMAGE_HEADER* AltImagePtr;
+    ImageStart = 0xFFF00000;
+    ImageEnd = 0xFFFFFFFF;
+    AltImagePtr = (AMD_IMAGE_HEADER*) (UINTN) ((AMD_CONFIG_PARAMS*)ConfigPtr)->AltImageBasePtr;
+
+    if ((UINTN)AltImagePtr != 0xFFFFFFFF) {
+      if (AltImagePtr != NULL) {
+        ImageStart = (UINT32) (UINTN)AltImagePtr;
+        ImageEnd = ImageStart + 4;
+      }
+      // Locate/test image base that matches this component
+      AltImagePtr = LibAmdLocateImage ((VOID*)ImageStart, (VOID*)ImageEnd, 4096, CIMX_NB_ID);
+      if (AltImagePtr != NULL) {
+        //Invoke alternative Image
+        ImageEntry = (IMAGE_ENTRY) (UINTN) ((UINT8*) AltImagePtr + AltImagePtr->EntryPointAddress);
+        Status = (*ImageEntry) (ConfigPtr);
+      }
+    }
+  }
+#endif
+  if (Status == AGESA_UNSUPPORTED) {
+ // 3. Try to execute any other functions
+    switch (((AMD_CONFIG_PARAMS*)ConfigPtr)->Func) {
+
+#if defined (B1_IMAGE) || defined (B2_IMAGE)
+// B1 & B2 Functions
+    case PH_AmdPowerOnResetInit:
+      Status = LibSystemApiCall (AmdPowerOnResetInit, ConfigPtr);
+      break;
+    case PH_AmdPcieEarlyInit:
+      Status = LibSystemApiCall (AmdPcieEarlyInit, ConfigPtr);
+      break;
+    case PH_AmdInitializer:
+      Status = LibSystemApiCall (AmdInitializer, ConfigPtr);
+      break;
+#endif
+#ifdef B2_IMAGE
+// B2 Functions
+    case PH_AmdNbHtInit :
+      Status = LibSystemApiCall (AmdHtInit, ConfigPtr);
+      break;
+    case PH_AmdEarlyPostInit  :
+      LibSystemApiCall (AmdMaskedMemoryInit, ConfigPtr);
+      Status = LibSystemApiCall (AmdEarlyPostInit, ConfigPtr);
+      break;
+    case PH_AmdMidPostInit  :
+      Status = LibSystemApiCall (AmdMidPostInit, ConfigPtr);
+      break;
+    case PH_AmdLatePostInit :
+      Status = LibSystemApiCall (AmdPcieLateInit, ConfigPtr);
+      Status = LibSystemApiCall (AmdLatePostInit, ConfigPtr);
+      Status = LibSystemApiCall (AmdPcieLateInitWa, ConfigPtr);
+      break;
+    case PH_AmdPcieValidatePortState :
+      Status = LibSystemApiCall (AmdPcieValidatePortState, ConfigPtr);
+      break;
+    case PH_AmdPcieLateInit :
+      Status = LibSystemApiCall (AmdPcieLateInit, ConfigPtr);
+      break;
+    case PH_AmdNbLateInit :
+      Status = LibSystemApiCall (AmdLatePostInit, ConfigPtr);
+      break;
+    case PH_AmdS3Init :
+      LibSystemApiCall (AmdMaskedMemoryInit, ConfigPtr);
+      Status = LibSystemApiCall (AmdS3InitIommu, ConfigPtr);
+      Status = LibSystemApiCall (AmdPcieS3Init, ConfigPtr);
+      Status = LibSystemApiCall (AmdS3Init, ConfigPtr);
+      Status = LibSystemApiCall (AmdPcieLateInitWa, ConfigPtr);
+      break;
+    case PH_AmdNbS3Init :
+      LibSystemApiCall (AmdMaskedMemoryInit, ConfigPtr);
+      Status = LibSystemApiCall (AmdS3Init, ConfigPtr);
+      break;
+    case PH_AmdPcieS3Init :
+      Status = LibSystemApiCall (AmdS3InitIommu, ConfigPtr);
+      Status = LibSystemApiCall (AmdPcieS3Init, ConfigPtr);
+      break;
+#endif
+#ifdef B3_IMAGE
+// B3 Functions
+#endif
+    default:
+      break;
+    }
+  }
+
+ // 4. Try next dispatcher if possible, and we have not already got status back
+  if ((mNbModuleID.NextBlock != NULL) && (Status == AGESA_UNSUPPORTED)) {
+    MODULE_ENTRY  ModuleEntry;
+    CIMX_TRACE ((TRACE_DATA (ConfigPtr, CIMX_TRACE_ALL), "CIMx - RD890 control goes to next Module \n"));
+    ModuleEntry = mNbModuleID.NextBlock->ModuleDispatcher;
+    Status = (*ModuleEntry) (ConfigPtr);
+  }
+  CIMX_TRACE ((TRACE_DATA (ConfigPtr, CIMX_TRACE_ALL), "CIMx - RD890 Exit\n"));
+  return Status;
+}