Skip to content

Commit

Permalink
Merge pull request hardkernel#42 from yan-wyb/khadas-vims-4.9.y
Browse files Browse the repository at this point in the history 
Add fan trigger temperatures setting nodes
  • Loading branch information
@numbqq
numbqq authored Apr 17, 2021
2 parents 6dd351a + 0cf38ef commit eba9589
Show file tree
Hide file tree
Showing 2 changed files with 213 additions and 0 deletions.
104 changes: 104 additions & 0 deletions drivers/misc/khadas-fan.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -251,10 +251,114 @@ static ssize_t fan_temp_store(struct device *dev, struct device_attribute *attr,
}
#endif

static void fan_set_func(struct khadas_fan_data *fan_data)
{
int temp = -EINVAL;

temp = get_cpu_temp();

if(temp != -EINVAL){
if(temp < fan_data->trig_temp_level0 ){
khadas_fan_level_set(fan_data,0);

}else if(temp < fan_data->trig_temp_level1 ){
khadas_fan_level_set(fan_data,1);

}else if(temp < fan_data->trig_temp_level2 ){
khadas_fan_level_set(fan_data,2);

}else{
khadas_fan_level_set(fan_data,3);
}
}

}

static ssize_t fan_trigger_low_show(struct class *cls,
struct class_attribute *attr, char *buf){

return sprintf(buf, "Fan trigger low speed temperature:%d\n", fan_data->trig_temp_level0);
}

static ssize_t fan_trigger_low_store(struct class *cls, struct class_attribute *attr,
const char *buf, size_t count){

int trigger;

if (kstrtoint(buf, 0, &trigger))
return -EINVAL;

if (trigger >= g_mcu_data->fan_data.trig_temp_level1){
pr_err("Invalid parameter\n");
return -EINVAL;
}

fan_data->trig_temp_level0 = trigger;

fan_set_func(fan_data);

return count;
}

static ssize_t fan_trigger_mid_show(struct class *cls,
struct class_attribute *attr, char *buf){

return sprintf(buf, "Fan trigger mid speed temperature:%d\n", fan_data->trig_temp_level1);
}

static ssize_t fan_trigger_mid_store(struct class *cls, struct class_attribute *attr,
const char *buf, size_t count){

int trigger;

if (kstrtoint(buf, 0, &trigger))
return -EINVAL;

if (trigger >= g_mcu_data->fan_data.trig_temp_level2 || trigger <= g_mcu_data->fan_data.trig_temp_level0){
pr_err("Invalid parameter\n");
return -EINVAL;
}

fan_data->trig_temp_level1 = trigger;

fan_set_func(fan_data);

return count;
}

static ssize_t fan_trigger_high_show(struct class *cls,
struct class_attribute *attr, char *buf){

return sprintf(buf, "Fan trigger high speed temperature:%d\n", fan_data->trig_temp_level2);
}

static ssize_t fan_trigger_high_store(struct class *cls, struct class_attribute *attr,
const char *buf, size_t count){

int trigger;

if (kstrtoint(buf, 0, &trigger))
return -EINVAL;

if (trigger <= g_mcu_data->fan_data.trig_temp_level1){
pr_err("Invalid parameter\n");
return -EINVAL;
}

fan_data->trig_temp_level2 = trigger;

fan_set_func(fan_data);

return count;
}

static struct class_attribute fan_class_attrs[] = {
__ATTR(enable, 0644, fan_enable_show, fan_enable_store),
__ATTR(mode, 0644, fan_mode_show, fan_mode_store),
__ATTR(level, 0644, fan_level_show, fan_level_store),
__ATTR(trigger_low, 0644, fan_trigger_low_show, fan_trigger_low_store),
__ATTR(trigger_mid, 0644, fan_trigger_mid_show, fan_trigger_mid_store),
__ATTR(trigger_high, 0644, fan_trigger_high_show, fan_trigger_high_store),
__ATTR(temp, 0644, fan_temp_show, NULL),
};

Expand Down
109 changes: 109 additions & 0 deletions drivers/misc/khadas-mcu.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -364,6 +364,7 @@ static ssize_t store_fan_mode(struct class *cls, struct class_attribute *attr,
return count;
}


