Moved initialization code from app, added loader.

This commit is contained in:
imi415 2022-08-06 08:59:16 +08:00
parent e0c277c3e5
commit afc5bdb757
Signed by: imi415
GPG Key ID: 17F01E106F9F5E0A
13 changed files with 1249 additions and 1 deletions

39
CMakeLists.txt Normal file
View File

@ -0,0 +1,39 @@
cmake_minimum_required(VERSION 3.10)
enable_language(ASM)
project(bootloader)
set(TARGET_LDSCRIPT "${CMAKE_SOURCE_DIR}/stx7105.ld")
set(TARGET_SOURCES
"startup_stx7105.S"
"startup_stx7105_init_ram.S"
)
set(TARGET_INCLUDES
"include"
)
set(TARGET_FLAGS_HARDWARE "-m4-300 -ml")
set(CMAKE_C_FLAGS_DEBUG "-DDEBUG -g -O0")
set(CMAKE_CXX_FLAGS_DEBUG "-DDEBUG -g -O0")
set(CMAKE_EXE_LINKER_FLAGS_DEBUG "")
set(CMAKE_C_FLAGS_RELEASE "-DNDEBUG -O2 -flto")
set(CMAKE_CXX_FLAGS_RELEASE "-DNDEBUG -O2 -flto")
set(CMAKE_EXE_LINKER_FLAGS_RELEASE "-flto")
set(CMAKE_C_FLAGS "${TARGET_FLAGS_HARDWARE} -Wall -ffunction-sections -fdata-sections")
set(CMAKE_CXX_FLAGS "${TARGET_FLAGS_HARDWARE} -Wall -ffunction-sections -fdata-sections")
set(CMAKE_EXE_LINKER_FLAGS "${TARGET_FLAGS_HARDWARE} -Wall -lc -lm -nostartfiles -Wl,--print-memory-usage -Wl,--gc-sections")
add_compile_definitions(${TARGET_DEFS})
include_directories(${TARGET_INCLUDES})
add_executable(${CMAKE_PROJECT_NAME}.elf ${TARGET_SOURCES})
target_link_options(${CMAKE_PROJECT_NAME}.elf
PRIVATE "-T${TARGET_LDSCRIPT}"
PRIVATE "-Wl,-Map=${CMAKE_PROJECT_NAME}.map"
)

3
LICENSE.STM Normal file
View File

@ -0,0 +1,3 @@
This project uses some initialization code from STLinux U-Boot,
the license header is kept in the corresponding files.
Check these files for license.

View File

@ -13,7 +13,7 @@ This bootloader will:
| Offset | Content |
|-|-|
| 0x00 | text length |
| 0x00 | end address of loadable sections |
| 0x04 | entry point |
## Project status

0
include/.gitkeep Normal file
View File

0
lib/.gitkeep Normal file
View File

10
sh-unknown-elf.cmake Normal file
View File

@ -0,0 +1,10 @@
set(CMAKE_C_COMPILER sh-unknown-elf-gcc)
set(CMAKE_CXX_COMPILER sh-unknown-elf-g++)
# Make CMake happy about those compilers
set(CMAKE_TRY_COMPILE_TARGET_TYPE "STATIC_LIBRARY")
# Poor old Windows...
if(WIN32)
set(CMAKE_SYSTEM_NAME "Generic")
endif()

0
src/.gitkeep Normal file
View File

259
startup_stx7105.S Normal file
View File

