/*************************************************************************** * __________ __ ___. * Open \______ \ ____ ____ | | _\_ |__ _______ ___ * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ * \/ \/ \/ \/ \/ * $Id$ * * Copyright (C) 2002 by Alan Korr * * 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 software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY * KIND, either express or implied. * ****************************************************************************/ #include "system.h" #include "thread.h" #include "i2s.h" #include "i2c-pp.h" #include "as3514.h" #ifdef HAVE_HOTSWAP #include "sd-pp-target.h" #endif #include "button-target.h" #include "usb_drv.h" #if !defined(BOOTLOADER) || defined(HAVE_BOOTLOADER_USB_MODE) extern void TIMER1(void); extern void TIMER2(void); extern void SERIAL0(void); #if defined(HAVE_ADJUSTABLE_CPU_FREQ) && (NUM_CORES > 1) static struct corelock cpufreq_cl SHAREDBSS_ATTR; #endif #if defined(IPOD_VIDEO) && !defined(BOOTLOADER) unsigned char probed_ramsize; #endif void __attribute__((interrupt("IRQ"))) irq_handler(void) { if(CURRENT_CORE == CPU) { if (CPU_INT_STAT & TIMER1_MASK) { TIMER1(); } else if (CPU_INT_STAT & TIMER2_MASK) { TIMER2(); } #ifdef HAVE_USBSTACK /* Rather high priority - place near front */ else if (CPU_INT_STAT & USB_MASK) { usb_drv_int(); } #endif #if defined(IPOD_MINI) /* Mini 1st gen only, mini 2nd gen uses iPod 4G code */ else if (CPU_HI_INT_STAT & GPIO0_MASK) { if ((GPIOA_INT_STAT & 0x3f) || (GPIOB_INT_STAT & 0x30)) ipod_mini_button_int(); if (GPIOC_INT_STAT & 0x02) firewire_insert_int(); if (GPIOD_INT_STAT & 0x08) usb_insert_int(); } /* end IPOD_MINI */ #elif CONFIG_KEYPAD == IPOD_4G_PAD /* except Mini 1st gen, handled above */ else if (CPU_HI_INT_STAT & I2C_MASK) { ipod_4g_button_int(); } #if defined(IPOD_COLOR) || defined(IPOD_MINI2G) || defined(IPOD_4G) else if (CPU_HI_INT_STAT & GPIO0_MASK) { if (GPIOC_INT_STAT & 0x02) firewire_insert_int(); if (GPIOD_INT_STAT & 0x08) usb_insert_int(); } #elif defined(IPOD_NANO) || defined(IPOD_VIDEO) else if (CPU_HI_INT_STAT & GPIO2_MASK) { if (GPIOL_INT_STAT & 0x10) usb_insert_int(); } #endif /* end CONFIG_KEYPAD == IPOD_4G_PAD */ #elif defined(IRIVER_H10) || defined(IRIVER_H10_5GB) else if (CPU_HI_INT_STAT & GPIO2_MASK) { if (GPIOL_INT_STAT & 0x04) usb_insert_int(); } /* end IRIVER_H10 || IRIVER_H10_5GB */ #elif defined(SANSA_E200) else if (CPU_HI_INT_STAT & GPIO0_MASK) { #ifdef HAVE_HOTSWAP if (GPIOA_INT_STAT & 0x80) microsd_int(); #endif if (GPIOB_INT_STAT & 0x10) usb_insert_int(); } else if (CPU_HI_INT_STAT & GPIO1_MASK) { if (GPIOF_INT_STAT & 0xff) button_int(); if (GPIOH_INT_STAT & 0xc0) clickwheel_int(); } /* end SANSA_E200 */ #elif defined(SANSA_C200) else if (CPU_HI_INT_STAT & GPIO1_MASK) { if (GPIOH_INT_STAT & 0x02) usb_insert_int(); } #ifdef HAVE_HOTSWAP else if (CPU_HI_INT_STAT & GPIO2_MASK) { if (GPIOL_INT_STAT & 0x08) microsd_int(); } #endif /* end SANSA_C200 */ #elif defined(MROBE_100) else if (CPU_HI_INT_STAT & GPIO0_MASK) { if (GPIOD_INT_STAT & 0x02) button_int(); if (GPIOD_INT_STAT & 0x80) headphones_int(); } else if (CPU_HI_INT_STAT & GPIO2_MASK) { if (GPIOL_INT_STAT & 0x04) usb_insert_int(); } /* end MROBE_100 */ #elif defined(PHILIPS_SA9200) else if (CPU_HI_INT_STAT & GPIO0_MASK) { if (GPIOD_INT_STAT & 0x02) button_int(); if (GPIOB_INT_STAT & 0x40) usb_insert_int(); } /* end PHILIPS_SA9200 */ #elif defined(PHILIPS_HDD1630) || defined(PHILIPS_HDD6330) else if (CPU_HI_INT_STAT & GPIO0_MASK) { if (GPIOA_INT_STAT & 0x20) button_int(); } else if (CPU_HI_INT_STAT & GPIO1_MASK) { if (GPIOE_INT_STAT & 0x04) usb_insert_int(); } /* end PHILIPS_HDD1630 || PHILIPS_HDD6330 */ #elif defined(SAMSUNG_YH820) || defined(SAMSUNG_YH920) || defined(SAMSUNG_YH925) else if (CPU_HI_INT_STAT & GPIO0_MASK) { if (GPIOD_INT_STAT & 0x10) usb_insert_int(); } /* end SAMSUNG_YHxxx */ #elif defined(PBELL_VIBE500) else if (CPU_HI_INT_STAT & GPIO0_MASK) { if (GPIOA_INT_STAT & 0x20) button_int(); } else if (CPU_HI_INT_STAT & GPIO2_MASK) { if (GPIOL_INT_STAT & 0x04) usb_insert_int(); } /* end PBELL_VIBE500 */ #endif #ifdef IPOD_ACCESSORY_PROTOCOL else if (CPU_HI_INT_STAT & SER0_MASK) { SERIAL0(); } #endif } else { if (COP_INT_STAT & TIMER2_MASK) TIMER2(); } } #endif /* BOOTLOADER || HAVE_BOOTLOADER_USB_MODE */ #if !defined(BOOTLOADER) || defined(HAVE_BOOTLOADER_USB_MODE) static void disable_all_interrupts(void) { COP_HI_INT_DIS = -1; CPU_HI_INT_DIS = -1; HI_INT_FORCED_CLR = -1; COP_INT_DIS = -1; CPU_INT_DIS = -1; INT_FORCED_CLR = -1; GPIOA_INT_EN = 0; GPIOB_INT_EN = 0; GPIOC_INT_EN = 0; GPIOD_INT_EN = 0; GPIOE_INT_EN = 0; GPIOF_INT_EN = 0; GPIOG_INT_EN = 0; GPIOH_INT_EN = 0; GPIOI_INT_EN = 0; GPIOJ_INT_EN = 0; GPIOK_INT_EN = 0; GPIOL_INT_EN = 0; } void ICODE_ATTR commit_dcache(void) { if (CACHE_CTL & CACHE_CTL_ENABLE) { CACHE_OPERATION |= CACHE_OP_FLUSH; while ((CACHE_CTL & CACHE_CTL_BUSY) != 0); nop; nop; nop; nop; } } void ICODE_ATTR commit_discard_idcache(void) { if (CACHE_CTL & CACHE_CTL_ENABLE) { register int istat = disable_interrupt_save(IRQ_FIQ_STATUS); commit_dcache(); /* Cache lines which are not marked as valid can cause memory * corruption when there are many writes to and code fetches from * cached memory. This workaround points all cache status words past * end of RAM and marks them as valid, but not dirty. Since that area * is never accessed, the cache lines don't affect anything, and * they're effectively discarded. Interrupts must be disabled here * because any change they make to cached memory could be discarded. */ register volatile unsigned long *p; for (p = &CACHE_STATUS_BASE; p < (&CACHE_STATUS_BASE) + 512*16/sizeof(*p); p += 16/sizeof(*p)) *p = ((MEMORYSIZE*0x100000) >> 11) | 0x800000; restore_interrupt(istat); } } void commit_discard_dcache(void) __attribute__((alias("commit_discard_idcache"))); static void init_cache(void) { /* Initialising the cache in the iPod bootloader may prevent Rockbox from starting * depending on the model */ /* cache init mode */ CACHE_CTL &= ~(CACHE_CTL_ENABLE | CACHE_CTL_RUN); CACHE_CTL |= CACHE_CTL_INIT; #ifndef BOOTLOADER /* what's this do? */ CACHE_PRIORITY |= CURRENT_CORE == CPU ? 0x10 : 0x20; #endif /* Cache if (addr & mask) >> 16 == (mask & match) >> 16: * yes: 0x00000000 - 0x03ffffff * no: 0x04000000 - 0x1fffffff * yes: 0x20000000 - 0x23ffffff * no: 0x24000000 - 0x3fffffff */ CACHE_MASK = 0x00001c00; CACHE_OPERATION = 0xfc0; /* enable cache */ CACHE_CTL |= CACHE_CTL_INIT | CACHE_CTL_ENABLE | CACHE_CTL_RUN; nop; nop; nop; nop; /* Ensure all cache lines are valid for the next flush. Since this * can run from cached RAM, rewriting of cache status words may not * be safe and the cache is filled instead by reading. */ register volatile char *p; for (p = (volatile char *)0; p < (volatile char *)0x2000; p += 0x10) (void)*p; } #endif /* BOOTLOADER || HAVE_BOOTLOADER_USB_MODE */ /* We need this for Sansas since we boost the cpu in their bootloader */ #if !defined(BOOTLOADER) || (defined(SANSA_E200) || defined(SANSA_C200) || \ defined(PHILIPS_SA9200)) void scale_suspend_core(bool suspend) ICODE_ATTR; void scale_suspend_core(bool suspend) { unsigned int core = CURRENT_CORE; IF_COP( unsigned int othercore = 1 - core; ) static int oldstatus IBSS_ATTR; if (suspend) { oldstatus = disable_interrupt_save(IRQ_FIQ_STATUS); IF_COP( PROC_CTL(othercore) = 0x40000000; nop; ) PROC_CTL(core) = 0x48000003; nop; } else { PROC_CTL(core) = 0x4800001f; nop; IF_COP( PROC_CTL(othercore) = 0x00000000; nop; ) restore_interrupt(oldstatus); } } #ifdef HAVE_ADJUSTABLE_CPU_FREQ void set_cpu_frequency(long frequency) ICODE_ATTR; void set_cpu_frequency(long frequency) #else static void pp_set_cpu_frequency(long frequency) #endif { #if defined(HAVE_ADJUSTABLE_CPU_FREQ) && (NUM_CORES > 1) corelock_lock(&cpufreq_cl); #endif switch (frequency) { /* Note1: The PP5022 PLL must be run at >= 96MHz * Bits 20..21 select the post divider (1/2/4/8). * PP5026 is similar to PP5022 except it doesn't * have this limitation (and the post divider?) * Note2: CLOCK_SOURCE is set via 0=32kHz, 1=16MHz, * 2=24MHz, 3=33MHz, 4=48MHz, 5=SLOW, 6=FAST, 7=PLL. * SLOW = 24MHz / (DIV_SLOW + 1), DIV = Bits 16-19 * FAST = PLL / (DIV_FAST + 1), DIV = Bits 20-23 */ case CPUFREQ_SLEEP: cpu_frequency = CPUFREQ_SLEEP; PLL_CONTROL |= 0x0c000000; scale_suspend_core(true); CLOCK_SOURCE = 0x20000000; /* source #1, #2, #3, #4: 32kHz (#2 active) */ scale_suspend_core(false); PLL_CONTROL &= ~0x80000000; /* disable PLL */ DEV_INIT2 &= ~INIT_PLL; /* disable PLL power */ break; case CPUFREQ_MAX: cpu_frequency = CPUFREQ_MAX; DEV_INIT2 |= INIT_PLL; /* enable PLL power */ PLL_CONTROL |= 0x88000000; /* enable PLL */ scale_suspend_core(true); CLOCK_SOURCE = 0x20002222; /* source #1, #2, #3, #4: 24MHz (#2 active) */ DEV_TIMING1 = 0x00000303; scale_suspend_core(false); #if defined(IPOD_MINI2G) MLCD_SCLK_DIV = 0x00000001; /* Mono LCD bridge serial clock divider */ #elif defined(IPOD_NANO) IDE0_CFG |= 0x10000000; /* set ">65MHz" bit */ #endif #if CONFIG_CPU == PP5020 PLL_CONTROL = 0x8a020a03; /* 80 MHz = 10/3 * 24MHz */ PLL_STATUS = 0xd19b; /* unlock frequencies > 66MHz */ PLL_CONTROL = 0x8a020a03; /* repeat setup */ udelay(500); /* wait for relock */ #elif (CONFIG_CPU == PP5022) || (CONFIG_CPU == PP5024) PLL_CONTROL = 0x8a121403; /* 80 MHz = (20/3 * 24MHz) / 2 */ while (!(PLL_STATUS & 0x80000000)); /* wait for relock */ #endif scale_suspend_core(true); DEV_TIMING1 = 0x00000808; CLOCK_SOURCE = 0x20007777; /* source #1, #2, #3, #4: PLL (#2 active) */ scale_suspend_core(false); break; #if 0 /******** CPUFREQ_NORMAL = 24MHz without PLL ********/ case CPUFREQ_NORMAL: cpu_frequency = CPUFREQ_NORMAL; PLL_CONTROL |= 0x08000000; scale_suspend_core(true); CLOCK_SOURCE = 0x20002222; /* source #1, #2, #3, #4: 24MHz (#2 active) */ DEV_TIMING1 = 0x00000303; #if defined(IPOD_MINI2G) MLCD_SCLK_DIV = 0x00000000; /* Mono LCD bridge serial clock divider */ #elif defined(IPOD_NANO) IDE0_CFG &= ~0x10000000; /* clear ">65MHz" bit */ #endif scale_suspend_core(false); PLL_CONTROL &= ~0x80000000; /* disable PLL */ DEV_INIT2 &= ~INIT_PLL; /* disable PLL power */ break; #else /******** CPUFREQ_NORMAL = 30MHz with PLL ********/ case CPUFREQ_NORMAL: cpu_frequency = CPUFREQ_NORMAL; DEV_INIT2 |= INIT_PLL; /* enable PLL power */ PLL_CONTROL |= 0x88000000; /* enable PLL */ scale_suspend_core(true); CLOCK_SOURCE = 0x20002222; /* source #1, #2, #3, #4: 24MHz (#2 active) */ DEV_TIMING1 = 0x00000303; scale_suspend_core(false); #if defined(IPOD_MINI2G) MLCD_SCLK_DIV = 0x00000000; /* Mono LCD bridge serial clock divider */ #elif defined(IPOD_NANO) IDE0_CFG &= ~0x10000000; /* clear ">65MHz" bit */ #endif #if CONFIG_CPU == PP5020 PLL_CONTROL = 0x8a020504; /* 30 MHz = 5/4 * 24MHz */ udelay(500); /* wait for relock */ #elif (CONFIG_CPU == PP5022) || (CONFIG_CPU == PP5024) PLL_CONTROL = 0x8a220501; /* 30 MHz = (5/1 * 24MHz) / 4 */ while (!(PLL_STATUS & 0x80000000)); /* wait for relock */ #endif scale_suspend_core(true); DEV_TIMING1 = 0x00000303; CLOCK_SOURCE = 0x20007777; /* source #1, #2, #3, #4: PLL (#2 active) */ scale_suspend_core(false); break; #endif /******** CPUFREQ_NORMAL end ********/ default: cpu_frequency = CPUFREQ_DEFAULT; PLL_CONTROL |= 0x08000000; scale_suspend_core(true); CLOCK_SOURCE = 0x20002222; /* source #1, #2, #3, #4: 24MHz (#2 active) */ DEV_TIMING1 = 0x00000303; #if defined(IPOD_MINI2G) MLCD_SCLK_DIV = 0x00000000; /* Mono LCD bridge serial clock divider */ #elif defined(IPOD_NANO) IDE0_CFG &= ~0x10000000; /* clear ">65MHz" bit */ #endif scale_suspend_core(false); PLL_CONTROL &= ~0x80000000; /* disable PLL */ DEV_INIT2 &= ~INIT_PLL; /* disable PLL power */ break; } #if defined(HAVE_ADJUSTABLE_CPU_FREQ) && (NUM_CORES > 1) corelock_unlock(&cpufreq_cl); #endif } #endif /* !BOOTLOADER || (SANSA_E200 || SANSA_C200 || PHILIPS_SA9200) */ #ifndef BOOTLOADER void system_init(void) { if (CURRENT_CORE == CPU) { #if defined (IRIVER_H10) || defined(IRIVER_H10_5GB) || defined(IPOD_COLOR) /* set minimum startup configuration */ DEV_EN = 0xc2000124; DEV_EN2 = 0x00002000; CACHE_PRIORITY = 0x0000003f; GPO32_VAL = 0x20000000; DEV_INIT1 = 0xdc000000; DEV_INIT2 = 0x40000000; /* reset all allowed devices */ DEV_RS = 0x3dfffef8; DEV_RS2 = 0xffffdfff; DEV_RS = 0x00000000; DEV_RS2 = 0x00000000; #elif defined (IPOD_VIDEO) /* set minimum startup configuration */ DEV_EN = 0xc2000124; DEV_EN2 = 0x00000000; CACHE_PRIORITY = 0x0000003f; GPO32_VAL &= 0x00004000; DEV_INIT1 = 0x00000000; DEV_INIT2 = 0x40000000; /* reset all allowed devices */ DEV_RS = 0x3dfffef8; DEV_RS2 = 0xffffffff; DEV_RS = 0x00000000; DEV_RS2 = 0x00000000; #elif defined (IPOD_NANO) /* set minimum startup configuration */ DEV_EN = 0xc2000124; DEV_EN2 = 0x00002000; CACHE_PRIORITY = 0x0000003f; GPO32_VAL = 0x50000000; DEV_INIT1 = 0xa8000000; DEV_INIT2 = 0x40000000; /* reset all allowed devices */ DEV_RS = 0x3ffffef8; DEV_RS2 = 0xffffdfff; DEV_RS = 0x00000000; DEV_RS2 = 0x00000000; #elif defined(SANSA_C200) || defined (SANSA_E200) /* set minimum startup configuration */ DEV_EN = 0xc4000124; DEV_EN2 = 0x00000000; CACHE_PRIORITY = 0x0000003f; GPO32_VAL = 0x10000000; DEV_INIT1 = 0x54000000; DEV_INIT2 = 0x40000000; /* reset all allowed devices */ DEV_RS = 0x3bfffef8; DEV_RS2 = 0xffffffff; DEV_RS = 0x00000000; DEV_RS2 = 0x00000000; #elif defined(PHILIPS_SA9200) /* reset all allowed devices */ DEV_RS = 0x3ffffef8; DEV_RS2 = 0xffffffff; DEV_RS = 0x00000000; DEV_RS2 = 0x00000000; #elif defined(IPOD_4G) /* set minimum startup configuration */ DEV_EN = 0xc2020124; DEV_EN2 = 0x00000000; CACHE_PRIORITY = 0x0000003f; GPO32_VAL = 0x02000000; DEV_INIT1 = 0x00000000; DEV_INIT2 = 0x40000000; /* reset all allowed devices */ DEV_RS = 0x3dfdfef8; DEV_RS2 = 0xffffffff; DEV_RS = 0x00000000; DEV_RS2 = 0x00000000; #elif defined (IPOD_MINI) /* to be done */ #elif defined (IPOD_MINI2G) /* to be done */ #elif defined (MROBE_100) /* to be done */ #elif defined (TATUNG_TPJ1022) /* to be done */ #elif defined(PBELL_VIBE500) /* reset all allowed devices */ DEV_RS = 0x3ffffef8; DEV_RS2 = 0xffffffff; DEV_RS = 0x00000000; DEV_RS2 = 0x00000000; #endif #if !defined(SANSA_E200) && !defined(SANSA_C200) && !defined(PHILIPS_SA9200) /* Remap the flash ROM on CPU, keep hidden from COP: * 0x00000000-0x3fffffff = 0x20000000-0x23ffffff */ MMAP1_LOGICAL = 0x20003c00; MMAP1_PHYSICAL = 0x00003084 | MMAP_PHYS_READ_MASK | MMAP_PHYS_WRITE_MASK | MMAP_PHYS_DATA_MASK | MMAP_PHYS_CODE_MASK; #endif disable_all_interrupts(); #ifdef HAVE_ADJUSTABLE_CPU_FREQ #if NUM_CORES > 1 corelock_init(&cpufreq_cl); cpu_boost_init(); #endif #else pp_set_cpu_frequency(CPUFREQ_MAX); #endif #if defined(IPOD_VIDEO) /* crt0-pp.S wrote the ram size to the last byte of the first 32MB ram bank. See the comment there for how we determine it. */ volatile unsigned char *end32 = (volatile unsigned char *)0x01ffffff; probed_ramsize = *end32; #endif } init_cache(); } #else /* BOOTLOADER */ void system_init(void) { /* Only the CPU gets here in the bootloader */ #ifdef HAVE_BOOTLOADER_USB_MODE disable_all_interrupts(); init_cache(); /* Use the local vector map */ CACHE_CTL |= CACHE_CTL_VECT_REMAP; #endif /* HAVE_BOOTLOADER_USB_MODE */ #if defined(SANSA_C200) || defined(SANSA_E200) || defined(PHILIPS_SA9200) pp_set_cpu_frequency(CPUFREQ_MAX); #endif /* Else the frequency should get changed upon USB connect - * decide per-target */ } #ifdef HAVE_BOOTLOADER_USB_MODE void system_prepare_fw_start(void) { disable_interrupt(IRQ_FIQ_STATUS); tick_stop(); disable_all_interrupts(); /* Some OF's disable this themselves, others do not and will hang. */ CACHE_CTL &= ~CACHE_CTL_VECT_REMAP; } #endif /* HAVE_BOOTLOADER_USB_MODE */ #endif /* !BOOTLOADER */ void ICODE_ATTR system_reboot(void) { disable_interrupt(IRQ_FIQ_STATUS); CPU_INT_DIS = -1; COP_INT_DIS = -1; /* Reboot */ #if defined(SANSA_E200) || defined(SANSA_C200) || defined(PHILIPS_SA9200) CACHE_CTL &= ~CACHE_CTL_VECT_REMAP; /* Magic used by the c200 OF: 0x23066000 Magic used by the c200 BL: 0x23066b7b In both cases, the OF executes these 2 commands from iram. */ STRAP_OPT_A = 0x23066b7b; DEV_RS = DEV_SYSTEM; #else DEV_RS |= DEV_SYSTEM; #endif /* wait until reboot kicks in */ while (1); } void system_exception_wait(void) { /* FIXME: we just need the right buttons */ CPU_INT_DIS = -1; COP_INT_DIS = -1; /* Halt */ PROC_CTL(CURRENT_CORE) = 0x40000000; while (1); } int system_memory_guard(int newmode) { (void)newmode; return 0; }