init. 1AQQW051HEADmaster

1 files changed, 166 insertions, 0 deletions

diff --git a/ReferenceCode/Chipset/SystemAgent/SaInit/Pei/PcieTrainingEqSettings.c b/ReferenceCode/Chipset/SystemAgent/SaInit/Pei/PcieTrainingEqSettings.c
new file mode 100644
index 0000000..dc4515e
--- /dev/null
+++ b/ReferenceCode/Chipset/SystemAgent/SaInit/Pei/PcieTrainingEqSettings.c
@@ -0,0 +1,166 @@
+/*++ @file
+  This file adds equalization setting support.
+
+@copyright
+  Copyright (c) 2012 Intel Corporation. All rights reserved
+  This software and associated documentation (if any) is furnished
+  under a license and may only be used or copied in accordance
+  with the terms of the license. Except as permitted by such
+  license, no part of this software or documentation may be
+  reproduced, stored in a retrieval system, or transmitted in any
+  form or by any means without the express written consent of
+  Intel Corporation.
+
+  This file contains an 'Intel Peripheral Driver' and uniquely
+  identified as "Intel Reference Module" and is
+  licensed for Intel CPUs and chipsets under the terms of your
+  license agreement with Intel or your vendor.  This file may
+  be modified by the user, subject to additional terms of the
+  license agreement
+
+--*/
+
+#include "PcieTraining.h"
+#include "PciExpressInit.h"
+
+#ifdef PEG_FLAG
+
+VOID
+GetLinkPartnerFullSwing (
+  IN  UINT8 Lane,
+  OUT UINT8 *FullSwing
+  )
+{
+  UINT32  Data32;
+
+  Data32 = BIT25 | BIT23 | (Lane << 19) | BIT18;
+  McD1PciCfg32(R_SA_PEG_EQPH3_OFFSET) = Data32;
+  Data32 = McD1PciCfg32(R_SA_PEG_EQPH3_OFFSET);
+  McD1PciCfg32(R_SA_PEG_EQPH3_OFFSET) = 0;
+
+  *FullSwing = (Data32 >> 6) & 0x3F;
+
+  return;
+}
+
+VOID
+GetCoefficientsFromPreset (
+  IN  UINT8 Preset,
+  IN  UINT8 FullSwing,
+  OUT UINT8 *PreCursor,
+  OUT UINT8 *Cursor,
+  OUT UINT8 *PostCursor
+  )
+{
+  INT32   PreCursorMilli;
+  INT32   PostCursorMilli;
+
+  PreCursorMilli  = 0;
+  PostCursorMilli = 0;
+
+  ///
+  /// Get starting values from Table 4-16 of the PCIe Base Spec v3.0
+  ///
+  switch (Preset) {
+    case  0:
+      PreCursorMilli  =    0;
+      PostCursorMilli = -250;
+      break;
+
+    case  1:
+      PreCursorMilli  =    0;
+      PostCursorMilli = -167;
+      break;
+
+    case  2:
+      PreCursorMilli  =    0;
+      PostCursorMilli = -200;
+      break;
+
+    case  3:
+      PreCursorMilli  =    0;
+      PostCursorMilli = -125;
+      break;
+
+    case  4:
+      PreCursorMilli  =    0;
+      PostCursorMilli =    0;
+      break;
+
+    case  5:
+      PreCursorMilli  = -100;
+      PostCursorMilli =    0;
+      break;
+
+    case  6:
+      PreCursorMilli  = -125;
+      PostCursorMilli =    0;
+      break;
+
+    case  7:
+      PreCursorMilli  = -100;
+      PostCursorMilli = -200;
+      break;
+
+    case  8:
+      PreCursorMilli  = -125;
+      PostCursorMilli = -125;
+      break;
+
+    case  9:
+      PreCursorMilli  = -166;
+      PostCursorMilli =    0;
+      break;
+
+    case 10:  ///< P10 is unsupported
+    default:
+      PreCursorMilli  = -100;
+      PostCursorMilli = -200;
+      DEBUG ((EFI_D_WARN, "GetCoefficientsFromPreset(): Unsupported Preset Requested: P%d. Using P7.\n", Preset));
+      break;
+  }
+
+  ///
+  /// Convert to absolute values
+  ///
+  if (PreCursorMilli < 0) {
+    PreCursorMilli *= -1;
+  }
+  if (PostCursorMilli < 0) {
+    PostCursorMilli *= -1;
+  }
+
+  ///
+  /// Apply FullSwing
+  ///
+  PreCursorMilli  *= FullSwing;
+  PostCursorMilli *= FullSwing;
+
+  ///
+  /// Convert to integers
+  ///
+  *PreCursor  = (( PreCursorMilli % 1000) >= 500) ? (UINT8) (( PreCursorMilli / 1000) + 1) : (UINT8) ( PreCursorMilli / 1000);
+  *PostCursor = ((PostCursorMilli % 1000) >= 500) ? (UINT8) ((PostCursorMilli / 1000) + 1) : (UINT8) (PostCursorMilli / 1000);
+  *Cursor     = FullSwing - (*PreCursor) - (*PostCursor);
+
+  return;
+}
+
+VOID
+SetPartnerTxCoefficients (
+  IN  UINT8 Lane,
+  IN  UINT8 *PreCursor,
+  IN  UINT8 *Cursor,
+  IN  UINT8 *PostCursor
+  )
+{
+  UINT32  Data32;
+
+  Data32 = (Lane << 19) | BIT18 | (*Cursor << 12) | (*PreCursor << 6) | (*PostCursor);
+  McD1PciCfg32(R_SA_PEG_EQPH3_OFFSET) = Data32;
+  McD1PciCfg32(R_SA_PEG_EQPH3_OFFSET) = 0;
+
+  return;
+}
+
+#endif // PEG_FLAG