| /* $NoKeywords:$ */ |
| /** |
| * @file |
| * |
| * PCIe early post initialization. |
| * |
| * |
| * |
| * @xrefitem bom "File Content Label" "Release Content" |
| * @e project: AGESA |
| * @e sub-project: GNB |
| * @e \$Revision: 63425 $ @e \$Date: 2011-12-22 11:24:10 -0600 (Thu, 22 Dec 2011) $ |
| * |
| */ |
| /* |
| ***************************************************************************** |
| * |
| * Copyright (c) 2008 - 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 "AGESA.h" |
| #include "Ids.h" |
| #include "amdlib.h" |
| #include "Gnb.h" |
| #include "GnbBapmCoeffCalcTN.h" |
| #include "GnbRegisterAccTN.h" |
| #include "GnbRegistersTN.h" |
| #include "GnbInitTN.h" |
| #include "Filecode.h" |
| #define FILECODE PROC_GNB_MODULES_GNBINITTN_GNBBAPMCOEFFCALC_FILECODE |
| /*---------------------------------------------------------------------------------------- |
| * D E F I N I T I O N S A N D M A C R O S |
| *---------------------------------------------------------------------------------------- |
| */ |
| |
| |
| #define GnbFpLibGetExp(V) ((INT32) ((*((UINT64*) &Value) >> 52) & 0x7FF) - (1023 + 52)) |
| #define GnbFpLibGetMnts(V) (INT64) ((*((UINT64*) &Value) & ((1ull << 52) - 1)) | (1ull << 52)) |
| |
| /*---------------------------------------------------------------------------------------- |
| * 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 |
| *---------------------------------------------------------------------------------------- |
| */ |
| |
| INT32 _fltused = 0; |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Calculate power of |
| * |
| * |
| * @param[in] Value value |
| * @param[in] Pow power |
| * @retval Value^Pow |
| */ |
| |
| STATIC DOUBLE |
| GnbBapmPowerOf ( |
| IN DOUBLE Value, |
| IN UINTN Pow |
| ) |
| { |
| DOUBLE Result; |
| Result = Value; |
| while ( --Pow > 0) { |
| Result *= Value; |
| } |
| return Result; |
| } |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Decode R from fuse |
| * |
| * |
| * @param[in] FuseR R fused value |
| * @retval R |
| */ |
| STATIC DOUBLE |
| GnbBapmDecodeR ( |
| IN UINT32 FuseR |
| ) |
| { |
| DOUBLE Value; |
| Value = ((DOUBLE) (FuseR & 0x1ff)) / (2 << (8 - 1)); |
| Value = GnbBapmPowerOf (Value, 4); |
| return ((FuseR & 0x200) != 0) ? (-1) * Value : Value; |
| } |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Decode Tau from fuse |
| * |
| * |
| * @param[in] FuseTau Tau fused value |
| * @retval Tau |
| */ |
| STATIC DOUBLE |
| GnbBapmDecodeTau ( |
| IN UINT32 FuseTau |
| ) |
| { |
| DOUBLE Value; |
| Value = FuseTau; |
| Value = GnbBapmPowerOf (Value / (2 << (9 - 1)), 16); |
| return Value; |
| } |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Calaculate X |
| * |
| * |
| * @param[in] Ts Samplig rate |
| * @param[in] Tau Tau value |
| * @param[in] R R value |
| * @retval X |
| */ |
| STATIC DOUBLE |
| GnbBapmCalculateX ( |
| IN DOUBLE Ts, |
| IN DOUBLE Tau, |
| IN DOUBLE R |
| ) |
| { |
| //X=(R*Ts)/(2*Tau+Ts); |
| DOUBLE Result; |
| Result = (R * Ts) / (2 * Tau + Ts); |
| return (Result * GnbBapmPowerOf (2, 36)) + 0.5; |
| } |
| |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Calaculate Y |
| * |
| * |
| * @param[in] Ts Samplig rate |
| * @param[in] Tau Tau value |
| * @retval Y |
| */ |
| STATIC DOUBLE |
| GnbBapmCalculateY ( |
| IN DOUBLE Ts, |
| IN DOUBLE Tau |
| ) |
| { |
| //Y=(2*Tau-Ts)/(2*Tau+Ts); |
| DOUBLE Result; |
| Result = (2 * Tau - Ts) / (2 * Tau + Ts); |
| return (Result * GnbBapmPowerOf (2, 32)) + 0.5; |
| } |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Set X & Y value |
| * |
| * |
| * @param[in] X X value |
| * @param[in] Y Y value |
| * @param[in] AddrOffset Offset of address |
| * @param[in] StdHeader Standard configuration header |
| */ |
| STATIC VOID |
| GnbBapmSetYAndX ( |
| IN INT32 X, |
| IN INT32 Y, |
| IN UINT32 AddrOffset, |
| IN AMD_CONFIG_PARAMS *StdHeader |
| ) |
| { |
| GnbRegisterWriteTN ( |
| D0F0xBC_x1F480_TYPE, |
| D0F0xBC_x1F480_ADDRESS + AddrOffset, |
| &X, |
| 0, |
| StdHeader |
| ); |
| IDS_HDT_CONSOLE (GNB_TRACE, "X: 0x%08x\n", X); |
| GnbRegisterWriteTN ( |
| D0F0xBC_x1F480_TYPE, |
| D0F0xBC_x1F480_ADDRESS + AddrOffset + 4, |
| &Y, |
| 0, |
| StdHeader |
| ); |
| IDS_HDT_CONSOLE (GNB_TRACE, "Y: 0x%08x\n", Y); |
| } |
| |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Extract INt32 from DOUBLE |
| * |
| * |
| * |
| * @param[in] Value Double value |
| * @retval int32 |
| */ |
| INT32 |
| GnbFpLibDoubleToInt32 ( |
| IN DOUBLE Value |
| ) |
| { |
| INT64 Mantissa; |
| INT32 Exponent; |
| Mantissa = GnbFpLibGetMnts (Value); |
| Exponent = GnbFpLibGetExp (Value); |
| if (Exponent < -64) { |
| Mantissa = 0; |
| } else if (Exponent < 0) { |
| Mantissa >>= - Exponent; |
| } else { |
| Mantissa <<= Exponent; |
| } |
| return (INT32) ((Value < 0) ? - Mantissa : Mantissa); |
| } |
| |
| |
| /*----------------------------------------------------------------------------------------*/ |
| /** |
| * Calcuate BAPM coefficient |
| * |
| * |
| * |
| * @param[in] StdHeader Standard configuration header |
| * @retval AGESA_STATUS |
| */ |
| |
| VOID |
| GnbBapmCalculateCoeffsTN ( |
| IN AMD_CONFIG_PARAMS *StdHeader |
| ) |
| { |
| UINT32 RFuse1; |
| UINT32 TauFuse1; |
| UINT32 Index; |
| DOUBLE R; |
| DOUBLE Tau; |
| DOUBLE Ts; |
| INT32 X; |
| INT32 Y; |
| |
| IDS_HDT_CONSOLE (GNB_TRACE, "GnbBapmCalculateCoeffsTN Enter\n"); |
| |
| LibAmdFinit (); |
| |
| Ts = ((DOUBLE) (D0F0xBC_x1F468_TimerPeriod_Value * D0F0xBC_x1F46C_BapmPeriod_Value) / 100) / 1000000; |
| |
| for (Index = 0; Index < 15; Index++) { |
| GnbRegisterReadTN ( |
| TYPE_D0F0xBC , |
| 0xe01040c4 + Index * 4, |
| &RFuse1, |
| 0, |
| StdHeader |
| ); |
| GnbRegisterReadTN ( |
| TYPE_D0F0xBC , |
| 0xe01040c4 + (Index + 15) * 4, |
| &TauFuse1, |
| 0, |
| StdHeader |
| ); |
| |
| R = GnbBapmDecodeR (RFuse1 & 0x3FF); |
| Tau = GnbBapmDecodeTau (TauFuse1 & 0x3FF); |
| |
| X = GnbFpLibDoubleToInt32 (GnbBapmCalculateX (Ts, Tau, R)); |
| Y = GnbFpLibDoubleToInt32 (GnbBapmCalculateY (Ts, Tau)); |
| GnbBapmSetYAndX (X, Y, Index * 2 * 4, StdHeader); |
| |
| R = GnbBapmDecodeR ((RFuse1 >> 10) & 0x3FF); |
| Tau = GnbBapmDecodeTau ((TauFuse1 >> 10) & 0x3FF); |
| |
| X = GnbFpLibDoubleToInt32 (GnbBapmCalculateX (Ts, Tau, R)); |
| Y = GnbFpLibDoubleToInt32 (GnbBapmCalculateY (Ts, Tau)); |
| |
| GnbBapmSetYAndX (X, Y, (Index * 2 + 30) * 4 , StdHeader); |
| |
| R = GnbBapmDecodeR ((RFuse1 >> 20) & 0x3FF); |
| Tau = GnbBapmDecodeTau ((TauFuse1 >> 20) & 0x3FF); |
| |
| X = GnbFpLibDoubleToInt32 (GnbBapmCalculateX (Ts, Tau, R)); |
| Y = GnbFpLibDoubleToInt32 (GnbBapmCalculateY (Ts, Tau)); |
| |
| GnbBapmSetYAndX (X, Y, (Index * 2 + 60) * 4 , StdHeader); |
| } |
| IDS_HDT_CONSOLE (GNB_TRACE, "GnbBapmCalculateCoeffsTN Exit\n"); |
| } |
| |
| |
| |