#include <stdio.h>
#include <unistd.h>
#include <stdlib.h>
#include "sysfs.h"
#include "cpufreq.h"
#include "debug.h"

struct s_cpudata {
 long int min_freq;
 long int max_freq;
 long int cur_freq;
 long int cur_temp;
 long int scale_max;
};

struct s_config {
 char *governor;
 long int max_temp;
 char *temp_input;
 long int freq_step;
 long int fallback_freq;
 unsigned int interval;
};

struct s_cpudata cpudata;
struct s_config config={"conservative",70000,"/sys/devices/virtual/thermal/thermal_zone0/temp",100000,2000000,10};

int main()
{
 long int diff;
 long int newfreq;
 
 printf("Governor: %s\nTemp input: %s\n",config.governor,config.temp_input);

 if (cpufreq_set_str("scaling_governor",config.governor,0)!=0)
 {
  printf("Failed to set governow\n");
  exit(1);
 }

 cpudata.min_freq=sysfs_read_long_int("/sys/devices/system/cpu/cpufreq/policy0/cpuinfo_min_freq");
 cpudata.max_freq=sysfs_read_long_int("/sys/devices/system/cpu/cpufreq/policy0/cpuinfo_max_freq");
 cpudata.scale_max=sysfs_read_long_int("/sys/devices/system/cpu/cpufreq/policy0/scaling_max_freq");

 while(1)
 {
  cpudata.cur_freq=sysfs_read_long_int("/sys/devices/system/cpu/cpufreq/policy0/scaling_cur_freq");
  cpudata.cur_temp=sysfs_read_long_int(config.temp_input);


  DEBUG1_MAIN("Data: %ld %ld %ld %ld %ld\n",cpudata.cur_temp,config.max_temp,cpudata.max_freq,cpudata.scale_max,cpudata.cur_freq);

  if ((cpudata.cur_temp<config.max_temp) && (cpudata.scale_max<cpudata.max_freq))
  {
   diff=(config.max_temp-cpudata.cur_temp)/1000;
   newfreq=cpudata.scale_max+(config.freq_step*diff);
   if (newfreq>cpudata.max_freq) newfreq=cpudata.max_freq;
   DEBUG1_MAIN("Increase to %ld\n",newfreq);
   cpufreq_set_long_int("scaling_max_freq",newfreq,100);
   cpudata.scale_max=sysfs_read_long_int("/sys/devices/system/cpu/cpufreq/policy0/scaling_max_freq");
  }

  if ((cpudata.cur_temp>config.max_temp) && (cpudata.scale_max>cpudata.min_freq))
  {
   diff=(cpudata.cur_temp-config.max_temp)/1000;
   newfreq=cpudata.scale_max-(config.freq_step*diff);
   if (newfreq<cpudata.min_freq) newfreq=cpudata.min_freq;
   DEBUG1_MAIN("Decrease to %ld\n",newfreq);
   cpufreq_set_long_int("scaling_max_freq",newfreq,100);
   cpudata.scale_max=sysfs_read_long_int("/sys/devices/system/cpu/cpufreq/policy0/scaling_max_freq");
  }

  sleep(config.interval);
 }
}