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

Thermal: Register pm suspend notifier

Browse Source 
Signed-off-by: wangjianyu3 <wangjianyu3@xiaomi.com>
This commit is contained in:
wangjianyu3 2023-11-14 21:25:40 +08:00 committed by Xiang Xiao
parent 2f285a04f9
commit 520e4042ce
1 changed files with 78 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

78
drivers/thermal/thermal_core.c
View File

@ -23,11 +23,16 @@
****************************************************************************/ ****************************************************************************/
#include <nuttx/kmalloc.h> #include <nuttx/kmalloc.h>
#ifdef CONFIG_PM
#include <nuttx/power/pm.h>
#endif
#include <assert.h>
#include <debug.h> #include <debug.h>
#include <stdio.h> #include <stdio.h>
#include <sys/boardctl.h> #include <sys/boardctl.h>
#include "sched/sched.h"
#include "thermal_core.h" #include "thermal_core.h"
/**************************************************************************** /****************************************************************************
@ -53,6 +58,11 @@ static void device_bind (FAR struct thermal_zone_device_s *zdev,
static void device_unbind (FAR struct thermal_zone_device_s *zdev, static void device_unbind (FAR struct thermal_zone_device_s *zdev,
FAR struct thermal_cooling_device_s *cdev); FAR struct thermal_cooling_device_s *cdev);
#ifdef CONFIG_PM
static void thermal_pm_notify(FAR struct pm_callback_s *cb, int domain,
enum pm_state_e pmstate);
#endif
/**************************************************************************** /****************************************************************************
* Private Data * Private Data
****************************************************************************/ ****************************************************************************/
@ -70,6 +80,13 @@ static mutex_t g_thermal_lock = NXMUTEX_INITIALIZER;
static FAR struct thermal_governor_s *g_def_governor = NULL; static FAR struct thermal_governor_s *g_def_governor = NULL;
#ifdef CONFIG_PM
struct pm_callback_s g_thermal_pm_cb =
{
.notify = thermal_pm_notify,
};
#endif
/**************************************************************************** /****************************************************************************
* Private Functions * Private Functions
****************************************************************************/ ****************************************************************************/
@ -264,6 +281,56 @@ find_governor_by_name(FAR const char *name)
return NULL; return NULL;
} }
#ifdef CONFIG_PM
static void thermal_pm_notify(FAR struct pm_callback_s *cb, int domain,
enum pm_state_e pmstate)
{
FAR struct thermal_zone_device_s *zdev;
switch (pmstate)
{
case PM_SLEEP:
{
nxmutex_lock(&g_thermal_lock);
list_for_every_entry(&g_zone_dev_list, zdev,
struct thermal_zone_device_s, node)
{
work_cancel(LPWORK, &zdev->monitor);
}
nxmutex_unlock(&g_thermal_lock);
}
break;
case PM_RESTORE:
case PM_NORMAL:
case PM_IDLE:
case PM_STANDBY:
{
nxmutex_lock(&g_thermal_lock);
list_for_every_entry(&g_zone_dev_list, zdev,
struct thermal_zone_device_s, node)
{
if (zdev->enabled && work_available(&zdev->monitor))
{
work_queue(LPWORK, &zdev->monitor,
(worker_t)thermal_zone_device_update, zdev,
zdev->params->polling_delay);
}
}
nxmutex_unlock(&g_thermal_lock);
}
break;
default:
break;
}
return;
}
#endif
/**************************************************************************** /****************************************************************************
* Public Functions * Public Functions
****************************************************************************/ ****************************************************************************/
@ -740,6 +807,8 @@ void thermal_zone_device_update(FAR struct thermal_zone_device_s *zdev)
int temp; int temp;
int ret; int ret;
DEBUGASSERT(!is_idle_task(this_task()));
nxmutex_lock(&g_thermal_lock); nxmutex_lock(&g_thermal_lock);
/* Update termerature */ /* Update termerature */
@ -855,5 +924,14 @@ int thermal_init(void)
} }
#endif #endif
#ifdef CONFIG_PM
ret = pm_register(&g_thermal_pm_cb);
if (ret < 0)
{
therr("Register suspend notifier failed!\n");
return ret;
}
#endif
return ret; return ret;
} }