libc/libgloss/or1k/boards/optimsoc.S

98 lines
2.8 KiB
ArmAsm

/* optimsoc.S -- Support for OpTiMSoC systems.
*
* Copyright (c) 2014 Authors
*
* Contributor Stefan Wallentowitz <stefan.wallentowitz@saunalahti.fi>
*
* 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 "../include/or1k-asm.h"
#include "../include/or1k-nop.h"
#define OPTIMSOC_NA_BASE 0xe0000000
#define OPTIMSOC_NA_REGS OPTIMSOC_NA_BASE + 0x00000
#define OPTIMSOC_NA_LMEM_SIZE OPTIMSOC_NA_REGS + 0x24
#define OPTIMSOC_NA_GMEM_SIZE OPTIMSOC_NA_REGS + 0x1c
#define OPTIMSOC_GZLL_STRING 0x677a6c6c
#define OPTIMSOC_GZLL_IMAGE_LAYOUT 0x2000
/*
* Define symbols to be used during startup - file is linked at compile time
*
*/
.weak _or1k_board_mem_base
.weak _or1k_board_mem_size
.weak _or1k_board_clk_freq
_or1k_board_mem_base: .long 0x0
_or1k_board_mem_size: .long 0x0
_or1k_board_clk_freq: .long 50000000
.weak _or1k_board_uart_base
.weak _or1k_board_uart_baud
.weak _or1k_board_uart_IRQ
_or1k_board_uart_base: .long 0x0
_or1k_board_uart_baud: .long 0
_or1k_board_uart_IRQ: .long 0
.weak _or1k_board_exit
_or1k_board_exit:
l.nop OR1K_NOP_K_EXIT
.Lexitloop:
OR1K_DELAYED_NOP(l.j .Lexitloop)
.extern _or1k_heap_start
.global _or1k_board_init_early
_or1k_board_init_early:
#ifndef __OR1K_MULTICORE__
l.nop 0x1
.die:
OR1K_DELAYED_NOP(l.j .die)
#endif
l.movhi r1,hi(OPTIMSOC_NA_LMEM_SIZE)
l.ori r1,r1,lo(OPTIMSOC_NA_LMEM_SIZE)
l.lwz r1,0(r1)
l.movhi r2,hi(_or1k_board_mem_size)
l.ori r2,r2,lo(_or1k_board_mem_size)
l.sw 0(r2),r1
// Set stack beyond apps if single image in local memory
// Is this a kernel running?
l.movhi r3,hi(OPTIMSOC_GZLL_STRING)
l.ori r3,r3,lo(OPTIMSOC_GZLL_STRING)
l.movhi r4,hi(OPTIMSOC_GZLL_IMAGE_LAYOUT)
l.ori r4,r4,lo(OPTIMSOC_GZLL_IMAGE_LAYOUT)
l.lwz r5,0(r4)
l.sfeq r3,r5
// If not, we are done
OR1K_DELAYED_NOP(l.bnf ._or1k_board_init_early_done)
// Else: are we running with global memory (loading)?
l.movhi r6,hi(OPTIMSOC_NA_GMEM_SIZE)
l.ori r6,r6,lo(OPTIMSOC_NA_GMEM_SIZE)
l.lwz r6,0(r6)
l.sfeqi r6,0
// If yes, we are done
OR1K_DELAYED_NOP(l.bnf ._or1k_board_init_early_done)
// Else: Read end of apps
l.lwz r7,12(r4)
l.movhi r8,hi(_or1k_heap_start)
l.ori r8,r8,lo(_or1k_heap_start)
l.sw 0(r8),r7
._or1k_board_init_early_done:
OR1K_DELAYED_NOP(l.jr r9)
.weak _or1k_board_init
_or1k_board_init:
OR1K_DELAYED_NOP(l.jr r9)