@ -0,0 +1,259 @@
/* Startup code, we can't use non-PIC code nor RAM before the LMI is initialized:
* The CPU starts with physical address 0x0, however the linker is linked to virtual
* addresses and LMI.
* Non-PIC code means any indirect addressing other than relative to PC.
*/
.section .text.init, "ax"
.global _start
_start:
nop
nop
mov.l _sr_k, r0
ldc r0, sr
_disable_wdt:
mov.l _cpg_wdt_wtcsr_k, r0
mov.l _cpg_wdt_wtcsr_value_k, r1
mov.w r1, @r0
_configure_spinor:
mov.l _emi_spinor_config_data_k, r0
mov.l _emi_spinor_config_data_value_k, r1
mov.l r1, @r0
mov.l _emi_spinor_modeselect_k, r0
mov.l _emi_spinor_modeselect_value_k, r1
mov.l r1, @r0
/* TODO: Initialize PMB, setup caches !! */
/*
* We need PMBs for LMI and EMI, both cached and uncached.
* To configure an PMB region, two register writes need to be issued:
* 1: Write to PMB address array, with region virtual address.
* The PMB address array entry is calculated as follows:
* - PMB_SLOT_X_ADDR=0xF610_0X00, X=0-F, with a maximum of 16 regions.
* The slot contents are defined as follows:
* - 0xAA00_0100, AA=Virtual page number, bit 31:30 has to be 0b10
* i.e. VA should located in range 0x8000_0000 - 0xBFFF_FFFF
* Note: VA needs to align with its configured size.
* 2: Write to PMB data array, with region size and cache modes.
* The PMB data array entry is calculated as follows:
* PMB_SLOT_X_DATA=0xF710_0X00, X=0-F, with a maximum of 16 regions.
*/
_invalidate_pmb:
mov.l _pmb_address_base, r1 /* PMB address slot base address */
mov #0, r2 /* Value to be written to PMB address slot */
mov #1, r3 /* PMB address stride, 0x100 */
shll8 r3 /* See above */
mov #0, r0 /* Counter */
_loop_invalid_pmb:
mov.l r2, @r1 /* Clear slot N */
add r3, r1 /* Slot += 1 */
cmp/eq #15, r0 /* Counter == 15? */
bf/s _loop_invalid_pmb /* Note: this is a delayed branch, be careful. */
add #1, r0 /* Counter += 1 */
_setup_pmb:
mova _pmb_poke_start_k, r0
mov r0, r1
mova _pmb_poke_end_k, r0
mov r0, r2
_loop_setup_pmb:
mov.l @r1+, r0 /* 1st word, register address */
mov.l @r1+, r3 /* 2nd word, register value */
mov.l r3, @r0
cmp/gt r1, r2
bt _loop_setup_pmb
_invalidate_caches:
mov.l _ccn_ccr_k, r0
mov #0, r1
mov.l r1, @r0 /* Clear all bits */
nop
nop
nop
nop
nop
nop
nop
nop
nop
_setup_caches:
mov.l _ccn_ccr_value_k, r1
mov.l r1, @r0
nop
nop
nop
nop
nop
nop
nop
nop
nop
_init_lmi:
mov.l _init_ram_k, r1 /* Load actual function address to r1 */
jsr @r1 /* Jump to the init_ram function */
nop
_enable_se_mode:
mov.l _ccn_mmucr_k, r0
mov #4, r1 /* SH4_MMUCR_TI */
mov.l r1, @r0
mov.l _ccn_pascr_k, r0
mov.l _ccn_pascr_value_k, r1
mov.l r1, @r0
_go_non_privileged:
mov.l _copy_app_k, r0
ldc r0, spc
stc sr, r0
ldc r0, ssr
rte
nop
_copy_app:
mov.l _app_copy_end_k, r0 /* App load location, in EMI */
mov.l @r0, r1 /* Offset 0, eidata */
mov.l _app_base_k, r2 /* App execute location, start of LMI RAM */
_loop_copy_app:
mov.l @r0+, r3
mov.l r3, @r2
add #4, r2
cmp/gt r2, r1
bt _loop_copy_app
_jump_to_app:
mov.l _app_entry_k, r0 /* App entry point, in LMI, defined by app */
mov.l @r0, r1
jsr @r1
/* It would be more efficient by using indirect addressing instead of 8 instructions... */
/* Align to 4 byte boundary since we are loading the whole word */
.align 4
/* PMB address register */
_pmb_address_base:
.long 0xF6100000
/* PMB poke tables */
_pmb_poke_start_k:
.long 0xF6100000 /* Address entry #0 register : LMI lower half, 128MB, mapped to 0x8000_0000 */
.long 0x80000100 /* Address entry #0 data : LMI lower half, 128MB, mapped to 0x8000_0000 */
.long 0xF6100100 /* Address entry #1 register : LMI higher half, 128MB, mapped to 0x8800_0000 */
.long 0x88000100 /* Address entry #1 data : LMI higher half, 128MB, mapped to 0x8800_0000 */
.long 0xF6100200 /* Address entry #2 register : LMI lower half, 128MB, mapped to 0x9000_0000 */
.long 0x90000100 /* Address entry #2 data : LMI lower half, 128MB, mapped to 0x9000_0000 */
.long 0xF6100300 /* Address entry #3 register : LMI higher half, 128MB, mapped to 0x9800_0000 */
.long 0x98000100 /* Address entry #3 data : LMI higher half, 128MB, mapped to 0x9800_0000 */
.long 0xF6100400 /* Address entry #4 register : EMI NOR uncached, 64MB, mapped to 0xA000_0000 */
.long 0xA0000100 /* Address entry #4 data : EMI NOR uncached, 64MB, mapped to 0xA000_0000 */
.long 0xF6100500 /* Address entry #5 register : EMI NOR cached, 64MB, mapped to 0xA400_0000 */
.long 0xA4000100 /* Address entry #5 data : EMI NOR cached, 64MB, mapped to 0xA400_0000 */
.long 0xF7100000 /* Data entry #0 register : LMI lower half, 128MB, uncached, unbuffered */
.long 0x40000380 /* Data entry #0 data : LMI lower half, 128MB, uncached, unbuffered */
.long 0xF7100100 /* Data entry #1 register : LMI higher half, 128MB, uncached, unbuffered */
.long 0x48000380 /* Data entry #1 data : LMI higher half, 128MB, uncached, unbuffered */
.long 0xF7100200 /* Data entry #2 register : LMI lower half, 128MB, uncached, unbuffered */
.long 0x40000380 /* Data entry #2 data : LMI lower half, 128MB, uncached, unbuffered */
.long 0xF7100300 /* Data entry #3 register : LMI higher half, 128MB, uncached, unbuffered */
.long 0x48000380 /* Data entry #3 data : LMI higher half, 128MB, uncached, unbuffered */
.long 0xF7100400 /* Data entry #4 register : EMI NOR uncached, 64MB, uncached, unbuffered */
.long 0x00000310 /* Data entry #4 data : EMI NOR uncached, 64MB, uncached, unbuffered */
.long 0xF7100500 /* Data entry #5 register : EMI NOR cached, 64MB, cached, buffered */
.long 0x00000118 /* Data entry #5 data : EMI NOR cached, 64MB, cached, buffered */
_pmb_poke_end_k:
.long 0x0000000
/* CCN CCR address */
_ccn_ccr_k:
.long 0xFF00001C
_ccn_ccr_value_k:
.long 0x8000090D
_ccn_mmucr_k:
.long 0xFF000010
_ccn_pascr_k:
.long 0xFF000070
_ccn_pascr_value_k:
.long 0x80000000
/* SR content */
_sr_k:
.long 0x400000F0
/* WDT */
_cpg_wdt_wtcsr_k:
.long 0xFFC0000C
_cpg_wdt_wtcsr_value_k:
.long 0x0000A500
/* EMI SPI NOR configuration registers */
_emi_spinor_config_data_k:
.long 0xFE702020
_emi_spinor_config_data_value_k:
.long 0x00020011
_emi_spinor_modeselect_k:
.long 0xFE702018
_emi_spinor_modeselect_value_k:
.long 0x00000002
/* PIO registers for debugging */
_gpio_set_k:
.long 0xFD020004
_gpio_clr_k:
.long 0xFD020008
_gpio_clr_pc0_k:
.long 0xFD020028
_gpio_set_pc1_k:
.long 0xFD020034
_gpio_clr_pc2_k:
.long 0xFD020048
_system_config_34_k:
.long 0xFE001188
_system_config_34_value_k:
.long 0x00000F00
_gpio4_clr_pc0_k:
.long 0xFD024028
_gpio4_set_pc1_k:
.long 0xFD024034
_gpio4_set_pc2_k:
.long 0xFD024044
_copy_app_k:
.long _copy_app
/* libc FPU routine */
_set_fpscr_k:
.long ___set_fpscr
/* C library consts */
_stack_k:
.long _stack
_sidata_k:
.long _sidata
_sdata_k:
.long _sdata
_edata_k:
.long _edata
_end_k:
.long _end
/* Function pointers */
_init_ram_k:
.long _memory_setup_init_ram
_app_base_k:
.long 0x80000000U /* App to be copied to */
_app_copy_end_k:
.long 0xA0008000U /* eiaddr */
_app_entry_k:
.long 0xA0008004U

