sergiotarxz/nuttx
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Thermal: Add dummy driver

Browse Source 
Signed-off-by: wangjianyu3 <wangjianyu3@xiaomi.com>
This commit is contained in:
wangjianyu3 2023-11-07 20:12:32 +08:00 committed by Xiang Xiao
parent b30f866f80
commit d43f0272e5
5 changed files with 389 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
drivers/thermal/Kconfig
View File

@ -37,4 +37,27 @@ config THERMAL_PROCFS
---help---
Enable thermal procfs.
config THERMAL_DUMMY
bool "Thermal dummy driver"
default n
---help---
Enable thermal dummy driver.
if THERMAL_DUMMY
config THERMAL_DUMMY_POLLING_DELAY
int "Polling delay"
default 200
---help---
Polling delay(tick).
config THERMAL_DUMMY_CPUFREQ
bool "Dummy cpufreq driver"
default n
depends on CPUFREQ
---help---
Enable cpufreq dummy driver.
endif # THERMAL_DUMMY
endif # THERMAL

4
drivers/thermal/Make.defs
View File

@ -36,6 +36,10 @@ ifeq ($(CONFIG_THERMAL_PROCFS),y)
CSRCS += thermal_procfs.c
endif
ifeq ($(CONFIG_THERMAL_DUMMY),y)
CSRCS += thermal_dummy.c
endif
DEPPATH += --dep-path thermal
VPATH += thermal

9
drivers/thermal/thermal_core.c
View File

