98 lines
		
	
	
		
			2.8 KiB
		
	
	
	
		
			ArmAsm
		
	
	
	
			
		
		
	
	
			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)
 |