mirror of
https://github.com/zephyrproject-rtos/zephyr
synced 2025-09-02 01:13:26 +00:00
e1639b5345
The existing device_set_power_state() API works only in synchronous mode and this is not desirable for devices(ex: Gyro) which take longer time (few 100 mSec) to suspend/resume. To support async mode, a new callback argument is added to the API. The device drivers can asynchronously suspend/resume and call the callback function upon completion of the async request. This commit adds the missing callback parameter to all the drivers to make it compliant with the new API. Signed-off-by: Ramakrishna Pallala <ramakrishna.pallala@intel.com>
136 lines
3.1 KiB
C
136 lines
3.1 KiB
C
/*
|
|
* Copyright (c) 2018 Intel Corporation.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#include <zephyr.h>
|
|
#include <kernel.h>
|
|
#include <string.h>
|
|
#include <soc.h>
|
|
#include <device.h>
|
|
#include "policy/pm_policy.h"
|
|
|
|
#if defined(CONFIG_SYS_POWER_MANAGEMENT)
|
|
#define LOG_LEVEL CONFIG_SYS_PM_LOG_LEVEL /* From power module Kconfig */
|
|
#include <logging/log.h>
|
|
LOG_MODULE_DECLARE(power);
|
|
|
|
/*
|
|
* FIXME: Remove the conditional inclusion of
|
|
* core_devices array once we enble the capability
|
|
* to build the device list based on devices power
|
|
* and clock domain dependencies.
|
|
*/
|
|
#if defined(CONFIG_SOC_SERIES_NRF52X) || defined(CONFIG_SOC_SERIES_NRF51X)
|
|
#define MAX_PM_DEVICES 15
|
|
#define NUM_CORE_DEVICES 4
|
|
#define MAX_DEV_NAME_LEN 16
|
|
static const char core_devices[NUM_CORE_DEVICES][MAX_DEV_NAME_LEN] = {
|
|
"CLOCK_32K",
|
|
"CLOCK_16M",
|
|
"sys_clock",
|
|
"UART_0",
|
|
};
|
|
#else
|
|
#error "Add SoC's core devices list for PM"
|
|
#endif
|
|
|
|
/*
|
|
* Ordered list to store devices on which
|
|
* device power policies would be executed.
|
|
*/
|
|
static int device_ordered_list[MAX_PM_DEVICES];
|
|
static int device_retval[MAX_PM_DEVICES];
|
|
static struct device *pm_device_list;
|
|
static int device_count;
|
|
|
|
int sys_pm_suspend_devices(void)
|
|
{
|
|
for (int i = device_count - 1; i >= 0; i--) {
|
|
int idx = device_ordered_list[i];
|
|
|
|
/* TODO: Improve the logic by checking device status
|
|
* and set the device states accordingly.
|
|
*/
|
|
device_retval[i] = device_set_power_state(&pm_device_list[idx],
|
|
DEVICE_PM_SUSPEND_STATE,
|
|
NULL, NULL);
|
|
if (device_retval[i]) {
|
|
LOG_ERR("%s suspend operation failed\n",
|
|
pm_device_list[idx].config->name);
|
|
return device_retval[i];
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int sys_pm_force_suspend_devices(void)
|
|
{
|
|
for (int i = device_count - 1; i >= 0; i--) {
|
|
int idx = device_ordered_list[i];
|
|
|
|
device_retval[i] = device_set_power_state(&pm_device_list[idx],
|
|
DEVICE_PM_FORCE_SUSPEND_STATE,
|
|
NULL, NULL);
|
|
if (device_retval[i]) {
|
|
LOG_ERR("%s force suspend operation failed\n",
|
|
pm_device_list[idx].config->name);
|
|
return device_retval[i];
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void sys_pm_resume_devices(void)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < device_count; i++) {
|
|
if (!device_retval[i]) {
|
|
int idx = device_ordered_list[i];
|
|
|
|
device_set_power_state(&pm_device_list[idx],
|
|
DEVICE_PM_ACTIVE_STATE, NULL, NULL);
|
|
}
|
|
}
|
|
}
|
|
|
|
void sys_pm_create_device_list(void)
|
|
{
|
|
int count;
|
|
int i, j;
|
|
bool is_core_dev;
|
|
|
|
/*
|
|
* Create an ordered list of devices that will be suspended.
|
|
* Ordering should be done based on dependencies. Devices
|
|
* in the beginning of the list will be resumed first.
|
|
*/
|
|
device_list_get(&pm_device_list, &count);
|
|
|
|
/* Reserve for 32KHz, 16MHz, system clock, etc... */
|
|
device_count = NUM_CORE_DEVICES;
|
|
|
|
for (i = 0; (i < count) && (device_count < MAX_PM_DEVICES); i++) {
|
|
|
|
/* Check if the device is core device */
|
|
for (j = 0, is_core_dev = false; j < NUM_CORE_DEVICES; j++) {
|
|
if (!strcmp(pm_device_list[i].config->name,
|
|
&core_devices[j][0])) {
|
|
is_core_dev = true;
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (is_core_dev) {
|
|
device_ordered_list[j] = i;
|
|
} else {
|
|
device_ordered_list[device_count++] = i;
|
|
}
|
|
}
|
|
}
|
|
#endif /* defined(CONFIG_SYS_POWER_MANAGEMENT) */
|