power_mgmt: Update sample and drivers according to new pm device API
Update the power sample and drivers with the new device driver power management API using the existing logic Jira: ZEP-954 Change-Id: Idd94232e458767635973e94e9fc673c01612c1e2 Signed-off-by: Amir Kaplan <amir.kaplan@intel.com>
This commit is contained in:
parent
d305da61e9
commit
c490219d1e
23 changed files with 1096 additions and 531 deletions
|
@ -28,6 +28,9 @@
|
|||
|
||||
struct rtc_data {
|
||||
struct nano_sem sem;
|
||||
#ifdef CONFIG_DEVICE_POWER_MANAGEMENT
|
||||
uint32_t device_power_state;
|
||||
#endif
|
||||
};
|
||||
|
||||
#ifdef CONFIG_RTC_QMSI_API_REENTRANCY
|
||||
|
@ -39,6 +42,25 @@ static const int reentrancy_protection = 1;
|
|||
static const int reentrancy_protection;
|
||||
#endif /* CONFIG_RTC_QMSI_API_REENTRANCY */
|
||||
|
||||
#ifdef CONFIG_DEVICE_POWER_MANAGEMENT
|
||||
|
||||
static void rtc_qmsi_set_power_state(struct device *dev, uint32_t power_state)
|
||||
{
|
||||
struct rtc_data *context = dev->driver_data;
|
||||
|
||||
context->device_power_state = power_state;
|
||||
}
|
||||
|
||||
static uint32_t rtc_qmsi_get_power_state(struct device *dev)
|
||||
{
|
||||
struct rtc_data *context = dev->driver_data;
|
||||
|
||||
return context->device_power_state;
|
||||
}
|
||||
#else
|
||||
#define rtc_qmsi_set_power_state(...)
|
||||
#endif
|
||||
|
||||
static void rtc_reentrancy_init(struct device *dev)
|
||||
{
|
||||
struct rtc_data *context = dev->driver_data;
|
||||
|
@ -141,33 +163,50 @@ static int rtc_qmsi_init(struct device *dev)
|
|||
/* Route RTC interrupt to Lakemont */
|
||||
QM_SCSS_INT->int_rtc_mask &= ~BIT(0);
|
||||
|
||||
rtc_qmsi_set_power_state(dev, DEVICE_PM_ACTIVE_STATE);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_DEVICE_POWER_MANAGEMENT
|
||||
static uint32_t int_rtc_mask_save;
|
||||
|
||||
static int rtc_suspend_device(struct device *dev, int pm_policy)
|
||||
static int rtc_suspend_device(struct device *dev)
|
||||
{
|
||||
if (pm_policy == SYS_PM_DEEP_SLEEP) {
|
||||
int_rtc_mask_save = QM_SCSS_INT->int_rtc_mask;
|
||||
}
|
||||
|
||||
int_rtc_mask_save = QM_SCSS_INT->int_rtc_mask;
|
||||
rtc_qmsi_set_power_state(dev, DEVICE_PM_SUSPEND_STATE);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int rtc_resume_device(struct device *dev, int pm_policy)
|
||||
static int rtc_resume_device(struct device *dev)
|
||||
{
|
||||
if (pm_policy == SYS_PM_DEEP_SLEEP) {
|
||||
QM_SCSS_INT->int_rtc_mask = int_rtc_mask_save;
|
||||
QM_SCSS_INT->int_rtc_mask = int_rtc_mask_save;
|
||||
rtc_qmsi_set_power_state(dev, DEVICE_PM_ACTIVE_STATE);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Implements the driver control management functionality
|
||||
* the *context may include IN data or/and OUT data
|
||||
*/
|
||||
static int rtc_qmsi_device_ctrl(struct device *dev, uint32_t ctrl_command,
|
||||
void *context)
|
||||
{
|
||||
if (ctrl_command == DEVICE_PM_SET_POWER_STATE) {
|
||||
if (*((uint32_t *)context) == DEVICE_PM_SUSPEND_STATE) {
|
||||
return rtc_suspend_device(dev);
|
||||
} else if (*((uint32_t *)context) == DEVICE_PM_ACTIVE_STATE) {
|
||||
return rtc_resume_device(dev);
|
||||
}
|
||||
} else if (ctrl_command == DEVICE_PM_GET_POWER_STATE) {
|
||||
*((uint32_t *)context) = rtc_qmsi_get_power_state(dev);
|
||||
return 0;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
DEFINE_DEVICE_PM_OPS(rtc, rtc_suspend_device, rtc_resume_device);
|
||||
|
||||
DEVICE_AND_API_INIT_PM(rtc, CONFIG_RTC_0_NAME, &rtc_qmsi_init,
|
||||
DEVICE_PM_OPS_GET(rtc), RTC_CONTEXT, NULL, SECONDARY,
|
||||
CONFIG_KERNEL_INIT_PRIORITY_DEVICE, (void *)&api);
|
||||
DEVICE_DEFINE(rtc, CONFIG_RTC_0_NAME, &rtc_qmsi_init, rtc_qmsi_device_ctrl,
|
||||
RTC_CONTEXT, NULL, SECONDARY, CONFIG_KERNEL_INIT_PRIORITY_DEVICE,
|
||||
(void *)&api);
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue