Function to set Nest Frequency based off DIMM memory capability

-Needed for 32x32GB DIMM support
-Finds max capable frequency of system and all present DIMMs
 and deconfigures any DIMM that cannot run at desired frequency
-If necessary, Sets Nest Freq and triggers SBE update

Change-Id: I9bba92f55f1b67ff4a15d79113f19d39272ec72d
RTC:122884
Depends-on:I1dca7196cd02a2704a238665b73b522c9e103936
Reviewed-on: http://gfw160.aus.stglabs.ibm.com:8080/gerrit/17829
Tested-by: Jenkins Server
Tested-by: Jenkins OP Build CI
Tested-by: FSP CI Jenkins
Tested-by: Jenkins OP HW
Reviewed-by: A. Patrick Williams III <iawillia@us.ibm.com>

1 files changed, 3 insertions, 14 deletions

diff --git a/src/include/util/align.H b/src/include/util/align.H
index e0132b2b7..10a836972 100644
--- a/src/include/util/align.H
+++ b/src/include/util/align.H
@@ -51,18 +51,7 @@
 #define ALIGN_MEGABYTE(u)       (ALIGN_X(u,MEGABYTE))
 #define ALIGN_MEGABYTE_DOWN(u)  (ALIGN_DOWN_X(u,MEGABYTE))
 
-// Returns a number that is aligned to the next highest power of 2 number of
-// pages for the given buffer.
-#define ALIGN_TO_NEXT_POWER_OF_TWO_PAGES(b)   ({\
-    unsigned int v = ALIGN_PAGE(b)/PAGE_SIZE;\
-    v--;\
-    v |= v >> 1;\
-    v |= v >> 2;\
-    v |= v >> 4;\
-    v |= v >> 8;\
-    v |= v >> 16;\
-    v++;\
-    v * PAGE_SIZE;\
-    })
-
+// Return a number rounded to the next power of two.
+#define ALIGN_POW2(u)           ((u&(u-1)) ? 1 << (64 - __builtin_clzl(u)) : u)
+#define ALIGN_POW2_DOWN(u)      (u ? 1 << (63 - __builtin_clzl(u)) : 0)
 #endif