@ -926,6 +926,15 @@ int thermal_init(void)
}
#endif
#ifdef CONFIG_THERMAL_DUMMY
ret = thermal_dummy_init();
if (ret < 0)
{
therr("Dummy driver init failed!\n");
return ret;
}
#endif
#ifdef CONFIG_THERMAL_CDEV_CPUFREQ
if (NULL == thermal_cpufreq_cooling_register())
{

6
drivers/thermal/thermal_core.h
View File

@ -89,4 +89,10 @@ int thermal_zone_procfs_register(FAR struct thermal_zone_device_s *zdev);
void thermal_zone_procfs_unregister(FAR struct thermal_zone_device_s *zdev);
#endif
/* Dummy Driver */
#ifdef CONFIG_THERMAL_DUMMY
int thermal_dummy_init(void);
#endif
#endif /* __DRIVERS_THERMAL_THERMAL_CORE_H */

347
drivers/thermal/thermal_dummy.c Normal file
View File

@ -0,0 +1,347 @@
/****************************************************************************
* drivers/thermal/thermal_dummy.c
*
* Licensed to the Apache Software Foundation (ASF) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership. The
* ASF licenses this file to you under the Apache License, Version 2.0 (the
* "License"); you may not use this file except in compliance with the
* License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
* License for the specific language governing permissions and limitations
* under the License.
*
****************************************************************************/
/****************************************************************************
* Included Files
****************************************************************************/
#include <nuttx/cpufreq.h>
#include <nuttx/thermal.h>
#include <sys/param.h>
/****************************************************************************
* Pre-processor Definitions
****************************************************************************/
#define DUMMY_TEMP_RANGE_LOW 45
#define DUMMY_TEMP_RANGE_HIGH 90
/****************************************************************************
* Private Types
****************************************************************************/
struct dummy_zone_device_s
{
int temperature;
bool raising;
};
struct dummy_cooling_device_s
{
unsigned int cur_state;
unsigned int max_state;
};
struct dummy_cpufreq_driver_s
{
struct cpufreq_driver driver;
const struct cpufreq_frequency_table *table;
size_t table_len;
int current;
};
/****************************************************************************
* Private Function Prototypes
****************************************************************************/
/* Zone Device */
static int dummy_zdev_get_temp (FAR struct thermal_zone_device_s *zdev,
FAR int *temp);
static int dummy_zdev_set_trips(FAR struct thermal_zone_device_s *zdev,
int low, int high);
/* Cooling Device */
static int
dummy_cdev_get_max_state(FAR struct thermal_cooling_device_s *cdev,
FAR unsigned int *state);
static int
dummy_cdev_get_state (FAR struct thermal_cooling_device_s *cdev,
FAR unsigned int *state);
static int
dummy_cdev_set_state (FAR struct thermal_cooling_device_s *cdev,
unsigned int state);
/* CPU Freq */
#ifdef CONFIG_THERMAL_DUMMY_CPUFREQ
FAR static const struct cpufreq_frequency_table *
dummy_cpufreq_get_table(FAR struct cpufreq_policy *driver);
static int dummy_cpufreq_target_index(FAR struct cpufreq_policy *driver,
unsigned int index);
static int dummy_cpufreq_get_frequency(FAR struct cpufreq_policy *driver);
static int dummy_cpufreq_suspend(FAR struct cpufreq_policy *driver);
static int dummy_cpufreq_resume (FAR struct cpufreq_policy *driver);
#endif /* CONFIG_THERMAL_DUMMY_CPUFREQ */
/****************************************************************************
* Private Data
****************************************************************************/
/* Bind */
static const struct thermal_zone_trip_s g_dummy_trips[] =
{
{.name = "cpu_crit", .temp = 90, .hyst = 10, .type = THERMAL_CRITICAL},
{.name = "cpu_alert1", .temp = 70, .hyst = 10, .type = THERMAL_NORMAL},
{.name = "cpu_alert0", .temp = 60, .hyst = 10, .type = THERMAL_NORMAL},
};
static const struct thermal_zone_map_s g_dummy_maps[] =
{
{
.trip_name = "cpu_alert1",
.cdev_name = "cpufreq",
.low = 3,
.high = THERMAL_NO_LIMIT,
.weight = 20
},
{
.trip_name = "cpu_alert1",
.cdev_name = "fan0",
.low = THERMAL_NO_LIMIT,
.high = THERMAL_NO_LIMIT,
.weight = 20
},
{
.trip_name = "cpu_alert0",
.cdev_name = "cpufreq",
.low = THERMAL_NO_LIMIT,
.high = 2,
.weight = 20
},
};
static const struct thermal_zone_params_s g_dummy_params =
{
.gov_name = "step_wise",
.polling_delay = CONFIG_THERMAL_DUMMY_POLLING_DELAY,
.trips = g_dummy_trips,
.num_trips = nitems(g_dummy_trips),
.maps = g_dummy_maps,
.num_maps = nitems(g_dummy_maps),
};
/* Zone device */
static const struct thermal_zone_device_ops_s g_dummy_zone_ops =
{
.get_temp = dummy_zdev_get_temp,
.set_trips = dummy_zdev_set_trips,
};
static struct dummy_zone_device_s g_dummy_zone =
{
.temperature = 45,
.raising = true,
};
/* Cooling Device - fan0 */
static struct dummy_cooling_device_s g_dummy_fan0_data =
{
.cur_state = 0,
.max_state = 16,
};
static const struct thermal_cooling_device_ops_s g_dummy_fan0_ops =
{
.set_state = dummy_cdev_set_state,
.get_state = dummy_cdev_get_state,
.get_max_state = dummy_cdev_get_max_state,
};
/* Cooling Device - cpufreq */
#ifdef CONFIG_THERMAL_DUMMY_CPUFREQ
static const struct cpufreq_frequency_table g_dummy_cpufreq_table[] =
{
{100},
{300},
{500},
{700},
{900},
{CPUFREQ_TABLE_END},
};
static struct dummy_cpufreq_driver_s g_dummy_cpufreq_driver =
{
.driver =
{
dummy_cpufreq_get_table,
dummy_cpufreq_target_index,
dummy_cpufreq_get_frequency,
dummy_cpufreq_suspend,
dummy_cpufreq_resume,
},
.table = g_dummy_cpufreq_table,
.table_len = nitems(g_dummy_cpufreq_table),
};
#endif /* CONFIG_THERMAL_DUMMY_CPUFREQ */
/****************************************************************************
* Private Functions
****************************************************************************/
/* Dummy Cooling Device Operations */
static int dummy_cdev_set_state(FAR struct thermal_cooling_device_s *cdev,
unsigned int state)
{
FAR struct dummy_cooling_device_s *c = cdev->devdata;
c->cur_state = state;
return OK;
}
static int dummy_cdev_get_state(FAR struct thermal_cooling_device_s *cdev,
FAR unsigned int *state)
{
FAR struct dummy_cooling_device_s *c = cdev->devdata;
*state = c->cur_state;
return OK;
}
static int
dummy_cdev_get_max_state(FAR struct thermal_cooling_device_s *cdev,
FAR unsigned int *state)
{
FAR struct dummy_cooling_device_s *c = cdev->devdata;
*state = c->max_state;
return OK;
}
/* Sensor */
static int dummy_zdev_get_temp(FAR struct thermal_zone_device_s *zdev,
FAR int *temp)
{
FAR struct dummy_zone_device_s *s = zdev->devdata;
if (s->temperature >= DUMMY_TEMP_RANGE_HIGH)
{
s->raising = false;
}
else if (s->temperature <= DUMMY_TEMP_RANGE_LOW)
{
s->raising = true;
}
if (s->raising)
{
s->temperature++;
}
else
{
s->temperature--;
}
*temp = s->temperature;
return OK;
}
static int dummy_zdev_set_trips(FAR struct thermal_zone_device_s *zdev,
int low, int high)
{
return OK;
}
#ifdef CONFIG_THERMAL_DUMMY_CPUFREQ
static FAR const struct cpufreq_frequency_table *dummy_cpufreq_get_table(
FAR struct cpufreq_policy *driver)
{
FAR struct dummy_cpufreq_driver_s **dummy =
(FAR struct dummy_cpufreq_driver_s **)driver;
return (*dummy)->table;
}
static int dummy_cpufreq_target_index(FAR struct cpufreq_policy *driver,
unsigned int index)
{
FAR struct dummy_cpufreq_driver_s **dummy =
(FAR struct dummy_cpufreq_driver_s **)driver;
DEBUGASSERT(index >= 0 && index < (*dummy)->table_len);
(*dummy)->current = (*dummy)->table[index].frequency;
return 0;
}
static int dummy_cpufreq_get_frequency(FAR struct cpufreq_policy *driver)
{
FAR struct dummy_cpufreq_driver_s **dummy =
(FAR struct dummy_cpufreq_driver_s **)driver;
return (*dummy)->current;
}
static int dummy_cpufreq_suspend(FAR struct cpufreq_policy *driver)
{
return 0;
}
static int dummy_cpufreq_resume(FAR struct cpufreq_policy *driver)
{
return 0;
}
#endif /* CONFIG_THERMAL_DUMMY_CPUFREQ */
int thermal_dummy_init(void)
{
FAR struct thermal_cooling_device_s *cdev;
FAR struct thermal_zone_device_s *zdev;
int ret = OK;
/* Driver - CPUFreq */
#ifdef CONFIG_THERMAL_DUMMY_CPUFREQ
ret = cpufreq_init(&g_dummy_cpufreq_driver.driver);
if (ret < 0)
{
therr("Dummy cpufreq driver init failed!\n");
return ret;
}
#endif /* CONFIG_THERMAL_DUMMY_CPUFREQ */
/* Cooling Device */
cdev = thermal_cooling_device_register("fan0", &g_dummy_fan0_data,
&g_dummy_fan0_ops);
if (cdev == NULL)
{
therr("Register cooling device fan0 failed!\n");
return -ENOTSUP;
}
/* Zone Device */
zdev = thermal_zone_device_register("cpu-thermal", &g_dummy_zone,
&g_dummy_zone_ops, &g_dummy_params);
if (zdev == NULL)
{
therr("Register zone deivce failed!\n");
return -ENOTSUP;
}
return ret;
}