]> git.kernelconcepts.de Git - karo-tx-uboot.git/blobdiff - board/sacsng/clkinit.c
Merge branch 'u-boot-imx/master' into 'u-boot-arm/master'
[karo-tx-uboot.git] / board / sacsng / clkinit.c
index 1e851e14d8820e472b30747d768d5d1ab5db3b8e..3894a5c1aaf04628a2a437f46d7544bf1609df5b 100644 (file)
 
 #include "clkinit.h"
 
+DECLARE_GLOBAL_DATA_PTR;
+
 int Daq64xSampling = 0;
 
 
 void Daq_BRG_Reset(uint brg)
 {
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      volatile uint *brg_ptr;
 
      brg_ptr = (uint *)&immr->im_brgc1;
 
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg -= 4;
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg -= 4;
      }
      brg_ptr += brg;
      *brg_ptr |=  CPM_BRG_RST;
@@ -51,14 +53,14 @@ void Daq_BRG_Reset(uint brg)
 
 void Daq_BRG_Disable(uint brg)
 {
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      volatile uint *brg_ptr;
 
      brg_ptr = (uint *)&immr->im_brgc1;
 
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg -= 4;
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg -= 4;
      }
      brg_ptr += brg;
      *brg_ptr &= ~CPM_BRG_EN;
@@ -66,13 +68,13 @@ void Daq_BRG_Disable(uint brg)
 
 void Daq_BRG_Enable(uint brg)
 {
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      volatile uint *brg_ptr;
 
      brg_ptr = (uint *)&immr->im_brgc1;
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg -= 4;
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg -= 4;
      }
      brg_ptr += brg;
      *brg_ptr |= CPM_BRG_EN;
@@ -80,58 +82,58 @@ void Daq_BRG_Enable(uint brg)
 
 uint Daq_BRG_Get_Div16(uint brg)
 {
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      uint *brg_ptr;
 
      brg_ptr = (uint *)&immr->im_brgc1;
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg -= 4;
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg -= 4;
      }
      brg_ptr += brg;
 
      if (*brg_ptr & CPM_BRG_DIV16) {
-         /* DIV16 active */
-         return (TRUE);
+        /* DIV16 active */
+        return true;
      }
      else {
-         /* DIV16 inactive */
-         return (FALSE);
+        /* DIV16 inactive */
+        return false;
      }
 }
 
 void Daq_BRG_Set_Div16(uint brg, uint div16)
 {
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      uint *brg_ptr;
 
      brg_ptr = (uint *)&immr->im_brgc1;
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg -= 4;
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg -= 4;
      }
      brg_ptr += brg;
 
      if (div16) {
-         /* DIV16 active */
-         *brg_ptr |=  CPM_BRG_DIV16;
+        /* DIV16 active */
+        *brg_ptr |=  CPM_BRG_DIV16;
      }
      else {
-         /* DIV16 inactive */
-         *brg_ptr &= ~CPM_BRG_DIV16;
+        /* DIV16 inactive */
+        *brg_ptr &= ~CPM_BRG_DIV16;
      }
 }
 
 uint Daq_BRG_Get_Count(uint brg)
 {
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      uint *brg_ptr;
      uint brg_cnt;
 
      brg_ptr = (uint *)&immr->im_brgc1;
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg -= 4;
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg -= 4;
      }
      brg_ptr += brg;
 
@@ -143,7 +145,7 @@ uint Daq_BRG_Get_Count(uint brg)
      brg_cnt = (*brg_ptr & CPM_BRG_CD_MASK) >> CPM_BRG_DIV16_SHIFT;
      brg_cnt++;
      if (*brg_ptr & CPM_BRG_DIV16) {
-         brg_cnt *= 16;
+        brg_cnt *= 16;
      }
 
     return (brg_cnt);
@@ -151,13 +153,13 @@ uint Daq_BRG_Get_Count(uint brg)
 
 void Daq_BRG_Set_Count(uint brg, uint brg_cnt)
 {
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      uint *brg_ptr;
 
      brg_ptr = (uint *)&immr->im_brgc1;
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg -= 4;
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg -= 4;
      }
      brg_ptr += brg;
 
@@ -166,14 +168,14 @@ void Daq_BRG_Set_Count(uint brg, uint brg_cnt)
       *         therefore we need to subtract 1 from the count.
       */
      if (brg_cnt > 4096) {
-         /* Prescale = Divide by 16 */
-         *brg_ptr = (*brg_ptr & ~CPM_BRG_CD_MASK)   |
+        /* Prescale = Divide by 16 */
+        *brg_ptr = (*brg_ptr & ~CPM_BRG_CD_MASK)   |
             (((brg_cnt / 16) - 1) << CPM_BRG_DIV16_SHIFT);
         *brg_ptr |= CPM_BRG_DIV16;
      }
      else {
-         /* Prescale = Divide by 1 */
-         *brg_ptr = (*brg_ptr & ~CPM_BRG_CD_MASK) |
+        /* Prescale = Divide by 1 */
+        *brg_ptr = (*brg_ptr & ~CPM_BRG_CD_MASK) |
             ((brg_cnt - 1) << CPM_BRG_DIV16_SHIFT);
         *brg_ptr &= ~CPM_BRG_DIV16;
      }
@@ -181,13 +183,13 @@ void Daq_BRG_Set_Count(uint brg, uint brg_cnt)
 
 uint Daq_BRG_Get_ExtClk(uint brg)
 {
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      uint *brg_ptr;
 
      brg_ptr = (uint *)&immr->im_brgc1;
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg -= 4;
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg -= 4;
      }
      brg_ptr += brg;
 