281
startup_stx7105_init_ram.S Normal file
View File

@ -0,0 +1,281 @@
/*
* (C) Copyright 2004-2009 STMicroelectronics.
*
* Andy Sturges <andy.sturges@st.com>
* Start Menefy <stuart.menefy@st.com>
* Sean McGoogan <Sean.McGoogan@st.com>
*
* See file CREDITS for list of people who contributed to this
* project.
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License as
* published by the Free Software Foundation; either version 2 of
* the License, or (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
* MA 02111-1307 USA
*/
/* These macros are compatible to STLinux U-boot. */
#define POKE32(addr, value) .long 0x00000004, addr, value
#define UPDATE32(addr, mask, value) .long 0x00000006, addr, mask, value
#define WHILE_NE32(addr, mask, value) .long 0x00000007, addr, mask, value
#define DELAY(val) /* ST did nothing */
#define END_MARKER .long 0x00000000, 0x00000000, 0x00000000
/* Poke operation list */
.section .rodata.init, "a"
__memory_setup_table:
#include "vendor/pdk7105.romgen"
/*
* Note that we also manually need to move the LMI base addresses to
* their 32-bit SE mode locations as defined in the datasheet and change the
* 'upper bound addresses' (in row attribute registers) for the LMIs.
*/
/* STX7105_SYSCONF_SYS_CFG38 */
UPDATE32(0xfe001000 + 0x0198, 0xFFFFFF00, 0x00000040)
/*
* Change LMI upper bound addresses
* Upper LMI addr=0x40000000 + 512MiB=0x60000000
*/
/* ST40_LMI_SDRA0_0 -> ST40_LMI_REGS_BASE + 0x000030 */
UPDATE32(0xFE901000 + 0x30, 0x001FFFFF, 0x60000000)
/* ST40_LMI_SDRA1_0 -> ST40_LMI_REGS_BASE + 0x000038 */
UPDATE32(0xFE901000 + 0x38, 0x001FFFFF, 0x60000000)
END_MARKER
__memory_setup_table_end:
.long 0x00000000
/*
* NOTE: ALL THIS CODE MUST BE PIC !!!!
*
* This code expects to be run with the caches enabled.
*/
.section .text.init, "ax"
.global _memory_setup_init_ram
_memory_setup_init_ram:
/* Stash the pr somewhere safe */
sts pr, r14
/*
* We need to get the poke loop & associated data
* into caches. The poke loop is structured so that it is
* all pulled into cache on it 1st iteration.
* To get the poke table into D-cache, we simply read it all.
*/
mova _init_ram_poke_loop_address, r0 /* R6: &poke_loop() */
mov.l @r0, r6
add r0, r6
mov.l _init_ram_p2_to_p1_mask, r3 /* R3: P2 -> P1 mapping */
and r3, r6 /* convert to P1 addresses */
mov.l _init_ram_data_start_address, r1 /* R1 = start address */
add r0, r1
mov.l _init_ram_data_end_address, r2 /* R2 = end address */
add r0, r2
and r3, r1 /* convert to a P1 addresses */
and r3, r2
mov r1, r5 /* R5 = scratch data ptr */
1:
mov.l @r5+, r4 /* Load poke table in D$ */
cmp/eq r5, r2
bf 1b
/*
* Its now safe to call the poke loop with real data, since it
* and its associated data table are in onchip caches. Setting
* up the memory interfaces may cause the EMI (where this FLASH
* image resides) to briefly hang - but the CPU will be safely
* executing from cache should this happen.
*/
do_pokes:
jsr @r6 /* R6 still points poke_loop() */
nop
/* Restore the PR */
lds r14, pr
rts
nop
.balign 4
_init_ram_poke_loop_address: .long _init_ram_poke_loop - _init_ram_poke_loop_address
_init_ram_data_start_address: .long __memory_setup_table - _init_ram_poke_loop_address
_init_ram_data_end_address: .long __memory_setup_table_end - _init_ram_poke_loop_address
_init_ram_p2_to_p1_mask: .long ~0x20000000
/*
* This is derived from STMicroelectronics gnu toolchain example:
* sh-superh-elf/examples/os21/romdynamic/bootstrap.S
* but it is not identical, because concurrently U-Boot added the
* IF_DEVID, IF_NOT_DEVID, ELSE and ENDIF commands, while the toolset
* added IF. This merged version supports both.
*/
/*
* The poke table is a series of long words, in the format
*
* opcode, address, operand, ...
*
* An opcode of 0 marks the table end
*/
/*
* Routine to setup peripheral registers.
* It is executed from within the I-cache,
* with all its data in the D-cache
*/
_init_ram_poke_loop:
mov.l @r1+, r0 /* opcode */
mov.l @r1+, r2 /* address */
mov.l @r1+, r3 /* value */
cmp/eq #0, r0 /* End marker ? */
bf 1f
rts /* Return point */
nop
1:
cmp/eq #4, r0 /* 4 byte write... */
bf 1f
mov.l r3, @r2
1:
cmp/eq #2, r0 /* 2 byte write... */
bf 1f
mov.w r3, @r2
1:
cmp/eq #1, r0 /* 1 byte write... */
bf 1f
mov.b r3, @r2
1:
cmp/eq #5, r0 /* 4 byte OR... */
bf 1f
mov.l @r2,r4
or r3,r4
mov.l r4,@r2
1:
cmp/eq #6, r0 /* 4 byte UPDATE... */
bf 1f
mov.l @r2,r4
and r3,r4
mov.l @r1+,r3
or r3,r4
mov.l r4,@r2
1:
cmp/eq #8, r0 /* 4 byte write UPDATE... */
bf 1f
mov.l @r3,r4
mov.l @r1+,r3
and r3,r4
mov.l @r1+,r3
shld r3,r4
mov.l @r1+,r3
or r3,r4
mov.l r4,@r2
1:
cmp/eq #7, r0 /* WHILE != ... */
bf 1f
mov.l @r1+,r5
2:
mov.l @r2,r4
and r3,r4
cmp/eq r4,r5
bf 2b
1:
cmp/eq #9, r0 /* IF_DEVID */
bf 1f /* r2 skip offset, r3 condition, r7 holds out cut value */
cmp/eq r3, r7
bt _init_ram_poke_loop /* go ahead with these pokes */
add r2, r1
bra _init_ram_poke_loop
nop
1:
cmp/eq #10, r0 /* IF_NOT_DEVID */
bf 1f /* r2 skip offset, r3 condition, r7 holds out cut value */
cmp/eq r3, r7
bf _init_ram_poke_loop /* go ahead with these pokes */
add r2, r1
bra _init_ram_poke_loop
nop
1: cmp/eq #11, r0 /* ELSE */
bf 1f /* r2 skip offset, r3 condition, r7 holds out cut value */
add r2, r1
bra _init_ram_poke_loop
nop
1:
cmp/eq #12,r0 /* IF == ... next op */
bf _init_ram_delay
mov.l @r1+,r5
mov.l @r2,r4
and r3,r4
cmp/eq r4,r5
bt _init_ram_poke_loop /* Compare succeeded - perform next op */
2: /* Skip the next operation (read past it) */
mov.l @r1+,r0 /* R0 = opcode */
mov.l @r1+,r2 /* skip address */
mov.l @r1+,r2 /* skip value */
/* How many further reads do we need to skip? */
cmp/eq #12,r0 /* If it's another IF, skip 1 and go back to start of skip loop */
bf 3f
mov.l @r1+,r2
bra 2b
nop
3:
mov #5,r2
cmp/gt r2,r0
bf 5f /* 0 further reads */
cmp/eq #8,r0 /* Is it number 8 (3 reads, otherwise 1 read) */
bf 4f
mov.l @r1+,r2 /* Skip 1 read */
mov.l @r1+,r2 /* Skip 1 read */
4:
mov.l @r1+,r2 /* Skip 1 read and continue */
5:
bra _init_ram_poke_loop
nop
_init_ram_delay:
mov #1,r0 /* small delay after EACH opcode */
swap.w r0, r0 /* 0x10000 iterations (~65k) */
2:
add #-1,r0
cmp/eq #0, r0
bf 2b
bt _init_ram_poke_loop

