summaryrefslogtreecommitdiffstats
path: root/libgloss/or1k/util.c
diff options
context:
space:
mode:
authorJeff Johnston <jjohnstn@redhat.com>2014-12-15 20:17:39 +0000
committerJeff Johnston <jjohnstn@redhat.com>2014-12-15 20:17:39 +0000
commit68a910123726e7868baf89cac9038b4dbb22f612 (patch)
tree108b63e655003a7d58a3cc6f252ab2e6ace706d1 /libgloss/or1k/util.c
parentd1219c0e89d2dc4ac865889cbd23f5e4c64d86e5 (diff)
downloadcygnal-68a910123726e7868baf89cac9038b4dbb22f612.tar.gz
cygnal-68a910123726e7868baf89cac9038b4dbb22f612.tar.bz2
cygnal-68a910123726e7868baf89cac9038b4dbb22f612.zip
2014-12-15 Stefan Wallentowitz <stefan.wallentowitz@tum.de>
* or1k/Makefile.in: Add libor1k * or1k/README: New file * or1k/caches-asm.S: New file * or1k/exceptions-asm.S: New file * or1k/exceptions.c: New file * or1k/impure.c: New file * or1k/include/or1k-nop.h: New file * or1k/include/or1k-support.h: New file * or1k/interrupts-asm.S: New file * or1k/interrupts.c: New file * or1k/mmu-asm.S: New file * or1k/or1k-internals.h: New file * or1k/or1k_uart.c: New file * or1k/or1k_uart.h: New file * or1k/outbyte.S: New file * or1k/sbrk.c: New file * or1k/sync-asm.S: New file * or1k/syscalls.c: New file * or1k/timer.c: New file * or1k/util.c: New file
Diffstat (limited to 'libgloss/or1k/util.c')
-rw-r--r--libgloss/or1k/util.c83
1 files changed, 83 insertions, 0 deletions
diff --git a/libgloss/or1k/util.c b/libgloss/or1k/util.c
new file mode 100644
index 000000000..74071719e
--- /dev/null
+++ b/libgloss/or1k/util.c
@@ -0,0 +1,83 @@
+/* util.c -- Utility functions for OpenRISC 1000.
+ *
+ * Copyright (c) 2014 Authors
+ *
+ * Contributor Julius Baxter <julius.baxter@orsoc.se>
+ * Contributor Stefan Wallentowitz <stefan.wallentowitz@tum.de>
+ *
+ * The authors hereby grant permission to use, copy, modify, distribute,
+ * and license this software and its documentation for any purpose, provided
+ * that existing copyright notices are retained in all copies and that this
+ * notice is included verbatim in any distributions. No written agreement,
+ * license, or royalty fee is required for any of the authorized uses.
+ * Modifications to this software may be copyrighted by their authors
+ * and need not follow the licensing terms described here, provided that
+ * the new terms are clearly indicated on the first page of each file where
+ * they apply.
+ */
+
+#include <stdint.h>
+#include <stddef.h>
+#include <reent.h>
+
+#include "or1k-internals.h"
+
+#ifdef __OR1K_MULTICORE__
+uint32_t* *_or1k_stack_core;
+uint32_t* *_or1k_exception_stack_core;
+#endif
+
+uint32_t* _or1k_stack_top;
+uint32_t* _or1k_stack_bottom;
+
+uint32_t* _or1k_exception_stack_top;
+uint32_t* _or1k_exception_stack_bottom;
+
+void _or1k_init() {
+#ifdef __OR1K_MULTICORE__
+ uint32_t c;
+
+ // Initialize stacks
+ _or1k_stack_core = _sbrk_r(0, sizeof(uint32_t*) * or1k_numcores());
+ _or1k_exception_stack_core = _sbrk_r(0, sizeof(uint32_t*) * or1k_numcores());
+
+ _or1k_stack_core[0] = _or1k_stack_top;
+ _or1k_exception_stack_core[0] = _or1k_exception_stack_top;
+
+ for (c = 1; c < or1k_numcores(); c++) {
+ _or1k_stack_core[c] = _or1k_stack_core[c-1] - _or1k_stack_size;
+ _or1k_exception_stack_core[c] = _or1k_exception_stack_core[c-1] -
+ _or1k_exception_stack_size;
+ }
+
+ size_t exc_size = sizeof(void*) * or1k_numcores() * OR1K_NUM_EXCEPTIONS;
+ _or1k_exception_handler_table = _sbrk_r(0, exc_size);
+
+ size_t int_size = sizeof(void*) * or1k_numcores() * 32;
+ size_t intdata_size = sizeof(void*) * or1k_numcores() * 32;
+ _or1k_interrupt_handler_table = _sbrk_r(0, int_size);
+ _or1k_interrupt_handler_data_ptr_table = _sbrk_r(0, intdata_size);
+#endif
+
+ _or1k_reent_init();
+
+#ifdef __OR1K_MULTICORE__
+ for (c = 0; c < or1k_numcores(); c++) {
+ _or1k_exception_handler_table[c][6] = _or1k_interrupt_handler;
+ }
+#else
+ _or1k_exception_handler_table[6] = _or1k_interrupt_handler;
+#endif
+}
+
+uint32_t or1k_critical_begin() {
+ uint32_t iee = or1k_interrupts_disable();
+ uint32_t tee = or1k_timer_disable();
+ return (iee << 1) | tee;
+}
+
+void or1k_critical_end(uint32_t restore) {
+ or1k_timer_restore(restore & 0x1);
+ or1k_interrupts_restore((restore >> 1) & 0x1);
+}
+