diff options
| -rw-r--r-- | drivers/misc/mediatek/mach/mt6735/fliper/fliper.c | 514 |
1 files changed, 252 insertions, 262 deletions
diff --git a/drivers/misc/mediatek/mach/mt6735/fliper/fliper.c b/drivers/misc/mediatek/mach/mt6735/fliper/fliper.c index d813949fa..82dac77c1 100644 --- a/drivers/misc/mediatek/mach/mt6735/fliper/fliper.c +++ b/drivers/misc/mediatek/mach/mt6735/fliper/fliper.c @@ -6,6 +6,7 @@ #include <linux/module.h> #include <linux/moduleparam.h> #include <asm/uaccess.h> +#include <linux/printk.h> #include <linux/platform_device.h> #include <linux/suspend.h> @@ -13,17 +14,21 @@ #include <linux/timer.h> #include <linux/jiffies.h> -#include <linux/earlysuspend.h> +#ifdef CONFIG_PM_AUTOSLEEP +#include <linux/fb.h> +#include <linux/notifier.h> +#endif -#include <mach/fliper.h> +#include "mach/fliper.h" +#include "mach/mt_mem_bw.h" #include <mach/mt_vcore_dvfs.h> -#define SEQ_printf(m, x...) \ - do { \ - if (m) \ - seq_printf(m, x); \ - else \ - printk(x); \ - } while (0) +#define SEQ_printf(m, x...)\ + do {\ + if (m)\ + seq_printf(m, x);\ + else\ + pr_debug(x);\ + } while (0) #define X_ms 100 #define Y_steps (2000/X_ms) @@ -31,99 +36,99 @@ #define BW_THRESHOLD_MAX 9000 #define BW_THRESHOLD_MIN 1000 -#define DISABLE_IN_EARLY_SUSPEND - -static int bw_threshold = 0; -static int fliper_enabled = 0; +static int bw_threshold; +static int fliper_enabled; static void enable_fliper(void); static void disable_fliper(void); static int vcore_high(void); static int vcore_low(void); extern unsigned int get_ddr_type(void)__attribute__((weak)); /* define supported DRAM types */ -enum -{ - LPDDR2 = 0, - DDR3_16, - DDR3_32, - LPDDR3, - mDDR, +enum { + LPDDR2 = 0, + DDR3_16, + DDR3_32, + LPDDR3, + mDDR, }; -static int fliper_debug = 0; +static int fliper_debug; static ssize_t mt_fliper_write(struct file *filp, const char *ubuf, - size_t cnt, loff_t *data) + size_t cnt, loff_t *data) { - char buf[64]; - int val; - int ret; - if (cnt >= sizeof(buf)) - return -EINVAL; - - if (copy_from_user(&buf, ubuf, cnt)) - return -EFAULT; - - buf[cnt] = 0; - - ret = strict_strtoul(buf, 10, (unsigned long*)&val); - if (ret < 0) - return ret; - if(val == 1){ - fliper_enabled = 1; - enable_fliper(); - }else if(val == 0){ - fliper_enabled = 0; - disable_fliper(); - }else if(val == 3){ - fliper_debug ^= 1; - }else if(val == 4){ - fliper_set_bw(0); - fliper_set_bw(10000); - fliper_set_bw(BW_THRESHOLD_HIGH); - }else if(val == 5){ - fliper_restore_bw(); - }else if(val == 6){ - ret = vcore_high(); - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> Command flip to S(%d)\n", ret); - }else if(val == 7){ - ret = vcore_low(); - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> Command flip to E(%d)\n", ret); - }else if(val == 8){ - if(bw_threshold < 5000) - bw_threshold += 250; - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> Command Change EMI bandwidth threshold to %d MB/s\n", bw_threshold); - }else if(val == 9){ - if(bw_threshold > 500) - bw_threshold -= 250; - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> Command Change EMI bandwidth threshold to %d MB/s\n", bw_threshold); - } - printk(KERN_CRIT" fliper option: %d\n", val); - return cnt; + char buf[64]; + unsigned long val; + int ret; + + if (cnt >= sizeof(buf)) + return -EINVAL; + + if (copy_from_user(&buf, ubuf, cnt)) + return -EFAULT; + + buf[cnt] = 0; + + ret = kstrtoul(buf, 10, (unsigned long *)&val); + if (ret < 0) { + if (fliper_debug) + pr_crit("\n<<SOC DVFS FLIPER>> no support change POWER_MODE\n"); + return cnt; + } + if (val == 1) { + fliper_enabled = 1; + enable_fliper(); + } else if (val == 0) { + fliper_enabled = 0; + disable_fliper(); + } else if (val == 3) { + fliper_debug ^= 1; + } else if (val == 4) { + fliper_set_bw(0); + fliper_set_bw(10000); + fliper_set_bw(BW_THRESHOLD_HIGH); + } else if (val == 5) { + fliper_restore_bw(); + } else if (val == 6) { + ret = vcore_high(); + pr_crit("\n<<SOC DVFS FLIPER>> Command flip to S(%d)\n", ret); + } else if (val == 7) { + ret = vcore_low(); + pr_crit("\n<<SOC DVFS FLIPER>> Command flip to E(%d)\n", ret); + } else if (val == 8) { + if (bw_threshold < 5000) + bw_threshold += 250; + pr_crit("\n<<SOC DVFS FLIPER>> Command Change EMI bandwidth threshold to %d MB/s\n", bw_threshold); + } else if (val == 9) { + if (bw_threshold > 500) + bw_threshold -= 250; + pr_crit("\n<<SOC DVFS FLIPER>> Command Change EMI bandwidth threshold to %d MB/s\n", bw_threshold); + } + pr_crit(" fliper option: %lu\n", val); + return cnt; } static int mt_fliper_show(struct seq_file *m, void *v) { - SEQ_printf(m, "----------------------------------------\n"); - SEQ_printf(m, "Fliper Enabled:%d, bw threshold:%d MB/s\n", fliper_enabled, bw_threshold); - SEQ_printf(m, "----------------------------------------\n"); - return 0; + SEQ_printf(m, "----------------------------------------\n"); + SEQ_printf(m, "Fliper Enabled:%d, bw threshold:%d MB/s\n", fliper_enabled, bw_threshold); + SEQ_printf(m, "----------------------------------------\n"); + return 0; } /*** Seq operation of mtprof ****/ -static int mt_fliper_open(struct inode *inode, struct file *file) -{ - return single_open(file, mt_fliper_show, inode->i_private); -} - -static const struct file_operations mt_fliper_fops = { - .open = mt_fliper_open, - .write = mt_fliper_write, - .read = seq_read, - .llseek = seq_lseek, - .release = single_release, +static int mt_fliper_open(struct inode *inode, struct file *file) +{ + return single_open(file, mt_fliper_show, inode->i_private); +} + +static const struct file_operations mt_fliper_fops = { + .open = mt_fliper_open, + .write = mt_fliper_write, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, }; /******* POWER PERF TRANSFORMER *********/ #include <asm/div64.h> -//Cache info #include <mach/mt_cpufreq.h> static void mt_power_pef_transfer(void); @@ -131,223 +136,208 @@ static DEFINE_TIMER(mt_pp_transfer_timer, (void *)mt_power_pef_transfer, 0, 0); static int pp_index; static void mt_power_pef_transfer_work(void); -static DECLARE_WORK(mt_pp_work,(void *) mt_power_pef_transfer_work); -//VOCRE +static DECLARE_WORK(mt_pp_work, (void *) mt_power_pef_transfer_work); -static int vcore_high() +static int vcore_high(void) { - int ret = 0; - ret = vcorefs_request_dvfs_opp(KIR_EMIBW, OPPI_PERF); - return ret; + int ret = 0; + + ret = vcorefs_request_dvfs_opp(KIR_EMIBW, OPPI_PERF); + return ret; } -static int vcore_low() +static int vcore_low(void) { - int ret = 0; - ret = vcorefs_request_dvfs_opp(KIR_EMIBW, OPPI_UNREQ); - return ret; + int ret = 0; + + ret = vcorefs_request_dvfs_opp(KIR_EMIBW, OPPI_UNREQ); + return ret; } -//EMI -extern unsigned long long get_mem_bw(void); -static void mt_power_pef_transfer_work() + +static void mt_power_pef_transfer_work(void) { - unsigned long long emi_bw = 0; - int perf_mode = -1; - int ret; - unsigned long long t1, t2; - t1 = 0; t2 = 0; - /* Get EMI*/ - if(fliper_debug == 1){ - t1 = sched_clock(); - emi_bw = get_mem_bw(); - t2 = sched_clock(); - }else - emi_bw = get_mem_bw(); - - if(emi_bw > bw_threshold) - perf_mode = 1; - - if(perf_mode == 1){ - if(pp_index == 0){ - ret = vcore_high(); - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> flip to S(%d), %llu\n", ret, emi_bw); - } - pp_index = 1 << Y_steps; - }else{ - if(pp_index == 1){ - ret = vcore_low(); - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> flip to E(%d), %llu\n", ret, emi_bw); - } - pp_index = pp_index >> 1; - } - - if(fliper_debug == 1) - printk(KERN_CRIT"EMI:Rate:count:mode %6llu:%4d :%llu ns\n", emi_bw, pp_index, t2-t1); + unsigned long long emi_bw = 0; + int perf_mode = -1; + int ret; + unsigned long long t1, t2; + + t1 = 0; t2 = 0; + /*Get EMI*/ + if (fliper_debug == 1) { + t1 = sched_clock(); + emi_bw = get_mem_bw(); + t2 = sched_clock(); + } else + emi_bw = get_mem_bw(); + + if (emi_bw > bw_threshold) + perf_mode = 1; + + if (perf_mode == 1) { + if (pp_index == 0) { + ret = vcore_high(); + pr_crit("\n<<SOC DVFS FLIPER>> flip to S(%d), %llu\n", ret, emi_bw); + } + pp_index = 1 << Y_steps; + } else { + if (pp_index == 1) { + ret = vcore_low(); + pr_crit("\n<<SOC DVFS FLIPER>> flip to E(%d), %llu\n", ret, emi_bw); + } + pp_index = pp_index >> 1; + } + + if (fliper_debug == 1) + pr_crit("EMI:Rate:count:mode %6llu:%4d :%llu ns\n", emi_bw, pp_index, t2-t1); } int fliper_set_bw(int bw) { - if(bw <= BW_THRESHOLD_MAX && bw >= BW_THRESHOLD_MIN){ - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> Set bdw threshold %d -> %d\n", bw_threshold, bw); - bw_threshold = bw; - }else{ - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> Set bdw threshold Error: %d (MAX:%d, MIN:%d)\n",bw, BW_THRESHOLD_MAX, BW_THRESHOLD_MIN ); - } - return 0; + if (bw <= BW_THRESHOLD_MAX && bw >= BW_THRESHOLD_MIN) { + pr_crit("\n<<SOC DVFS FLIPER>> Set bdw threshold %d -> %d\n", bw_threshold, bw); + bw_threshold = bw; + } else { + pr_crit("\n<<SOC DVFS FLIPER>> Set bdw threshold Error: %d (MAX:%d, MIN:%d)\n" + , bw, BW_THRESHOLD_MAX, BW_THRESHOLD_MIN); + } + return 0; } -int fliper_restore_bw() +int fliper_restore_bw(void) { - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> Restore bdw threshold %d -> %d\n", bw_threshold, BW_THRESHOLD); - bw_threshold = BW_THRESHOLD; - return 0; + pr_crit("\n<<SOC DVFS FLIPER>> Restore bdw threshold %d -> %d\n", bw_threshold, BW_THRESHOLD); + bw_threshold = BW_THRESHOLD; + return 0; } -static void enable_fliper() +static void enable_fliper(void) { - printk(KERN_CRIT"fliper enable +++\n"); - mod_timer(&mt_pp_transfer_timer, jiffies + msecs_to_jiffies(X_ms)); + pr_crit("fliper enable +++\n"); + mod_timer(&mt_pp_transfer_timer, jiffies + msecs_to_jiffies(X_ms)); } -static void disable_fliper() +static void disable_fliper(void) { - printk(KERN_CRIT"fliper disable ---\n"); - del_timer(&mt_pp_transfer_timer); + pr_crit("fliper disable ---\n"); + del_timer(&mt_pp_transfer_timer); } -static void mt_power_pef_transfer() +static void mt_power_pef_transfer(void) { - mod_timer(&mt_pp_transfer_timer, jiffies + msecs_to_jiffies(X_ms)); - schedule_work(&mt_pp_work); + mod_timer(&mt_pp_transfer_timer, jiffies + msecs_to_jiffies(X_ms)); + schedule_work(&mt_pp_work); } -#if 0 -/*-------------FLIPER DEVICE/DRIVER--------------*/ -static int fliper_probe(struct platform_device *dev) +#ifndef CONFIG_PM_AUTOSLEEP + static int +fliper_pm_callback(struct notifier_block *nb, + unsigned long action, void *ptr) { - printk("[%s] enter...\n", __func__); - return 0; -} + int ret; + + switch (action) { + + case PM_SUSPEND_PREPARE: + ret = vcore_low(); + pr_crit("\n<<SOC DVFS FLIPER>> Suspend and flip to E(%d)\n", ret); + pp_index = 0; + disable_fliper(); + break; + case PM_HIBERNATION_PREPARE: + break; + + case PM_POST_SUSPEND: + if (fliper_enabled == 1) + enable_fliper(); + else + pr_crit("\n<<SOC DVFS FLIPER>> Resume enable flipper but flipper is disabled\n"); + break; + + case PM_POST_HIBERNATION: + break; + + default: + return NOTIFY_DONE; + } -static int fliper_remove(struct platform_device *dev) -{ - printk("[%s] enter...\n", __func__); - return 0; + return NOTIFY_OK; } -static int fliper_pm_suspend(struct device *device) +#endif + +#ifdef CONFIG_PM_AUTOSLEEP +static void fliper_early_suspend(void) { - int ret; - ret = vcorefs_request_dvfs_opp(KR_EMI_MON, OPPI_UNREQ); - printk(KERN_EMERG"\n<<SOC DVFS FLIPER>> Suspend and flip to E(%d)\n", ret); + int ret; - return 0; + ret = vcore_low(); + pr_emerg("\n<<SOC DVFS FLIPER>> Early Suspend and flip to E(%d)\n", ret); + pp_index = 0; + disable_fliper(); } -struct dev_pm_ops fliper_pm_ops = { - .suspend = fliper_pm_suspend, -}; - -struct platform_device fliper_device = { - .name = "fliper", - .id = -1, - .dev = {}, -}; -static struct platform_driver fliper_driver = { - .driver = { - .name = "fliper", -#ifdef CONFIG_PM - .pm = &fliper_pm_ops, -#endif - .owner = THIS_MODULE, - }, - .probe = fliper_probe, - .remove = fliper_remove, -}; -#endif -static int -fliper_pm_callback(struct notifier_block *nb, - unsigned long action, void *ptr) +static void fliper_late_resume(void) { - int ret; - switch (action) { - - case PM_SUSPEND_PREPARE: - ret = vcore_low(); - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> Suspend and flip to E(%d)\n", ret); - pp_index = 0; - disable_fliper(); - case PM_HIBERNATION_PREPARE: - break; - - case PM_POST_SUSPEND: - if(fliper_enabled == 1) - enable_fliper(); - else - printk(KERN_CRIT"\n<<SOC DVFS FLIPER>> Resume enable flipper but flipper is disabled\n"); - - case PM_POST_HIBERNATION: - break; - - default: - return NOTIFY_DONE; - } - - return NOTIFY_OK; + pr_emerg("\n<<SOC DVFS FLIPER>> Late Resume\n"); + enable_fliper(); } -static void fliper_early_suspend(struct early_suspend *h) -{ - int ret; - ret = vcore_low(); - printk(KERN_EMERG"\n<<SOC DVFS FLIPER>> Early Suspend and flip to E(%d)\n", ret); - pp_index = 0; - disable_fliper(); -} -static void fliper_late_resume(struct early_suspend *h) + + + + +static int fliper_fb_notifier_callback(struct notifier_block *self, unsigned long event, void *fb_evdata) { - printk(KERN_EMERG"\n<<SOC DVFS FLIPER>> Late Resume\n" ); - enable_fliper(); + struct fb_event *evdata = fb_evdata; + int blank; + + if (event != FB_EVENT_BLANK) + return 0; + + blank = *(int *)evdata->data; + + switch (blank) { + case FB_BLANK_UNBLANK: + case FB_BLANK_NORMAL: + fliper_late_resume(); + break; + case FB_BLANK_VSYNC_SUSPEND: + case FB_BLANK_HSYNC_SUSPEND: + break; + case FB_BLANK_POWERDOWN: + fliper_early_suspend(); + break; + default: + return -EINVAL; + } + + return 0; } -static struct early_suspend fliper_early_suspend_handler = -{ - .level = EARLY_SUSPEND_LEVEL_DISABLE_FB, - .suspend = fliper_early_suspend, - .resume = fliper_late_resume, + +static struct notifier_block fliper_fb_notif = { + .notifier_call = fliper_fb_notifier_callback, }; +#endif + + /*-----------------------------------------------*/ #define TIME_5SEC_IN_MS 5000 static int __init init_fliper(void) { - struct proc_dir_entry *pe; - pe = proc_create("fliper", 0644, NULL, &mt_fliper_fops); - if (!pe) - return -ENOMEM; - bw_threshold = BW_THRESHOLD; - printk("prepare mt pp transfer: jiffies:%lu-->%lu\n",jiffies, jiffies + msecs_to_jiffies(TIME_5SEC_IN_MS)); - printk("- next jiffies:%lu >>> %lu\n",jiffies, jiffies + msecs_to_jiffies(X_ms)); - mod_timer(&mt_pp_transfer_timer, jiffies + msecs_to_jiffies(TIME_5SEC_IN_MS)); - fliper_enabled = 1; -#ifdef DISABLE_IN_EARLY_SUSPEND - register_early_suspend(&fliper_early_suspend_handler); + struct proc_dir_entry *pe; + int ret = 0; + + pe = proc_create("fliper", 0664, NULL, &mt_fliper_fops); + if (!pe) + return -ENOMEM; + bw_threshold = BW_THRESHOLD; + pr_debug("prepare mt pp transfer: jiffies:%lu-->%lu\n", jiffies, jiffies + msecs_to_jiffies(TIME_5SEC_IN_MS)); + pr_debug("- next jiffies:%lu >>> %lu\n", jiffies, jiffies + msecs_to_jiffies(X_ms)); + mod_timer(&mt_pp_transfer_timer, jiffies + msecs_to_jiffies(TIME_5SEC_IN_MS)); + fliper_enabled = 1; + +#ifdef CONFIG_PM_AUTOSLEEP + ret = fb_register_client(&fliper_fb_notif); + if (ret) + pr_err("\n<<SOC DVFS FLIPER>> register fb notifier, ret=%d\n", ret); #else - pm_notifier(fliper_pm_callback, 0); + pm_notifier(fliper_pm_callback, 0); #endif -#if 0 -/*-------------FLIPER DEVICE/DRIVER--------------*/ - int ret; - ret = platform_device_register(&fliper_device); - if (ret) { - printk("fliper_device register fail(%d)\n", ret); - return ret; - } - - ret = platform_driver_register(&fliper_driver); - if (ret) { - printk("fliper_driver register fail(%d)\n", ret); - return ret; - } -#endif - - return 0; + return 0; } -__initcall(init_fliper); - -//MODULE_LICENSE("GPL"); -//MODULE_AUTHOR("MTK"); -//MODULE_DESCRIPTION("The fliper function"); +late_initcall(init_fliper); |