[Patch ARM] Add support for bare-metal cpu initialization on A profile cores.
Ramana Radhakrishnan
ramrad01@arm.com
Thu Sep 19 13:34:00 GMT 2013
Hi,
Increasingly we've found the need for a start-up routine required for
bare-metal applications that need to initialize the mmu and the caches
for use during hardware bring-up and/or for bare-metal testing on ARM's
propreitary models as well as allow for semi-hosting to happen at the
same time. This has been found to be useful in a number of situations
and this is just the initial patch set required for this to work on A
profile CPUs. I would recommend that this not be used for earlier cores
without testing.
The way this is implemented is by adding a new weak function called
_rdimon_init_hook that deals with this initialization. I expect this to
work on newer hardware because our testing involves testing with the AEM
models that model the newer hardware but I don't have access to any such
hardware to test this right now.
The SMP enable bit in the ACTLR is enabled only for A15 and A7 but not
for any other cores as this is needed only on those cores. We use this
internally for some of our GCC test runs on our fast models, we've tried
it in the past to run some simple applications on bare-metal A7 and A15
boards.
This necessitates the use of a new specs file aprofile-ve.specs which
I've added and provided as an example. I have tested this on an AEM
model but am confident that this will work just fine on a bare-metal
board connected via D-Stream or anything that implements the standard
Angel API.
If people want to use a different base address for the text section and
/ or for the vectors page in the cpu init code this is available by
doing --defsym _rdimon_vector_base=FOO or -Ttext_section=BAR . The
specs file only eases the use for this.
Tested with an arm-eabi bare-metal GCC multilib build across
architecture variants, Thumbness and fpu abi variants using the new
specs file in my baremetal build script and tested with
--specs=aprofile-ve.specs passed by default in my site.exp - tested on
AEM VE model internally .
Ok to apply ?
regards
Ramana
<DATE> 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.
-------------- next part --------------
diff --git a/libgloss/arm/Makefile.in b/libgloss/arm/Makefile.in
index 3fb7236..998ace5 100644
--- a/libgloss/arm/Makefile.in
+++ b/libgloss/arm/Makefile.in
@@ -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
diff --git a/libgloss/arm/configure b/libgloss/arm/configure
index 4c316a1..cc7e570 100644
--- a/libgloss/arm/configure
+++ b/libgloss/arm/configure
@@ -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
@@ -3141,6 +3150,13 @@ cat >>$CONFIG_STATUS <<_ACEOF
#
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}
ac_configure_args="${ac_configure_args} --enable-multilib"
@@ -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
diff --git a/libgloss/arm/configure.in b/libgloss/arm/configure.in
index 970952f..d617f49 100644
--- a/libgloss/arm/configure.in
+++ b/libgloss/arm/configure.in
@@ -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}
diff --git a/libgloss/arm/cpu-init/Makefile.in b/libgloss/arm/cpu-init/Makefile.in
new file mode 100644
index 0000000..2abb5f6
--- /dev/null
+++ b/libgloss/arm/cpu-init/Makefile.in
@@ -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
diff --git a/libgloss/arm/cpu-init/rdimon-aem.S b/libgloss/arm/cpu-init/rdimon-aem.S
new file mode 100644
index 0000000..351c721
--- /dev/null
+++ b/libgloss/arm/cpu-init/rdimon-aem.S
@@ -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)
diff --git a/libgloss/arm/crt0.S b/libgloss/arm/crt0.S
index 86ee2cd..17e3fb6 100644
--- a/libgloss/arm/crt0.S
+++ b/libgloss/arm/crt0.S
@@ -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 */
diff --git a/libgloss/arm/elf-aprofile-ve.specs b/libgloss/arm/elf-aprofile-ve.specs
new file mode 100644
index 0000000..9dea410
--- /dev/null
+++ b/libgloss/arm/elf-aprofile-ve.specs
@@ -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}
More information about the Newlib
mailing list