source: trunk/libs/newlib/src/libgloss/or1k/boards/optimsoc.S @ 565

/* 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)