linux-kernel-cpufreq_interactive2

static unsigned int *get_tokenized_data(const char *buf, int *num_tokens)
{
 const char *cp;
 int i;
 int ntokens = 1;
 unsigned int *tokenized_data;
 int err = -EINVAL;

 cp = buf;
 while ((cp = strpbrk(cp + 1, " :")))
  ntokens++;

 if (!(ntokens & 0x1))
  goto err;

 tokenized_data = kmalloc(ntokens * sizeof(unsigned int), GFP_KERNEL);
 if (!tokenized_data) {
  err = -ENOMEM;
  goto err;
 }

 cp = buf;
 i = 0;
 while (i < ntokens) {
  if (sscanf(cp, "%u", &tokenized_data[i++]) != 1)
   goto err_kfree;

  cp = strpbrk(cp, " :");
  if (!cp)
   break;
  cp++;
 }

 if (i != ntokens)
  goto err_kfree;

 *num_tokens = ntokens;
 return tokenized_data;

err_kfree:
 kfree(tokenized_data);
err:
 return ERR_PTR(err);
}

static ssize_t show_target_loads(
 struct cpufreq_interactive_tunables *tunables,
 char *buf)
{
 int i;
 ssize_t ret = 0;
 unsigned long flags;

 spin_lock_irqsave(&tunables->target_loads_lock, flags);

 for (i = 0; i < tunables->ntarget_loads; i++)
  ret += sprintf(buf + ret, "%u%s", tunables->target_loads[i],
          i & 0x1 ? ":" : " ");

 sprintf(buf + ret - 1, "\n");
 spin_unlock_irqrestore(&tunables->target_loads_lock, flags);
 return ret;
}

static ssize_t store_target_loads(
 struct cpufreq_interactive_tunables *tunables,
 const char *buf, size_t count)
{
 int ntokens;
 unsigned int *new_target_loads = NULL;
 unsigned long flags;

 new_target_loads = get_tokenized_data(buf, &ntokens);
 if (IS_ERR(new_target_loads))
  return PTR_RET(new_target_loads);

 spin_lock_irqsave(&tunables->target_loads_lock, flags);
 if (tunables->target_loads != default_target_loads)
  kfree(tunables->target_loads);
 tunables->target_loads = new_target_loads;
 tunables->ntarget_loads = ntokens;
 spin_unlock_irqrestore(&tunables->target_loads_lock, flags);
 return count;
}

static ssize_t show_above_hispeed_delay(
 struct cpufreq_interactive_tunables *tunables, char *buf)
{
 int i;
 ssize_t ret = 0;
 unsigned long flags;

 spin_lock_irqsave(&tunables->above_hispeed_delay_lock, flags);

 for (i = 0; i < tunables->nabove_hispeed_delay; i++)
  ret += sprintf(buf + ret, "%u%s",
          tunables->above_hispeed_delay[i],
          i & 0x1 ? ":" : " ");

 sprintf(buf + ret - 1, "\n");
 spin_unlock_irqrestore(&tunables->above_hispeed_delay_lock, flags);
 return ret;
}

static ssize_t store_above_hispeed_delay(
 struct cpufreq_interactive_tunables *tunables,
 const char *buf, size_t count)
{
 int ntokens;
 unsigned int *new_above_hispeed_delay = NULL;
 unsigned long flags;

 new_above_hispeed_delay = get_tokenized_data(buf, &ntokens);
 if (IS_ERR(new_above_hispeed_delay))
  return PTR_RET(new_above_hispeed_delay);

 spin_lock_irqsave(&tunables->above_hispeed_delay_lock, flags);
 if (tunables->above_hispeed_delay != default_above_hispeed_delay)
  kfree(tunables->above_hispeed_delay);
 tunables->above_hispeed_delay = new_above_hispeed_delay;
 tunables->nabove_hispeed_delay = ntokens;
 spin_unlock_irqrestore(&tunables->above_hispeed_delay_lock, flags);
 return count;

}

static ssize_t show_hispeed_freq(struct cpufreq_interactive_tunables *tunables,
  char *buf)
{
 return sprintf(buf, "%u\n", tunables->hispeed_freq);
}

