2013-09-20 Matthew Gretton-Dann <matthew.gretton-dann@arm.com>
Ramana Radhakrishnan <ramana.radhakrishnan@arm.com> Greta Yorsh <greta.yorsh@arm.com> * arm/Makefile.in: Add support for cpu-init directory and add elf-aprofile-ve.specs. * arm/configure.in: Likewise. * arm/configure: Regenerate. * arm/cpu-init: New directory. * arm/cpu-init/Makefile.in: New file. * arm/cpu-init/rdimon-aem.S: Likewise. * arm/crt0.S: Call _rdimon_init_hook * arm/elf-aprofile-ve.specs: New file.
This commit is contained in:
Richard Earnshaw
@@ -41,6 +41,8 @@ AR = @AR@
|
||||
LD = @LD@
|
||||
RANLIB = @RANLIB@
|
||||
|
||||
SUBDIRS = @subdirs@
|
||||
|
||||
OBJDUMP = `if [ -f ${objroot}/../binutils/objdump ] ; \
|
||||
then echo ${objroot}/../binutils/objdump ; \
|
||||
else t='$(program_transform_name)'; echo objdump | sed -e $$t ; fi`
|
||||
@@ -73,7 +75,7 @@ RDPMON_INSTALL = install-rdpmon
|
||||
RDIMON_CRT0 = rdimon-crt0.o
|
||||
RDIMON_BSP = librdimon.a
|
||||
RDIMON_OBJS = $(patsubst %,rdimon-%,$(RDPMON_OBJS))
|
||||
RDIMON_SCRIPTS = rdimon.specs
|
||||
RDIMON_SCRIPTS = rdimon.specs aprofile-ve.specs
|
||||
RDIMON_INSTALL = install-rdimon
|
||||
|
||||
CFLAGS = -g
|
||||
@@ -94,6 +96,15 @@ IQ80310_INSTALL = install-iq80310
|
||||
# it to link is a good test, so we ignore all the errors for now.
|
||||
#
|
||||
all: ${CRT0} ${LINUX_CRT0} ${LINUX_BSP} ${REDBOOT_CRT0} ${REDBOOT_OBJS} ${RDPMON_CRT0} ${RDPMON_BSP} ${RDIMON_CRT0} ${RDIMON_BSP}
|
||||
@rootpre=`pwd`/; export rootpre; \
|
||||
srcrootpre=`cd $(srcdir); pwd`/; export srcrootpre; \
|
||||
for dir in .. ${SUBDIRS}; do \
|
||||
if [ x$$dir != x.. ]; then \
|
||||
if [ -d $$dir ]; then \
|
||||
(cd $$dir; $(MAKE) $(FLAGS_TO_PASS)); \
|
||||
else true; fi; \
|
||||
else true; fi; \
|
||||
done
|
||||
|
||||
#
|
||||
# here's where we build the test programs for each target
|
||||
@@ -141,12 +152,30 @@ $(RDIMON_BSP): $(RDIMON_OBJS)
|
||||
|
||||
clean mostlyclean:
|
||||
rm -f a.out core *.i *.o *-test *.srec *.dis *.x $(SIM_BSP) $(IQ80310_BSP)
|
||||
@rootpre=`pwd`/; export rootpre; \
|
||||
srcrootpre=`cd $(srcdir); pwd`/; export srcrootpre; \
|
||||
for dir in .. ${SUBDIRS}; do \
|
||||
if [ x$$dir != x.. ]; then \
|
||||
if [ -d $$dir ]; then \
|
||||
(cd $$dir; $(MAKE) $(FLAGS_TO_PASS) clean); \
|
||||
else true; fi; \
|
||||
else true; fi; \
|
||||
done
|
||||
|
||||
distclean maintainer-clean realclean: clean
|
||||
rm -f Makefile config.status *~
|
||||
|
||||
.PHONY: install info install-info clean-info
|
||||
install: ${CRT0_INSTALL} ${LINUX_INSTALL} ${REDBOOT_INSTALL} ${RDPMON_INSTALL} ${RDIMON_INSTALL} ${IQ80310_INSTALL} ${PID_INSTALL}
|
||||
@rootpre=`pwd`/; export rootpre; \
|
||||
srcrootpre=`cd $(srcdir); pwd`/; export srcrootpre; \
|
||||
for dir in .. ${SUBDIRS}; do \
|
||||
if [ x$$dir != x.. ]; then \
|
||||
if [ -d $$dir ]; then \
|
||||
(cd $$dir; $(MAKE) $(FLAGS_TO_PASS) install); \
|
||||
else true; fi; \
|
||||
else true; fi; \
|
||||
done
|
||||
|
||||
install-crt0:
|
||||
${INSTALL_DATA} ${CRT0} $(DESTDIR)${tooldir}/lib${MULTISUBDIR}/$$x
|
||||
|
||||
21
libgloss/arm/configure
vendored
21
libgloss/arm/configure
vendored
@@ -650,6 +650,7 @@ CCAS
|
||||
CCASFLAGS
|
||||
objtype
|
||||
host_makefile_frag_path
|
||||
subdirs
|
||||
LIBOBJS
|
||||
LTLIBOBJS'
|
||||
ac_subst_files='host_makefile_frag'
|
||||
@@ -2556,6 +2557,14 @@ host_makefile_frag_path=$host_makefile_frag
|
||||
|
||||
|
||||
|
||||
# Configure cpu init plug-ins
|
||||
if test -d "${srcdir}/cpu-init"; then
|
||||
subdirs="${subdirs} cpu-init"
|
||||
ac_config_files="$ac_config_files cpu-init/Makefile"
|
||||
|
||||
|
||||
fi
|
||||
|
||||
ac_config_files="$ac_config_files Makefile"
|
||||
|
||||
cat >confcache <<\_ACEOF
|
||||
@@ -3140,6 +3149,13 @@ cat >>$CONFIG_STATUS <<_ACEOF
|
||||
# INIT-COMMANDS
|
||||
#
|
||||
AMDEP_TRUE="$AMDEP_TRUE" ac_aux_dir="$ac_aux_dir"
|
||||
srcdir=${srcdir}
|
||||
target=${target}
|
||||
with_multisubdir=${with_multisubdir}
|
||||
ac_configure_args="${ac_configure_args} --enable-multilib"
|
||||
CONFIG_SHELL=${CONFIG_SHELL-/bin/sh}
|
||||
libgloss_topdir=${libgloss_topdir}
|
||||
|
||||
srcdir=${srcdir}
|
||||
target=${target}
|
||||
with_multisubdir=${with_multisubdir}
|
||||
@@ -3157,6 +3173,7 @@ for ac_config_target in $ac_config_targets
|
||||
do
|
||||
case $ac_config_target in
|
||||
"depfiles") CONFIG_COMMANDS="$CONFIG_COMMANDS depfiles" ;;
|
||||
"cpu-init/Makefile") CONFIG_FILES="$CONFIG_FILES cpu-init/Makefile" ;;
|
||||
"Makefile") CONFIG_FILES="$CONFIG_FILES Makefile" ;;
|
||||
|
||||
*) { { echo "$as_me:$LINENO: error: invalid argument: $ac_config_target" >&5
|
||||
@@ -3297,11 +3314,12 @@ CCAS!$CCAS$ac_delim
|
||||
CCASFLAGS!$CCASFLAGS$ac_delim
|
||||
objtype!$objtype$ac_delim
|
||||
host_makefile_frag_path!$host_makefile_frag_path$ac_delim
|
||||
subdirs!$subdirs$ac_delim
|
||||
LIBOBJS!$LIBOBJS$ac_delim
|
||||
LTLIBOBJS!$LTLIBOBJS$ac_delim
|
||||
_ACEOF
|
||||
|
||||
if test `sed -n "s/.*$ac_delim\$/X/p" conf$$subs.sed | grep -c X` = 75; then
|
||||
if test `sed -n "s/.*$ac_delim\$/X/p" conf$$subs.sed | grep -c X` = 76; then
|
||||
break
|
||||
elif $ac_last_try; then
|
||||
{ { echo "$as_me:$LINENO: error: could not make $CONFIG_STATUS" >&5
|
||||
@@ -3734,6 +3752,7 @@ echo "$as_me: error: cannot create directory $as_dir" >&2;}
|
||||
done
|
||||
done
|
||||
;;
|
||||
"cpu-init/Makefile":F) . ${libgloss_topdir}/config-ml.in ;;
|
||||
"Makefile":F) . ${libgloss_topdir}/config-ml.in ;;
|
||||
|
||||
esac
|
||||
|
||||
@@ -69,6 +69,21 @@ host_makefile_frag_path=$host_makefile_frag
|
||||
AC_SUBST(host_makefile_frag_path)
|
||||
AC_SUBST_FILE(host_makefile_frag)
|
||||
|
||||
# Configure cpu init plug-ins
|
||||
if test -d "${srcdir}/cpu-init"; then
|
||||
subdirs="${subdirs} cpu-init"
|
||||
AC_CONFIG_FILES(cpu-init/Makefile,
|
||||
. ${libgloss_topdir}/config-ml.in,
|
||||
srcdir=${srcdir}
|
||||
target=${target}
|
||||
with_multisubdir=${with_multisubdir}
|
||||
ac_configure_args="${ac_configure_args} --enable-multilib"
|
||||
CONFIG_SHELL=${CONFIG_SHELL-/bin/sh}
|
||||
libgloss_topdir=${libgloss_topdir}
|
||||
)
|
||||
AC_SUBST(subdirs)
|
||||
fi
|
||||
|
||||
AC_CONFIG_FILES(Makefile,
|
||||
. ${libgloss_topdir}/config-ml.in,
|
||||
srcdir=${srcdir}
|
||||
|
||||
87
libgloss/arm/cpu-init/Makefile.in
Normal file
87
libgloss/arm/cpu-init/Makefile.in
Normal file
@@ -0,0 +1,87 @@
|
||||
#
|
||||
#
|
||||
DESTDIR =
|
||||
VPATH = @srcdir@ @srcdir@/.. @srcdir@/../..
|
||||
srcdir = @srcdir@
|
||||
objdir = .
|
||||
srcroot = $(srcdir)/../../..
|
||||
objroot = $(objdir)/../../..
|
||||
|
||||
prefix = @prefix@
|
||||
exec_prefix = @exec_prefix@
|
||||
|
||||
host_alias = @host_alias@
|
||||
target_alias = @target_alias@
|
||||
|
||||
bindir = @bindir@
|
||||
libdir = @libdir@
|
||||
tooldir = $(exec_prefix)/$(target_alias)
|
||||
|
||||
objtype = @objtype@
|
||||
|
||||
INSTALL = @INSTALL@
|
||||
INSTALL_PROGRAM = @INSTALL_PROGRAM@
|
||||
INSTALL_DATA = @INSTALL_DATA@
|
||||
|
||||
# Multilib support variables.
|
||||
# TOP is used instead of MULTI{BUILD,SRC}TOP.
|
||||
MULTISRCTOP =
|
||||
MULTIBUILDTOP =
|
||||
MULTIDIRS =
|
||||
MULTISUBDIR =
|
||||
MULTIDO = true
|
||||
MULTICLEAN = true
|
||||
|
||||
SHELL = /bin/sh
|
||||
|
||||
CC = @CC@
|
||||
|
||||
AS = @AS@
|
||||
AR = @AR@
|
||||
LD = @LD@
|
||||
RANLIB = @RANLIB@
|
||||
|
||||
CPU_INIT_OBJS = rdimon-aem.o
|
||||
CPU_INIT_INSTALL = install-cpu-init
|
||||
|
||||
CFLAGS = -g
|
||||
|
||||
# Host specific makefile fragment comes in here.
|
||||
@host_makefile_frag@
|
||||
|
||||
.PHONY: all
|
||||
all: ${CPU_INIT_OBJS}
|
||||
|
||||
#
|
||||
# here's where we build the test programs for each target
|
||||
#
|
||||
.PHONY: test
|
||||
test:
|
||||
|
||||
# Static pattern rule for assembling cpu init files to object files.
|
||||
${CPU_INIT_OBJS}: %.o: %.S
|
||||
$(CC) $(CFLAGS_FOR_TARGET) $(INCLUDES) -DARM_RDI_MONITOR -o $@ -c $<
|
||||
|
||||
clean mostlyclean:
|
||||
rm -f a.out core *.i *.o *-test *.srec *.dis *.x
|
||||
|
||||
distclean maintainer-clean realclean: clean
|
||||
rm -f Makefile *~
|
||||
|
||||
.PHONY: install info install-info clean-info
|
||||
install: ${CPU_INIT_INSTALL}
|
||||
|
||||
install-cpu-init:
|
||||
test -d $(DESTDIR)${tooldir}/lib${MULTISUBDIR}/cpu-init || mkdir $(DESTDIR)${tooldir}/lib${MULTISUBDIR}/cpu-init
|
||||
set -e; for x in ${CPU_INIT_OBJS}; do ${INSTALL_DATA} $$x $(DESTDIR)${tooldir}/lib${MULTISUBDIR}/cpu-init/$$x; done
|
||||
|
||||
doc:
|
||||
info:
|
||||
install-info:
|
||||
clean-info:
|
||||
|
||||
Makefile: Makefile.in ../config.status @host_makefile_frag_path@
|
||||
$(SHELL) ../config.status --file cpu-init/Makefile
|
||||
|
||||
../config.status: ../configure
|
||||
$(SHELL) ../config.status --recheck
|
||||
518
libgloss/arm/cpu-init/rdimon-aem.S
Normal file
518
libgloss/arm/cpu-init/rdimon-aem.S
Normal file
@@ -0,0 +1,518 @@
|
||||
/* Copyright (c) 2005-2013 ARM Ltd. All rights reserved.
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions
|
||||
are met:
|
||||
1. Redistributions of source code must retain the above copyright
|
||||
notice, this list of conditions and the following disclaimer.
|
||||
2. Redistributions in binary form must reproduce the above copyright
|
||||
notice, this list of conditions and the following disclaimer in the
|
||||
documentation and/or other materials provided with the distribution.
|
||||
3. The name of the company may not be used to endorse or promote
|
||||
products derived from this software without specific prior written
|
||||
permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY ARM LTD ``AS IS'' AND ANY EXPRESS OR IMPLIED
|
||||
WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
||||
MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||||
IN NO EVENT SHALL ARM LTD BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
|
||||
SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED
|
||||
TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
||||
PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
||||
LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
||||
NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||||
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */
|
||||
|
||||
/* This file gives a basic initialisation of a Cortex-A series core. It is
|
||||
the bare minimum required to get Cortex-A core running with a semihosting
|
||||
interface.
|
||||
|
||||
It sets up a basic 1:1 phsyical address to virtual address mapping;
|
||||
turns the MMU on; enables branch prediction; activates any integrated
|
||||
caches; enables the Advanced SIMD and VFP co-processors; and installs
|
||||
basic exception handlers.
|
||||
|
||||
It does not handle peripherals, and assumes all memory is Normal.
|
||||
|
||||
It does not change processor state from the startup privilege and security
|
||||
level.
|
||||
|
||||
By default it assumes exception vectors are located from address 0.
|
||||
However, if this is not true they can be moved by defining the
|
||||
_rdimon_vector_base symbol. For example if you have HIVECS enabled you
|
||||
may pass --defsym _rdimon_vector_base=0xffff0000 on the linker command
|
||||
line. */
|
||||
|
||||
.syntax unified
|
||||
.arch armv7-a
|
||||
|
||||
#if defined(__thumb__)
|
||||
.thumb
|
||||
#endif
|
||||
|
||||
@ CPU Initialisation
|
||||
.globl _rdimon_hw_init_hook
|
||||
.type _rdimon_hw_init_hook, %function
|
||||
|
||||
_rdimon_hw_init_hook:
|
||||
@ Only run the code on CPU 0 - otherwise spin
|
||||
mrc 15, 0, r4, cr0, cr0, 5 @ Read MPIDR
|
||||
ands r4, r4, #15
|
||||
spin:
|
||||
bne spin
|
||||
|
||||
mov r10, lr @ Save LR for final return
|
||||
|
||||
#ifdef __ARMEB__
|
||||
@ Setup for Big Endian
|
||||
setend be
|
||||
mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
|
||||
orr r4, r4, #(1<<25) @ Switch to Big Endian (Set SCTLR.EE)
|
||||
mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
|
||||
#else
|
||||
@ Setup for Little Endian
|
||||
setend le
|
||||
mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
|
||||
bic r4, r4, #(1<<25) @ Switch to LE (unset SCTLR.EE)
|
||||
mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
|
||||
#endif
|
||||
|
||||
bl is_a15_a7
|
||||
|
||||
@ For Cortex-A15 and Cortex-A7 only:
|
||||
@ Write zero into the ACTLR to turn everything on.
|
||||
moveq r4, #0
|
||||
mcreq 15, 0, r4, c1, c0, 1
|
||||
isb
|
||||
|
||||
@ For Cortex-A15 and Cortex-A7 only:
|
||||
@ Set ACTLR:SMP bit before enabling the caches and MMU,
|
||||
@ or performing any cache and TLB maintenance operations.
|
||||
mrceq 15, 0, r4, c1, c0, 1 @ Read ACTLR
|
||||
orreq r4, r4, #(1<<6) @ Enable ACTLR:SMP
|
||||
mcreq 15, 0, r4, c1, c0, 1 @ Write ACTLR
|
||||
isb
|
||||
|
||||
@ Setup for exceptions being taken to Thumb/ARM state
|
||||
mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
|
||||
#if defined(__thumb__)
|
||||
orr r4, r4, #(1 << 30) @ Enable SCTLR.TE
|
||||
#else
|
||||
bic r4, r4, #(1 << 30) @ Disable SCTLR.TE
|
||||
#endif
|
||||
mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
|
||||
|
||||
bl __reset_caches
|
||||
|
||||
mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
|
||||
orr r4, r4, #(1<<22) @ Enable unaligned mode
|
||||
bic r4, r4, #2 @ Disable alignment faults
|
||||
bic r4, r4, #1 @ Disable MMU
|
||||
mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
|
||||
|
||||
mov r4, #0
|
||||
mcr 15, 0, r4, cr8, cr7, 0 @ Write TLBIALL - Invaliidate unified
|
||||
@ TLB
|
||||
@ Setup MMU Primary table P=V mapping.
|
||||
mvn r4, #0
|
||||
mcr 15, 0, r4, cr3, cr0, 0 @ Write DACR
|
||||
|
||||
mov r4, #0 @ Always use TTBR0, no LPAE
|
||||
mcr 15, 0, r4, cr2, cr0, 2 @ Write TTBCR
|
||||
adr r4, page_table_addr @ Load the base for vectors
|
||||
ldr r4, [r4]
|
||||
add r4, r4, #1 @ Page tables inner cacheable
|
||||
|
||||
mcr 15, 0, r4, cr2, cr0, 0 @ Write TTBR0
|
||||
|
||||
mov r0, #34 @ 0x22 @ TR0 and TR1 - normal memory
|
||||
orr r0, r0, #(1 << 19) @ Shareable
|
||||
mcr 15, 0, r0, cr10, cr2, 0 @ Write PRRR
|
||||
movw r0, #0x33
|
||||
movt r0, #0x33
|
||||
mcr 15, 0, r0, cr10, cr2, 1 @ Write NMRR
|
||||
mrc 15, 0, r0, cr1, cr0, 0 @ Read SCTLR
|
||||
bic r0, r0, #(1 << 28) @ Clear TRE bit
|
||||
mcr 15, 0, r0, cr1, cr0, 0 @ Write SCTLR
|
||||
|
||||
@ Now install the vector code - we move the Vector code from where it is
|
||||
@ in the image to be based at _rdimon_vector_base. We have to do this copy
|
||||
@ as the code is all PC-relative. We actually cheat and do a BX <reg> so
|
||||
@ that we are at a known address relatively quickly and have to move as
|
||||
@ little code as possible.
|
||||
mov r7, #(VectorCode_Limit - VectorCode)
|
||||
adr r5, VectorCode
|
||||
adr r6, vector_base_addr @ Load the base for vectors
|
||||
ldr r6, [r6]
|
||||
|
||||
copy_loop: @ Do the copy
|
||||
ldr r4, [r5], #4
|
||||
str r4, [r6], #4
|
||||
subs r7, r7, #4
|
||||
bne copy_loop
|
||||
|
||||
mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
|
||||
bic r4, r4, #0x1000 @ Disable I Cache
|
||||
bic r4, r4, #4 @ Disable D Cache
|
||||
orr r4, r4, #1 @ Enable MMU
|
||||
bic r4, r4, #(1 << 28) @ Clear TRE bit
|
||||
mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
|
||||
mrc 15, 0, r4, cr1, cr0, 2 @ Read CPACR
|
||||
orr r4, r4, #0x00f00000 @ Turn on VFP Co-procs
|
||||
bic r4, r4, #0x80000000 @ Clear ASEDIS bit
|
||||
mcr 15, 0, r4, cr1, cr0, 2 @ Write CPACR
|
||||
isb
|
||||
mov r4, #0
|
||||
mcr 15, 0, r4, cr7, cr5, 4 @ Flush prefetch buffer
|
||||
mrc 15, 0, r4, cr1, cr0, 2 @ Read CPACR
|
||||
ubfx r4, r4, #20, #4 @ Extract bits [20, 23)
|
||||
cmp r4, #0xf @ If not all set then the CPU does not
|
||||
itt eq @ have FP or Advanced SIMD.
|
||||
moveq r4, #0x40000000 @ Enable FP and Advanced SIMD
|
||||
mcreq 10, 7, r4, cr8, cr0, 0 @ vmsr fpexc, r4
|
||||
skip_vfp_enable:
|
||||
bl __enable_caches @ Turn caches on
|
||||
bx r10 @ Return to CRT startup routine
|
||||
|
||||
@ This enable us to be more precise about which caches we want
|
||||
init_cpu_client_enable_dcache:
|
||||
init_cpu_client_enable_icache:
|
||||
mov r0, #1
|
||||
bx lr
|
||||
|
||||
vector_base_addr:
|
||||
.word _rdimon_vector_base
|
||||
.weak _rdimon_vector_base
|
||||
page_table_addr:
|
||||
.word page_tables
|
||||
|
||||
@ Vector code - must be PIC and in ARM state.
|
||||
VectorCode:
|
||||
b vector_reset
|
||||
b vector_undef
|
||||
b vector_swi
|
||||
b vector_prefetch
|
||||
b vector_dataabt
|
||||
b vector_reserved
|
||||
b vector_irq
|
||||
b vector_fiq
|
||||
|
||||
vector_reset:
|
||||
adr sp, vector_sp_base
|
||||
push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
|
||||
mov r4, #0
|
||||
b vector_common
|
||||
vector_undef:
|
||||
adr sp, vector_sp_base
|
||||
push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
|
||||
mov r4, #1
|
||||
b vector_common
|
||||
vector_swi:
|
||||
adr sp, vector_sp_base
|
||||
push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
|
||||
mov r4, #2
|
||||
b vector_common
|
||||
vector_prefetch:
|
||||
adr sp, vector_sp_base
|
||||
push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
|
||||
mov r4, #3
|
||||
b vector_common
|
||||
vector_dataabt:
|
||||
adr sp, vector_sp_base
|
||||
push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
|
||||
mov r4, #4
|
||||
b vector_common
|
||||
vector_reserved:
|
||||
adr sp, vector_sp_base
|
||||
push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
|
||||
mov r4, #5
|
||||
b vector_common
|
||||
vector_irq:
|
||||
adr sp, vector_sp_base
|
||||
push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
|
||||
mov r4, #6
|
||||
b vector_common
|
||||
vector_fiq:
|
||||
adr sp, vector_sp_base
|
||||
push {r0, r1, r2, r3, r4, r5, r6, r7, r8, r9, sl, fp, ip, lr}
|
||||
mov r4, #7
|
||||
b vector_common
|
||||
vector_common:
|
||||
adr r1, vector_common_adr @ Find where we're going to
|
||||
ldr r1, [r1]
|
||||
bx r1 @ And branch there
|
||||
vector_common_adr:
|
||||
.word vector_common_2 @ Common handling code
|
||||
|
||||
@ Vector stack
|
||||
.align 3 @ Align to 8 byte boundary boundary to
|
||||
@ keep ABI compatibility
|
||||
.fill 32, 4, 0 @ 32-entry stack is enough for vector
|
||||
@ handlers.
|
||||
vector_sp_base:
|
||||
VectorCode_Limit:
|
||||
@ End of PIC code for vectors
|
||||
|
||||
@ Common Handling of vectors
|
||||
.type vector_common_2, %function
|
||||
vector_common_2:
|
||||
mrs r1, APSR
|
||||
mrs r2, SPSR
|
||||
push {r1, r2} @ Save PSRs
|
||||
|
||||
@ Output the vector we have caught
|
||||
bl out_nl
|
||||
adr r0, which_vector
|
||||
bl out_string
|
||||
adr r0, vector_names
|
||||
mov r1, #11
|
||||
mla r0, r4, r1, r0
|
||||
bl out_string
|
||||
bl out_nl
|
||||
|
||||
@ Dump the registers
|
||||
adrl r6, register_names
|
||||
mov r7, #0
|
||||
dump_r_loop:
|
||||
mov r0, r6
|
||||
bl out_string
|
||||
add r6, r6, #6
|
||||
ldr r0, [sp, r7, lsl #2]
|
||||
bl out_word
|
||||
bl out_nl
|
||||
add r7, r7, #1
|
||||
cmp r7, #16
|
||||
blt dump_r_loop
|
||||
adr r0, end
|
||||
bl out_string
|
||||
|
||||
@ And exit
|
||||
mov r0, #24
|
||||
orr r1, r4, #0x20000
|
||||
svc 0x00123456
|
||||
|
||||
@ Output the string in r0
|
||||
out_string:
|
||||
push {lr}
|
||||
mov r1, r0
|
||||
mov r0, #4
|
||||
svc 0x00123456
|
||||
pop {pc}
|
||||
|
||||
@ Output a New-line
|
||||
out_nl:
|
||||
mov r0, #10
|
||||
@ Fallthrough
|
||||
|
||||
@ Output the character in r0
|
||||
out_char:
|
||||
push {lr}
|
||||
strb r0, [sp, #-4]!
|
||||
mov r0, #3
|
||||
mov r1, sp
|
||||
svc 0x00123456
|
||||
add sp, sp, #4
|
||||
pop {pc}
|
||||
|
||||
@ Output the value of r0 as a hex-word
|
||||
out_word:
|
||||
push {r4, r5, r6, lr}
|
||||
mov r4, r0
|
||||
mov r5, #28
|
||||
adr r6, hexchars
|
||||
word_loop:
|
||||
lsr r0, r4, r5
|
||||
and r0, r0, #15
|
||||
ldrb r0, [r6, r0]
|
||||
bl out_char
|
||||
subs r5, r5, #4
|
||||
bpl word_loop
|
||||
pop {r4, r5, r6, pc}
|
||||
|
||||
hexchars:
|
||||
.ascii "0123456789abcdef"
|
||||
|
||||
which_vector:
|
||||
.asciz "Hit vector:"
|
||||
end:
|
||||
.asciz "End.\n"
|
||||
|
||||
vector_names:
|
||||
.asciz "reset "
|
||||
.asciz "undef "
|
||||
.asciz "swi "
|
||||
.asciz "prefetch "
|
||||
.asciz "data abort"
|
||||
.asciz "reserved "
|
||||
.asciz "irq "
|
||||
.asciz "fiq "
|
||||
|
||||
register_names:
|
||||
.asciz "apsr "
|
||||
.asciz "spsr "
|
||||
.asciz "r0 "
|
||||
.asciz "r1 "
|
||||
.asciz "r2 "
|
||||
.asciz "r3 "
|
||||
.asciz "r4 "
|
||||
.asciz "r5 "
|
||||
.asciz "r6 "
|
||||
.asciz "r7 "
|
||||
.asciz "r8 "
|
||||
.asciz "r9 "
|
||||
.asciz "r10 "
|
||||
.asciz "r11 "
|
||||
.asciz "r12 "
|
||||
.asciz "r14 "
|
||||
|
||||
.align
|
||||
|
||||
@ Enable the caches
|
||||
__enable_caches:
|
||||
mov r0, #0
|
||||
mcr 15, 0, r0, cr8, cr7, 0 @ Invalidate all unified-TLB
|
||||
mov r0, #0
|
||||
mcr 15, 0, r0, cr7, cr5, 6 @ Invalidate branch predictor
|
||||
mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
|
||||
orr r4, r4, #0x800 @ Enable branch predictor
|
||||
mcr 15, 0, r4, cr1, cr0, 0 @ Set SCTLR
|
||||
mov r5, lr @ Save LR as we're going to BL
|
||||
mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
|
||||
bl init_cpu_client_enable_icache
|
||||
cmp r0, #0
|
||||
it ne
|
||||
orrne r4, r4, #0x1000 @ Enable I-Cache
|
||||
bl init_cpu_client_enable_dcache
|
||||
cmp r0, #0
|
||||
it ne
|
||||
orrne r4, r4, #4
|
||||
mcr 15, 0, r4, cr1, cr0, 0 @ Eanble D-Cache
|
||||
bx r5 @ Return
|
||||
|
||||
__reset_caches:
|
||||
mov ip, lr @ Save LR
|
||||
mov r0, #0
|
||||
mcr 15, 0, r0, cr7, cr5, 6 @ Invalidate branch predictor
|
||||
mrc 15, 0, r6, cr1, cr0, 0 @ Read SCTLR
|
||||
mrc 15, 0, r0, cr1, cr0, 0 @ Read SCTLR!
|
||||
bic r0, r0, #0x1000 @ Disable I cache
|
||||
mcr 15, 0, r0, cr1, cr0, 0 @ Write SCTLR
|
||||
mrc 15, 1, r0, cr0, cr0, 1 @ Read CLIDR
|
||||
tst r0, #3 @ Harvard Cache?
|
||||
mov r0, #0
|
||||
it ne
|
||||
mcrne 15, 0, r0, cr7, cr5, 0 @ Invalidate Instruction Cache?
|
||||
|
||||
mrc 15, 0, r1, cr1, cr0, 0 @ Read SCTLR (again!)
|
||||
orr r1, r1, #0x800 @ Enable branch predictor
|
||||
|
||||
@ If we're not enabling caches we have
|
||||
@ no more work to do.
|
||||
bl init_cpu_client_enable_icache
|
||||
cmp r0, #0
|
||||
it ne
|
||||
orrne r1, r1, #0x1000 @ Enable I-Cache now -
|
||||
@ We actually only do this if we have a
|
||||
@ Harvard style cache.
|
||||
bleq init_cpu_client_enable_dcache
|
||||
cmpeq r0, #0
|
||||
beq Finished1
|
||||
|
||||
mcr 15, 0, r1, cr1, cr0, 0 @ Write SCTLR (turn on Branch predictor & I-cache)
|
||||
|
||||
mrc 15, 1, r0, cr0, cr0, 1 @ Read CLIDR
|
||||
ands r3, r0, #0x7000000
|
||||
lsr r3, r3, #23 @ Total cache levels << 1
|
||||
beq Finished1
|
||||
|
||||
mov lr, #0 @ lr = cache level << 1
|
||||
Loop11:
|
||||
mrc 15, 1, r0, cr0, cr0, 1 @ Read CLIDR
|
||||
add r2, lr, lr, lsr #1 @ r2 holds cache 'set' position
|
||||
lsr r1, r0, r2 @ Bottom 3-bits are Ctype for this level
|
||||
and r1, r1, #7 @ Get those 3-bits alone
|
||||
cmp r1, #2
|
||||
blt Skip1 @ No cache or only I-Cache at this level
|
||||
mcr 15, 2, lr, cr0, cr0, 0 @ Write CSSELR
|
||||
mov r1, #0
|
||||
isb sy
|
||||
mrc 15, 1, r1, cr0, cr0, 0 @ Read CCSIDR
|
||||
and r2, r1, #7 @ Extract line length field
|
||||
add r2, r2, #4 @ Add 4 for the line length offset (log2 16 bytes)
|
||||
movw r0, #0x3ff
|
||||
ands r0, r0, r1, lsr #3 @ r0 is the max number on the way size
|
||||
clz r4, r0 @ r4 is the bit position of the way size increment
|
||||
movw r5, #0x7fff
|
||||
ands r5, r5, r1, lsr #13 @ r5 is the max number of the index size (right aligned)
|
||||
Loop21:
|
||||
mov r7, r0 @ r7 working copy of max way size
|
||||
Loop31:
|
||||
orr r1, lr, r7, lsl r4 @ factor in way number and cache number
|
||||
orr r1, r1, r5, lsl r2 @ factor in set number
|
||||
tst r6, #4 @ D-Cache on?
|
||||
ite eq
|
||||
mcreq 15, 0, r1, cr7, cr6, 2 @ No - invalidate by set/way
|
||||
mcrne 15, 0, r1, cr7, cr14, 2 @ yes - clean + invalidate by set/way
|
||||
subs r7, r7, #1 @ Decrement way number
|
||||
bge Loop31
|
||||
subs r5, r5, #1 @ Decrement set number
|
||||
bge Loop21
|
||||
Skip1:
|
||||
add lr, lr, #2 @ increment cache number
|
||||
cmp r3, lr
|
||||
bgt Loop11
|
||||
Finished1:
|
||||
@ Now we know the caches are clean we can:
|
||||
mrc 15, 0, r4, cr1, cr0, 0 @ Read SCTLR
|
||||
bic r4, r4, #4 @ Disable D-Cache
|
||||
mcr 15, 0, r4, cr1, cr0, 0 @ Write SCTLR
|
||||
mov r4, #0
|
||||
mcr 15, 0, r4, cr7, cr5, 6 @ Write BPIALL
|
||||
|
||||
bx ip @ Return
|
||||
|
||||
@ Set Z if this is a Cortex-A15 or Cortex_A7
|
||||
@ Other flags corrupted
|
||||
is_a15_a7:
|
||||
mrc 15, 0, r8, c0, c0, 0
|
||||
movw r9, #0xfff0
|
||||
movt r9, #0xff0f
|
||||
and r8, r8, r9
|
||||
movw r9, #0xc0f0
|
||||
movt r9, #0x410f
|
||||
cmp r8, r9
|
||||
movw r9, #0xc070
|
||||
movt r9, #0x410f
|
||||
cmpne r8, r9
|
||||
bx lr
|
||||
|
||||
@ Descriptor type: Section
|
||||
@ Bufferable: True
|
||||
@ Cacheable: True
|
||||
@ Execute Never: False
|
||||
@ Domain: 0
|
||||
@ Impl. Defined: 0
|
||||
@ Access: 0/11 Full access
|
||||
@ TEX: 001
|
||||
@ Shareable: False
|
||||
@ Not Global: False
|
||||
@ Supersection: False
|
||||
#define PT(X) \
|
||||
.word X;
|
||||
#define PT2(X) \
|
||||
PT(X) PT(X + 0x100000) PT(X + 0x200000) PT(X + 0x300000)
|
||||
#define PT3(X) \
|
||||
PT2(X) PT2(X + 0x400000) PT2(X + 0x800000) PT2(X + 0xc00000)
|
||||
#define PT4(X) \
|
||||
PT3(X) PT3(X + 0x1000000) PT3(X + 0x2000000) PT3(X + 0x3000000)
|
||||
#define PT5(X) \
|
||||
PT4(X) PT4(X + 0x4000000) PT4(X + 0x8000000) PT4(X + 0xc000000)
|
||||
#define PT6(X) \
|
||||
PT5(X) PT5(X + 0x10000000) PT5(X + 0x20000000) PT5(X + 0x30000000)
|
||||
#define PT7(X) \
|
||||
PT6(X) PT6(X + 0x40000000) PT6(X + 0x80000000) PT6(X + 0xc0000000)
|
||||
|
||||
.section page_tables_section, "aw", %progbits
|
||||
.p2align 14
|
||||
page_tables:
|
||||
PT7(0x1c0e)
|
||||
@@ -77,6 +77,12 @@
|
||||
.fnstart
|
||||
#endif
|
||||
|
||||
/* The init hook does not use the stack and is called before the stack has been set up. */
|
||||
#ifdef ARM_RDI_MONITOR
|
||||
bl _rdimon_hw_init_hook
|
||||
.weak FUNCTION (_rdimon_hw_init_hook)
|
||||
#endif
|
||||
|
||||
/* Start by setting up a stack */
|
||||
#ifdef ARM_RDP_MONITOR
|
||||
/* Issue Demon SWI to read stack info */
|
||||
|
||||
22
libgloss/arm/elf-aprofile-ve.specs
Normal file
22
libgloss/arm/elf-aprofile-ve.specs
Normal file
@@ -0,0 +1,22 @@
|
||||
# aem-ve.specs
|
||||
#
|
||||
# Spec file for AArch32 A profile baremetal newlib, libgloss on VE platform with AngelAPI
|
||||
# semi-hosting.
|
||||
#
|
||||
# This Spec file is also appropriate for the foundation model.
|
||||
|
||||
%rename link old_link
|
||||
|
||||
*link:
|
||||
--defsym=_rdimon_vector_base=0x80000000 -Ttext-segment=0x80008000 %(old_link)
|
||||
|
||||
%rename lib libc
|
||||
|
||||
*libgloss:
|
||||
-lrdimon
|
||||
|
||||
*lib:
|
||||
cpu-init/rdimon-aem.o%s --start-group %(libc) %(libgloss) --end-group
|
||||
|
||||
*startfile:
|
||||
crti%O%s crtbegin%O%s %{!pg:rdimon-crt0%O%s} %{pg:rdimon-crt0%O%s}
|
||||
Reference in New Issue
Block a user