forked from len0rd/rockbox
iPod Classic: Do boosting the right way round ;-)
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@29268 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Michael Sparmann
parent
2db7f00255
commit
fdf092ebd3
1 changed files with 152 additions and 148 deletions
|
|
@ -25,6 +25,8 @@
|
||||||
#include "system-target.h"
|
#include "system-target.h"
|
||||||
#include "pmu-target.h"
|
#include "pmu-target.h"
|
||||||
|
|
||||||
|
extern long sleepin, slept;
|
||||||
|
|
||||||
#define default_interrupt(name) \
|
#define default_interrupt(name) \
|
||||||
extern __attribute__((weak,alias("UIRQ"))) void name (void)
|
extern __attribute__((weak,alias("UIRQ"))) void name (void)
|
||||||
|
|
||||||
|
|
@ -32,146 +34,146 @@ void irq_handler(void) __attribute__((interrupt ("IRQ"), naked));
|
||||||
void fiq_handler(void) __attribute__((interrupt ("FIQ"), naked, \
|
void fiq_handler(void) __attribute__((interrupt ("FIQ"), naked, \
|
||||||
weak, alias("fiq_dummy")));
|
weak, alias("fiq_dummy")));
|
||||||
|
|
||||||
default_interrupt(INT_IRQ0);
|
default_interrupt(INT_IRQ0);
|
||||||
default_interrupt(INT_IRQ1);
|
default_interrupt(INT_IRQ1);
|
||||||
default_interrupt(INT_IRQ2);
|
default_interrupt(INT_IRQ2);
|
||||||
default_interrupt(INT_IRQ3);
|
default_interrupt(INT_IRQ3);
|
||||||
default_interrupt(INT_IRQ4);
|
default_interrupt(INT_IRQ4);
|
||||||
default_interrupt(INT_IRQ5);
|
default_interrupt(INT_IRQ5);
|
||||||
default_interrupt(INT_IRQ6);
|
default_interrupt(INT_IRQ6);
|
||||||
default_interrupt(INT_IRQ7);
|
default_interrupt(INT_IRQ7);
|
||||||
default_interrupt(INT_TIMERA);
|
default_interrupt(INT_TIMERA);
|
||||||
default_interrupt(INT_TIMERB);
|
default_interrupt(INT_TIMERB);
|
||||||
default_interrupt(INT_TIMERC);
|
default_interrupt(INT_TIMERC);
|
||||||
default_interrupt(INT_TIMERD);
|
default_interrupt(INT_TIMERD);
|
||||||
default_interrupt(INT_TIMERE);
|
default_interrupt(INT_TIMERE);
|
||||||
default_interrupt(INT_TIMERF);
|
default_interrupt(INT_TIMERF);
|
||||||
default_interrupt(INT_TIMERG);
|
default_interrupt(INT_TIMERG);
|
||||||
default_interrupt(INT_TIMERH);
|
default_interrupt(INT_TIMERH);
|
||||||
default_interrupt(INT_IRQ9);
|
default_interrupt(INT_IRQ9);
|
||||||
default_interrupt(INT_IRQ10);
|
default_interrupt(INT_IRQ10);
|
||||||
default_interrupt(INT_IRQ11);
|
default_interrupt(INT_IRQ11);
|
||||||
default_interrupt(INT_IRQ12);
|
default_interrupt(INT_IRQ12);
|
||||||
default_interrupt(INT_IRQ13);
|
default_interrupt(INT_IRQ13);
|
||||||
default_interrupt(INT_IRQ14);
|
default_interrupt(INT_IRQ14);
|
||||||
default_interrupt(INT_IRQ15);
|
default_interrupt(INT_IRQ15);
|
||||||
default_interrupt(INT_DMAC0C0);
|
default_interrupt(INT_DMAC0C0);
|
||||||
default_interrupt(INT_DMAC0C1);
|
default_interrupt(INT_DMAC0C1);
|
||||||
default_interrupt(INT_DMAC0C2);
|
default_interrupt(INT_DMAC0C2);
|
||||||
default_interrupt(INT_DMAC0C3);
|
default_interrupt(INT_DMAC0C3);
|
||||||
default_interrupt(INT_DMAC0C4);
|
default_interrupt(INT_DMAC0C4);
|
||||||
default_interrupt(INT_DMAC0C5);
|
default_interrupt(INT_DMAC0C5);
|
||||||
default_interrupt(INT_DMAC0C6);
|
default_interrupt(INT_DMAC0C6);
|
||||||
default_interrupt(INT_DMAC0C7);
|
default_interrupt(INT_DMAC0C7);
|
||||||
default_interrupt(INT_DMAC1C0);
|
default_interrupt(INT_DMAC1C0);
|
||||||
default_interrupt(INT_DMAC1C1);
|
default_interrupt(INT_DMAC1C1);
|
||||||
default_interrupt(INT_DMAC1C2);
|
default_interrupt(INT_DMAC1C2);
|
||||||
default_interrupt(INT_DMAC1C3);
|
default_interrupt(INT_DMAC1C3);
|
||||||
default_interrupt(INT_DMAC1C4);
|
default_interrupt(INT_DMAC1C4);
|
||||||
default_interrupt(INT_DMAC1C5);
|
default_interrupt(INT_DMAC1C5);
|
||||||
default_interrupt(INT_DMAC1C6);
|
default_interrupt(INT_DMAC1C6);
|
||||||
default_interrupt(INT_DMAC1C7);
|
default_interrupt(INT_DMAC1C7);
|
||||||
default_interrupt(INT_IRQ18);
|
default_interrupt(INT_IRQ18);
|
||||||
default_interrupt(INT_USB_FUNC);
|
default_interrupt(INT_USB_FUNC);
|
||||||
default_interrupt(INT_IRQ20);
|
default_interrupt(INT_IRQ20);
|
||||||
default_interrupt(INT_IRQ21);
|
default_interrupt(INT_IRQ21);
|
||||||
default_interrupt(INT_IRQ22);
|
default_interrupt(INT_IRQ22);
|
||||||
default_interrupt(INT_WHEEL);
|
default_interrupt(INT_WHEEL);
|
||||||
default_interrupt(INT_IRQ24);
|
default_interrupt(INT_IRQ24);
|
||||||
default_interrupt(INT_IRQ25);
|
default_interrupt(INT_IRQ25);
|
||||||
default_interrupt(INT_IRQ26);
|
default_interrupt(INT_IRQ26);
|
||||||
default_interrupt(INT_IRQ27);
|
default_interrupt(INT_IRQ27);
|
||||||
default_interrupt(INT_IRQ28);
|
default_interrupt(INT_IRQ28);
|
||||||
default_interrupt(INT_ATA);
|
default_interrupt(INT_ATA);
|
||||||
default_interrupt(INT_IRQ30);
|
default_interrupt(INT_IRQ30);
|
||||||
default_interrupt(INT_IRQ31);
|
default_interrupt(INT_IRQ31);
|
||||||
default_interrupt(INT_IRQ32);
|
default_interrupt(INT_IRQ32);
|
||||||
default_interrupt(INT_IRQ33);
|
default_interrupt(INT_IRQ33);
|
||||||
default_interrupt(INT_IRQ34);
|
default_interrupt(INT_IRQ34);
|
||||||
default_interrupt(INT_IRQ35);
|
default_interrupt(INT_IRQ35);
|
||||||
default_interrupt(INT_IRQ36);
|
default_interrupt(INT_IRQ36);
|
||||||
default_interrupt(INT_IRQ37);
|
default_interrupt(INT_IRQ37);
|
||||||
default_interrupt(INT_IRQ38);
|
default_interrupt(INT_IRQ38);
|
||||||
default_interrupt(INT_IRQ39);
|
default_interrupt(INT_IRQ39);
|
||||||
default_interrupt(INT_IRQ40);
|
default_interrupt(INT_IRQ40);
|
||||||
default_interrupt(INT_IRQ41);
|
default_interrupt(INT_IRQ41);
|
||||||
default_interrupt(INT_IRQ42);
|
default_interrupt(INT_IRQ42);
|
||||||
default_interrupt(INT_IRQ43);
|
default_interrupt(INT_IRQ43);
|
||||||
default_interrupt(INT_IRQ44);
|
default_interrupt(INT_IRQ44);
|
||||||
default_interrupt(INT_IRQ45);
|
default_interrupt(INT_IRQ45);
|
||||||
default_interrupt(INT_IRQ46);
|
default_interrupt(INT_IRQ46);
|
||||||
default_interrupt(INT_IRQ47);
|
default_interrupt(INT_IRQ47);
|
||||||
default_interrupt(INT_IRQ48);
|
default_interrupt(INT_IRQ48);
|
||||||
default_interrupt(INT_IRQ49);
|
default_interrupt(INT_IRQ49);
|
||||||
default_interrupt(INT_IRQ50);
|
default_interrupt(INT_IRQ50);
|
||||||
default_interrupt(INT_IRQ51);
|
default_interrupt(INT_IRQ51);
|
||||||
default_interrupt(INT_IRQ52);
|
default_interrupt(INT_IRQ52);
|
||||||
default_interrupt(INT_IRQ53);
|
default_interrupt(INT_IRQ53);
|
||||||
default_interrupt(INT_IRQ54);
|
default_interrupt(INT_IRQ54);
|
||||||
default_interrupt(INT_IRQ55);
|
default_interrupt(INT_IRQ55);
|
||||||
default_interrupt(INT_IRQ56);
|
default_interrupt(INT_IRQ56);
|
||||||
default_interrupt(INT_IRQ57);
|
default_interrupt(INT_IRQ57);
|
||||||
default_interrupt(INT_IRQ58);
|
default_interrupt(INT_IRQ58);
|
||||||
default_interrupt(INT_IRQ59);
|
default_interrupt(INT_IRQ59);
|
||||||
default_interrupt(INT_IRQ60);
|
default_interrupt(INT_IRQ60);
|
||||||
default_interrupt(INT_IRQ61);
|
default_interrupt(INT_IRQ61);
|
||||||
default_interrupt(INT_IRQ62);
|
default_interrupt(INT_IRQ62);
|
||||||
default_interrupt(INT_IRQ63);
|
default_interrupt(INT_IRQ63);
|
||||||
|
|
||||||
|
|
||||||
int current_irq;
|
int current_irq;
|
||||||
|
|
||||||
|
|
||||||
void INT_TIMER(void) ICODE_ATTR;
|
|
||||||
void INT_TIMER()
|
|
||||||
{
|
|
||||||
if (TACON & (TACON >> 4) & 0x7000) INT_TIMERA();
|
|
||||||
if (TBCON & (TBCON >> 4) & 0x7000) INT_TIMERB();
|
|
||||||
if (TCCON & (TCCON >> 4) & 0x7000) INT_TIMERC();
|
|
||||||
if (TDCON & (TDCON >> 4) & 0x7000) INT_TIMERD();
|
|
||||||
if (TFCON & (TFCON >> 4) & 0x7000) INT_TIMERF();
|
|
||||||
if (TGCON & (TGCON >> 4) & 0x7000) INT_TIMERG();
|
|
||||||
if (THCON & (THCON >> 4) & 0x7000) INT_TIMERH();
|
|
||||||
}
|
|
||||||
|
|
||||||
void INT_DMAC0(void) ICODE_ATTR;
|
void INT_TIMER(void) ICODE_ATTR;
|
||||||
void INT_DMAC0()
|
void INT_TIMER()
|
||||||
{
|
{
|
||||||
uint32_t intsts = DMAC0INTSTS;
|
if (TACON & (TACON >> 4) & 0x7000) INT_TIMERA();
|
||||||
if (intsts & 1) INT_DMAC0C0();
|
if (TBCON & (TBCON >> 4) & 0x7000) INT_TIMERB();
|
||||||
if (intsts & 2) INT_DMAC0C1();
|
if (TCCON & (TCCON >> 4) & 0x7000) INT_TIMERC();
|
||||||
if (intsts & 4) INT_DMAC0C2();
|
if (TDCON & (TDCON >> 4) & 0x7000) INT_TIMERD();
|
||||||
if (intsts & 8) INT_DMAC0C3();
|
if (TFCON & (TFCON >> 4) & 0x7000) INT_TIMERF();
|
||||||
if (intsts & 0x10) INT_DMAC0C4();
|
if (TGCON & (TGCON >> 4) & 0x7000) INT_TIMERG();
|
||||||
if (intsts & 0x20) INT_DMAC0C5();
|
if (THCON & (THCON >> 4) & 0x7000) INT_TIMERH();
|
||||||
if (intsts & 0x40) INT_DMAC0C6();
|
}
|
||||||
if (intsts & 0x80) INT_DMAC0C7();
|
|
||||||
}
|
void INT_DMAC0(void) ICODE_ATTR;
|
||||||
|
void INT_DMAC0()
|
||||||
void INT_DMAC1(void) ICODE_ATTR;
|
{
|
||||||
void INT_DMAC1()
|
uint32_t intsts = DMAC0INTSTS;
|
||||||
{
|
if (intsts & 1) INT_DMAC0C0();
|
||||||
uint32_t intsts = DMAC1INTSTS;
|
if (intsts & 2) INT_DMAC0C1();
|
||||||
if (intsts & 1) INT_DMAC1C0();
|
if (intsts & 4) INT_DMAC0C2();
|
||||||
if (intsts & 2) INT_DMAC1C1();
|
if (intsts & 8) INT_DMAC0C3();
|
||||||
if (intsts & 4) INT_DMAC1C2();
|
if (intsts & 0x10) INT_DMAC0C4();
|
||||||
if (intsts & 8) INT_DMAC1C3();
|
if (intsts & 0x20) INT_DMAC0C5();
|
||||||
if (intsts & 0x10) INT_DMAC1C4();
|
if (intsts & 0x40) INT_DMAC0C6();
|
||||||
if (intsts & 0x20) INT_DMAC1C5();
|
if (intsts & 0x80) INT_DMAC0C7();
|
||||||
if (intsts & 0x40) INT_DMAC1C6();
|
}
|
||||||
if (intsts & 0x80) INT_DMAC1C7();
|
|
||||||
}
|
void INT_DMAC1(void) ICODE_ATTR;
|
||||||
|
void INT_DMAC1()
|
||||||
|
{
|
||||||
|
uint32_t intsts = DMAC1INTSTS;
|
||||||
|
if (intsts & 1) INT_DMAC1C0();
|
||||||
|
if (intsts & 2) INT_DMAC1C1();
|
||||||
|
if (intsts & 4) INT_DMAC1C2();
|
||||||
|
if (intsts & 8) INT_DMAC1C3();
|
||||||
|
if (intsts & 0x10) INT_DMAC1C4();
|
||||||
|
if (intsts & 0x20) INT_DMAC1C5();
|
||||||
|
if (intsts & 0x40) INT_DMAC1C6();
|
||||||
|
if (intsts & 0x80) INT_DMAC1C7();
|
||||||
|
}
|
||||||
|
|
||||||
static void (* const irqvector[])(void) =
|
static void (* const irqvector[])(void) =
|
||||||
{
|
{
|
||||||
INT_IRQ0,INT_IRQ1,INT_IRQ2,INT_IRQ3,INT_IRQ4,INT_IRQ5,INT_IRQ6,INT_IRQ7,
|
INT_IRQ0,INT_IRQ1,INT_IRQ2,INT_IRQ3,INT_IRQ4,INT_IRQ5,INT_IRQ6,INT_IRQ7,
|
||||||
INT_TIMER,INT_IRQ9,INT_IRQ10,INT_IRQ11,INT_IRQ12,INT_IRQ13,INT_IRQ14,INT_IRQ15,
|
INT_TIMER,INT_IRQ9,INT_IRQ10,INT_IRQ11,INT_IRQ12,INT_IRQ13,INT_IRQ14,INT_IRQ15,
|
||||||
INT_DMAC0,INT_DMAC1,INT_IRQ18,INT_USB_FUNC,INT_IRQ20,INT_IRQ21,INT_IRQ22,INT_WHEEL,
|
INT_DMAC0,INT_DMAC1,INT_IRQ18,INT_USB_FUNC,INT_IRQ20,INT_IRQ21,INT_IRQ22,INT_WHEEL,
|
||||||
INT_IRQ24,INT_IRQ25,INT_IRQ26,INT_IRQ27,INT_IRQ28,INT_ATA,INT_IRQ30,INT_IRQ31,
|
INT_IRQ24,INT_IRQ25,INT_IRQ26,INT_IRQ27,INT_IRQ28,INT_ATA,INT_IRQ30,INT_IRQ31,
|
||||||
INT_IRQ32,INT_IRQ33,INT_IRQ34,INT_IRQ35,INT_IRQ36,INT_IRQ37,INT_IRQ38,INT_IRQ39,
|
INT_IRQ32,INT_IRQ33,INT_IRQ34,INT_IRQ35,INT_IRQ36,INT_IRQ37,INT_IRQ38,INT_IRQ39,
|
||||||
INT_IRQ40,INT_IRQ41,INT_IRQ42,INT_IRQ43,INT_IRQ55,INT_IRQ56,INT_IRQ57,INT_IRQ58,
|
INT_IRQ40,INT_IRQ41,INT_IRQ42,INT_IRQ43,INT_IRQ55,INT_IRQ56,INT_IRQ57,INT_IRQ58,
|
||||||
INT_IRQ48,INT_IRQ49,INT_IRQ50,INT_IRQ51,INT_IRQ52,INT_IRQ53,INT_IRQ54,INT_IRQ55,
|
INT_IRQ48,INT_IRQ49,INT_IRQ50,INT_IRQ51,INT_IRQ52,INT_IRQ53,INT_IRQ54,INT_IRQ55,
|
||||||
INT_IRQ56,INT_IRQ57,INT_IRQ58,INT_IRQ59,INT_IRQ60,INT_IRQ61,INT_IRQ62,INT_IRQ63
|
INT_IRQ56,INT_IRQ57,INT_IRQ58,INT_IRQ59,INT_IRQ60,INT_IRQ61,INT_IRQ62,INT_IRQ63
|
||||||
};
|
};
|
||||||
|
|
||||||
static void UIRQ(void)
|
static void UIRQ(void)
|
||||||
|
|
@ -188,18 +190,20 @@ void irq_handler(void)
|
||||||
asm volatile( "stmfd sp!, {r0-r7, ip, lr} \n" /* Store context */
|
asm volatile( "stmfd sp!, {r0-r7, ip, lr} \n" /* Store context */
|
||||||
"sub sp, sp, #8 \n"); /* Reserve stack */
|
"sub sp, sp, #8 \n"); /* Reserve stack */
|
||||||
|
|
||||||
void* dummy = VIC0ADDRESS;
|
if (sleepin) slept += USEC_TIMER - sleepin;
|
||||||
dummy = VIC1ADDRESS;
|
sleepin = 0;
|
||||||
uint32_t irqs0 = VIC0IRQSTATUS;
|
void* dummy = VIC0ADDRESS;
|
||||||
uint32_t irqs1 = VIC1IRQSTATUS;
|
dummy = VIC1ADDRESS;
|
||||||
for (current_irq = 0; irqs0; current_irq++, irqs0 >>= 1)
|
uint32_t irqs0 = VIC0IRQSTATUS;
|
||||||
if (irqs0 & 1)
|
uint32_t irqs1 = VIC1IRQSTATUS;
|
||||||
irqvector[current_irq]();
|
for (current_irq = 0; irqs0; current_irq++, irqs0 >>= 1)
|
||||||
for (current_irq = 32; irqs1; current_irq++, irqs1 >>= 1)
|
if (irqs0 & 1)
|
||||||
if (irqs1 & 1)
|
irqvector[current_irq]();
|
||||||
irqvector[current_irq]();
|
for (current_irq = 32; irqs1; current_irq++, irqs1 >>= 1)
|
||||||
VIC0ADDRESS = NULL;
|
if (irqs1 & 1)
|
||||||
VIC1ADDRESS = NULL;
|
irqvector[current_irq]();
|
||||||
|
VIC0ADDRESS = NULL;
|
||||||
|
VIC1ADDRESS = NULL;
|
||||||
|
|
||||||
asm volatile( "add sp, sp, #8 \n" /* Cleanup stack */
|
asm volatile( "add sp, sp, #8 \n" /* Cleanup stack */
|
||||||
"ldmfd sp!, {r0-r7, ip, lr} \n" /* Restore context */
|
"ldmfd sp!, {r0-r7, ip, lr} \n" /* Restore context */
|
||||||
|
|
@ -256,13 +260,13 @@ void set_cpu_frequency(long frequency)
|
||||||
//TODO: Need to understand this better
|
//TODO: Need to understand this better
|
||||||
if (frequency == CPUFREQ_MAX)
|
if (frequency == CPUFREQ_MAX)
|
||||||
{
|
{
|
||||||
CLKCON0 = 0x3011;
|
CLKCON1 = 0x404101;
|
||||||
CLKCON1 = 0x4001;
|
CLKCON0 = 0x3000;
|
||||||
}
|
}
|
||||||
else
|
else
|
||||||
{
|
{
|
||||||
CLKCON1 = 0x404101;
|
CLKCON0 = 0x3011;
|
||||||
CLKCON0 = 0x3000;
|
CLKCON1 = 0x4001;
|
||||||
}
|
}
|
||||||
|
|
||||||
cpu_frequency = frequency;
|
cpu_frequency = frequency;
|
||||||
|
|
|
||||||
Loading…
Add table
Add a link
Reference in a new issue