static ssize_t store_hispeed_freq(struct cpufreq_interactive_tunables *tunables,
  const char *buf, size_t count)
{
 int ret;
 long unsigned int val;

 ret = strict_strtoul(buf, 0, &val);
 if (ret < 0)
  return ret;
 tunables->hispeed_freq = val;
 return count;
}

static ssize_t show_go_hispeed_load(struct cpufreq_interactive_tunables
  *tunables, char *buf)
{
 return sprintf(buf, "%lu\n", tunables->go_hispeed_load);
}

static ssize_t store_go_hispeed_load(struct cpufreq_interactive_tunables
  *tunables, const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = strict_strtoul(buf, 0, &val);
 if (ret < 0)
  return ret;
 tunables->go_hispeed_load = val;
 return count;
}

static ssize_t show_min_sample_time(struct cpufreq_interactive_tunables
  *tunables, char *buf)
{
 return sprintf(buf, "%lu\n", tunables->min_sample_time);
}

static ssize_t store_min_sample_time(struct cpufreq_interactive_tunables
  *tunables, const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = strict_strtoul(buf, 0, &val);
 if (ret < 0)
  return ret;
 tunables->min_sample_time = val;
 return count;
}

static ssize_t show_timer_rate(struct cpufreq_interactive_tunables *tunables,
  char *buf)
{
 return sprintf(buf, "%lu\n", tunables->timer_rate);
}

static ssize_t store_timer_rate(struct cpufreq_interactive_tunables *tunables,
  const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = strict_strtoul(buf, 0, &val);
 if (ret < 0)
  return ret;
 tunables->timer_rate = val;
 return count;
}

static ssize_t show_timer_slack(struct cpufreq_interactive_tunables *tunables,
  char *buf)
{
 return sprintf(buf, "%d\n", tunables->timer_slack_val);
}

static ssize_t store_timer_slack(struct cpufreq_interactive_tunables *tunables,
  const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = kstrtol(buf, 10, &val);
 if (ret < 0)
  return ret;

 tunables->timer_slack_val = val;
 return count;
}

static ssize_t show_boost(struct cpufreq_interactive_tunables *tunables,
     char *buf)
{
 return sprintf(buf, "%d\n", tunables->boost_val);
}

static ssize_t store_boost(struct cpufreq_interactive_tunables *tunables,
      const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = kstrtoul(buf, 0, &val);
 if (ret < 0)
  return ret;

 tunables->boost_val = val;

 if (tunables->boost_val) {
  trace_cpufreq_interactive_boost("on");
  cpufreq_interactive_boost();
 } else {
  trace_cpufreq_interactive_unboost("off");
 }

 return count;
}

static ssize_t store_boostpulse(struct cpufreq_interactive_tunables *tunables,
    const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = kstrtoul(buf, 0, &val);
 if (ret < 0)
  return ret;

 tunables->boostpulse_endtime = ktime_to_us(ktime_get()) +
  tunables->boostpulse_duration_val;
 trace_cpufreq_interactive_boost("pulse");
#ifdef CONFIG_HISI_HMPTH_SET
  if(tunables->boost_hmp_val && !tunables->hmp_boosted) {
   tunables->hmp_boosted = true;
   set_hmp_policy(HMP_NAME, HMP_PRIO, HMP_ON, tunables->boost_hmp_upthreshold,
     tunables->boost_hmp_downthreshold);
  }
#endif
 cpufreq_interactive_boost();
 return count;
}

static ssize_t show_boostpulse_duration(struct cpufreq_interactive_tunables
  *tunables, char *buf)
{
 return sprintf(buf, "%d\n", tunables->boostpulse_duration_val);
}

static ssize_t store_boostpulse_duration(struct cpufreq_interactive_tunables
  *tunables, const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = kstrtoul(buf, 0, &val);
 if (ret < 0)
  return ret;

 tunables->boostpulse_duration_val = val;
 return count;
}
#ifdef CONFIG_ARCH_HIXXX
static ssize_t show_boostpulse_min_interval(struct cpufreq_interactive_tunables
  *tunables, char *buf)
{
 return sprintf(buf, "%d\n", tunables->boostpulse_min_interval);
}

