From cd630c9e0a2e0aa259a6e53a5af1369f36984b1c Mon Sep 17 00:00:00 2001 From: Tomasz Malesinski Date: Sat, 24 Mar 2007 19:26:13 +0000 Subject: PNX0101 changes: Make PNX0101-specific system.c and crt0.S. Add new register names from LPC2880 user manual. Add support for timer. Enable CPU frequency changing. git-svn-id: svn://svn.rockbox.org/rockbox/trunk@12904 a1c6a512-1295-4272-9138-f99709370657 --- firmware/target/arm/crt0-pnx0101.S | 229 +++++++++++++++++++++++ firmware/target/arm/crt0.S | 24 --- firmware/target/arm/system-pnx0101.c | 351 +++++++++++++++++++++++++++++++++++ 3 files changed, 580 insertions(+), 24 deletions(-) create mode 100644 firmware/target/arm/crt0-pnx0101.S create mode 100644 firmware/target/arm/system-pnx0101.c (limited to 'firmware/target/arm') diff --git a/firmware/target/arm/crt0-pnx0101.S b/firmware/target/arm/crt0-pnx0101.S new file mode 100644 index 0000000000..d11546edaa --- /dev/null +++ b/firmware/target/arm/crt0-pnx0101.S @@ -0,0 +1,229 @@ +/*************************************************************************** + * __________ __ ___. + * Open \______ \ ____ ____ | | _\_ |__ _______ ___ + * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / + * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < + * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ + * \/ \/ \/ \/ \/ + * $Id: crt0.S 11850 2006-12-29 02:49:12Z markun $ + * + * Copyright (C) 2002 by Linus Nielsen Feltzing + * + * All files in this archive are subject to the GNU General Public License. + * See the file COPYING in the source tree root for full license agreement. + * + * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY + * KIND, either express or implied. + * + ****************************************************************************/ +#define ASM /* do not include structure definitions from pnx0101.h */ + +#include "config.h" +#include "cpu.h" + + .section .init.text,"ax",%progbits + + .global start +start: + +/* Arm bootloader and startup code based on startup.s from the iPodLinux loader + * + * Copyright (c) 2003, Daniel Palffy (dpalffy (at) rainstorm.org) + * Copyright (c) 2005, Bernard Leach + * + */ + + msr cpsr_c, #0xd3 /* enter supervisor mode, disable IRQ */ + +#ifndef BOOTLOADER +#ifndef DEBUG + ldr r0, =0x80105000 + mov r1, #1 + str r1, [r0, #4] + mov r1, #0 + str r1, [r0, #4] +1: ldr r1, [r0] + cmp r1, #0 + bne 1b + mov r1, #0x74 + str r1, [r0, #8] + mov r1, #2 + str r1, [r0, #0x18] + mov r1, #2 + str r1, [r0, #0x20] + mov r1, #82 + str r1, [r0, #0x28] + mov r1, #100 + str r1, [r0, #0x2c] + mov r1, #0x120 + str r1, [r0, #0x30] + mov r1, #6 + str r1, [r0, #4] + ldr r0, =1f + mov r15, r0 +1: +#endif /* !DEBUG */ + +#ifndef DEBUG + /* Copy exception handler code to address 0 */ + ldr r2, =_vectorsstart + ldr r3, =_vectorsend + ldr r4, =_vectorscopy +1: + cmp r3, r2 + ldrhi r5, [r4], #4 + strhi r5, [r2], #4 + bhi 1b +#else + ldr r1, =vectors + ldr r0, =irq_handler + str r0, [r1, #24] + ldr r0, =fiq_handler + str r0, [r1, #28] +#endif + +#ifndef STUB + /* Zero out IBSS */ + ldr r2, =_iedata + ldr r3, =_iend + mov r4, #0 +1: + cmp r3, r2 + strhi r4, [r2], #4 + bhi 1b + + /* Copy the IRAM */ + ldr r2, =_iramcopy + ldr r3, =_iramstart + ldr r4, =_iramend +1: + cmp r4, r3 + ldrhi r5, [r2], #4 + strhi r5, [r3], #4 + bhi 1b +#endif /* !STUB */ +#endif /* !BOOTLOADER */ + + /* Initialise bss section to zero */ + ldr r2, =_edata + ldr r3, =_end + mov r4, #0 +1: + cmp r3, r2 + strhi r4, [r2], #4 + bhi 1b + + /* Set up some stack and munge it with 0xdeadbeef */ + ldr sp, =stackend + mov r3, sp + ldr r2, =stackbegin + ldr r4, =0xdeadbeef +1: + cmp r3, r2 + strhi r4, [r2], #4 + bhi 1b + + /* Set up stack for IRQ mode */ + msr cpsr_c, #0xd2 + ldr sp, =irq_stack + /* Set up stack for FIQ mode */ + msr cpsr_c, #0xd1 + ldr sp, =fiq_stack + + /* Let abort and undefined modes use IRQ stack */ + msr cpsr_c, #0xd7 + ldr sp, =irq_stack + msr cpsr_c, #0xdb + ldr sp, =irq_stack + /* Switch to supervisor mode */ + msr cpsr_c, #0xd3 + ldr sp, =stackend + bl main + /* main() should never return */ + +/* Exception handlers. Will be copied to address 0 after memory remapping */ + .section .vectors,"aw" + ldr pc, [pc, #24] + ldr pc, [pc, #24] + ldr pc, [pc, #24] + ldr pc, [pc, #24] + ldr pc, [pc, #24] + ldr pc, [pc, #24] + ldr pc, [pc, #24] + ldr pc, [pc, #24] + + /* Exception vectors */ + .global vectors +vectors: + .word start + .word undef_instr_handler + .word software_int_handler + .word prefetch_abort_handler + .word data_abort_handler + .word reserved_handler + .word irq_handler + .word fiq_handler + + .text + +#ifndef STUB + .global irq + .global fiq + .global UIE +#endif + +/* All illegal exceptions call into UIE with exception address as first + parameter. This is calculated differently depending on which exception + we're in. Second parameter is exception number, used for a string lookup + in UIE. + */ +undef_instr_handler: + mov r0, lr + mov r1, #0 + b UIE + +/* We run supervisor mode most of the time, and should never see a software + exception being thrown. Perhaps make it illegal and call UIE? + */ +software_int_handler: +reserved_handler: + movs pc, lr + +prefetch_abort_handler: + sub r0, lr, #4 + mov r1, #1 + b UIE + +fiq_handler: + @ Branch straight to FIQ handler in pcm_playback.c. This also handles the + @ the correct return sequence. + stmfd sp!, {r0-r7, r12, lr} + bl fiq + ldmfd sp!, {r0-r7, r12, lr} + subs pc, lr, #4 + +data_abort_handler: + sub r0, lr, #8 + mov r1, #2 + b UIE + +irq_handler: +#ifndef STUB + stmfd sp!, {r0-r11, r12, lr} + bl irq + ldmfd sp!, {r0-r11, r12, lr} +#endif + subs pc, lr, #4 + +#ifdef STUB +UIE: + b UIE +#endif + +/* 256 words of IRQ stack */ + .space 256*4 +irq_stack: + +/* 256 words of FIQ stack */ + .space 256*4 +fiq_stack: diff --git a/firmware/target/arm/crt0.S b/firmware/target/arm/crt0.S index c552e44320..581a997477 100644 --- a/firmware/target/arm/crt0.S +++ b/firmware/target/arm/crt0.S @@ -34,30 +34,6 @@ start: msr cpsr_c, #0xd3 /* enter supervisor mode, disable IRQ */ #ifndef BOOTLOADER -#if CONFIG_CPU == PNX0101 - -#ifndef DEBUG - ldr r0, =0x80105000 - mov r1, #1 - str r1, [r0, #4] - mov r1, #0 - str r1, [r0, #4] -1: ldr r1, [r0] - cmp r1, #0 - bne 1b - mov r1, #0x74 - str r1, [r0, #8] - mov r1, #2 - str r1, [r0, #0x18] - mov r1, #0x120 - str r1, [r0, #0x30] - mov r1, #6 - str r1, [r0, #4] - ldr r0, =1f - mov r15, r0 -1: -#endif /* !DEBUG */ -#endif /* chipset specific */ #ifndef DEBUG /* Copy exception handler code to address 0 */ diff --git a/firmware/target/arm/system-pnx0101.c b/firmware/target/arm/system-pnx0101.c new file mode 100644 index 0000000000..9d8bb405a8 --- /dev/null +++ b/firmware/target/arm/system-pnx0101.c @@ -0,0 +1,351 @@ +/*************************************************************************** + * __________ __ ___. + * Open \______ \ ____ ____ | | _\_ |__ _______ ___ + * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / + * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < + * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ + * \/ \/ \/ \/ \/ + * $Id: $ + * + * Copyright (C) 2007 by Tomasz Malesinski + * + * All files in this archive are subject to the GNU General Public License. + * See the file COPYING in the source tree root for full license agreement. + * + * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY + * KIND, either express or implied. + * + ****************************************************************************/ + +#include +#include "pnx0101.h" +#include "system.h" + +static struct +{ + unsigned char freq; + unsigned char sys_mult; + unsigned char sys_div; + unsigned char mem_conf[9]; +} +perf_modes[3] ICONST_ATTR = +{ + {12, 4, 4, {2, 1, 1, 1, 1, 1, 1, 1, 1, 0}}, + {48, 4, 1, {5, 4, 1, 4, 4, 1, 3, 3, 1, 0}}, + {60, 5, 1, {6, 5, 1, 5, 5, 1, 4, 3, 1, 1}} +}; + +static int performance_mode, bus_divider; + +static void cgu_set_sel_stage_input(int clock, int input) +{ + int s = CGU.base_ssr[clock]; + if (s & 1) + CGU.base_fs2[clock] = input; + else + CGU.base_fs1[clock] = input; + CGU.base_scr[clock] = (s & 3) ^ 3; +} + +static void cgu_reset_sel_stage_clocks(int first_esr, int n_esr, + int first_div, int n_div) +{ + int i; + for (i = 0; i < n_esr; i++) + CGU.clk_esr[first_esr + i] = 0; + for (i = 0; i < n_div; i++) + CGU.base_fdc[first_div + i] = 0; +} + +static void cgu_configure_div(int div, int n, int m) +{ + int msub, madd, div_size, max_n; + unsigned long cfg; + + if (n == m) + { + CGU.base_fdc[div] = CGU.base_fdc[div] & ~1; + return; + } + + msub = -n; + madd = m - n; + div_size = (div == PNX0101_HIPREC_FDC) ? 10 : 8; + max_n = 1 << div_size; + while ((madd << 1) < max_n && (msub << 1) >= -max_n) + { + madd <<= 1; + msub <<= 1; + } + cfg = (((msub << div_size) | madd) << 3) | 4; + CGU.base_fdc[div] = CGU.base_fdc[div] & ~1; + CGU.base_fdc[div] = cfg | 2; + CGU.base_fdc[div] = cfg; + CGU.base_fdc[div] = cfg | 1; +} + +static void cgu_connect_div_to_clock(int rel_div, int esr) +{ + CGU.clk_esr[esr] = (rel_div << 1) | 1; +} + +static void cgu_disconnect_div_from_clock(int esr) +{ + CGU.clk_esr[esr] = 0; +} + +static void cgu_enable_clock(int clock) +{ + CGU.clk_pcr[clock] |= 1; +} + +static void cgu_start_sel_stage_dividers(int bcr) +{ + CGU.base_bcr[bcr] = 1; +} + +/* Convert a pointer that points to IRAM (0x4xxxx) to a pointer that + points to the uncached page (0x0xxxx) that is also mapped to IRAM. */ +static inline void *noncached(void *p) { + return (void *)(((unsigned long)p) & 0xffff); +} + +/* TODO: if it works, then comment it */ +static void do_set_mem_timings(int mode) ICODE_ATTR; +static void do_set_mem_timings(int mode) +{ + unsigned char *mem_conf = noncached(perf_modes[mode].mem_conf); + int old_irq = set_irq_level(HIGHEST_IRQ_LEVEL); + while ((EMC.status & 3) != 0); + EMC.control = 5; + EMCSTATIC0.waitrd = mem_conf[0]; + EMCSTATIC0.waitwr = mem_conf[1]; + EMCSTATIC1.waitrd = mem_conf[3]; + EMCSTATIC1.waitwr = mem_conf[4]; + EMCSTATIC2.waitrd = mem_conf[6]; + EMCSTATIC2.waitwr = mem_conf[7]; + EMCSTATIC0.waitoen = mem_conf[2]; + EMCSTATIC1.waitoen = mem_conf[5]; + EMCSTATIC2.waitoen = mem_conf[8]; +#ifndef DEBUG + EMCSTATIC1.config = mem_conf[9] ? 0x80081 : 0x81; +#endif + EMC.control = 1; + set_irq_level(old_irq); +} + +static void emc_set_mem_timings(int mode) { + void (*f)(int) = noncached(do_set_mem_timings); + (*f)(mode); +} + +/* +static void do_enable_write_buffers(int on) ICODE_ATTR; +static void do_enable_write_buffers(int on) { + int old_irq = set_irq_level(HIGHEST_IRQ_LEVEL); + while ((EMC.status & 3) != 0); + EMC.control = 5; + EMCSTATIC1.config = on ? 0x80081 : 0x81; + EMC.control = 1; + set_irq_level(old_irq); +} + +void emc_enable_write_buffers(int on) { + void (*f)(int) = noncached(do_enable_write_buffers); + (*f)(on); +} +*/ + +/* can it be replaced? */ +static void cgu_busy_wait(int n) +{ + while (n > 0) + { + n--; + } +} + +static void cgu_set_sys_mult(int i) +{ + cgu_set_sel_stage_input(PNX0101_SEL_STAGE_SYS, PNX0101_MAIN_CLOCK_FAST); + cgu_set_sel_stage_input(PNX0101_SEL_STAGE_APB3, PNX0101_MAIN_CLOCK_FAST); + + PLL.lppdn = 1; + PLL.lpfin = 1; + PLL.lpmbyp = 0; + PLL.lpdbyp = 0; + PLL.lppsel = 1; + PLL.lpmsel = i - 1; + PLL.lppdn = 0; + while (!PLL.lplock); + + cgu_configure_div(PNX0101_FIRST_DIV_SYS + 1, 1, (i == 5) ? 15 : 12); + cgu_connect_div_to_clock(1, 0x11); + cgu_enable_clock(0x11); + cgu_start_sel_stage_dividers(PNX0101_BCR_SYS); + + cgu_set_sel_stage_input(PNX0101_SEL_STAGE_SYS, + PNX0101_MAIN_CLOCK_MAIN_PLL); + cgu_set_sel_stage_input(PNX0101_SEL_STAGE_APB3, + PNX0101_MAIN_CLOCK_MAIN_PLL); +} + +static void pnx0101_set_performance_mode(int mode) +{ + int old = performance_mode; + if (perf_modes[old].freq < perf_modes[mode].freq) + { + emc_set_mem_timings(mode); + if (perf_modes[old].sys_mult != perf_modes[mode].sys_mult) + cgu_set_sys_mult(perf_modes[mode].sys_mult); + if (perf_modes[old].sys_div != perf_modes[mode].sys_div) + cgu_configure_div(bus_divider, 1, perf_modes[mode].sys_div); + } + else if (perf_modes[old].freq > perf_modes[mode].freq) + { + if (perf_modes[old].sys_mult != perf_modes[mode].sys_mult) + cgu_set_sys_mult(perf_modes[mode].sys_mult); + if (perf_modes[old].sys_div != perf_modes[mode].sys_div) + cgu_configure_div(bus_divider, 1, perf_modes[mode].sys_div); + emc_set_mem_timings(mode); + } + performance_mode = mode; +} + +static void pnx0101_init_clocks(void) +{ + bus_divider = PNX0101_FIRST_DIV_SYS + (CGU.clk_esr[0] >> 1); + performance_mode = 0; + pnx0101_set_performance_mode(2); +/* +#ifndef DEBUG + emc_enable_write_buffers(1); +#endif +*/ + cgu_set_sel_stage_input(PNX0101_SEL_STAGE_APB1, + PNX0101_MAIN_CLOCK_FAST); + cgu_reset_sel_stage_clocks(PNX0101_FIRST_ESR_APB1, PNX0101_N_ESR_APB1, + PNX0101_FIRST_DIV_APB1, PNX0101_N_DIV_APB1); + cgu_configure_div(PNX0101_FIRST_DIV_APB1, 1, 4); + cgu_connect_div_to_clock(0, PNX0101_ESR_APB1); + cgu_connect_div_to_clock(0, PNX0101_ESR_T0); + cgu_connect_div_to_clock(0, PNX0101_ESR_T1); + cgu_connect_div_to_clock(0, PNX0101_ESR_I2C); + cgu_enable_clock(PNX0101_CLOCK_APB1); + cgu_enable_clock(PNX0101_CLOCK_T0); + cgu_enable_clock(PNX0101_CLOCK_T1); + cgu_enable_clock(PNX0101_CLOCK_I2C); +} + +#ifdef HAVE_ADJUSTABLE_CPU_FREQ +void set_cpu_frequency(long frequency) +{ + switch (frequency) + { + case CPUFREQ_MAX: + pnx0101_set_performance_mode(2); + cpu_frequency = CPUFREQ_MAX; + break; + case CPUFREQ_NORMAL: + pnx0101_set_performance_mode(1); + cpu_frequency = CPUFREQ_NORMAL; + break; + case CPUFREQ_DEFAULT: + default: + pnx0101_set_performance_mode(0); + cpu_frequency = CPUFREQ_DEFAULT; + break; + } + +} +#endif + +interrupt_handler_t interrupt_vector[0x1d] __attribute__ ((section(".idata"))); + +#define IRQ_READ(reg, dest) \ + do { unsigned long v2; \ + do { \ + dest = (reg); \ + v2 = (reg); \ + } while ((dest != v2)); \ + } while (0); + +#define IRQ_WRITE_WAIT(reg, val, cond) \ + do { unsigned long v, v2; \ + do { \ + (reg) = (val); \ + v = (reg); \ + v2 = (reg); \ + } while ((v != v2) || !(cond)); \ + } while (0); + +static void undefined_int(void) +{ +} + +void irq(void) +{ + int n; + IRQ_READ(INTVECTOR[0], n) + (*(interrupt_vector[n >> 3]))(); +} + +void fiq(void) +{ +} + +void irq_enable_int(int n) +{ + IRQ_WRITE_WAIT(INTREQ[n], INTREQ_WEENABLE | INTREQ_ENABLE, v & 0x10000); +} + +void irq_disable_int(int n) +{ + IRQ_WRITE_WAIT(INTREQ[n], INTREQ_WEENABLE, (v & 0x10000) == 0); +} + +void irq_set_int_handler(int n, interrupt_handler_t handler) +{ + interrupt_vector[n] = handler; +} + +void system_init(void) +{ + int i; + + /* turn off watchdog */ + (*(volatile unsigned long *)0x80002804) = 0; + + /* + IRQ_WRITE_WAIT(INTVECTOR[0], 0, v == 0); + IRQ_WRITE_WAIT(INTVECTOR[1], 0, v == 0); + IRQ_WRITE_WAIT(INTPRIOMASK[0], 0, v == 0); + IRQ_WRITE_WAIT(INTPRIOMASK[1], 0, v == 0); + */ + + for (i = 0; i < 0x1c; i++) + { + IRQ_WRITE_WAIT(INTREQ[i], + INTREQ_WEPRIO | INTREQ_WETARGET | + INTREQ_WEENABLE | INTREQ_WEACTVLO | 1, + (v & 0x3010f) == 1); + IRQ_WRITE_WAIT(INTREQ[i], INTREQ_WEENABLE, (v & 0x10000) == 0); + IRQ_WRITE_WAIT(INTREQ[i], INTREQ_WEPRIO | 1, (v & 0xf) == 1); + interrupt_vector[i + 1] = undefined_int; + } + interrupt_vector[0] = undefined_int; + pnx0101_init_clocks(); +} + + +void system_reboot(void) +{ + (*(volatile unsigned long *)0x80002804) = 1; + while (1); +} + +int system_memory_guard(int newmode) +{ + (void)newmode; + return 0; +} -- cgit v1.2.3