summaryrefslogtreecommitdiffstats
path: root/c/src/lib/libbsp/powerpc/qoriq/startup/mmu-tlb1.S
diff options
context:
space:
mode:
authorSebastian Huber <sebastian.huber@embedded-brains.de>2011-07-21 15:18:02 +0000
committerSebastian Huber <sebastian.huber@embedded-brains.de>2011-07-21 15:18:02 +0000
commitdc0a7df67469f1170cfb95114c03f5980710c1be (patch)
tree202b566de761b1f6090696c89ccf4b787f3dc0cb /c/src/lib/libbsp/powerpc/qoriq/startup/mmu-tlb1.S
parent2011-07-21 Sebastian Huber <sebastian.huber@embedded-brains.de> (diff)
downloadrtems-dc0a7df67469f1170cfb95114c03f5980710c1be.tar.bz2
2011-07-21 Sebastian Huber <sebastian.huber@embedded-brains.de>
PR 1799/bsps * .cvsignore, ChangeLog, Makefile.am, README, bsp_specs, configure.ac, clock/clock-config.c, console/console-config.c, console/uart-bridge-master.c, console/uart-bridge-slave.c, include/.cvsignore, include/bsp.h, include/hwreg_vals.h, include/intercom.h, include/irq.h, include/mmu.h, include/qoriq.h, include/tm27.h, include/tsec-config.h, include/u-boot-config.h, include/uart-bridge.h, irq/irq.c, make/custom/qoriq.inc, make/custom/qoriq_core_0.cfg, make/custom/qoriq_core_1.cfg, make/custom/qoriq_p1020rdb.cfg, network/if_intercom.c, network/network.c, rtc/rtc-config.c, shmsupp/intercom-mpci.c, shmsupp/intercom.c, shmsupp/lock.S, start/start.S, startup/bsppredriverhook.c, startup/bspreset.c, startup/bspstart.c, startup/linkcmds.base, startup/linkcmds.qoriq_core_0, startup/linkcmds.qoriq_core_1, startup/linkcmds.qoriq_p1020rdb, startup/mmu-config.c, startup/mmu-tlb1.S, startup/mmu.c: New files.
Diffstat (limited to 'c/src/lib/libbsp/powerpc/qoriq/startup/mmu-tlb1.S')
-rw-r--r--c/src/lib/libbsp/powerpc/qoriq/startup/mmu-tlb1.S86
1 files changed, 86 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/powerpc/qoriq/startup/mmu-tlb1.S b/c/src/lib/libbsp/powerpc/qoriq/startup/mmu-tlb1.S
new file mode 100644
index 0000000000..390b5474b6
--- /dev/null
+++ b/c/src/lib/libbsp/powerpc/qoriq/startup/mmu-tlb1.S
@@ -0,0 +1,86 @@
+/**
+ * @file
+ *
+ * @ingroup QorIQMMU
+ *
+ * @brief qoriq_tlb1_write() and qoriq_tlb1_invalidate() implementation.
+ */
+
+/*
+ * Copyright (c) 2011 embedded brains GmbH. All rights reserved.
+ *
+ * embedded brains GmbH
+ * Obere Lagerstr. 30
+ * 82178 Puchheim
+ * Germany
+ * <rtems@embedded-brains.de>
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.com/license/LICENSE.
+ *
+ * $Id$
+ */
+
+#include <libcpu/powerpc-utility.h>
+
+ .global qoriq_tlb1_write
+ .global qoriq_tlb1_invalidate
+ .global qoriq_tlb1_ts_0_only
+
+ .section ".bsp_start_text", "ax"
+
+qoriq_tlb1_write:
+ rlwinm r3, r3, 16, 12, 15
+ rlwinm r7, r7, 0, 0, 19
+ oris r3, r3, 0x1000
+ mtspr FSL_EIS_MAS0, r3
+ oris r4, r4, 0xc000
+ rlwinm r8, r8, 8, 20, 23
+ or r8, r4, r8
+ mtspr FSL_EIS_MAS1, r8
+ or r5, r7, r5
+ mtspr FSL_EIS_MAS2, r5
+ or r6, r7, r6
+ mtspr FSL_EIS_MAS3, r6
+ li r0, 0
+ mtspr FSL_EIS_MAS7, r0
+ tlbwe
+ sync
+ isync
+ blr
+
+qoriq_tlb1_invalidate:
+ rlwinm r3, r3, 16, 12, 15
+ oris r3, r3, 0x1000
+ mtspr FSL_EIS_MAS0, r3
+ li r0, 0
+ mtspr FSL_EIS_MAS1, r0
+ mtspr FSL_EIS_MAS2, r0
+ mtspr FSL_EIS_MAS3, r0
+ mtspr FSL_EIS_MAS7, r0
+ tlbwe
+ sync
+ isync
+ blr
+
+qoriq_tlb1_ts_0_only:
+ mflr r12
+ li r11, 16
+ mtctr r11
+ li r11, 0
+2:
+ rlwinm r0, r11, 16, 12, 15
+ oris r0, r0, (FSL_EIS_MAS0_TLBSEL >> 16)
+ mtspr FSL_EIS_MAS0, r0
+ tlbre
+ mfspr r0, FSL_EIS_MAS1
+ andi. r0, r0, FSL_EIS_MAS1_TS
+ beq 1f
+ mr r3, r11
+ bl qoriq_tlb1_invalidate
+1:
+ addi r11, r11, 1
+ bdnz 2b
+ mtlr r12
+ blr