static ssize_t store_boostpulse_min_interval(struct cpufreq_interactive_tunables
  *tunables, const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = kstrtoul(buf, 0, &val);
 if (ret < 0)
  return ret;

 tunables->boostpulse_min_interval = val;
 return count;
}
#endif

static ssize_t show_io_is_busy(struct cpufreq_interactive_tunables *tunables,
  char *buf)
{
 return sprintf(buf, "%u\n", tunables->io_is_busy);
}

static ssize_t store_io_is_busy(struct cpufreq_interactive_tunables *tunables,
  const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = kstrtoul(buf, 0, &val);
 if (ret < 0)
  return ret;
 tunables->io_is_busy = val;
 return count;
}

#ifdef CONFIG_HISI_HMPTH_SET
static ssize_t show_boost_hmp(struct cpufreq_interactive_tunables *tunables,
  char *buf)
{
 return sprintf(buf, "%u\n", tunables->boost_hmp_val);
}

static ssize_t store_boost_hmp(struct cpufreq_interactive_tunables *tunables,
  const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = kstrtoul(buf, 0, &val);
 if (ret < 0)
  return ret;
 tunables->boost_hmp_val = val;
 return count;
}

static ssize_t show_boost_hmp_upthreshold(struct cpufreq_interactive_tunables
  *tunables, char *buf)
{
 return sprintf(buf, "%u\n", tunables->boost_hmp_upthreshold);
}

static ssize_t store_boost_hmp_upthreshold(struct cpufreq_interactive_tunables
  *tunables, const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = kstrtoul(buf, 0, &val);
 if (ret < 0)
  return ret;
 tunables->boost_hmp_upthreshold = val;
 return count;
}

static ssize_t show_boost_hmp_downthreshold(struct cpufreq_interactive_tunables
  *tunables, char *buf)
{
 return sprintf(buf, "%u\n", tunables->boost_hmp_downthreshold);
}

static ssize_t store_boost_hmp_downthreshold(struct cpufreq_interactive_tunables
  *tunables, const char *buf, size_t count)
{
 int ret;
 unsigned long val;

 ret = kstrtoul(buf, 0, &val);
 if (ret < 0)
  return ret;
 tunables->boost_hmp_downthreshold = val;
 return count;
}
#endif

/*
 * Create show/store routines
 * - sys: One governor instance for complete SYSTEM
 * - pol: One governor instance per struct cpufreq_policy
 */
#define show_gov_pol_sys(file_name)     \
static ssize_t show_##file_name##_gov_sys    \
(struct kobject *kobj, struct attribute *attr, char *buf)  \
{         \
 return show_##file_name(common_tunables, buf);   \
}         \
         \
static ssize_t show_##file_name##_gov_pol    \
(struct cpufreq_policy *policy, char *buf)    \
{         \
 return show_##file_name(policy->governor_data, buf);  \
}

#define store_gov_pol_sys(file_name)     \
static ssize_t store_##file_name##_gov_sys    \
(struct kobject *kobj, struct attribute *attr, const char *buf,  \
 size_t count)       \
{         \
 return store_##file_name(common_tunables, buf, count);  \
}         \
         \
static ssize_t store_##file_name##_gov_pol    \
(struct cpufreq_policy *policy, const char *buf, size_t count)  \
{         \
 return store_##file_name(policy->governor_data, buf, count); \
}

#define show_store_gov_pol_sys(file_name)    \
show_gov_pol_sys(file_name);      \
store_gov_pol_sys(file_name)

show_store_gov_pol_sys(target_loads);
show_store_gov_pol_sys(above_hispeed_delay);
show_store_gov_pol_sys(hispeed_freq);
show_store_gov_pol_sys(go_hispeed_load);
show_store_gov_pol_sys(min_sample_time);
show_store_gov_pol_sys(timer_rate);
show_store_gov_pol_sys(timer_slack);
show_store_gov_pol_sys(boost);
store_gov_pol_sys(boostpulse);
show_store_gov_pol_sys(boostpulse_duration);
#ifdef CONFIG_ARCH_HIXXX
show_store_gov_pol_sys(boostpulse_min_interval);
#endif
show_store_gov_pol_sys(io_is_busy);
#ifdef CONFIG_HISI_HMPTH_SET
show_store_gov_pol_sys(boost_hmp);
show_store_gov_pol_sys(boost_hmp_upthreshold);
show_store_gov_pol_sys(boost_hmp_downthreshold);
#endif

