void cpu_boost_(bool on_off, char* location, int line)
{
corelock_lock(&boostctrl_cl);
if (cpu_boost_calls_count == MAX_BOOST_LOG)
{
cpu_boost_first = (cpu_boost_first+1)%MAX_BOOST_LOG;
cpu_boost_calls_count--;
if (cpu_boost_calls_count < 0)
cpu_boost_calls_count = 0;
}
if (cpu_boost_calls_count < MAX_BOOST_LOG)
{
int message = (cpu_boost_first+cpu_boost_calls_count)%MAX_BOOST_LOG;
snprintf(cpu_boost_calls[message], MAX_PATH,
"%c %s:%d",on_off?'B':'U',location,line);
cpu_boost_calls_count++;
}
#else
void cpu_boost(bool on_off)
{
corelock_lock(&boostctrl_cl);
#endif /* CPU_BOOST_LOGGING */
if(on_off)
{
/* Boost the frequency if not already boosted */
if(++boost_counter == 1)
set_cpu_frequency(CPUFREQ_MAX);
}
else
{
/* Lower the frequency if the counter reaches 0 */
if(--boost_counter <= 0)
{
if(cpu_idle)
set_cpu_frequency(CPUFREQ_DEFAULT);
else
set_cpu_frequency(CPUFREQ_NORMAL);
/* Safety measure */
if (boost_counter < 0)
{
boost_counter = 0;
}
}
}
corelock_unlock(&boostctrl_cl);
}
unsigned int get_cpu_frequency(void)
{
unsigned int frequency;
unsigned int fpidiv;
SCU_PLLCON0_t_nonv pllcon0;
SCU_PLLCON1_t_nonv pllcon1;
SCU_PLLSTAT_t_nonv pllstat;
if (!freq_init)
{
set_cpu_frequency();
#ifdef ENABLE_ICACHE
/* enable instruction cache (PMI_CON0) */
unlock_wdtcon();
PMI_CON0.bits.PCBYP = 0;
lock_wdtcon();
#endif /* ENABLE_ICACHE */
}
pllcon0 = SCU_PLLCON0;
pllcon1 = SCU_PLLCON1;
pllstat = SCU_PLLSTAT;
/* read FPI divider value */
fpidiv = SCU_CCUCON0.bits.FPIDIV;
if (pllstat.bits.VCOBYST)
{
/* prescaler mode */
unsigned int k_div;
k_div = pllcon1.bits.K1DIV + 1;
frequency = DEF_FRQ / k_div;
}
else if (pllstat.bits.FINDIS)
{
/* freerunning mode */
unsigned int k_div;
k_div = pllcon1.bits.K2DIV + 1;
frequency = VCOBASE_FREQ / k_div;
}
else
{
/* normal mode */
unsigned int k_div, n_div, p_div;
n_div = pllcon0.bits.NDIV + 1;
p_div = pllcon0.bits.PDIV + 1;
k_div = pllcon1.bits.K2DIV + 1;
frequency = DEF_FRQ * n_div / (k_div * p_div);
}
frequency /= (fpidiv + 1);
return frequency;
}
void cpu_idle_mode(bool on_off)
{
corelock_lock(&boostctrl_cl);
cpu_idle = on_off;
/* We need to adjust the frequency immediately if the CPU
isn't boosted */
if(boost_counter == 0)
{
if(cpu_idle)
set_cpu_frequency(CPUFREQ_DEFAULT);
else
set_cpu_frequency(CPUFREQ_NORMAL);
}
corelock_unlock(&boostctrl_cl);
}
int main(){
// try 300mhz
if(set_cpu_frequency(FREQ_300MHZ)<0){
printf("Failed to set CPU frequency to 300mhz\n");
return -1;
}
printf("\nFrequency set to: ");
print_cpu_frequency();
// try 600mhz
if(set_cpu_frequency(FREQ_600MHZ)<0){
printf("Failed to set CPU frequency to 600mhz\n");
return -1;
}
printf("\nFrequency set to: ");
print_cpu_frequency();
// try 800mhz
if(set_cpu_frequency(FREQ_800MHZ)<0){
printf("Failed to set CPU frequency to 800mhz\n");
return -1;
}
printf("\nFrequency set to: ");
print_cpu_frequency();
// try 1000mhz
if(set_cpu_frequency(FREQ_1000MHZ)<0){
printf("Failed to set CPU frequency to 1000mhz\n");
return -1;
}
printf("\nFrequency set to: ");
print_cpu_frequency();
// try auto ondemand governor
if(set_cpu_frequency(FREQ_ONDEMAND)<0){
printf("Failed to set CPU frequency to ONDEMAND\n");
return -1;
}
printf("\nFrequency set to scale automatically on demand\n\n");
return 0;
}
static void prvSetupHardware( void )
{
extern void set_cpu_frequency(void);
/* Set-up the PLL. */
set_cpu_frequency();
/* Initialise LED outputs. */
vParTestInitialise();
}
unsigned int get_cpu_frequency(void)
{
unsigned int frequency;
PLL_CLC_t_nonv pllclc;
#ifdef __USE_USB__
SCU_CON_t_nonv scucon;
#endif /* __USE_USB__ */
if (!freq_init)
{
#ifdef __USE_USB__
/* prepare SCU_CON for USB */
scucon = SCU_CON;
scucon.bits.USBCLDIV = (SYS_CFG_USB_CLK_DIVISOR - 1);
scucon.bits.USBCLSEL = 3;
#endif /* __USE_USB__ */
/* set speed to selected clock frequency */
set_cpu_frequency();
#if defined(__USE_USB__) || defined(ENABLE_ICACHE)
unlock_wdtcon();
#ifdef __USE_USB__
SCU_CON = scucon;
#endif /* __USE_USB__ */
#ifdef ENABLE_ICACHE
/* enable instruction cache (PMI_CON0) */
PMI_CON0.bits.CCBYP = 0;
#endif /* ENABLE_ICACHE */
lock_wdtcon();
#endif /* __USE_USB__ || ENABLE_ICACHE */
}
pllclc = PLL_CLC;
if (pllclc.bits.BYPPIN)
{
frequency = DEF_FRQ;
}
else
{
unsigned int k_div, n_div, p_div;
n_div = pllclc.bits.NDIV + 1;
k_div = pllclc.bits.KDIV + 1;
p_div = pllclc.bits.PDIV + 1;
frequency = DEF_FRQ * n_div / (k_div * p_div);
}
if (!(pllclc.bits.SYSFSL))
frequency /= 2;
return frequency;
}
static void init(void)
{
int rc;
bool mounted = false;
#if CONFIG_CHARGING && (CONFIG_CPU == SH7034)
/* if nobody initialized ATA before, I consider this a cold start */
bool coldstart = (PACR2 & 0x4000) != 0; /* starting from Flash */
#endif
system_init();
kernel_init();
#ifdef HAVE_ADJUSTABLE_CPU_FREQ
set_cpu_frequency(CPUFREQ_NORMAL);
#ifdef CPU_COLDFIRE
coldfire_set_pllcr_audio_bits(DEFAULT_PLLCR_AUDIO_BITS);
#endif
cpu_boost(true);
#endif
buffer_init();
settings_reset();
i2c_init();
power_init();
enable_irq();
#ifdef CPU_ARM
enable_fiq();
#endif
/* current_tick should be ticking by now */
CHART("ticking");
lcd_init();
#ifdef HAVE_REMOTE_LCD
lcd_remote_init();
#endif
font_init();
CHART(">show_logo");
show_logo();
CHART("<show_logo");
lang_init(core_language_builtin, language_strings,
LANG_LAST_INDEX_IN_ARRAY);
#ifdef DEBUG
debug_init();
#else
#ifdef HAVE_SERIAL
serial_setup();
#endif
#endif
#if CONFIG_RTC
rtc_init();
#endif
#ifdef HAVE_RTC_RAM
CHART(">settings_load(RTC)");
settings_load(SETTINGS_RTC); /* early load parts of global_settings */
CHART("<settings_load(RTC)");
#endif
adc_init();
usb_init();
#if CONFIG_USBOTG == USBOTG_ISP1362
isp1362_init();
#elif CONFIG_USBOTG == USBOTG_M5636
m5636_init();
#endif
backlight_init();
button_init();
powermgmt_init();
#if CONFIG_TUNER
radio_init();
#endif
/* Keep the order of this 3 (viewportmanager handles statusbars)
* Must be done before any code uses the multi-screen API */
CHART(">gui_syncstatusbar_init");
gui_syncstatusbar_init(&statusbars);
CHART("<gui_syncstatusbar_init");
CHART(">sb_skin_init");
sb_skin_init();
CHART("<sb_skin_init");
CHART(">gui_sync_wps_init");
gui_sync_wps_init();
CHART("<gui_sync_wps_init");
CHART(">viewportmanager_init");
viewportmanager_init();
CHART("<viewportmanager_init");
#if CONFIG_CHARGING && (CONFIG_CPU == SH7034)
/* charger_inserted() can't be used here because power_thread()
hasn't checked power_input_status() yet */
if (coldstart && (power_input_status() & POWER_INPUT_MAIN_CHARGER)
&& !global_settings.car_adapter_mode
#ifdef ATA_POWER_PLAYERSTYLE
&& !ide_powered() /* relies on probing result from bootloader */
#endif
)
{
rc = charging_screen(); /* display a "charging" screen */
if (rc == 1) /* charger removed */
power_off();
/* "On" pressed or USB connected: proceed */
show_logo(); /* again, to provide better visual feedback */
}
#endif
CHART(">storage_init");
rc = storage_init();
CHART("<storage_init");
if(rc)
{
#ifdef HAVE_LCD_BITMAP
lcd_clear_display();
lcd_putsf(0, 1, "ATA error: %d", rc);
lcd_puts(0, 3, "Press ON to debug");
lcd_update();
while(!(button_get(true) & BUTTON_REL)); /*DO NOT CHANGE TO ACTION SYSTEM */
dbg_ports();
#endif
panicf("ata: %d", rc);
}
#ifdef HAVE_EEPROM_SETTINGS
CHART(">eeprom_settings_init");
eeprom_settings_init();
CHART("<eeprom_settings_init");
#endif
#ifndef HAVE_USBSTACK
usb_start_monitoring();
while (usb_detect() == USB_INSERTED)
{
#ifdef HAVE_EEPROM_SETTINGS
firmware_settings.disk_clean = false;
#endif
/* enter USB mode early, before trying to mount */
if (button_get_w_tmo(HZ/10) == SYS_USB_CONNECTED)
#if (CONFIG_STORAGE & STORAGE_MMC)
if (!mmc_touched() ||
(mmc_remove_request() == SYS_HOTSWAP_EXTRACTED))
#endif
{
gui_usb_screen_run();
mounted = true; /* mounting done @ end of USB mode */
}
#ifdef HAVE_USB_POWER
if (usb_powered()) /* avoid deadlock */
break;
#endif
}
#endif
if (!mounted)
{
CHART(">disk_mount_all");
rc = disk_mount_all();
CHART("<disk_mount_all");
if (rc<=0)
{
lcd_clear_display();
lcd_puts(0, 0, "No partition");
lcd_puts(0, 1, "found.");
#ifdef HAVE_LCD_BITMAP
lcd_puts(0, 2, "Insert USB cable");
lcd_puts(0, 3, "and fix it.");
#endif
lcd_update();
while(button_get(true) != SYS_USB_CONNECTED) {};
gui_usb_screen_run();
system_reboot();
}
}
#if defined(SETTINGS_RESET) || (CONFIG_KEYPAD == IPOD_4G_PAD) || \
(CONFIG_KEYPAD == IRIVER_H10_PAD)
#ifdef SETTINGS_RESET
/* Reset settings if holding the reset button. (Rec on Archos,
A on Gigabeat) */
if ((button_status() & SETTINGS_RESET) == SETTINGS_RESET)
#else
/* Reset settings if the hold button is turned on */
if (button_hold())
#endif
{
splash(HZ*2, str(LANG_RESET_DONE_CLEAR));
settings_reset();
}
else
#endif
{
CHART(">settings_load(ALL)");
settings_load(SETTINGS_ALL);
CHART("<settings_load(ALL)");
}
CHART(">init_dircache(true)");
rc = init_dircache(true);
CHART("<init_dircache(true)");
if (rc < 0)
{
#ifdef HAVE_TAGCACHE
remove(TAGCACHE_STATEFILE);
#endif
}
CHART(">settings_apply(true)");
settings_apply(true);
CHART("<settings_apply(true)");
CHART(">init_dircache(false)");
init_dircache(false);
CHART("<init_dircache(false)");
#ifdef HAVE_TAGCACHE
CHART(">init_tagcache");
init_tagcache();
CHART("<init_tagcache");
#endif
#ifdef HAVE_EEPROM_SETTINGS
if (firmware_settings.initialized)
{
/* In case we crash. */
firmware_settings.disk_clean = false;
CHART(">eeprom_settings_store");
eeprom_settings_store();
CHART("<eeprom_settings_store");
}
#endif
playlist_init();
tree_mem_init();
filetype_init();
scrobbler_init();
#if CONFIG_CODEC == SWCODEC
tdspeed_init();
#endif /* CONFIG_CODEC == SWCODEC */
#if CONFIG_CODEC != SWCODEC
/* No buffer allocation (see buffer.c) may take place after the call to
audio_init() since the mpeg thread takes the rest of the buffer space */
mp3_init( global_settings.volume,
global_settings.bass,
global_settings.treble,
global_settings.balance,
global_settings.loudness,
global_settings.avc,
global_settings.channel_config,
global_settings.stereo_width,
global_settings.mdb_strength,
global_settings.mdb_harmonics,
global_settings.mdb_center,
global_settings.mdb_shape,
global_settings.mdb_enable,
global_settings.superbass);
/* audio_init must to know the size of voice buffer so init voice first */
talk_init();
#endif /* CONFIG_CODEC != SWCODEC */
CHART(">audio_init");
audio_init();
CHART("<audio_init");
#if (CONFIG_CODEC == SWCODEC) && defined(HAVE_RECORDING) && !defined(SIMULATOR)
pcm_rec_init();
#endif
/* runtime database has to be initialized after audio_init() */
cpu_boost(false);
#if CONFIG_CHARGING
car_adapter_mode_init();
#endif
#ifdef IPOD_ACCESSORY_PROTOCOL
iap_setup(global_settings.serial_bitrate);
#endif
#ifdef HAVE_ACCESSORY_SUPPLY
accessory_supply_set(global_settings.accessory_supply);
#endif
#ifdef HAVE_LINEOUT_POWEROFF
lineout_set(global_settings.lineout_active);
#endif
#ifdef HAVE_HOTSWAP_STORAGE_AS_MAIN
CHART("<check_bootfile(false)");
check_bootfile(false); /* remember write time and filesize */
CHART(">check_bootfile(false)");
#endif
CHART("<settings_apply_skins");
settings_apply_skins();
CHART(">settings_apply_skins");
}