60
stx7105.ld Normal file
View File

@ -0,0 +1,60 @@
HEAP_SIZE = 0x10000;
STACK_SIZE = 0x10000;
ENTRY(_start)
/* We don't use 29-bit mode since PMB and LMI initialization has to be done anyway. */
MEMORY {
EMI (rx) : ORIGIN = 0xA0000000, LENGTH = 0x00080000 /* EMI virtual address: 0xA000_0000 */
LMI (rwx) : ORIGIN = 0x80000000, LENGTH = 0x10000000 /* LMI virtual address: 0x8000_0000 */
}
SECTIONS {
.text : {
. = ALIGN(4);
*(.text.init)
*(.text.exc)
*(.text)
*(.text*)
*(.rodata)
*(.rodata*)
. = ALIGN(4);
} >EMI
_sidata = LOADADDR(.data);
.data : {
. = ALIGN(4);
_sdata = .;
*(.data)
*(.data*)
. = ALIGN(4);
_edata = .;
} >LMI AT >EMI
.bss : {
. = ALIGN(4);
__bss_start = .;
*(.bss)
*(.bss*)
*(COMMON)
. = ALIGN(8);
_end = .;
__end = _end;
} >LMI
.heap : {
. = ALIGN(8);
. += HEAP_SIZE;
}
.stack : {
. = ALIGN(8);
. += STACK_SIZE;
}
_stack = ORIGIN(LMI) + LENGTH(LMI);
PROVIDE(__stack = _stack);
}

14
tools/flash_image.sh Executable file
View File

@ -0,0 +1,14 @@
#!/bin/sh
IMAGE_NAME=$1
if [ -z "${IMAGE_NAME}" ] ; then
IMAGE_NAME=image.bin
fi
if [ ! -f "${IMAGE_NAME}" ] ; then
echo "binary not exist."
exit -1
fi
flashrom --programmer ch341a_spi -w "${IMAGE_NAME}"

33
tools/pad_image.sh Executable file
View File

@ -0,0 +1,33 @@
#!/bin/sh
FLASH_SIZE=32768
INPUT_IMAGE="$1"
BINARY_NAME="$2"
# ELF name not a valid name.
if [ ! -f "${INPUT_IMAGE}" ] ; then
echo "No such file."
exit -1
fi
# Output name not set..
if [ -z "${BINARY_NAME}" ] ; then
echo "Binary name not set, using default"
BINARY_NAME="image.bin"
fi
# Create binary file from ELF
sh-unknown-elf-objcopy -O binary ${INPUT_IMAGE} ${BINARY_NAME}
if [ "$?" -lt "0" ] ; then
exit -2
fi
# Calculate size and padding length
BINARY_SIZE=`stat --format "%s" ${BINARY_NAME}`
PAD_SIZE=$((${FLASH_SIZE} - ${BINARY_SIZE}))
echo "Output binary size: ${BINARY_SIZE}, additional padding: ${PAD_SIZE}."
# Pad output file using `dd`
tr '\0' '\377' < /dev/zero | dd bs=1 count=${PAD_SIZE} of=${BINARY_NAME} conv=notrunc seek=${BINARY_SIZE}

549
vendor/pdk7105.romgen vendored Executable file
View File