static ssize_t show_fan_level(struct class *cls,
struct class_attribute *attr, char *buf)
{
Expand Down Expand Up @@ -400,6 +401,111 @@ static ssize_t show_fan_temp(struct class *cls,
return sprintf(buf, "cpu_temp:%d\nFan trigger temperature: level0:%d level1:%d level2:%d\n", temp, g_mcu_data->fan_data.trig_temp_level0, g_mcu_data->fan_data.trig_temp_level1, g_mcu_data->fan_data.trig_temp_level2);
}


void fan_level_set(struct mcu_data *ug_mcu_data){

struct mcu_fan_data *fan_data = &g_mcu_data->fan_data;
int temp = -EINVAL;

if ((KHADAS_BOARD_VIM1 == ug_mcu_data->board) ||
(KHADAS_BOARD_VIM2 == ug_mcu_data->board))
temp = get_cpu_temp();
else if (KHADAS_BOARD_VIM3 == ug_mcu_data->board)
temp = meson_get_temperature();

if(temp != -EINVAL){
if(temp < ug_mcu_data->fan_data.trig_temp_level0 ) {
mcu_fan_level_set(fan_data, 0);
}else if(temp < ug_mcu_data->fan_data.trig_temp_level1 ) {
mcu_fan_level_set(fan_data, 1);
}else if(temp < ug_mcu_data->fan_data.trig_temp_level2 ) {
mcu_fan_level_set(fan_data, 2);
}else{
mcu_fan_level_set(fan_data, 3);
}
}
}


static ssize_t show_fan_trigger_low(struct class *cls,
struct class_attribute *attr, char *buf){

return sprintf(buf, "Fan trigger low speed temperature:%d\n", g_mcu_data->fan_data.trig_temp_level0);
}

static ssize_t store_fan_trigger_low(struct class *cls, struct class_attribute *attr,
const char *buf, size_t count){

int trigger;

if (kstrtoint(buf, 0, &trigger))
return -EINVAL;

if (trigger >= g_mcu_data->fan_data.trig_temp_level1){
pr_err("Invalid parameter\n");
return -EINVAL;
}

g_mcu_data->fan_data.trig_temp_level0 = trigger;

fan_level_set(g_mcu_data);

return count;
}

static ssize_t show_fan_trigger_mid(struct class *cls,
struct class_attribute *attr, char *buf){

return sprintf(buf, "Fan trigger mid speed temperature:%d\n", g_mcu_data->fan_data.trig_temp_level1);
}

static ssize_t store_fan_trigger_mid(struct class *cls, struct class_attribute *attr,
const char *buf, size_t count){

int trigger;

if (kstrtoint(buf, 0, &trigger))
return -EINVAL;

if (trigger >= g_mcu_data->fan_data.trig_temp_level2 || trigger <= g_mcu_data->fan_data.trig_temp_level0){
pr_err("Invalid parameter\n");
return -EINVAL;
}

g_mcu_data->fan_data.trig_temp_level1 = trigger;

fan_level_set(g_mcu_data);

return count;
}

static ssize_t show_fan_trigger_high(struct class *cls,
struct class_attribute *attr, char *buf){

return sprintf(buf, "Fan trigger high speed temperature:%d\n", g_mcu_data->fan_data.trig_temp_level2);
}

static ssize_t store_fan_trigger_high(struct class *cls, struct class_attribute *attr,
const char *buf, size_t count){

int trigger;

if (kstrtoint(buf, 0, &trigger))
return -EINVAL;

if (trigger <= g_mcu_data->fan_data.trig_temp_level1 ){
pr_err("Invalid parameter\n");
return -EINVAL;
}

g_mcu_data->fan_data.trig_temp_level2 = trigger;

fan_level_set(g_mcu_data);

return count;
}


static ssize_t store_wol_enable(struct class *cls, struct class_attribute *attr,
const char *buf, size_t count)
{
Expand Down Expand Up @@ -525,6 +631,9 @@ static struct class_attribute fan_class_attrs[] = {
__ATTR(enable, 0644, show_fan_enable, store_fan_enable),
__ATTR(mode, 0644, show_fan_mode, store_fan_mode),
__ATTR(level, 0644, show_fan_level, store_fan_level),
__ATTR(trigger_temp_low, 0644, show_fan_trigger_low, store_fan_trigger_low),
__ATTR(trigger_temp_mid, 0644, show_fan_trigger_mid, store_fan_trigger_mid),
__ATTR(trigger_temp_high, 0644, show_fan_trigger_high, store_fan_trigger_high),
__ATTR(temp, 0644, show_fan_temp, NULL),
};

Expand Down

0 comments on commit eba9589

Please sign in to comment.