1 files changed, 54 insertions, 1 deletions

diff --git a/drivers/devfreq/governor_simpleondemand.c b/drivers/devfreq/governor_simpleondemand.c
index a2e3eae79011..0720ba84ca92 100644
--- a/drivers/devfreq/governor_simpleondemand.c
+++ b/drivers/devfreq/governor_simpleondemand.c
@@ -10,8 +10,10 @@
  */
 
 #include <linux/errno.h>
+#include <linux/module.h>
 #include <linux/devfreq.h>
 #include <linux/math64.h>
+#include "governor.h"
 
 /* Default constants for DevFreq-Simple-Ondemand (DFSO) */
 #define DFSO_UPTHRESHOLD        (90)
@@ -88,7 +90,58 @@ static int devfreq_simple_ondemand_func(struct devfreq *df,
         return 0;
 }
 
-const struct devfreq_governor devfreq_simple_ondemand = {
+static int devfreq_simple_ondemand_handler(struct devfreq *devfreq,
+                                unsigned int event, void *data)
+{
+        switch (event) {
+        case DEVFREQ_GOV_START:
+                devfreq_monitor_start(devfreq);
+                break;
+
+        case DEVFREQ_GOV_STOP:
+                devfreq_monitor_stop(devfreq);
+                break;
+
+        case DEVFREQ_GOV_INTERVAL:
+                devfreq_interval_update(devfreq, (unsigned int *)data);
+                break;
+
+        case DEVFREQ_GOV_SUSPEND:
+                devfreq_monitor_suspend(devfreq);
+                break;
+
+        case DEVFREQ_GOV_RESUME:
+                devfreq_monitor_resume(devfreq);
+                break;
+
+        default:
+                break;
+        }
+
+        return 0;
+}
+
+static struct devfreq_governor devfreq_simple_ondemand = {
         .name = "simple_ondemand",
         .get_target_freq = devfreq_simple_ondemand_func,
+        .event_handler = devfreq_simple_ondemand_handler,
 };
+
+static int __init devfreq_simple_ondemand_init(void)
+{
+        return devfreq_add_governor(&devfreq_simple_ondemand);
+}
+subsys_initcall(devfreq_simple_ondemand_init);
+
+static void __exit devfreq_simple_ondemand_exit(void)
+{
+        int ret;
+
+        ret = devfreq_remove_governor(&devfreq_simple_ondemand);
+        if (ret)
+                pr_err("%s: failed remove governor %d\n", __func__, ret);
+
+        return;
+}
+module_exit(devfreq_simple_ondemand_exit);
+MODULE_LICENSE("GPL");