@@ -201,64 +203,63 @@ char* Daq_BRG_Get_ExtClk_Description(uint brg)
      extc = Daq_BRG_Get_ExtClk(brg);
 
      switch (brg + 1) {
-         case 1:
-         case 2:
-         case 5:
-         case 6: {
-             switch (extc) {
-                 case 0: {
-                     return ("BRG_INT");
-                 }
-                 case 1: {
-                     return ("CLK3");
-                 }
-                 case 2: {
-                     return ("CLK5");
-                 }
-             }
-             return ("??1245??");
-         }
-         case 3:
-         case 4:
-         case 7:
-         case 8: {
-             switch (extc) {
-                 case 0: {
-                     return ("BRG_INT");
-                 }
-                 case 1: {
-                     return ("CLK9");
-                 }
-                 case 2: {
-                     return ("CLK15");
-                 }
-             }
-             return ("??3478??");
-         }
+        case 1:
+        case 2:
+        case 5:
+        case 6: {
+            switch (extc) {
+                case 0: {
+                    return ("BRG_INT");
+                }
+                case 1: {
+                    return ("CLK3");
+                }
+                case 2: {
+                    return ("CLK5");
+                }
+            }
+            return ("??1245??");
+        }
+        case 3:
+        case 4:
+        case 7:
+        case 8: {
+            switch (extc) {
+                case 0: {
+                    return ("BRG_INT");
+                }
+                case 1: {
+                    return ("CLK9");
+                }
+                case 2: {
+                    return ("CLK15");
+                }
+            }
+            return ("??3478??");
+        }
      }
      return ("??9876??");
 }
 
 void Daq_BRG_Set_ExtClk(uint brg, uint extc)
 {
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      uint *brg_ptr;
 
      brg_ptr = (uint *)&immr->im_brgc1;
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg -= 4;
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg -= 4;
      }
      brg_ptr += brg;
 
      *brg_ptr = (*brg_ptr & ~CPM_BRG_EXTC_MASK) |