#define gov_sys_attr_rw(_name)      \
static struct global_attr _name##_gov_sys =    \
__ATTR(_name, 0644, show_##_name##_gov_sys, store_##_name##_gov_sys)

#define gov_pol_attr_rw(_name)      \
static struct freq_attr _name##_gov_pol =    \
__ATTR(_name, 0644, show_##_name##_gov_pol, store_##_name##_gov_pol)

#define gov_sys_pol_attr_rw(_name)     \
 gov_sys_attr_rw(_name);      \
 gov_pol_attr_rw(_name)

gov_sys_pol_attr_rw(target_loads);
gov_sys_pol_attr_rw(above_hispeed_delay);
gov_sys_pol_attr_rw(hispeed_freq);
gov_sys_pol_attr_rw(go_hispeed_load);
gov_sys_pol_attr_rw(min_sample_time);
gov_sys_pol_attr_rw(timer_rate);
gov_sys_pol_attr_rw(timer_slack);
gov_sys_pol_attr_rw(boost);
gov_sys_pol_attr_rw(boostpulse_duration);
#ifdef CONFIG_ARCH_HIXXX
gov_sys_pol_attr_rw(boostpulse_min_interval);
#endif
gov_sys_pol_attr_rw(io_is_busy);
#ifdef CONFIG_HISI_HMPTH_SET
gov_sys_pol_attr_rw(boost_hmp);
gov_sys_pol_attr_rw(boost_hmp_upthreshold);
gov_sys_pol_attr_rw(boost_hmp_downthreshold);
#endif

static struct global_attr boostpulse_gov_sys =
 __ATTR(boostpulse, 0200, NULL, store_boostpulse_gov_sys);

static struct freq_attr boostpulse_gov_pol =
 __ATTR(boostpulse, 0200, NULL, store_boostpulse_gov_pol);

/* One Governor instance for entire system */
static struct attribute *interactive_attributes_gov_sys[] = {
 &target_loads_gov_sys.attr,
 &above_hispeed_delay_gov_sys.attr,
 &hispeed_freq_gov_sys.attr,
 &go_hispeed_load_gov_sys.attr,
 &min_sample_time_gov_sys.attr,
 &timer_rate_gov_sys.attr,
 &timer_slack_gov_sys.attr,
 &boost_gov_sys.attr,
 &boostpulse_gov_sys.attr,
 &boostpulse_duration_gov_sys.attr,
#ifdef CONFIG_ARCH_HIXXX
 &boostpulse_min_interval_gov_sys.attr,
#endif
 &io_is_busy_gov_sys.attr,
#ifdef CONFIG_HISI_HMPTH_SET
 &boost_hmp_gov_sys.attr,
 &boost_hmp_upthreshold_gov_sys.attr,
 &boost_hmp_downthreshold_gov_sys.attr,
#endif
 NULL,
};

static struct attribute_group interactive_attr_group_gov_sys = {
 .attrs = interactive_attributes_gov_sys,
 .name = "interactive",
};

/* Per policy governor instance */
static struct attribute *interactive_attributes_gov_pol[] = {
 &target_loads_gov_pol.attr,
 &above_hispeed_delay_gov_pol.attr,
 &hispeed_freq_gov_pol.attr,
 &go_hispeed_load_gov_pol.attr,
 &min_sample_time_gov_pol.attr,
 &timer_rate_gov_pol.attr,
 &timer_slack_gov_pol.attr,
 &boost_gov_pol.attr,
 &boostpulse_gov_pol.attr,
 &boostpulse_duration_gov_pol.attr,
#ifdef CONFIG_ARCH_HIXXX
 &boostpulse_min_interval_gov_pol.attr,
#endif
 &io_is_busy_gov_pol.attr,
#ifdef CONFIG_HISI_HMPTH_SET
 &boost_hmp_gov_pol.attr,
 &boost_hmp_upthreshold_gov_pol.attr,
 &boost_hmp_downthreshold_gov_pol.attr,
#endif
 NULL,
};

static struct attribute_group interactive_attr_group_gov_pol = {
 .attrs = interactive_attributes_gov_pol,
 .name = "interactive",
};

static struct attribute_group *get_sysfs_attr(void)
{
 if (have_governor_per_policy())
  return &interactive_attr_group_gov_pol;
 else
  return &interactive_attr_group_gov_sys;
}

static int cpufreq_interactive_idle_notifier(struct notifier_block *nb,
          unsigned long val,
          void *data)
{
 switch (val) {
 case IDLE_START:
  cpufreq_interactive_idle_start();
  break;
 case IDLE_END:
  cpufreq_interactive_idle_end();
  break;
 }

 return 0;
}

static struct notifier_block cpufreq_interactive_idle_nb = {
 .notifier_call = cpufreq_interactive_idle_notifier,
};

static int cpufreq_governor_interactive(struct cpufreq_policy *policy,
  unsigned int event)
{
 int rc;
 unsigned int j;
 struct cpufreq_interactive_cpuinfo *pcpu;
 struct cpufreq_frequency_table *freq_table;
 struct cpufreq_interactive_tunables *tunables;

 if (have_governor_per_policy())
  tunables = policy->governor_data;
 else
  tunables = common_tunables;

 WARN_ON(!tunables && (event != CPUFREQ_GOV_POLICY_INIT));
 if (!tunables && (event != CPUFREQ_GOV_POLICY_INIT))
  return 0;

 switch (event) {
 case CPUFREQ_GOV_POLICY_INIT:
  if (have_governor_per_policy()) {
   WARN_ON(tunables);
  } else if (tunables) {
   tunables->usage_count++;
   policy->governor_data = tunables;
   return 0;
  }

  tunables = kzalloc(sizeof(*tunables), GFP_KERNEL);
  if (!tunables) {
   pr_err("%s: POLICY_INIT: kzalloc failed\n", __func__);
   return -ENOMEM;
  }

  rc = sysfs_create_group(get_governor_parent_kobj(policy),
    get_sysfs_attr());
  if (rc) {
   kfree(tunables);
   return rc;
  }

#ifdef CONFIG_INPUT_PULSE_SUPPORT
  if (policy->cpu == 0) {
   rc = input_register_handler(&cpufreq_interactive_input_handler);
   if (rc)
    pr_warn("%s: failed to register input handler\n",
     __func__);
  }
#endif /*#ifdef CONFIG_INPUT_PULSE_SUPPORT*/

  tunables->usage_count = 1;
  tunables->above_hispeed_delay = default_above_hispeed_delay;
  tunables->nabove_hispeed_delay =
   ARRAY_SIZE(default_above_hispeed_delay);
  tunables->go_hispeed_load = DEFAULT_GO_HISPEED_LOAD;
  tunables->target_loads = default_target_loads;
  tunables->ntarget_loads = ARRAY_SIZE(default_target_loads);
  tunables->min_sample_time = DEFAULT_MIN_SAMPLE_TIME;
  tunables->timer_rate = DEFAULT_TIMER_RATE;
  tunables->boostpulse_duration_val = DEFAULT_MIN_SAMPLE_TIME;
  tunables->timer_slack_val = DEFAULT_TIMER_SLACK;
#ifdef CONFIG_ARCH_HIXXX
  tunables->boostpulse_min_interval = DEFAULT_MIN_BOOSTPULSE_INTERVAL;
#endif

#ifdef CONFIG_HISI_HMPTH_SET
  tunables->boost_hmp_upthreshold = DEFAULT_HMP_UP_THRESHOLD;
  tunables->boost_hmp_downthreshold = DEFAULT_HMP_DOWN_THRESHOLD;
#endif

  spin_lock_init(&tunables->target_loads_lock);
  spin_lock_init(&tunables->above_hispeed_delay_lock);

  if (!policy->governor->initialized) {
   idle_notifier_register(&cpufreq_interactive_idle_nb);
   cpufreq_register_notifier(&cpufreq_notifier_block,
     CPUFREQ_TRANSITION_NOTIFIER);
  }

  policy->governor_data = tunables;
  if (!have_governor_per_policy())
   common_tunables = tunables;

#ifdef CONFIG_ARCH_HIXXX
  if (policy->cpu == 0)
   cpufreq_interactive_initialized = 1;
#endif

  break;

 case CPUFREQ_GOV_POLICY_EXIT:
#ifdef CONFIG_ARCH_HIXXX
  if (policy->cpu == 0)
   cpufreq_interactive_initialized = 0;
#endif
  if (!--tunables->usage_count) {
   if (policy->governor->initialized == 1) {
    cpufreq_unregister_notifier(&cpufreq_notifier_block,
      CPUFREQ_TRANSITION_NOTIFIER);
    idle_notifier_unregister(&cpufreq_interactive_idle_nb);
   }

#ifdef CONFIG_INPUT_PULSE_SUPPORT
   if (policy->cpu == 0)
    input_unregister_handler(&cpufreq_interactive_input_handler);
#endif /*#ifdef CONFIG_INPUT_PULSE_SUPPORT*/

   sysfs_remove_group(get_governor_parent_kobj(policy),
     get_sysfs_attr());
   kfree(tunables);
   common_tunables = NULL;
  }

  policy->governor_data = NULL;
  break;

 case CPUFREQ_GOV_START:
  mutex_lock(&gov_lock);

  freq_table = cpufreq_frequency_get_table(policy->cpu);
  if (!tunables->hispeed_freq)
#ifdef CONFIG_ARCH_HIXXX
#define HIXXX_DEFAULT_HISPEED_FREQ (1209600)
   tunables->hispeed_freq = HIXXX_DEFAULT_HISPEED_FREQ;
#else
   tunables->hispeed_freq = policy->max;
#endif
  for_each_cpu(j, policy->cpus) {
   pcpu = &per_cpu(cpuinfo, j);
   pcpu->policy = policy;
   pcpu->target_freq = policy->cur;
   pcpu->freq_table = freq_table;
   pcpu->floor_freq = pcpu->target_freq;
   pcpu->floor_validate_time =
    ktime_to_us(ktime_get());
   pcpu->hispeed_validate_time =
    pcpu->floor_validate_time;
   down_write(&pcpu->enable_sem);
   del_timer_sync(&pcpu->cpu_timer);
   del_timer_sync(&pcpu->cpu_slack_timer);
   cpufreq_interactive_timer_start(tunables, j);
   pcpu->governor_enabled = 1;
   up_write(&pcpu->enable_sem);
  }

  mutex_unlock(&gov_lock);
  break;

 case CPUFREQ_GOV_STOP:
  mutex_lock(&gov_lock);
  for_each_cpu(j, policy->cpus) {
   pcpu = &per_cpu(cpuinfo, j);
   down_write(&pcpu->enable_sem);
   pcpu->governor_enabled = 0;
   del_timer_sync(&pcpu->cpu_timer);
   del_timer_sync(&pcpu->cpu_slack_timer);
   up_write(&pcpu->enable_sem);
  }

  mutex_unlock(&gov_lock);
  break;

 case CPUFREQ_GOV_LIMITS:
  if (policy->max < policy->cur)
   __cpufreq_driver_target(policy,
     policy->max, CPUFREQ_RELATION_H);
  else if (policy->min > policy->cur)
   __cpufreq_driver_target(policy,
     policy->min, CPUFREQ_RELATION_L);

  mutex_lock(&gov_lock);

  for_each_cpu(j, policy->cpus) {
   pcpu = &per_cpu(cpuinfo, j);

   /* hold write semaphore to avoid race */
   down_write(&pcpu->enable_sem);
   if (pcpu->governor_enabled == 0) {
    up_write(&pcpu->enable_sem);
    continue;
   }

   /* update target_freq firstly */
   if (policy->max < pcpu->target_freq)
    pcpu->target_freq = policy->max;
   else if (policy->min > pcpu->target_freq)
    pcpu->target_freq = policy->min;

   /* Reschedule timer only if policy->max is raised.
    * Delete the timers, else the timer callback may
    * return without re-arm the timer when failed
    * acquire the semaphore. This race may cause timer
    * stopped unexpectedly.
    */
   del_timer_sync(&pcpu->cpu_timer);
    del_timer_sync(&pcpu->cpu_slack_timer);
    cpufreq_interactive_timer_start(tunables, j);
   up_write(&pcpu->enable_sem);
  }
  mutex_unlock(&gov_lock);
  break;
 }
 return 0;
}

#ifndef CONFIG_CPU_FREQ_DEFAULT_GOV_INTERACTIVE
static
#endif
struct cpufreq_governor cpufreq_gov_interactive = {
 .name = "interactive",
 .governor = cpufreq_governor_interactive,
 .max_transition_latency = 10000000,
 .owner = THIS_MODULE,
};

static void cpufreq_interactive_nop_timer(unsigned long data)
{
}

static int __init cpufreq_interactive_init(void)
{
 unsigned int i;
 struct cpufreq_interactive_cpuinfo *pcpu;
 struct sched_param param = { .sched_priority = MAX_RT_PRIO-1 };

#ifdef CONFIG_HI6XXX_LP_TRACE
    g_freqdump_addr = ioremap(MEMORY_FREQDUMP_ADDR,MEMORY_FREQDUMP_SIZE);
#endif

 /* Initalize per-cpu timers */
 for_each_possible_cpu(i) {
  pcpu = &per_cpu(cpuinfo, i);
  init_timer_deferrable(&pcpu->cpu_timer);
  pcpu->cpu_timer.function = cpufreq_interactive_timer;
  pcpu->cpu_timer.data = i;
  init_timer(&pcpu->cpu_slack_timer);
  pcpu->cpu_slack_timer.function = cpufreq_interactive_nop_timer;
  spin_lock_init(&pcpu->load_lock);
  init_rwsem(&pcpu->enable_sem);
 }

 spin_lock_init(&speedchange_cpumask_lock);
 mutex_init(&gov_lock);
 speedchange_task =
  kthread_create(cpufreq_interactive_speedchange_task, NULL,
          "cfinteractive");
 if (IS_ERR(speedchange_task))
  return PTR_ERR(speedchange_task);

 sched_setscheduler_nocheck(speedchange_task, SCHED_FIFO, &param);
 get_task_struct(speedchange_task);

 /* NB: wake up so the thread does not look hung to the freezer */
 wake_up_process(speedchange_task);

#ifdef CONFIG_INPUT_PULSE_SUPPORT
 /* No rescuer thread, bind to CPU queuing the work for possibly
    warm cache (probably doesn't matter much). */
 down_wq = alloc_workqueue("knteractive_down", 0, 1);

 if (!down_wq)
  goto err_freeuptask;

 INIT_WORK(&inputopen.inputopen_work, cpufreq_interactive_input_open);
#endif /*#ifdef CONFIG_INPUT_PULSE_SUPPORT*/

 return cpufreq_register_governor(&cpufreq_gov_interactive);

#ifdef CONFIG_INPUT_PULSE_SUPPORT
err_freeuptask:
 put_task_struct(speedchange_task);
 return -ENOMEM;
#endif /*#ifdef CONFIG_INPUT_PULSE_SUPPORT*/
}

#ifdef CONFIG_CPU_FREQ_DEFAULT_GOV_INTERACTIVE
fs_initcall(cpufreq_interactive_init);
#else
module_init(cpufreq_interactive_init);
#endif

static void __exit cpufreq_interactive_exit(void)
{
 cpufreq_unregister_governor(&cpufreq_gov_interactive);
 kthread_stop(speedchange_task);
 put_task_struct(speedchange_task);
#ifdef CONFIG_HI6XXX_LP_TRACE
    iounmap(g_freqdump_addr);
#endif
}

module_exit(cpufreq_interactive_exit);