/* <:copyright-BRCM:2015:GPL/GPL:standard Copyright (c) 2015 Broadcom All Rights Reserved This program is free software; you can redistribute it and/or modify it under the terms of the GNU General Public License, version 2, as published by the Free Software Foundation (the "GPL"). This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for more details. A copy of the GPL is available at http://www.broadcom.com/licenses/GPLv2.php, or by writing to the Free Software Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. :> */ #include #include #include #include #include #include #include #include #include "board.h" #if defined(CONFIG_BCM_DDR_SELF_REFRESH_PWRSAVE) #if defined(CONFIG_BCM963158) || defined(CONFIG_BCM963178) || defined(CONFIG_BCM947622) || \ defined(CONFIG_BCM96756) || defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) #define CONFIG_BCM_DDR_HW_SELF_REFRESH #else #define CONFIG_BCM_DDR_SW_SELF_REFRESH #endif #endif #if defined(CONFIG_BCM_DDR_HW_SELF_REFRESH) #include #include typedef struct ddr_autosr_dbgfs_t { struct dentry *debugfs_dir; struct dentry *debugfs_parm; } ddr_autosr_dbgfs_t; static ddr_autosr_dbgfs_t g_dbgfs; #define MEMC_CLK_INMHZ 533 #define DEFAULT_DDR_AUTOSR_THRSH_US 20 /* default threshold for idle time before DDR enter self refresh */ #endif // available cpu idle state indices // (see bcm_arm_idle_driver[] below) enum bcm_cpuidle_states { bcs_nop, bcs_wfi, bcs_last }; #if defined(CONFIG_BCM_CPUIDLE_CLK_DIVIDER) static ktime_t time_start, time_end; static s64 time_in, time_out; static unsigned int freq_max_index = 0; // the index of the max freq allowed by all limiters in this system static unsigned int freq_oper_index = 0; // the index of the freq that will be used while active (not sleeping) static unsigned int freq_admin_index = 0; // the index of the max freq configured by the user #if (defined (CONFIG_BCM96858) || defined (CONFIG_BCM96856)) static unsigned int bcm_arm_freq_table_mhz[] = {1500, 750, 375, 188}; #else static unsigned int bcm_arm_freq_table_mhz[] = {1800, 900, 450, 225}; #endif /* frequency to clock control pattern mapping */ static const unsigned int bcm_arm_freq_pattern[] = { 0xffffffff, // 100.00% [32/32] 0x55555555, // 50.00% [16/32] 0x11111111, // 25.00% [8/32] 0x01010101, // 12.50% [4/32] }; #define NUM_PATTERN_INDEX (sizeof(bcm_arm_freq_pattern)/sizeof(unsigned)) #define LAST_PATTERN_INDEX (NUM_PATTERN_INDEX-1) #endif // Enabling WFI by default gives the same behaviour as when cpuidle is compiled out static unsigned int wfi_enabled = 1; void set_cpu_arm_wait(int enable) { wfi_enabled = enable; cpu_idle_poll_ctrl(!wfi_enabled); printk("Wait Instruction is %sabled\n", enable ? "en" : "dis"); } EXPORT_SYMBOL(set_cpu_arm_wait); int get_cpu_arm_wait(void) { return (wfi_enabled); } EXPORT_SYMBOL(get_cpu_arm_wait); #if defined(CONFIG_BCM_CPUIDLE_CLK_DIVIDER) static unsigned int auto_clock_divide_enabled = 0; static void bcm_arm_cpuidle_update_freq( void ) { freq_oper_index = (freq_max_index > freq_admin_index) ? freq_max_index : freq_admin_index; #if defined(CONFIG_BCM94908) BIUCTRL->cluster_clk_pattern[0] = bcm_arm_freq_pattern[freq_oper_index]; #elif defined(CONFIG_BCM96856) || defined(CONFIG_BCM96858) BIUCFG->aux.cluster_clkctrl[0].clk_pattern = bcm_arm_freq_pattern[freq_oper_index]; #else #error BCM_CPUIDLE_CLK_DIVIDER not support on this chip #endif } void bcm_arm_cpuidle_set_auto_clk_divide(unsigned int enabled) { auto_clock_divide_enabled = enabled ? 1 : 0; time_in = time_out = 0; printk("Cpuidle Host Clock divider is %sabled\n", (auto_clock_divide_enabled)?"en":"dis"); } EXPORT_SYMBOL(bcm_arm_cpuidle_set_auto_clk_divide); int bcm_arm_cpuidle_get_auto_clk_divide ( void ) { return auto_clock_divide_enabled; } EXPORT_SYMBOL(bcm_arm_cpuidle_get_auto_clk_divide); #define bcm_arm_cpuidle_index_to_divider(index) (1 << index) static int bcm_arm_cpuidle_divider_to_index (unsigned div) { switch (div) { case 1: return 0; case 2: return 1; case 4: return 2; case 8: return 3; default: return -1; } } void bcm_arm_cpuidle_set_clk_divider(unsigned int maxdiv) { int index = bcm_arm_cpuidle_divider_to_index(maxdiv); if (index != -1) { freq_admin_index = index; bcm_arm_cpuidle_update_freq(); } } EXPORT_SYMBOL(bcm_arm_cpuidle_set_clk_divider); int bcm_arm_cpuidle_get_clk_divider ( void ) { return bcm_arm_cpuidle_index_to_divider(freq_admin_index); } EXPORT_SYMBOL(bcm_arm_cpuidle_get_clk_divider); // set maximum frequency for governor void bcm_cpufreq_set_freq_max(unsigned maxdiv) { int index = bcm_arm_cpuidle_divider_to_index(maxdiv); if (index != -1) { freq_max_index = index; bcm_arm_cpuidle_update_freq(); } } EXPORT_SYMBOL(bcm_cpufreq_set_freq_max); #endif #if defined(CONFIG_BCM_DDR_SELF_REFRESH_PWRSAVE) static unsigned int self_refresh_enabled = 0; void BcmPwrMngtSetDRAMSelfRefresh(unsigned int enable) { self_refresh_enabled = enable; #if defined(CONFIG_BCM_DDR_HW_SELF_REFRESH) if (enable) { #if defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) MEMC->glb.auto_self_refresh |= MEMC_DDR_AUTO_SELFREFRESH_EN; #else MEMC->CHN_TIM_AUTO_SELF_REFRESH |= MEMC_DDR_AUTO_SELFREFRESH_EN; #endif } else { #if defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) MEMC->glb.auto_self_refresh &= ~(MEMC_DDR_AUTO_SELFREFRESH_EN); #else MEMC->CHN_TIM_AUTO_SELF_REFRESH &= ~(MEMC_DDR_AUTO_SELFREFRESH_EN); #endif } #endif printk("DDR Self Refresh is %sabled\n", self_refresh_enabled ? "en" : "dis"); } EXPORT_SYMBOL(BcmPwrMngtSetDRAMSelfRefresh); int BcmPwrMngtGetDRAMSelfRefresh(void) { return (self_refresh_enabled); } EXPORT_SYMBOL(BcmPwrMngtGetDRAMSelfRefresh); #if defined(CONFIG_BCM_DDR_SW_SELF_REFRESH) static PWRMNGT_DDR_SR_CTRL ddrSrCtrl = {.word = 0}; static volatile PWRMNGT_DDR_SR_CTRL *pDdrSrCtrl = &ddrSrCtrl; void BcmPwrMngtRegisterLmemAddr(PWRMNGT_DDR_SR_CTRL *pDdrSr) { int cpu; // Initialize to busy status if (NULL != pDdrSr) { pDdrSrCtrl = pDdrSr; } else { pDdrSrCtrl = &ddrSrCtrl; } pDdrSrCtrl->word = 0; for_each_possible_cpu(cpu) { pDdrSrCtrl->host |= 1<host = 0; // Ensure the PHY MIPS is not active so we can enter SR if (!pDdrSrCtrl->phy) { uint32 dram_cfg = MEMC->CHN_TIM_DRAM_CFG | DRAM_CFG_DRAMSLEEP; MEMC->CHN_TIM_DRAM_CFG = dram_cfg; } } } #endif #if defined(CONFIG_BCM_CPUIDLE_CLK_DIVIDER) time_end = ktime_get(); if (!ktime_to_ns(time_start)) { time_start = time_end; } diff = ktime_to_us(ktime_sub(time_end, time_start)); time_start = time_end; if (diff > S64_MAX) diff = S64_MAX; time_out += diff; if (do_clk_div) { // Check if this is the last cpu entering wfi // in which case we can reduce the core frequency. // The frequency will be raised back immediately after wfi // since the code below is running with local interrupts disabled #if defined(CONFIG_BCM94908) unsigned int wfx_mask = BIUCTRL->wfx_state & ((1 << 4) - 1); if ((((wfx_mask & online_mask) | cpu_mask) ^ online_mask) == 0) { BIUCTRL->cluster_clk_pattern[0] = bcm_arm_freq_pattern[LAST_PATTERN_INDEX]; } #elif defined(CONFIG_BCM96856) || defined(CONFIG_BCM96858) wfi_state |= cpu_mask; if ((wfi_state ^ online_mask) == 0) { // all CPUs in the cluster are in WFI, lower the clock frequency BIUCFG->aux.cluster_clkctrl[0].clk_pattern = bcm_arm_freq_pattern[LAST_PATTERN_INDEX]; } #else #error BCM_CPUIDLE_CLK_DIVIDER not support on this chip #endif dsb(ish); wfi(); #if defined(CONFIG_BCM94908) if (BIUCTRL->cluster_clk_pattern[0] != bcm_arm_freq_pattern[freq_oper_index]) { update_stats = true; } BIUCTRL->cluster_clk_pattern[0] = bcm_arm_freq_pattern[freq_oper_index]; #elif defined(CONFIG_BCM96856) || defined(CONFIG_BCM96858) if (BIUCFG->aux.cluster_clkctrl[0].clk_pattern != bcm_arm_freq_pattern[freq_oper_index]) { // all CPUs are in WFI, so the current CPU is the first out of WFI update_stats = true; wfi_state &= ~(cpu_mask); } BIUCFG->aux.cluster_clkctrl[0].clk_pattern = bcm_arm_freq_pattern[freq_oper_index]; #else #error BCM_CPUIDLE_CLK_DIVIDER not support on this chip #endif if (update_stats == true) { time_end = ktime_get(); diff = ktime_to_us(ktime_sub(time_end, time_start)); time_start = time_end; if (diff > S64_MAX) diff = S64_MAX; time_in += diff; } } else #endif { dsb(ish); wfi(); } #if defined(CONFIG_BCM_DDR_SW_SELF_REFRESH) if (do_ddr_sr) { ddrSrCtrl.host |= cpu_mask; } #endif return index; } static int bcm_arm_cpuidle_nop_enter(struct cpuidle_device *dev, struct cpuidle_driver *drv, int index) { return index; } static struct cpuidle_driver bcm_arm_idle_driver = { .name = "bcm_wfi", .owner = THIS_MODULE, .states[bcs_nop] = { .enter = bcm_arm_cpuidle_nop_enter, .desc = "nop", .name = "nop", .power_usage = 900, }, .states[bcs_wfi] = { .enter = bcm_arm_cpuidle_wfi_enter, .name = "wfi", .desc = "Wait For Interrupt", .power_usage = 500, }, .state_count = bcs_last, }; #if defined(CONFIG_BCM_CPUIDLE_CLK_DIVIDER) static ssize_t show_enable_auto_clkdiv(struct device *dev, struct device_attribute *attr, char *buf) { return sprintf(buf, "%d\n", auto_clock_divide_enabled); } static ssize_t store_enable_auto_clkdiv(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { unsigned long long value; int err = kstrtoull(buf, 0, &value); if (err) return err; auto_clock_divide_enabled = value?1:0; time_in = time_out = 0; return size; } static ssize_t show_time_inside_clkdiv(struct device *dev, struct device_attribute *attr, char *buf) { return sprintf(buf, "%lld\n", time_in); } static ssize_t show_time_outside_clkdiv(struct device *dev, struct device_attribute *attr, char *buf) { return sprintf(buf, "%lld\n", time_out); } static ssize_t show_valid_freq_list (struct device *dev, struct device_attribute *attr, char *buf) { int i = 0; buf[0] = 0; for ( ; i < NUM_PATTERN_INDEX; i++) { char buf2[16]; snprintf(buf2, sizeof(buf2), "%d\n", bcm_arm_freq_table_mhz[i]); strcat(buf, buf2); } return strlen(buf); } static ssize_t show_oper_max_freq (struct device *dev, struct device_attribute *attr, char *buf) { return sprintf(buf, "%d\n", bcm_arm_freq_table_mhz[freq_oper_index]); } static ssize_t show_admin_max_freq (struct device *dev, struct device_attribute *attr, char *buf) { return sprintf(buf, "%d\n", bcm_arm_freq_table_mhz[freq_admin_index]); } static ssize_t store_admin_max_freq(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { unsigned long long value; int index = 0; int err = kstrtoull(buf, 0, &value); if (err) return err; // If we can't fit in above the second lowest value, assume the lowest value freq_admin_index = NUM_PATTERN_INDEX - 1; // Search for a valid index matching the input for ( ; index < NUM_PATTERN_INDEX -1 ; index++ ) { if (value >= bcm_arm_freq_table_mhz[index]) { freq_admin_index = index; break; } } bcm_arm_cpuidle_update_freq(); return size; } static ssize_t show_percent_inside_clkdiv(struct device *dev, struct device_attribute *attr, char *buf) { s64 per100 = 100*time_in/(time_in+time_out); s64 remainder = 100000*time_in/(time_in+time_out) - 1000*per100; return sprintf(buf, "%lld.%03lld\n", per100, remainder); } static ssize_t store_time_inside_clkdiv(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { time_in = time_out = 0; return size; } static DEVICE_ATTR(enable_auto_clkdiv, 0644, show_enable_auto_clkdiv, store_enable_auto_clkdiv); static DEVICE_ATTR(time_inside_clkdiv, 0644, show_time_inside_clkdiv, store_time_inside_clkdiv); static DEVICE_ATTR(time_outside_clkdiv, 0644, show_time_outside_clkdiv, store_time_inside_clkdiv); static DEVICE_ATTR(percent_inside_clkdiv, 0644, show_percent_inside_clkdiv, store_time_inside_clkdiv); static DEVICE_ATTR(valid_freq_list, 0444, show_valid_freq_list, NULL); static DEVICE_ATTR(oper_max_freq, 0444, show_oper_max_freq, NULL); static DEVICE_ATTR(admin_max_freq, 0644, show_admin_max_freq, store_admin_max_freq); static struct attribute *bcm_arm_cpuidle_attrs[] = { &dev_attr_enable_auto_clkdiv.attr, &dev_attr_time_inside_clkdiv.attr, &dev_attr_time_outside_clkdiv.attr, &dev_attr_percent_inside_clkdiv.attr, &dev_attr_valid_freq_list.attr, &dev_attr_oper_max_freq.attr, &dev_attr_admin_max_freq.attr, NULL }; static struct attribute_group bcm_arm_cpuidle_attr_group = { .attrs = bcm_arm_cpuidle_attrs, .name = "bcm_arm_cpuidle", }; #endif #if defined(CONFIG_BCM_DDR_HW_SELF_REFRESH) static int ddr_autosr_parm_read (void * data, u64 *val) { #if defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) uint32_t reg = MEMC->glb.auto_self_refresh; #else uint32_t reg = MEMC->CHN_TIM_AUTO_SELF_REFRESH; #endif uint32_t thres_us = (reg & MEMC_DDR_AUTO_SR_IDLE_CNT_MASK) / MEMC_CLK_INMHZ; printk("returning DDR auto refresh threshold in us\n"); *val = (u64)thres_us; return 0; } static int ddr_autosr_parm_write (void *data, u64 val) { uint32_t thres = (uint32_t)val * MEMC_CLK_INMHZ; #if defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) uint32_t reg = MEMC->glb.auto_self_refresh; #else uint32_t reg = MEMC->CHN_TIM_AUTO_SELF_REFRESH; #endif /* threshold needs a min value of 1 (MEMC tick) */ if (thres == 0) thres = 1; reg &= ~(MEMC_DDR_AUTO_SR_IDLE_CNT_MASK); reg |= thres; #if defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) MEMC->glb.auto_self_refresh = reg; #else MEMC->CHN_TIM_AUTO_SELF_REFRESH = reg; #endif printk("setting DDR auto refresh threshold to = %u (us) -> %u(ticks)\n", (uint32_t)val, thres); return 0; } DEFINE_SIMPLE_ATTRIBUTE (ddr_autosr_fops, ddr_autosr_parm_read, ddr_autosr_parm_write, "%llu\n"); #endif static int __init bcm_arm_cpuidle_init(void) { #if defined(CONFIG_BCM_CPUIDLE_CLK_DIVIDER) sysfs_create_group(&cpu_subsys.dev_root->kobj, &bcm_arm_cpuidle_attr_group); #if defined(CONFIG_BCM94908) if ((BIUCTRL->cluster_clk_ctrl[0] & 1 << 4) == 0) { BIUCTRL->cluster_clk_pattern[0] = ~0; // full-speed user clock-pattern BIUCTRL->cluster_clk_ctrl[0] = 1 << 4; // enable user clock-patterns } #elif defined(CONFIG_BCM96856) || defined(CONFIG_BCM96858) BIUCFG->aux.cluster_clkctrl[0].clk_pattern = ~0; // enable clock control and select clock pattern register BIUCFG->aux.cluster_clkctrl[0].clk_control = ((1 << 4) | (1 << 31)); #else #error BCM_CPUIDLE_CLK_DIVIDER not support on this chip #endif #endif #if defined(CONFIG_BCM_DDR_SELF_REFRESH_PWRSAVE) MEMC->PhyControl.IDLE_PAD_CONTROL = 0xe; MEMC->PhyControl.IDLE_PAD_EN0 = 0x6df; MEMC->PhyControl.IDLE_PAD_EN1 = 0x3fffff; #if defined(CONFIG_BCM96858) || defined(CONFIG_BCM94908) || defined(CONFIG_BCM96846) || defined(CONFIG_BCM96856) || defined(CONFIG_BCM963138) || defined(CONFIG_BCM963178) || defined(CONFIG_BCM947622) || defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) MEMC->PhyByteLane0Control.IDLE_PAD_CTRL = 0xfffe; MEMC->PhyByteLane1Control.IDLE_PAD_CTRL = 0xfffe; #endif #if defined(CONFIG_BCM96858) || defined(CONFIG_BCM94908) || defined(CONFIG_BCM96846) || defined(CONFIG_BCM96856) MEMC->PhyByteLane2Control.IDLE_PAD_CTRL = 0xfffe; MEMC->PhyByteLane3Control.IDLE_PAD_CTRL = 0xfffe; #endif #if defined(CONFIG_BCM963178) MEMC->PhyControl.CLOCK_IDLE = 0x1e; #elif defined(CONFIG_BCM947622) MEMC->PhyControl.CLOCK_IDLE = 0x1a; #endif #if defined(CONFIG_BCM963178) || defined(CONFIG_BCM947622) || defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) MEMC->PhyByteLane0Control.CLOCK_IDLE = 0x7; MEMC->PhyByteLane1Control.CLOCK_IDLE = 0x7; #endif #if defined(CONFIG_BCM_DDR_HW_SELF_REFRESH) // set up number of mclk cycles the memc has to be idle before it // automatically enters self-refresh, if enabled; // and enable MEMC Slow Clock when DDR Self-Refresh is activated #if defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) MEMC->glb.auto_self_refresh &= ~(MEMC_DDR_AUTO_SR_IDLE_CNT_MASK); MEMC->glb.auto_self_refresh |= ((DEFAULT_DDR_AUTOSR_THRSH_US * MEMC_CLK_INMHZ) & MEMC_DDR_AUTO_SR_IDLE_CNT_MASK); MEMC->glb.gcfg |= MEMC_GLB_GCFG_SREF_SLOW_CLK_MASK; #else MEMC->CHN_TIM_AUTO_SELF_REFRESH &= ~(MEMC_DDR_AUTO_SR_IDLE_CNT_MASK); MEMC->CHN_TIM_AUTO_SELF_REFRESH |= DEFAULT_DDR_AUTOSR_THRSH_US * MEMC_CLK_INMHZ; MEMC->GLB_GCFG |= MEMC_GLB_GCFG_SREF_SLOW_CLK_MASK; #endif // #if defined(CONFIG_BCM963146) || defined(CONFIG_BCM94912) || defined(CONFIG_BCM96813) g_dbgfs.debugfs_dir = debugfs_create_dir("ddr_autosr", NULL); if (IS_ERR(g_dbgfs.debugfs_dir)) { PTR_ERR(g_dbgfs.debugfs_dir); g_dbgfs.debugfs_dir = NULL; } if (g_dbgfs.debugfs_dir) { g_dbgfs.debugfs_parm = debugfs_create_file ("autosr_thres", S_IRUSR | S_IWUSR, g_dbgfs.debugfs_dir, NULL, &ddr_autosr_fops); } #endif #endif // #if defined(CONFIG_BCM_DDR_SELF_REFRESH_PWRSAVE) return cpuidle_register(&bcm_arm_idle_driver, NULL); } late_initcall(bcm_arm_cpuidle_init);