-                ((extc << CPM_BRG_EXTC_SHIFT) & CPM_BRG_EXTC_MASK);
+               ((extc << CPM_BRG_EXTC_SHIFT) & CPM_BRG_EXTC_MASK);
 }
 
 uint Daq_BRG_Rate(uint brg)
 {
-     DECLARE_GLOBAL_DATA_PTR;
-     volatile immap_t *immr = (immap_t *)CFG_IMMR;
+     volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
      uint *brg_ptr;
      uint brg_cnt;
      uint brg_freq = 0;
@@ -266,15 +267,15 @@ uint Daq_BRG_Rate(uint brg)
      brg_ptr = (uint *)&immr->im_brgc1;
      brg_ptr += brg;
      if (brg >= 5) {
-         brg_ptr = (uint *)&immr->im_brgc5;
-         brg_ptr += (brg - 4);
+        brg_ptr = (uint *)&immr->im_brgc5;
+        brg_ptr += (brg - 4);
      }
 
     brg_cnt = Daq_BRG_Get_Count(brg);
 
     switch (Daq_BRG_Get_ExtClk(brg)) {
-        case CPM_BRG_EXTC_CLK3:
-        case CPM_BRG_EXTC_CLK5: {
+       case CPM_BRG_EXTC_CLK3:
+       case CPM_BRG_EXTC_CLK5: {
            brg_freq = brg_cnt;
            break;
        }
@@ -286,7 +287,6 @@ uint Daq_BRG_Rate(uint brg)
 }
 
 uint Daq_Get_SampleRate(void)
-
 {
      /*
       * Read the BRG's to return the actual sample rate.
@@ -294,68 +294,11 @@ uint Daq_Get_SampleRate(void)
      return (Daq_BRG_Rate(MCLK_BRG) / (MCLK_DIVISOR * SCLK_DIVISOR));
 }
 
-uint Daq_Set_SampleRate(uint rate, uint force)
-
-{
-    DECLARE_GLOBAL_DATA_PTR;
-    uint mclk_divisor; /* MCLK divisor */
-    uint rate_curr;    /* Current sample rate */
-
-    /*
-     * Limit the sample rate to some sensible values.
-     */
-    if (Daq64xSampling) {
-      if (rate > MAX_64x_SAMPLE_RATE) {
-         rate = MAX_64x_SAMPLE_RATE;
-      }
-    }
-    else {
-      if (rate > MAX_128x_SAMPLE_RATE) {
-         rate = MAX_128x_SAMPLE_RATE;
-      }
-    }
-    if (rate < MIN_SAMPLE_RATE) {
-        rate = MIN_SAMPLE_RATE;
-    }
-
-    /* Check to see if we are really changing rates */
-    rate_curr = Daq_Get_SampleRate();
-    if ((rate != rate_curr) || force) {
-        /*
-        * Dynamically adjust MCLK based on the new sample rate.
-        */
-
-        /* Compute the divisors */
-        mclk_divisor = BRG_INT_CLK / (rate * MCLK_DIVISOR * SCLK_DIVISOR);
-
-       /* Setup MCLK */
-       Daq_BRG_Set_Count(MCLK_BRG, mclk_divisor);
-
-       /* Setup SCLK */
-#       ifdef RUN_SCLK_ON_BRG_INT
-          Daq_BRG_Set_Count(SCLK_BRG, mclk_divisor * MCLK_DIVISOR);
-#       else
-          Daq_BRG_Set_Count(SCLK_BRG, MCLK_DIVISOR);
-#       endif
-
-#       ifdef RUN_LRCLK_ON_BRG_INT
-           Daq_BRG_Set_Count(LRCLK_BRG,
-                             mclk_divisor * MCLK_DIVISOR * SCLK_DIVISOR);
-#       else
-           Daq_BRG_Set_Count(LRCLK_BRG, SCLK_DIVISOR);
-#       endif
-
-       /* Read the BRG's to return the actual sample rate. */
-       rate_curr = Daq_Get_SampleRate();
-    }
-
-    return (rate_curr);
-}
-
 void Daq_Init_Clocks(int sample_rate, int sample_64x)
-
 {
-    volatile ioport_t *iopa = ioport_addr((immap_t *)CFG_IMMR, 0 /* port A */);
+    volatile ioport_t *iopa = ioport_addr((immap_t *)CONFIG_SYS_IMMR, 0 /* port A */);
+    uint mclk_divisor; /* MCLK divisor */
+    int  flag;         /* Interrupt state */
 
     /* Save off the clocking data */
     Daq64xSampling = sample_64x;
@@ -363,18 +306,11 @@ void Daq_Init_Clocks(int sample_rate, int sample_64x)
     /*
      * Limit the sample rate to some sensible values.
      */
-    if (Daq64xSampling) {
-      if (sample_rate > MAX_64x_SAMPLE_RATE) {
-         sample_rate = MAX_64x_SAMPLE_RATE;
-      }
-    }
-    else {
-      if (sample_rate > MAX_128x_SAMPLE_RATE) {
-         sample_rate = MAX_128x_SAMPLE_RATE;
-      }
+    if (sample_rate > MAX_64x_SAMPLE_RATE) {
+       sample_rate = MAX_64x_SAMPLE_RATE;
     }
     if (sample_rate < MIN_SAMPLE_RATE) {
-        sample_rate = MIN_SAMPLE_RATE;
+       sample_rate = MIN_SAMPLE_RATE;
     }
 
     /*
@@ -386,20 +322,53 @@ void Daq_Init_Clocks(int sample_rate, int sample_64x)
 
     /* Setup SCLK */
 #   ifdef RUN_SCLK_ON_BRG_INT
-        Daq_BRG_Set_ExtClk(SCLK_BRG, CPM_BRG_EXTC_BRGCLK);
+       Daq_BRG_Set_ExtClk(SCLK_BRG, CPM_BRG_EXTC_BRGCLK);
 #   else
-        Daq_BRG_Set_ExtClk(SCLK_BRG, CPM_BRG_EXTC_CLK9);
+       Daq_BRG_Set_ExtClk(SCLK_BRG, CPM_BRG_EXTC_CLK9);
 #   endif
 
     /* Setup LRCLK */
 #   ifdef RUN_LRCLK_ON_BRG_INT
-        Daq_BRG_Set_ExtClk(LRCLK_BRG, CPM_BRG_EXTC_BRGCLK);
+       Daq_BRG_Set_ExtClk(LRCLK_BRG, CPM_BRG_EXTC_BRGCLK);
+#   else
+       Daq_BRG_Set_ExtClk(LRCLK_BRG, CPM_BRG_EXTC_CLK5);
+#   endif
+
+    /*
+     * Dynamically adjust MCLK based on the new sample rate.
+     */
+
+    /* Compute the divisors */
+    mclk_divisor = BRG_INT_CLK / (sample_rate * MCLK_DIVISOR * SCLK_DIVISOR);
+
+    /*
+     * Disable interrupt and save the current state
+     */
+    flag = disable_interrupts();
+
+    /* Setup MCLK */
+    Daq_BRG_Set_Count(MCLK_BRG, mclk_divisor);
+
+    /* Setup SCLK */
+#   ifdef RUN_SCLK_ON_BRG_INT
+       Daq_BRG_Set_Count(SCLK_BRG, mclk_divisor * MCLK_DIVISOR);
+#   else
+       Daq_BRG_Set_Count(SCLK_BRG, MCLK_DIVISOR);
+#   endif
+
+#   ifdef RUN_LRCLK_ON_BRG_INT
+       Daq_BRG_Set_Count(LRCLK_BRG,
+                         mclk_divisor * MCLK_DIVISOR * SCLK_DIVISOR);
 #   else
-        Daq_BRG_Set_ExtClk(LRCLK_BRG, CPM_BRG_EXTC_CLK5);
+       Daq_BRG_Set_Count(LRCLK_BRG, SCLK_DIVISOR);
 #   endif
 
-    /* Setup the BRG rates */
-    Daq_Set_SampleRate(sample_rate, TRUE);
+    /*
+     * Restore the Interrupt state
+     */
+     if (flag) {
+        enable_interrupts();
+     }
 
     /* Enable the clock drivers */
     iopa->pdat &= ~SLRCLK_EN_MASK;
@@ -409,124 +378,284 @@ void Daq_Stop_Clocks(void)
 
 {
 #ifdef TIGHTEN_UP_BRG_TIMING
-    volatile immap_t *immr = (immap_t *)CFG_IMMR;
+    volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
+    register uint mclk_brg;       /* MCLK  BRG value */
+    register uint sclk_brg;       /* SCLK  BRG value */
+    register uint lrclk_brg;      /* LRCLK BRG value */
+    unsigned long flag;           /* Interrupt flags */
 #endif
 
 #   ifdef TIGHTEN_UP_BRG_TIMING
-        /*
-         * Reset MCLK BRG
-         */
+       /*
+        * Obtain MCLK BRG reset/disabled value
+        */
 #       if (MCLK_BRG == 0)
-            immr->im_brgc1 |=  CPM_BRG_RST;
-            immr->im_brgc1 &= ~CPM_BRG_RST;
+           mclk_brg = (*IM_BRGC1 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 1)
-            immr->im_brgc2 |=  CPM_BRG_RST;
-            immr->im_brgc2 &= ~CPM_BRG_RST;
+           mclk_brg = (*IM_BRGC2 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 2)
-            immr->im_brgc3 |=  CPM_BRG_RST;
-            immr->im_brgc3 &= ~CPM_BRG_RST;
+           mclk_brg = (*IM_BRGC3 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 3)
-            immr->im_brgc4 |=  CPM_BRG_RST;
-            immr->im_brgc4 &= ~CPM_BRG_RST;
+           mclk_brg = (*IM_BRGC4 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 4)
-            immr->im_brgc5 |=  CPM_BRG_RST;
-            immr->im_brgc5 &= ~CPM_BRG_RST;
+           mclk_brg = (*IM_BRGC5 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 5)
-            immr->im_brgc6 |=  CPM_BRG_RST;
-            immr->im_brgc6 &= ~CPM_BRG_RST;
+           mclk_brg = (*IM_BRGC6 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 6)
-            immr->im_brgc7 |=  CPM_BRG_RST;
-            immr->im_brgc7 &= ~CPM_BRG_RST;
+           mclk_brg = (*IM_BRGC7 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 7)
-            immr->im_brgc8 |=  CPM_BRG_RST;
-            immr->im_brgc8 &= ~CPM_BRG_RST;
+           mclk_brg = (*IM_BRGC8 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 
-        /*
-         * Reset SCLK BRG
-         */
+       /*
+        * Obtain SCLK BRG reset/disabled value
+        */
 #       if (SCLK_BRG == 0)
-            immr->im_brgc1 |=  CPM_BRG_RST;
-            immr->im_brgc1 &= ~CPM_BRG_RST;
+           sclk_brg = (*IM_BRGC1 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 1)
-            immr->im_brgc2 |=  CPM_BRG_RST;
-            immr->im_brgc2 &= ~CPM_BRG_RST;
+           sclk_brg = (*IM_BRGC2 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 2)
-            immr->im_brgc3 |=  CPM_BRG_RST;
-            immr->im_brgc3 &= ~CPM_BRG_RST;
+           sclk_brg = (*IM_BRGC3 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 3)
-            immr->im_brgc4 |=  CPM_BRG_RST;
-            immr->im_brgc4 &= ~CPM_BRG_RST;
+           sclk_brg = (*IM_BRGC4 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 4)
-            immr->im_brgc5 |=  CPM_BRG_RST;
-            immr->im_brgc5 &= ~CPM_BRG_RST;
+           sclk_brg = (*IM_BRGC5 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 5)
-            immr->im_brgc6 |=  CPM_BRG_RST;
-            immr->im_brgc6 &= ~CPM_BRG_RST;
+           sclk_brg = (*IM_BRGC6 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 6)
-            immr->im_brgc7 |=  CPM_BRG_RST;
-            immr->im_brgc7 &= ~CPM_BRG_RST;
+           sclk_brg = (*IM_BRGC7 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 7)
-            immr->im_brgc8 |=  CPM_BRG_RST;
-            immr->im_brgc8 &= ~CPM_BRG_RST;
+           sclk_brg = (*IM_BRGC8 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 
-        /*
-         * Reset LRCLK BRG
-         */
+       /*
+        * Obtain LRCLK BRG reset/disabled value
+        */
 #       if (LRCLK_BRG == 0)
-            immr->im_brgc1 |=  CPM_BRG_RST;
-            immr->im_brgc1 &= ~CPM_BRG_RST;
+           lrclk_brg = (*IM_BRGC1 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 1)
-            immr->im_brgc2 |=  CPM_BRG_RST;
-            immr->im_brgc2 &= ~CPM_BRG_RST;
+           lrclk_brg = (*IM_BRGC2 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 2)
-            immr->im_brgc3 |=  CPM_BRG_RST;
-            immr->im_brgc3 &= ~CPM_BRG_RST;
+           lrclk_brg = (*IM_BRGC3 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 3)
-            immr->im_brgc4 |=  CPM_BRG_RST;
-            immr->im_brgc4 &= ~CPM_BRG_RST;
+           lrclk_brg = (*IM_BRGC4 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 4)
-            immr->im_brgc5 |=  CPM_BRG_RST;
-            immr->im_brgc5 &= ~CPM_BRG_RST;
+           lrclk_brg = (*IM_BRGC5 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 5)
-            immr->im_brgc6 |=  CPM_BRG_RST;
-            immr->im_brgc6 &= ~CPM_BRG_RST;
+           lrclk_brg = (*IM_BRGC6 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 6)
-            immr->im_brgc7 |=  CPM_BRG_RST;
-            immr->im_brgc7 &= ~CPM_BRG_RST;
+           lrclk_brg = (*IM_BRGC7 | CPM_BRG_RST) & ~CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 7)
-            immr->im_brgc8 |=  CPM_BRG_RST;
-            immr->im_brgc8 &= ~CPM_BRG_RST;
+           lrclk_brg = (*IM_BRGC8 | CPM_BRG_RST) & ~CPM_BRG_EN;
+#       endif
+
+       /*
+        * Disable interrupt and save the current state
+        */
+       flag = disable_interrupts();
+
+       /*
+        * Set reset on MCLK BRG
+        */
+#       if (MCLK_BRG == 0)
+           *IM_BRGC1 = mclk_brg;
+#       endif
+#       if (MCLK_BRG == 1)
+           *IM_BRGC2 = mclk_brg;
+#       endif
+#       if (MCLK_BRG == 2)
+           *IM_BRGC3 = mclk_brg;
+#       endif
+#       if (MCLK_BRG == 3)
+           *IM_BRGC4 = mclk_brg;
+#       endif
+#       if (MCLK_BRG == 4)
+           *IM_BRGC5 = mclk_brg;
+#       endif
+#       if (MCLK_BRG == 5)
+           *IM_BRGC6 = mclk_brg;
+#       endif
+#       if (MCLK_BRG == 6)
+           *IM_BRGC7 = mclk_brg;
+#       endif
+#       if (MCLK_BRG == 7)
+           *IM_BRGC8 = mclk_brg;
+#       endif
+
+       /*
+        * Set reset on SCLK BRG
+        */
+#       if (SCLK_BRG == 0)
+           *IM_BRGC1 = sclk_brg;
+#       endif
+#       if (SCLK_BRG == 1)
+           *IM_BRGC2 = sclk_brg;
+#       endif
+#       if (SCLK_BRG == 2)
+           *IM_BRGC3 = sclk_brg;
+#       endif
+#       if (SCLK_BRG == 3)
+           *IM_BRGC4 = sclk_brg;
+#       endif
+#       if (SCLK_BRG == 4)
+           *IM_BRGC5 = sclk_brg;
+#       endif
+#       if (SCLK_BRG == 5)
+           *IM_BRGC6 = sclk_brg;
+#       endif
+#       if (SCLK_BRG == 6)
+           *IM_BRGC7 = sclk_brg;
 #       endif
+#       if (SCLK_BRG == 7)
+           *IM_BRGC8 = sclk_brg;
+#       endif
+
+       /*
+        * Set reset on LRCLK BRG
+        */
+#       if (LRCLK_BRG == 0)
+           *IM_BRGC1 = lrclk_brg;
+#       endif
+#       if (LRCLK_BRG == 1)
+           *IM_BRGC2 = lrclk_brg;
+#       endif
+#       if (LRCLK_BRG == 2)
+           *IM_BRGC3 = lrclk_brg;
+#       endif
+#       if (LRCLK_BRG == 3)
+           *IM_BRGC4 = lrclk_brg;
+#       endif
+#       if (LRCLK_BRG == 4)
+           *IM_BRGC5 = lrclk_brg;
+#       endif
+#       if (LRCLK_BRG == 5)
+           *IM_BRGC6 = lrclk_brg;
+#       endif
+#       if (LRCLK_BRG == 6)
+           *IM_BRGC7 = lrclk_brg;
+#       endif
+#       if (LRCLK_BRG == 7)
+           *IM_BRGC8 = lrclk_brg;
+#       endif
+
+       /*
+        * Clear reset on MCLK BRG
+        */
+#       if (MCLK_BRG == 0)
+           *IM_BRGC1 = mclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (MCLK_BRG == 1)
+           *IM_BRGC2 = mclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (MCLK_BRG == 2)
+           *IM_BRGC3 = mclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (MCLK_BRG == 3)
+           *IM_BRGC4 = mclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (MCLK_BRG == 4)
+           *IM_BRGC5 = mclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (MCLK_BRG == 5)
+           *IM_BRGC6 = mclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (MCLK_BRG == 6)
+           *IM_BRGC7 = mclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (MCLK_BRG == 7)
+           *IM_BRGC8 = mclk_brg & ~CPM_BRG_RST;
+#       endif
+
+       /*
+        * Clear reset on SCLK BRG
+        */
+#       if (SCLK_BRG == 0)
+           *IM_BRGC1 = sclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (SCLK_BRG == 1)
+           *IM_BRGC2 = sclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (SCLK_BRG == 2)
+           *IM_BRGC3 = sclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (SCLK_BRG == 3)
+           *IM_BRGC4 = sclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (SCLK_BRG == 4)
+           *IM_BRGC5 = sclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (SCLK_BRG == 5)
+           *IM_BRGC6 = sclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (SCLK_BRG == 6)
+           *IM_BRGC7 = sclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (SCLK_BRG == 7)
+           *IM_BRGC8 = sclk_brg & ~CPM_BRG_RST;
+#       endif
+
+       /*
+        * Clear reset on LRCLK BRG
+        */
+#       if (LRCLK_BRG == 0)
+           *IM_BRGC1 = lrclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (LRCLK_BRG == 1)
+           *IM_BRGC2 = lrclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (LRCLK_BRG == 2)
+           *IM_BRGC3 = lrclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (LRCLK_BRG == 3)
+           *IM_BRGC4 = lrclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (LRCLK_BRG == 4)
+           *IM_BRGC5 = lrclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (LRCLK_BRG == 5)
+           *IM_BRGC6 = lrclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (LRCLK_BRG == 6)
+           *IM_BRGC7 = lrclk_brg & ~CPM_BRG_RST;
+#       endif
+#       if (LRCLK_BRG == 7)
+           *IM_BRGC8 = lrclk_brg & ~CPM_BRG_RST;
+#       endif
+
+       /*
+        * Restore the Interrupt state
+        */
+       if (flag) {
+           enable_interrupts();
+       }
 #   else
-        /*
-         * Reset the clocks
-         */
-        Daq_BRG_Reset(MCLK_BRG);
-        Daq_BRG_Reset(SCLK_BRG);
-        Daq_BRG_Reset(LRCLK_BRG);
+       /*
+        * Reset the clocks
+        */
+       Daq_BRG_Reset(MCLK_BRG);
+       Daq_BRG_Reset(SCLK_BRG);
+       Daq_BRG_Reset(LRCLK_BRG);
 #   endif
 }
 
@@ -534,101 +663,101 @@ void Daq_Start_Clocks(int sample_rate)
 
 {
 #ifdef TIGHTEN_UP_BRG_TIMING
-    volatile immap_t *immr = (immap_t *)CFG_IMMR;
+    volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
 
-    uint          mclk_brg;       /* MCLK  BRG value */
-    uint          sclk_brg;       /* SCLK  BRG value */
+    register uint mclk_brg;       /* MCLK  BRG value */
+    register uint sclk_brg;       /* SCLK  BRG value */
+    register uint temp_lrclk_brg; /* Temporary LRCLK BRG value */
+    register uint real_lrclk_brg; /* Permanent LRCLK BRG value */
     uint          lrclk_brg;      /* LRCLK BRG value */
-    uint          temp_lrclk_brg; /* Temporary LRCLK BRG value */
-    uint         real_lrclk_brg; /* Permanent LRCLK BRG value */
     unsigned long flags;          /* Interrupt flags */
     uint          sclk_cnt;       /* SCLK count */
     uint          delay_cnt;      /* Delay count */
 #endif
 
 #   ifdef TIGHTEN_UP_BRG_TIMING
-        /*
-         * Obtain the enabled MCLK BRG value
-         */
+       /*
+        * Obtain the enabled MCLK BRG value
+        */
 #       if (MCLK_BRG == 0)
-            mclk_brg = (immr->im_brgc1 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           mclk_brg = (*IM_BRGC1 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 1)
-            mclk_brg = (immr->im_brgc2 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           mclk_brg = (*IM_BRGC2 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 2)
-            mclk_brg = (immr->im_brgc3 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           mclk_brg = (*IM_BRGC3 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 3)
-            mclk_brg = (immr->im_brgc4 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           mclk_brg = (*IM_BRGC4 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 4)
-            mclk_brg = (immr->im_brgc5 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           mclk_brg = (*IM_BRGC5 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 5)
-            mclk_brg = (immr->im_brgc6 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           mclk_brg = (*IM_BRGC6 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 6)
-            mclk_brg = (immr->im_brgc7 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           mclk_brg = (*IM_BRGC7 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (MCLK_BRG == 7)
-            mclk_brg = (immr->im_brgc8 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           mclk_brg = (*IM_BRGC8 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 
-        /*
-         * Obtain the enabled SCLK BRG value
-         */
+       /*
+        * Obtain the enabled SCLK BRG value
+        */
 #       if (SCLK_BRG == 0)
-            sclk_brg = (immr->im_brgc1 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           sclk_brg = (*IM_BRGC1 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 1)
-            sclk_brg = (immr->im_brgc2 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           sclk_brg = (*IM_BRGC2 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 2)
-            sclk_brg = (immr->im_brgc3 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           sclk_brg = (*IM_BRGC3 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 3)
-            sclk_brg = (immr->im_brgc4 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           sclk_brg = (*IM_BRGC4 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 4)
-            sclk_brg = (immr->im_brgc5 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           sclk_brg = (*IM_BRGC5 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 5)
-            sclk_brg = (immr->im_brgc6 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           sclk_brg = (*IM_BRGC6 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 6)
-            sclk_brg = (immr->im_brgc7 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           sclk_brg = (*IM_BRGC7 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (SCLK_BRG == 7)
-            sclk_brg = (immr->im_brgc8 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           sclk_brg = (*IM_BRGC8 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 
-        /*
-         * Obtain the enabled LRCLK BRG value
-         */
+       /*
+        * Obtain the enabled LRCLK BRG value
+        */
 #       if (LRCLK_BRG == 0)
-            lrclk_brg = (immr->im_brgc1 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           lrclk_brg = (*IM_BRGC1 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 1)
-            lrclk_brg = (immr->im_brgc2 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           lrclk_brg = (*IM_BRGC2 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 2)
-            lrclk_brg = (immr->im_brgc3 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           lrclk_brg = (*IM_BRGC3 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 3)
-            lrclk_brg = (immr->im_brgc4 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           lrclk_brg = (*IM_BRGC4 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 4)
-            lrclk_brg = (immr->im_brgc5 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           lrclk_brg = (*IM_BRGC5 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 5)
-            lrclk_brg = (immr->im_brgc6 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           lrclk_brg = (*IM_BRGC6 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 6)
-            lrclk_brg = (immr->im_brgc7 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           lrclk_brg = (*IM_BRGC7 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 #       if (LRCLK_BRG == 7)
-            lrclk_brg = (immr->im_brgc8 & ~CPM_BRG_RST) | CPM_BRG_EN;
+           lrclk_brg = (*IM_BRGC8 & ~CPM_BRG_RST) | CPM_BRG_EN;
 #       endif
 
        /* Save off the real LRCLK value */
@@ -638,148 +767,160 @@ void Daq_Start_Clocks(int sample_rate)
        sclk_cnt  = ((sclk_brg & 0x00001FFE) >> 1) + 1;
 
        /* Compute the delay as a function of SCLK count */
-        delay_cnt = ((sclk_cnt / 4) - 2) * 10 + 6;
-       if (sample_rate == 43402) {
+       delay_cnt = ((sclk_cnt / 4) - 2) * 10 + 6;
+       if (DaqSampleRate == 43402) {
          delay_cnt++;
        }
 
-        /* Clear out the count */
+       /* Clear out the count */
        temp_lrclk_brg = sclk_brg & ~0x00001FFE;
 
-        /* Insert the count */
+       /* Insert the count */
        temp_lrclk_brg |= ((delay_cnt + (sclk_cnt / 2) - 1) << 1) &  0x00001FFE;
 
-        /*
-         * Enable MCLK BRG
-         */
+       /*
+        * Disable interrupt and save the current state
+        */
+       flag = disable_interrupts();
+
+       /*
+        * Enable MCLK BRG
+        */
 #       if (MCLK_BRG == 0)
-            immr->im_brgc1 = mclk_brg;
+           *IM_BRGC1 = mclk_brg;
 #       endif
 #       if (MCLK_BRG == 1)
-            immr->im_brgc2 = mclk_brg;
+           *IM_BRGC2 = mclk_brg;
 #       endif
 #       if (MCLK_BRG == 2)
-            immr->im_brgc3 = mclk_brg;
+           *IM_BRGC3 = mclk_brg;
 #       endif
 #       if (MCLK_BRG == 3)
-            immr->im_brgc4 = mclk_brg;
+           *IM_BRGC4 = mclk_brg;
 #       endif
 #       if (MCLK_BRG == 4)
-            immr->im_brgc5 = mclk_brg;
+           *IM_BRGC5 = mclk_brg;
 #       endif
 #       if (MCLK_BRG == 5)
-            immr->im_brgc6 = mclk_brg;
+           *IM_BRGC6 = mclk_brg;
 #       endif
 #       if (MCLK_BRG == 6)
-            immr->im_brgc7 = mclk_brg;
+           *IM_BRGC7 = mclk_brg;
 #       endif
 #       if (MCLK_BRG == 7)
-            immr->im_brgc8 = mclk_brg;
+           *IM_BRGC8 = mclk_brg;
 #       endif
 
-        /*
-         * Enable SCLK BRG
-         */
+       /*
+        * Enable SCLK BRG
+        */
 #       if (SCLK_BRG == 0)
-            immr->im_brgc1 = sclk_brg;
+           *IM_BRGC1 = sclk_brg;
 #       endif
 #       if (SCLK_BRG == 1)
-            immr->im_brgc2 = sclk_brg;
+           *IM_BRGC2 = sclk_brg;
 #       endif
 #       if (SCLK_BRG == 2)
-            immr->im_brgc3 = sclk_brg;
+           *IM_BRGC3 = sclk_brg;
 #       endif
 #       if (SCLK_BRG == 3)
-            immr->im_brgc4 = sclk_brg;
+           *IM_BRGC4 = sclk_brg;
 #       endif
 #       if (SCLK_BRG == 4)
-            immr->im_brgc5 = sclk_brg;
+           *IM_BRGC5 = sclk_brg;
 #       endif
 #       if (SCLK_BRG == 5)
-            immr->im_brgc6 = sclk_brg;
+           *IM_BRGC6 = sclk_brg;
 #       endif
 #       if (SCLK_BRG == 6)
-            immr->im_brgc7 = sclk_brg;
+           *IM_BRGC7 = sclk_brg;
 #       endif
 #       if (SCLK_BRG == 7)
-            immr->im_brgc8 = sclk_brg;
+           *IM_BRGC8 = sclk_brg;
 #       endif
 
-        /*
-         * Enable LRCLK BRG (1st time - temporary)
-         */
+       /*
+        * Enable LRCLK BRG (1st time - temporary)
+        */
 #       if (LRCLK_BRG == 0)
-             immr->im_brgc1 = temp_lrclk_brg;
+           *IM_BRGC1 = temp_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 1)
-             immr->im_brgc2 = temp_lrclk_brg;
+           *IM_BRGC2 = temp_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 2)
-             immr->im_brgc3 = temp_lrclk_brg;
+           *IM_BRGC3 = temp_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 3)
-             immr->im_brgc4 = temp_lrclk_brg;
+           *IM_BRGC4 = temp_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 4)
-             immr->im_brgc5 = temp_lrclk_brg;
+           *IM_BRGC5 = temp_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 5)
-             immr->im_brgc6 = temp_lrclk_brg;
+           *IM_BRGC6 = temp_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 6)
-             immr->im_brgc7 = temp_lrclk_brg;
+           *IM_BRGC7 = temp_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 7)
-             immr->im_brgc8 = temp_lrclk_brg;
+           *IM_BRGC8 = temp_lrclk_brg;
 #       endif
 
-        /*
-         * Enable LRCLK BRG (2nd time - permanent)
-         */
+       /*
+        * Enable LRCLK BRG (2nd time - permanent)
+        */
 #       if (LRCLK_BRG == 0)
-             immr->im_brgc1 = real_lrclk_brg;
+           *IM_BRGC1 = real_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 1)
-             immr->im_brgc2 = real_lrclk_brg;
+           *IM_BRGC2 = real_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 2)
-             immr->im_brgc3 = real_lrclk_brg;
+           *IM_BRGC3 = real_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 3)
-             immr->im_brgc4 = real_lrclk_brg;
+           *IM_BRGC4 = real_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 4)
-             immr->im_brgc5 = real_lrclk_brg;
+           *IM_BRGC5 = real_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 5)
-             immr->im_brgc6 = real_lrclk_brg;
+           *IM_BRGC6 = real_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 6)
-             immr->im_brgc7 = real_lrclk_brg;
+           *IM_BRGC7 = real_lrclk_brg;
 #       endif
 #       if (LRCLK_BRG == 7)
-             immr->im_brgc8 = real_lrclk_brg;
+           *IM_BRGC8 = real_lrclk_brg;
 #       endif
+
+       /*
+        * Restore the Interrupt state
+        */
+       if (flag) {
+           enable_interrupts();
+       }
 #   else
-        /*
-         * Enable the clocks
-         */
-        Daq_BRG_Enable(LRCLK_BRG);
-        Daq_BRG_Enable(SCLK_BRG);
-        Daq_BRG_Enable(MCLK_BRG);
+       /*
+        * Enable the clocks
+        */
+       Daq_BRG_Enable(LRCLK_BRG);
+       Daq_BRG_Enable(SCLK_BRG);
+       Daq_BRG_Enable(MCLK_BRG);
 #   endif
 }
 
 void Daq_Display_Clocks(void)
 
 {
-    volatile immap_t *immr = (immap_t *)CFG_IMMR;
+    volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
     uint mclk_divisor; /* Detected MCLK divisor */
     uint sclk_divisor; /* Detected SCLK divisor */
 
     printf("\nBRG:\n");
     if (immr->im_brgc4 != 0) {
-        printf("\tbrgc4\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  MCLK\n",
+       printf("\tbrgc4\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  MCLK\n",
               immr->im_brgc4,
               (uint)&(immr->im_brgc4),
               Daq_BRG_Get_Count(3),
@@ -787,7 +928,7 @@ void Daq_Display_Clocks(void)
               Daq_BRG_Get_ExtClk_Description(3));
     }
     if (immr->im_brgc8 != 0) {
-        printf("\tbrgc8\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  SCLK\n",
+       printf("\tbrgc8\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  SCLK\n",
               immr->im_brgc8,
               (uint)&(immr->im_brgc8),
               Daq_BRG_Get_Count(7),
@@ -795,7 +936,7 @@ void Daq_Display_Clocks(void)
               Daq_BRG_Get_ExtClk_Description(7));
     }
     if (immr->im_brgc6 != 0) {
-        printf("\tbrgc6\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  LRCLK\n",
+       printf("\tbrgc6\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  LRCLK\n",
               immr->im_brgc6,
               (uint)&(immr->im_brgc6),
               Daq_BRG_Get_Count(5),
@@ -803,7 +944,7 @@ void Daq_Display_Clocks(void)
               Daq_BRG_Get_ExtClk_Description(5));
     }
     if (immr->im_brgc1 != 0) {
-        printf("\tbrgc1\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  SMC1\n",
+       printf("\tbrgc1\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  SMC1\n",
               immr->im_brgc1,
               (uint)&(immr->im_brgc1),
               Daq_BRG_Get_Count(0),
@@ -811,7 +952,7 @@ void Daq_Display_Clocks(void)
               Daq_BRG_Get_ExtClk_Description(0));
     }
     if (immr->im_brgc2 != 0) {
-        printf("\tbrgc2\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  SMC2\n",
+       printf("\tbrgc2\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  SMC2\n",
               immr->im_brgc2,
               (uint)&(immr->im_brgc2),
               Daq_BRG_Get_Count(1),
@@ -819,7 +960,7 @@ void Daq_Display_Clocks(void)
               Daq_BRG_Get_ExtClk_Description(1));
     }
     if (immr->im_brgc3 != 0) {
-        printf("\tbrgc3\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  SCC1\n",
+       printf("\tbrgc3\t0x%08x @ 0x%08x, %5d count, %d extc, %8s,  SCC1\n",
               immr->im_brgc3,
               (uint)&(immr->im_brgc3),
               Daq_BRG_Get_Count(2),
@@ -827,7 +968,7 @@ void Daq_Display_Clocks(void)
               Daq_BRG_Get_ExtClk_Description(2));
     }
     if (immr->im_brgc5 != 0) {
-        printf("\tbrgc5\t0x%08x @ 0x%08x, %5d count, %d extc, %8s\n",
+       printf("\tbrgc5\t0x%08x @ 0x%08x, %5d count, %d extc, %8s\n",
               immr->im_brgc5,
               (uint)&(immr->im_brgc5),
               Daq_BRG_Get_Count(4),
@@ -835,7 +976,7 @@ void Daq_Display_Clocks(void)
               Daq_BRG_Get_ExtClk_Description(4));
     }
     if (immr->im_brgc7 != 0) {
-        printf("\tbrgc7\t0x%08x @ 0x%08x, %5d count, %d extc, %8s\n",
+       printf("\tbrgc7\t0x%08x @ 0x%08x, %5d count, %d extc, %8s\n",
               immr->im_brgc7,
               (uint)&(immr->im_brgc7),
               Daq_BRG_Get_Count(6),
@@ -844,14 +985,14 @@ void Daq_Display_Clocks(void)
     }
 
 #   ifdef RUN_SCLK_ON_BRG_INT
-        mclk_divisor = Daq_BRG_Rate(MCLK_BRG) / Daq_BRG_Rate(SCLK_BRG);
+       mclk_divisor = Daq_BRG_Rate(MCLK_BRG) / Daq_BRG_Rate(SCLK_BRG);
 #   else
-        mclk_divisor = Daq_BRG_Get_Count(SCLK_BRG);
+       mclk_divisor = Daq_BRG_Get_Count(SCLK_BRG);
 #   endif
 #   ifdef RUN_LRCLK_ON_BRG_INT
-        sclk_divisor = Daq_BRG_Rate(SCLK_BRG) / Daq_BRG_Rate(LRCLK_BRG);
+       sclk_divisor = Daq_BRG_Rate(SCLK_BRG) / Daq_BRG_Rate(LRCLK_BRG);
 #   else
-        sclk_divisor = Daq_BRG_Get_Count(LRCLK_BRG);
+       sclk_divisor = Daq_BRG_Get_Count(LRCLK_BRG);
 #   endif
 
     printf("\nADC/DAC Clocking (%d/%d):\n", sclk_divisor, mclk_divisor);
@@ -860,23 +1001,23 @@ void Daq_Display_Clocks(void)
           mclk_divisor,
           mclk_divisor * sclk_divisor);
 #   ifdef RUN_SCLK_ON_BRG_INT
-        printf("\tSCLK  %8d Hz, or %3dx LRCLK\n",
+       printf("\tSCLK  %8d Hz, or %3dx LRCLK\n",
               Daq_BRG_Rate(SCLK_BRG),
               sclk_divisor);
 #   else
-        printf("\tSCLK  %8d Hz, or %3dx LRCLK\n",
+       printf("\tSCLK  %8d Hz, or %3dx LRCLK\n",
               Daq_BRG_Rate(MCLK_BRG) / mclk_divisor,
               sclk_divisor);
 #   endif
 #   ifdef RUN_LRCLK_ON_BRG_INT
-        printf("\tLRCLK %8d Hz\n",
+       printf("\tLRCLK %8d Hz\n",
               Daq_BRG_Rate(LRCLK_BRG));
 #   else
 #       ifdef RUN_SCLK_ON_BRG_INT
-            printf("\tLRCLK %8d Hz\n",
+           printf("\tLRCLK %8d Hz\n",
                   Daq_BRG_Rate(SCLK_BRG) / sclk_divisor);
 #       else
-            printf("\tLRCLK %8d Hz\n",
+           printf("\tLRCLK %8d Hz\n",
                   Daq_BRG_Rate(MCLK_BRG) / (mclk_divisor * sclk_divisor));
 #       endif
 #   endif