@ -0,0 +1,549 @@
/*
sdk7105 connect start - parameters {'no_devid_validate': '1', 'no_convertor_abort': '1', 'no_devid_abort': '1'}
Initialization TCK frequency set to 1562500 Hz
Device id 0x1d43e041
tapmux connect(): boot mode single core setup
tapmux setup to bypass to core st40, channel 1
sdk7105 initialization start ...
sdk7105_setup - parameters {'tapmux_bypass_init': u'st40', 'no_devid_validate': '1', 'no_convertor_abort': '1', 'reset_low_period': 360000, 'no_devid_abort': '1'}
Chip infos
*/
/*
stx7105_sysconf_regs.SYSCONF_DEVICEID0
PEEK(0xfe001000) (used target peek value 0x1d43e041)
Device ID = 0x1D43E041 ==> STi7105 cut 2
*/
/*
stx7105_sysconf_regs.SYSCONF_STA1
PEEK(0xfe00100c) (used target peek value 0x00001015)
Mode pins = 0x00001015 ==> ClockgenA ref : SYSCLKIN/OSC
Boot mode ... : ST40 first
Boot port size: 16-bits
Boot device . : NOR flash
*/
/*stx7105_sysconf_regs.SYSCONF_CFG40*/
POKE32(0xfe0011a0, 0x00000005)
POKE32(0xfe0011a0, 0x00000005)
/*stx7105_sysconf_regs.SYSCONF_CFG04*/
POKE32(0xfe001110, 0x000001a6)
/* Magic sequence to configure the ClockGenA switch control to reset values*/
/* These do not appear to be correctly reset on WDT reset so do it here */
/* CLOCKGEN A CKGA_CLKOPSRC_SWITCH_CFG reset=0 */
POKE32(0xfe213014, 0x00000000)
/* CLOCKGEN A CKGA_CLKOPSRC_SWITCH_CFG2 reset=0 */
POKE32(0xfe213024, 0x00000000)
/*stx7105_clockgena_regs.CKGA_PLL0_ENABLE_FB*/
WHILE_NE32(0xfe21301c, 0xffffffff, 0x00000000)
/*stx7105_clockgena_regs.CKGA_PLL1_ENABLE_FB*/
WHILE_NE32(0xfe213020, 0xffffffff, 0x00000000)
/*stx7105_clockgena_regs.CKGA_PLL0_CFG*/
POKE32(0xfe213000, 0x80101e02)
/*stx7105_clockgena_regs.CKGA_POWER_CFG*/
POKE32(0xfe213010, 0x00000001)
/*stx7105_clockgena_regs.CKGA_PLL0_CFG*/
POKE32(0xfe213000, 0x00180f01)
/*stx7105_clockgena_regs.CKGA_POWER_CFG*/
POKE32(0xfe213010, 0x00000000)
/*stx7105_clockgena_regs.CKGA_PLL0_CFG*/
WHILE_NE32(0xfe213000, 0x80000000, 0x80000000)
/*stx7105_clockgena_regs.CKGA_PLL0_CFG*/
POKE32(0xfe213000, 0x80000f01)
/*stx7105_clockgena_regs.CKGA_PLL1_CFG*/
POKE32(0xfe213004, 0x80102803)
POKE32(0xfe213b00, 0x00000001) /*stx7105_clockgena_regs.CKGA_PLL1_DIV0_CFG*/
POKE32(0xfe213b04, 0x00000001) /*stx7105_clockgena_regs.CKGA_PLL1_DIV1_CFG*/
POKE32(0xfe213b08, 0x00000001) /*stx7105_clockgena_regs.CKGA_PLL1_DIV2_CFG*/
POKE32(0xfe213b0c, 0x00000103) /*stx7105_clockgena_regs.CKGA_PLL1_DIV3_CFG*/
POKE32(0xfe213a10, 0x00010100) /*stx7105_clockgena_regs.CKGA_PLL0LS_DIV4_CFG*/
POKE32(0xfe213b14, 0x00000307) /*stx7105_clockgena_regs.CKGA_PLL1_DIV5_CFG*/
POKE32(0xfe213a18, 0x00010100) /*stx7105_clockgena_regs.CKGA_PLL0LS_DIV6_CFG*/
POKE32(0xfe213a1c, 0x00010100) /*stx7105_clockgena_regs.CKGA_PLL0LS_DIV7_CFG*/
POKE32(0xfe213b20, 0x00000103) /*stx7105_clockgena_regs.CKGA_PLL1_DIV8_CFG*/
POKE32(0xfe213b24, 0x00000103) /*stx7105_clockgena_regs.CKGA_PLL1_DIV9_CFG*/
POKE32(0xfe213b28, 0x00000103) /*stx7105_clockgena_regs.CKGA_PLL1_DIV10_CFG*/
POKE32(0xfe213b2c, 0x00000103) /*stx7105_clockgena_regs.CKGA_PLL1_DIV11_CFG*/
POKE32(0xfe213b30, 0x00000102) /*stx7105_clockgena_regs.CKGA_PLL1_DIV12_CFG*/
POKE32(0xfe213a34, 0x00000811) /*stx7105_clockgena_regs.CKGA_PLL0LS_DIV13_CFG*/
POKE32(0xfe213b38, 0x0000050b) /*stx7105_clockgena_regs.CKGA_PLL1_DIV14_CFG*/
POKE32(0xfe213b3c, 0x00000307) /*stx7105_clockgena_regs.CKGA_PLL1_DIV15_CFG*/
POKE32(0xfe213b40, 0x00000103) /*stx7105_clockgena_regs.CKGA_PLL1_DIV16_CFG*/
POKE32(0xfe213b44, 0x00000103) /*stx7105_clockgena_regs.CKGA_PLL1_DIV17_CFG*/
POKE32(0xfe213010, 0x00000002) /*stx7105_clockgena_regs.CKGA_POWER_CFG*/
POKE32(0xfe213004, 0x00182803) /*stx7105_clockgena_regs.CKGA_PLL1_CFG*/
POKE32(0xfe213010, 0x00000000) /*stx7105_clockgena_regs.CKGA_POWER_CFG*/
WHILE_NE32(0xfe213004, 0x80000000, 0x80000000) /*stx7105_clockgena_regs.CKGA_PLL1_CFG*/
POKE32(0xfe213004, 0x80002803) /*stx7105_clockgena_regs.CKGA_PLL1_CFG*/
POKE32(0xfe213014, 0xa6aa59aa) /*stx7105_clockgena_regs.CKGA_CLKOPSRC_SWITCH_CFG*/
POKE32(0xfe213024, 0x0000000a) /*stx7105_clockgena_regs.CKGA_CLKOPSRC_SWITCH_CFG2*/
/*stx7105_sysconf_regs.SYSCONF_CFG11*/
POKE32(0xfe00112c, 0x00001d28)
POKE32(0xfe00112c, 0x00001af4)
POKE32(0xfe00112c, 0x00000af4)
/*stx7105_sysconf_regs.SYSCONF_STA3*/
WHILE_NE32(0xfe001014, 0x00000001, 0x00000000)
/*set_lmi2x_freq: freq=800.000 rdiv=0x3, ddiv=0x50 Clock frequencies*/
/*stx7105_sysconf_regs.SYSCONF_CFG04*/
POKE32(0xfe001110, 0x000001a2)
/*stx7105_sysconf_regs.SYSCONF_CFG11*/
POKE32(0xfe00112c, 0x08000af5)
/*stx7105_sysconf_regs.SYSCONF_CFG12*/
POKE32(0xfe001130, 0xa000380f)
POKE32(0xfe001130, 0xa000380f)
POKE32(0xfe001130, 0xa000380f)
POKE32(0xfe001130, 0xa000380f)
POKE32(0xfe001130, 0xa000380f)
POKE32(0xfe001130, 0xa000380f)
POKE32(0xfe001130, 0xa200380f)
POKE32(0xfe001130, 0xa200380f)
POKE32(0xfe001130, 0xa200380f)
POKE32(0xfe001130, 0xa200380f)
POKE32(0xfe001130, 0xa200380f)
POKE32(0xfe001130, 0xa200780f)
POKE32(0xfe001130, 0xa200780f)
POKE32(0xfe001130, 0xa200680f)
POKE32(0xfe001130, 0xa200680f)
POKE32(0xfe001130, 0xa200680f)
POKE32(0xfe001130, 0xa200680f)
POKE32(0xfe001130, 0xa200680f)
POKE32(0xfe001130, 0xa200684f)
POKE32(0xfe001130, 0xa200686f)
/*
POKE32(0xfe001130, 0xa200687f)
POKE32(0xfe001130, 0xa200687f)
POKE32(0xfe001130, 0xa200687f)
POKE32(0xfe001130, 0xa200687f)
POKE32(0xfe001130, 0xa200687f)
*/
POKE32(0xfe001130, 0xa200687f)
POKE32(0xfe001130, 0xa200687f)
POKE32(0xfe001130, 0xa200687f)
POKE32(0xfe001130, 0xa200687f)
POKE32(0xfe001130, 0xa200687f)
/*stx7105_sysconf_regs.SYSCONF_CFG13*/
POKE32(0xfe001134, 0x00400000)
POKE32(0xfe001134, 0x00600000)
POKE32(0xfe001134, 0x00600000)
POKE32(0xfe001134, 0x00600000)
POKE32(0xfe001134, 0x00600000)
POKE32(0xfe001134, 0x00600000)
POKE32(0xfe001134, 0x00600000)
POKE32(0xfe001134, 0x00600000)
POKE32(0xfe001134, 0x00600000)
/*stx7105_sysconf_regs.SYSCONF_CFG14*/
POKE32(0xfe001138, 0x00000000)
POKE32(0xfe001138, 0x00000000)
POKE32(0xfe001138, 0x00000000)
POKE32(0xfe001138, 0x00000000)
POKE32(0xfe001138, 0x00000000)
POKE32(0xfe001138, 0x00000000)
/*stx7105_sysconf_regs.SYSCONF_CFG38*/
POKE32(0xfe001198, 0x0000fe00)
POKE32(0xfe001198, 0x0000fe00)
POKE32(0xfe001198, 0x0000fe00)
POKE32(0xfe001198, 0x0020fe00)
POKE32(0xfe001198, 0x0020fe00)
POKE32(0xfe001198, 0x002cfe00)
POKE32(0xfe001198, 0x002ffe00)
POKE32(0xfe001198, 0x002ffe0c)
/*stx7105_sysconf_regs.SYSCONF_CFG40*/
POKE32(0xfe0011a0, 0x00000005)
/*stx7105_sysconf_regs.SYSCONF_CFG42*/
POKE32(0xfe0011a8, 0x20000000)
POKE32(0xfe0011a8, 0x28000000)
POKE32(0xfe0011a8, 0x2fb80000)
POKE32(0xfe0011a8, 0x2fbbdc00)
POKE32(0xfe0011a8, 0x2fbbddee)
/*stx7105_sysconf_regs.SYSCONF_CFG43*/
POKE32(0xfe0011ac, 0x00000000)
POKE32(0xfe0011ac, 0x18000000)
POKE32(0xfe0011ac, 0x18a00000)
POKE32(0xfe0011ac, 0x18a001ee)
/*stx7105_sysconf_regs.SYSCONF_CFG51*/
POKE32(0xfe0011cc, 0x00000000)
POKE32(0xfe0011cc, 0x00000000)
/*stx7105_sysconf_regs.SYSCONF_CFG52*/
POKE32(0xfe0011d0, 0x00000000)
POKE32(0xfe0011d0, 0x00000000)
/*stx7105_sysconf_regs.SYSCONF_CFG55*/
POKE32(0xfe0011dc, 0x00002000)
POKE32(0xfe0011dc, 0x00002000)
POKE32(0xfe0011dc, 0x00002000)
POKE32(0xfe0011dc, 0x07fc2000)
POKE32(0xfe0011dc, 0x07fc2000)
POKE32(0xfe0011dc, 0x07fc2000)
POKE32(0xfe0011dc, 0x07fc2000)
POKE32(0xfe0011dc, 0x07fc2280)
POKE32(0xfe0011dc, 0x07fc22c0)
POKE32(0xfe0011dc, 0x07fc22c0)
POKE32(0xfe0011dc, 0x07fc22c4)
/*stx7105_sysconf_regs.SYSCONF_CFG04*/
POKE32(0xfe001110, 0x000001a6)
DELAY(10)
/*stx7105_sysconf_regs.SYSCONF_CFG13*/
POKE32(0xfe001134, 0x00600000)
/*stx7105_sysconf_regs.SYSCONF_CFG14*/
POKE32(0xfe001138, 0x00000000)
/*stx7105_sysconf_regs.SYSCONF_CFG42*/
POKE32(0xfe0011a8, 0x2fbbddee)
POKE32(0xfe0011a8, 0x2fbbddee)
POKE32(0xfe0011a8, 0x2fbbddee)
/*stx7105_sysconf_regs.SYSCONF_CFG43*/
POKE32(0xfe0011ac, 0x18a001ee)
POKE32(0xfe0011ac, 0x18a001ee)
/*stx7105_sysconf_regs.SYSCONF_CFG51*/
POKE32(0xfe0011cc, 0x00000000)
POKE32(0xfe0011cc, 0x00000000)
/*stx7105_sysconf_regs.SYSCONF_CFG52*/
POKE32(0xfe0011d0, 0x00000000)
POKE32(0xfe0011d0, 0x00000000)
/*stx7105_sysconf_regs.SYSCONF_CFG55*/
POKE32(0xfe0011dc, 0x07fc22c4)
/*stx7105_sysconf_regs.SYSCONF_CFG04*/
POKE32(0xfe001110, 0x000001a2)
/*stx7105_sysconf_regs.SYSCONF_CFG11*/
POKE32(0xfe00112c, 0x00000af5)
POKE32(0xfe00112c, 0x00000af4)
DELAY(10)
POKE32(0xfe00112c, 0x08000af4)
POKE32(0xfe00112c, 0x08000af5)
DELAY(10)
/*stx7105_sysconf_regs.SYSCONF_CFG04*/
POKE32(0xfe001110, 0x000001a6)
DELAY(10)
/*st40_emi_regs.EMI_BANK_ENABLE*/
POKE32(0xfe700860, 0x00000005)
POKE32(0xfe700800, 0x00000000) /*st40_emi_regs.EMI_BANK0_BASEADDRESS*/
POKE32(0xfe700810, 0x00000010) /*st40_emi_regs.EMI_BANK1_BASEADDRESS*/
POKE32(0xfe700820, 0x00000018) /*st40_emi_regs.EMI_BANK2_BASEADDRESS*/
POKE32(0xfe700830, 0x0000001a) /*st40_emi_regs.EMI_BANK3_BASEADDRESS*/
POKE32(0xfe700840, 0x0000001c) /*st40_emi_regs.EMI_BANK4_BASEADDRESS*/
/*st40_emi_regs.EMI_BANK0_EMICONFIGDATA0-3*/
POKE32(0xfe700100, 0x001016d1)
POKE32(0xfe700108, 0x9d200000)
POKE32(0xfe700110, 0x9d220000)
POKE32(0xfe700118, 0x00000000)
/*st40_emi_regs.EMI_BANK1_EMICONFIGDATA0-3*/
POKE32(0xfe700140, 0x002016d1)
POKE32(0xfe700148, 0x9d222200)
POKE32(0xfe700150, 0x9d220044)
POKE32(0xfe700158, 0x00000000)
/*st40_emi_regs.EMI_BANK2_EMICONFIGDATA0-3*/
POKE32(0xfe700180, 0x002046f9)
POKE32(0xfe700188, 0xa5a00000)
POKE32(0xfe700190, 0xa5a20000)
POKE32(0xfe700198, 0x00000000)
/*st40_emi_regs.EMI_BANK3_EMICONFIGDATA0-3*/
POKE32(0xfe7001c0, 0x002016d1)
POKE32(0xfe7001c8, 0x9d222200)
POKE32(0xfe7001d0, 0x9d220044)
POKE32(0xfe7001d8, 0x00000000)
/*st40_emi_regs.EMI_BANK4_EMICONFIGDATA0-3*/
POKE32(0xfe700200, 0x002016d1)
POKE32(0xfe700208, 0x9d222200)
POKE32(0xfe700210, 0x9d220044)
POKE32(0xfe700218, 0x00000000)
/*st40_emi_regs.EMI_GENCFG*/
POKE32(0xfe700028, 0x00000010)
/*st40_lmigp_regs.LMI_MIM_0-1*/
POKE32(0xfe901008, 0x0b30017b)
POKE32(0xfe90100c, 0x000000b0)
/*st40_lmigp_regs.LMI_STR_0-1*/
POKE32(0xfe901018, 0xcf35b424)
POKE32(0xfe90101c, 0x00242ed8)
/*st40_lmigp_regs.LMI_SDRA0_0-1*/
POKE32(0xfe901030, 0x1c001a20)
POKE32(0xfe901038, 0x1c001a20)
DELAY(200000)
/*st40_lmigp_regs.LMI_SCR_0*/
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020023)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020022)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
/*st40_lmigp_regs.LMI_SDMR0_0*/
POKE32(0xfe901048, 0x00010000)
/*st40_lmigp_regs.LMI_SDMR0_0*/
POKE32(0xfe901048, 0x00018000)
/*st40_lmigp_regs.LMI_SDMR0_0*/
POKE32(0xfe901048, 0x00008006)
/*st40_lmigp_regs.LMI_SDMR0_0*/
POKE32(0xfe901048, 0x00004363)
/*st40_lmigp_regs.LMI_SCR_0*/
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020022)
POKE32(0xfe901010, 0x00020024)
POKE32(0xfe901010, 0x00020024)
/*st40_lmigp_regs.LMI_SDMR0_0*/
POKE32(0xfe901048, 0x00004263)
/*st40_lmigp_regs.LMI_MIM_0*/
POKE32(0xfe901008, 0x0b30037b)
POKE32(0xfe901008, 0x0b30037b)
/*st40_lmigp_regs.LMI_SCR_0*/
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
POKE32(0xfe901010, 0x00020021)
/*st40_lmigp_regs.LMI_GCC_0*/
POKE32(0xfe901028, 0x00000000)
/*Info: correcting interco reset setup*/
POKE32(0xfe20d200, 0x00000005)
POKE32(0xfe20d204, 0x00000004)
POKE32(0xfe20d208, 0x00000003)
POKE32(0xfe20d20c, 0x00000002)
POKE32(0xfe20d210, 0x00000001)
POKE32(0xfe20d214, 0x00000001)
POKE32(0xfe20d218, 0x00000001)
POKE32(0xfe20d21c, 0x00000001)
POKE32(0xfe20d220, 0x00000001)
POKE32(0xfe2410fc, 0x00000005)
POKE32(0xfe20a0ec, 0x00000002)
POKE32(0xfe20a0f0, 0x00000005)
POKE32(0xfe20a0f4, 0x00000003)
POKE32(0xfe20a0f8, 0x00000003)
POKE32(0xfe20a1ec, 0x00000002)
POKE32(0xfe20a1f0, 0x00000005)
POKE32(0xfe20a1f4, 0x00000003)
POKE32(0xfe20a1f8, 0x00000003)
POKE32(0xfe20a1fc, 0x00000000)
POKE32(0xfe20a2ec, 0x00000002)
POKE32(0xfe20a2f0, 0x00000005)
POKE32(0xfe20a2f4, 0x00000003)
POKE32(0xfe20a2f8, 0x00000003)
POKE32(0xfe20a2fc, 0x00000000)
POKE32(0xfe20a3ec, 0x00000002)
POKE32(0xfe20a3f0, 0x00000005)
POKE32(0xfe20a3f4, 0x00000003)
POKE32(0xfe20a3f8, 0x00000003)
POKE32(0xfe20a3fc, 0x00000000)
POKE32(0xfe20aefc, 0x00000005)
POKE32(0xfe540034, 0x00000003)
POKE32(0xfe540038, 0x00000000)
POKE32(0xfe540110, 0x00010303)
POKE32(0xfe540114, 0x00000000)
POKE32(0xfe540030, 0x00000005)
POKE32(0xfe54010c, 0x00000005)
POKE32(0xfe540600, 0x00000006)
POKE32(0xfe540604, 0x00000005)
POKE32(0xfe540608, 0x00000004)
POKE32(0xfe54060c, 0x00000003)
POKE32(0xfe540610, 0x00000002)
POKE32(0xfe540614, 0x00000001)
POKE32(0xfe540618, 0x00000000)
POKE32(0xfe540680, 0x00000001)
POKE32(0xfe540684, 0x00000000)
POKE32(0xfe20bb04, 0x00000005)
POKE32(0xfe20bb08, 0x00000003)
POKE32(0xfe20bb10, 0x00000002)
POKE32(0xfe20bb24, 0x00000005)
POKE32(0xfe20bb28, 0x00000003)
POKE32(0xfe20bb2c, 0x00000000)
POKE32(0xfe20bb30, 0x00000002)
POKE32(0xfe20bb44, 0x00000005)
POKE32(0xfe20bb48, 0x00000003)
POKE32(0xfe20bb4c, 0x00000000)
POKE32(0xfe20bb50, 0x00000002)
POKE32(0xfe20bb84, 0x00000005)
POKE32(0xfe20bb88, 0x00000003)
POKE32(0xfe20bb8c, 0x00000000)
POKE32(0xfe20bb90, 0x00000002)
POKE32(0xfe20a0fc, 0x00000000)
POKE32(0xfe20bb0c, 0x00000000)
POKE32(0xfe231010, 0x00000008)
POKE32(0xfe231080, 0x00000221)
POKE32(0xfe261010, 0x00000008)
POKE32(0xfe261080, 0x00000221)
POKE32(0xfd101024, 0x0003c000)
POKE32(0xfd101824, 0x0003c000)
POKE32(0xfd104d24, 0x0003c000)
POKE32(0xfd102024, 0x0003c000)
/* PEEK(0xfe001180) (used target peek value 0x00000b35) */
POKE32(0xfe001180, 0x00000b05)
POKE32(0xfe1fff04, 0x00254608)
POKE32(0xfeafff04, 0x00254608)
/* PEEK(0xfe00111c) (used target peek value 0x08081508) */
POKE32(0xfe00111c, 0x08091508)
POKE32(0xfd117000, 0x0025c608)
POKE32(0xfd111000, 0x00201004)
/* PEEK(0xfe001180) (used target peek value 0x00000b05) */
POKE32(0xfe001180, 0x00000b01)
POKE32(0xfe401744, 0x0025c005)
/*st40_ccn_regs.CCN_CCR*/
POKE32(0xff00001c, 0x8000090d)
/*stx7105_sysconf_regs.SYSCONF_CFG09*/
POKE32(0xfe001124, 0x08000a8c)
/*stx7105_sysconf_regs.SYSCONF_CFG05*/
POKE32(0xfe001114, 0x04000040)
/*stx7105_sysconf_regs.SYSCONF_CFG26*/
POKE32(0xfe001168, 0xfe804001)
/*stx7105_sysconf_regs.SYSCONF_CFG27*/
POKE32(0xfe00116c, 0x00001fd1)
POKE32(0xfe00116c, 0x00001fd0)
/*stx7105: booted audio companion*/
/*stx7105_sysconf_regs.SYSCONF_CFG09*/
POKE32(0xfe001124, 0x08000a8c)
/*stx7105_sysconf_regs.SYSCONF_CFG05*/
POKE32(0xfe001114, 0x04000040)
/*stx7105_sysconf_regs.SYSCONF_CFG28*/
POKE32(0xfe001170, 0xfe604001)
/*stx7105_sysconf_regs.SYSCONF_CFG29*/
POKE32(0xfe001174, 0x00001fcd)
/*stx7105_sysconf_regs.SYSCONF_CFG29*/
POKE32(0xfe001174, 0x00001fcc)
/* stx7105: booted video companion*/
/* TCK frequency set to 12500000 Hz*/
/* tapmux complete_connect(): single core setup*/
/* sdk7105 initialization complete*/