1 files changed, 159 insertions, 0 deletions
diff --git a/board/eltec/bab7xx/l2cache.c b/board/eltec/bab7xx/l2cache.c
new file mode 100644
index 0000000..748d515
--- /dev/null
+++ b/board/eltec/bab7xx/l2cache.c
@@ -0,0 +1,159 @@
+/*
+ * (C) Copyright 2002 ELTEC Elektronik AG
+ * Frank Gottschling <fgottschling@eltec.de>
+ *
+ * See file CREDITS for list of people who contributed to this
+ * project.
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
+ * MA 02111-1307 USA
+ */
+
+#include <common.h>
+
+#if defined(CFG_L2_BAB7xx)
+
+#include <pci.h>
+#include <mpc106.h>
+
+/* defines L2CR register for MPC750 */
+
+#define L2CR_E           0x80000000
+#define L2CR_256K        0x10000000
+#define L2CR_512K        0x20000000
+#define L2CR_1024K       0x30000000
+#define L2CR_I           0x00200000
+#define L2CR_SL          0x00008000
+#define L2CR_IP          0x00000001
+
+/*----------------------------------------------------------------------------*/
+
+static int dummy (int dummy)
+{
+    return (dummy+1);
+}
+
+/*----------------------------------------------------------------------------*/
+
+int l2_cache_enable (int l2control)
+{
+    if (l2control)              /* BAB750 */
+    {
+        mtspr(SPRN_L2CR, l2control);
+        mtspr(SPRN_L2CR, (l2control | L2CR_I));
+        while (mfspr(SPRN_L2CR) & L2CR_IP)
+            ;
+        mtspr(SPRN_L2CR, (l2control | L2CR_E));
+        return (0);
+    }
+    else /* BAB740 */
+    {
+        int picr1, picr2, mask;
+        int picr2CacheSize, cacheSize;
+        int *d;
+        int devbusfn;
+        u32 reg32;
+
+        devbusfn = pci_find_device(PCI_VENDOR_ID_MOTOROLA,
+                                   PCI_DEVICE_ID_MOTOROLA_MPC106, 0);
+        if (devbusfn == -1)
+            return (-1);
+
+        pci_read_config_dword  (devbusfn, PCI_PICR2, &reg32);
+        reg32 &= ~PICR2_L2_EN;
+        pci_write_config_dword (devbusfn, PCI_PICR2, reg32);
+
+        /* cache size */
+        if (*(volatile unsigned char *) (CFG_ISA_IO + 0x220) & 0x04)
+        {
+            /* cache size is 512 KB */
+            picr2CacheSize = PICR2_L2_SIZE_512K;
+            cacheSize = 0x80000;
+        }
+        else
+        {
+            /* cache size is 256 KB */
+            picr2CacheSize = PICR2_L2_SIZE_256K;
+            cacheSize = 0x40000;
+        }
+
+        /* setup PICR1 */
+        mask =
+        ~(PICR1_CF_BREAD_WS(1) |
+          PICR1_CF_BREAD_WS(2) |
+          PICR1_CF_CBA(0xff) |
+          PICR1_CF_CACHE_1G |
+          PICR1_CF_DPARK |
+          PICR1_CF_APARK |
+          PICR1_CF_L2_CACHE_MASK);
+
+        picr1 =
+        (PICR1_CF_CBA(0x3f) |
+         PICR1_CF_CACHE_1G |
+         PICR1_CF_APARK |
+         PICR1_CF_DPARK |
+         PICR1_CF_L2_COPY_BACK); /* PICR1_CF_L2_WRITE_THROUGH */
+
+        pci_read_config_dword  (devbusfn, PCI_PICR1, &reg32);
+        reg32 &= mask;
+        reg32 |= picr1;
+        pci_write_config_dword (devbusfn, PCI_PICR1, reg32);
+
+        /*
+         * invalidate all L2 cache
+         */
+        picr2 =
+        (PICR2_CF_INV_MODE |
+         PICR2_CF_HIT_HIGH |
+         PICR2_CF_MOD_HIGH |
+         PICR2_CF_L2_HIT_DELAY(1) |
+         PICR2_CF_APHASE_WS(1) |
+         picr2CacheSize);
+
+        pci_write_config_dword (devbusfn, PCI_PICR2, picr2);
+
+        /*
+         * dummy transactions
+         */
+        for (d=0; d<(int *)(2*cacheSize); d++)
+            dummy(*d);
+
+        pci_write_config_dword (devbusfn, PCI_PICR2,
+                                (picr2 | PICR2_CF_FLUSH_L2));
+
+        /* setup PICR2 */
+        picr2 =
+        (PICR2_CF_FAST_CASTOUT |
+         PICR2_CF_WDATA |
+         PICR2_CF_ADDR_ONLY_DISABLE |
+         PICR2_CF_HIT_HIGH |
+         PICR2_CF_MOD_HIGH |
+         PICR2_L2_UPDATE_EN |
+         PICR2_L2_EN |
+         PICR2_CF_APHASE_WS(1) |
+         PICR2_CF_DATA_RAM_PBURST |
+         PICR2_CF_L2_HIT_DELAY(1) |
+         PICR2_CF_SNOOP_WS(2) |
+         picr2CacheSize);
+
+        pci_write_config_dword (devbusfn, PCI_PICR2, picr2);
+    }
+    return (0);
+}
+
+/*----------------------------------------------------------------------------*/
+
+#endif /* (CFG_L2_BAB7xx) */
+