diff options
| -rw-r--r-- | firmware/target/arm/as3525/debug-as3525.c | 265 |
1 files changed, 264 insertions, 1 deletions
diff --git a/firmware/target/arm/as3525/debug-as3525.c b/firmware/target/arm/as3525/debug-as3525.c index 8e2d90ca3b..6533c4b16f 100644 --- a/firmware/target/arm/as3525/debug-as3525.c +++ b/firmware/target/arm/as3525/debug-as3525.c @@ -27,17 +27,41 @@ #include "system.h" #include "sprintf.h" #include "cpu.h" +#include "pl180.h" #define _DEBUG_PRINTF(a,varargs...) \ snprintf(buf, sizeof(buf), (a), ##varargs); lcd_puts(0,line++,buf) #define ON "Enabled" -#define OFF "Enabled" +#define OFF "Disabled" #define CP15_MMU (1<<0) /* mmu off/on */ #define CP15_DC (1<<2) /* dcache off/on */ #define CP15_IC (1<<12) /* icache off/on */ +#define CLK_MAIN 24000000 /* 24 MHz */ + +#define CLK_PLLA 0 +#define CLK_PLLB 1 +#define CLK_922T 2 +#define CLK_FCLK 3 +#define CLK_EXTMEM 4 +#define CLK_PCLK 5 +#define CLK_IDE 6 +#define CLK_I2C 7 +#define CLK_I2SI 8 +#define CLK_I2SO 9 +#define CLK_DBOP 10 +#define CLK_SD_IDENT_NAND 11 +#define CLK_SD_IDENT_MSD 12 +#define CLK_USB 13 + +#define I2C2_CPSR0 *((volatile unsigned int *)(I2C_AUDIO_BASE + 0x1C)) +#define I2C2_CPSR1 *((volatile unsigned int *)(I2C_AUDIO_BASE + 0x20)) +#define MCI_NAND *((volatile unsigned long *)(NAND_FLASH_BASE + 0x04)) +#define MCI_SD *((volatile unsigned long *)(SD_MCI_BASE + 0x04)) + + /* FIXME: target tree is including ./debug-target.h rather than the one in * sansa-fuze/, even though deps contains the correct one * if I put the below into a sansa-fuze/debug-target.h, it doesn't work*/ @@ -57,8 +81,247 @@ static unsigned read_cp15 (void) return (value); } +int calc_freq(int clk) +{ + int out_div; + + switch(clk) { + /* clk_main = clk_int = 24MHz oscillator */ + case CLK_PLLA: + if(CGU_PLLASUP & (1<<3)) + return 0; + + /*assume 24MHz oscillator only input available */ + out_div = ((CGU_PLLA>>13) & 0x3); /* bits 13:14 */ + if (out_div == 3) /* for 11 NO=4 */ + out_div=4; + if(out_div) /* NO = 0 not allowed */ + return ((2 * (CGU_PLLA & 0xff))*CLK_MAIN)/ + (((CGU_PLLA>>8) & 0x1f)*out_div); + return 0; + case CLK_PLLB: + if(CGU_PLLBSUP & (1<<3)) + return 0; + + /*assume 24MHz oscillator only input available */ + out_div = ((CGU_PLLB>>13) & 0x3); /* bits 13:14 */ + if (out_div == 3) /* for 11 NO=4 */ + out_div=4; + if(out_div) /* NO = 0 not allowed */ + return ((2 * (CGU_PLLB & 0xff))*CLK_MAIN)/ + (((CGU_PLLB>>8) & 0x1f)*out_div); + return 0; + case CLK_922T: + if (!(read_cp15()>>30)) /* fastbus */ + return calc_freq(CLK_PCLK); + else /* Synch or Asynch bus*/ + return calc_freq(CLK_FCLK); + case CLK_FCLK: + switch(CGU_PROC & 3) { + case 0: + return CLK_MAIN/ + ((8/(8-((CGU_PROC & 0xc)>>2)))*(((CGU_PROC & 0xf0)>>4) + 1)); + case 1: + return calc_freq(CLK_PLLA)/ + ((8/(8-((CGU_PROC & 0xc)>>2)))*(((CGU_PROC & 0xf0)>>4) + 1)); + case 2: + return calc_freq(CLK_PLLB)/ + ((8/(8-((CGU_PROC & 0xc)>>2)))*(((CGU_PROC & 0xf0)>>4) + 1)); + default: + return 0; + } + case CLK_EXTMEM: + switch(CGU_PERI & 3) { + case 0: + return CLK_MAIN/(((CGU_PERI & 0x3c)>>2)+1); + case 1: + return calc_freq(CLK_PLLA)/(((CGU_PERI & 0x3c)>>2)+1); + case 2: + return calc_freq(CLK_PLLB)/(((CGU_PERI & 0x3c)>>2)+1); + case 3: + return calc_freq(CLK_FCLK)/(((CGU_PERI & 0x3c)>>2)+1); + default: + return 0; + } + case CLK_PCLK: + return calc_freq(CLK_EXTMEM)/(((CGU_PERI & 0x40)>>6)+1); + case CLK_IDE: + switch(CGU_IDE & 3) { + case 0: + return CLK_MAIN/(((CGU_IDE & 0x3c)>>2)+1); + case 1: + return calc_freq(CLK_PLLA)/(((CGU_IDE & 0x3c)>>2)+1);; + case 2: + return calc_freq(CLK_PLLB)/(((CGU_IDE & 0x3c)>>2)+1); + default: + return 0; + } + case CLK_I2C: + return calc_freq(CLK_PCLK)/(I2C2_CPSR1<<8 | I2C2_CPSR0); + case CLK_I2SI: + switch((CGU_AUDIO>>12) & 3) { + case 0: + return CLK_MAIN/(((CGU_AUDIO>>14) & 0x1ff)+1); + case 1: + return calc_freq(CLK_PLLA)/(((CGU_AUDIO>>14) & 0x1ff)+1); + case 2: + return calc_freq(CLK_PLLB)/(((CGU_AUDIO>>14) & 0x1ff)+1); + default: + return 0; + } + case CLK_I2SO: + switch(CGU_AUDIO & 3) { + case 0: + return CLK_MAIN/(((CGU_AUDIO>>2) & 0x1ff)+1); + case 1: + return calc_freq(CLK_PLLA)/(((CGU_AUDIO>>2) & 0x1ff)+1); + case 2: + return calc_freq(CLK_PLLB)/(((CGU_AUDIO>>2) & 0x1ff)+1); + default: + return 0; + } + case CLK_DBOP: + return calc_freq(CLK_PCLK)/((CGU_DBOP & 7)+1); + case CLK_SD_IDENT_NAND: + return calc_freq(CLK_PCLK)/(((MCI_NAND & 0xff)*2)+1); + case CLK_SD_IDENT_MSD: + return calc_freq(CLK_PCLK)/(((MCI_SD & 0xff)*2)+1); + case CLK_USB: + switch(CGU_USB & 3) { /* 0-> div=1 other->div=1/(2*n) */ + case 0: + if (!((CGU_USB>>2) & 0xf)) + return CLK_MAIN; + else + return CLK_MAIN/(2*((CGU_USB>>2) & 0xf)); + case 1: + if (!((CGU_USB>>2) & 0xf)) + return calc_freq(CLK_PLLA); + else + return calc_freq(CLK_PLLA)/(2*((CGU_USB>>2) & 0xf)); + case 2: + if (!((CGU_USB>>2) & 0xf)) + return calc_freq(CLK_PLLB); + else + return calc_freq(CLK_PLLB)/(2*((CGU_USB>>2) & 0xf)); + default: + return 0; + } + default: + return 0; + } +} + bool __dbg_hw_info(void) { +char buf[50]; + int line; + + lcd_clear_display(); + lcd_setfont(FONT_SYSFIXED); + + while(1) + { + lcd_clear_display(); + line = 0; + _DEBUG_PRINTF("[Clock Frequencies:]"); + _DEBUG_PRINTF(" SET ACT"); + _DEBUG_PRINTF("922T: %3dMHz", calc_freq(CLK_922T)/1000000); + _DEBUG_PRINTF("PLLA:%3dMHz %3dMHz", AS3525_PLLA_FREQ/1000000, calc_freq(CLK_PLLA)/1000000); + _DEBUG_PRINTF("PLLB: %3dMHz", calc_freq(CLK_PLLB)/1000000); + _DEBUG_PRINTF("FCLK: %3dMHz", calc_freq(CLK_FCLK)/1000000); + +#if LCD_HEIGHT < 176 /* clip */ + lcd_update(); + while(1) + { + int btn = button_get_w_tmo(HZ/10); + if(btn == (DEBUG_CANCEL|BUTTON_REL)) + goto end; + else if(btn == (BUTTON_DOWN|BUTTON_REL)) + break; + } + lcd_clear_display(); + line = 0; +#endif /* LCD_HEIGHT < 176 */ + + _DEBUG_PRINTF("DRAM:%3dMHz %3dMHz", AS3525_PCLK_FREQ/1000000, calc_freq(CLK_EXTMEM)/1000000); + _DEBUG_PRINTF("PCLK:%3dMHz %3dMHz", AS3525_PCLK_FREQ/1000000, calc_freq(CLK_PCLK)/1000000); + _DEBUG_PRINTF("IDE :%3dMHz %3dMHz", AS3525_IDE_FREQ/1000000,calc_freq(CLK_IDE)/1000000); + _DEBUG_PRINTF("DBOP:%3dMHz %3dMHz", AS3525_DBOP_FREQ/1000000,calc_freq(CLK_DBOP)/1000000); + _DEBUG_PRINTF("I2C :%3dkHz %3dkHz", AS3525_I2C_FREQ/1000,calc_freq(CLK_I2C)/1000); + _DEBUG_PRINTF("I2SI: %s %3dMHz", (CGU_AUDIO & (1<<23)) ? "on " : "off" ,calc_freq(CLK_I2SI)/1000000); + +#if LCD_HEIGHT < 176 /* clip */ + lcd_update(); + while(1) + { + int btn = button_get_w_tmo(HZ/10); + if(btn == (DEBUG_CANCEL|BUTTON_REL)) + goto end; + else if(btn == (BUTTON_DOWN|BUTTON_REL)) + break; + } + lcd_clear_display(); + line = 0; +#endif /* LCD_HEIGHT < 176 */ + + _DEBUG_PRINTF("I2SO: %s %3dMHz", (CGU_AUDIO & (1<<11)) ? "on " : "off", calc_freq(CLK_I2SO)/1000000); + _DEBUG_PRINTF("SD :%3dkHz %3dkHz", AS3525_SD_IDENT_FREQ/1000,calc_freq(CLK_SD_IDENT_NAND)/1000); + _DEBUG_PRINTF("MSD :%3dkHz %3dkHz", AS3525_SD_IDENT_FREQ/1000,calc_freq(CLK_SD_IDENT_MSD)/1000); + _DEBUG_PRINTF("USB: %3dMHz", calc_freq(CLK_USB)/1000000); + + lcd_update(); + while(1) + { + int btn = button_get_w_tmo(HZ/10); + if(btn == (DEBUG_CANCEL|BUTTON_REL)) + goto end; + else if(btn == (BUTTON_DOWN|BUTTON_REL)) + break; + } + lcd_clear_display(); + line = 0; + + _DEBUG_PRINTF("CGU_PLLA :%8x", (unsigned int)(CGU_PLLA)); + _DEBUG_PRINTF("CGU_PLLB :%8x", (unsigned int)(CGU_PLLB)); + _DEBUG_PRINTF("CGU_PROC :%8x", (unsigned int)(CGU_PROC)); + _DEBUG_PRINTF("CGU_PERI :%8x", (unsigned int)(CGU_PERI)); + _DEBUG_PRINTF("CGU_IDE :%8x", (unsigned int)(CGU_IDE)); + _DEBUG_PRINTF("CGU_DBOP :%8x", (unsigned int)(CGU_DBOP)); + +#if LCD_HEIGHT < 176 /* clip */ + lcd_update(); + while(1) + { + int btn = button_get_w_tmo(HZ/10); + if(btn == (DEBUG_CANCEL|BUTTON_REL)) + goto end; + else if(btn == (BUTTON_DOWN|BUTTON_REL)) + break; + } + lcd_clear_display(); + line = 0; +#endif /* LCD_HEIGHT < 176 */ + + _DEBUG_PRINTF("CGU_AUDIO :%8x", (unsigned int)(CGU_AUDIO)); + _DEBUG_PRINTF("CGU_USB :%8x", (unsigned int)(CGU_USB)); + _DEBUG_PRINTF("I2C2_CPSR :%8x", (unsigned int)(I2C2_CPSR1<<8 | I2C2_CPSR0)); + _DEBUG_PRINTF("MCI_NAND :%8x", (unsigned int)(MCI_NAND)); + _DEBUG_PRINTF("MCI_SD :%8x", (unsigned int)(MCI_SD)); + + lcd_update(); + while(1) + { + int btn = button_get_w_tmo(HZ/10); + if(btn == (DEBUG_CANCEL|BUTTON_REL)) + goto end; + else if(btn == (BUTTON_DOWN|BUTTON_REL)) + break; + } + } + +end: + lcd_setfont(FONT_UI); return false; } |