mtk: fliper: backport 3.18 drivers (without earlysuspend)

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);