151 lines
4.1 KiB
C
151 lines
4.1 KiB
C
/*
|
|
* Copyright (c) 2023 Google LLC
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT power_domain_gpio_monitor
|
|
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/drivers/gpio.h>
|
|
#include <zephyr/pm/device.h>
|
|
#include <zephyr/pm/device_runtime.h>
|
|
|
|
#include <zephyr/logging/log.h>
|
|
|
|
LOG_MODULE_REGISTER(power_domain_gpio_monitor, CONFIG_POWER_DOMAIN_LOG_LEVEL);
|
|
|
|
struct pd_gpio_monitor_config {
|
|
struct gpio_dt_spec power_good_gpio;
|
|
};
|
|
|
|
struct pd_gpio_monitor_data {
|
|
struct gpio_callback callback;
|
|
const struct device *dev;
|
|
bool is_powered;
|
|
};
|
|
|
|
struct pd_visitor_context {
|
|
const struct device *domain;
|
|
enum pm_device_action action;
|
|
};
|
|
|
|
static int pd_on_domain_visitor(const struct device *dev, void *context)
|
|
{
|
|
struct pd_visitor_context *visitor_context = context;
|
|
|
|
/* Only run action if the device is on the specified domain */
|
|
if (!dev->pm || (dev->pm->domain != visitor_context->domain)) {
|
|
return 0;
|
|
}
|
|
|
|
dev->pm->usage = 0;
|
|
(void)pm_device_action_run(dev, visitor_context->action);
|
|
return 0;
|
|
}
|
|
|
|
static void pd_gpio_monitor_callback(const struct device *port,
|
|
struct gpio_callback *cb, gpio_port_pins_t pins)
|
|
{
|
|
struct pd_gpio_monitor_data *data = CONTAINER_OF(cb, struct pd_gpio_monitor_data, callback);
|
|
const struct pd_gpio_monitor_config *config = data->dev->config;
|
|
const struct device *dev = data->dev;
|
|
struct pd_visitor_context context = {.domain = dev};
|
|
int rc;
|
|
|
|
rc = gpio_pin_get_dt(&config->power_good_gpio);
|
|
if (rc < 0) {
|
|
LOG_WRN("Failed to read gpio logic level");
|
|
return;
|
|
}
|
|
|
|
data->is_powered = rc;
|
|
if (rc == 0) {
|
|
context.action = PM_DEVICE_ACTION_SUSPEND;
|
|
(void)device_supported_foreach(dev, pd_on_domain_visitor, &context);
|
|
context.action = PM_DEVICE_ACTION_TURN_OFF;
|
|
(void)device_supported_foreach(dev, pd_on_domain_visitor, &context);
|
|
return;
|
|
}
|
|
|
|
pm_device_children_action_run(data->dev, PM_DEVICE_ACTION_TURN_ON, NULL);
|
|
}
|
|
|
|
static int pd_gpio_monitor_pm_action(const struct device *dev, enum pm_device_action action)
|
|
{
|
|
struct pd_gpio_monitor_data *data = dev->data;
|
|
|
|
switch (action) {
|
|
case PM_DEVICE_ACTION_TURN_ON:
|
|
case PM_DEVICE_ACTION_TURN_OFF:
|
|
return -ENOTSUP;
|
|
case PM_DEVICE_ACTION_RESUME:
|
|
if (!data->is_powered) {
|
|
return -EAGAIN;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int pd_gpio_monitor_init(const struct device *dev)
|
|
{
|
|
const struct pd_gpio_monitor_config *config = dev->config;
|
|
struct pd_gpio_monitor_data *data = dev->data;
|
|
int rc;
|
|
|
|
data->dev = dev;
|
|
|
|
if (!gpio_is_ready_dt(&config->power_good_gpio)) {
|
|
LOG_ERR("GPIO port %s is not ready", config->power_good_gpio.port->name);
|
|
return -ENODEV;
|
|
}
|
|
|
|
rc = gpio_pin_configure_dt(&config->power_good_gpio, GPIO_INPUT);
|
|
if (rc) {
|
|
LOG_ERR("Failed to configure GPIO");
|
|
goto unconfigure_pin;
|
|
}
|
|
|
|
rc = gpio_pin_interrupt_configure_dt(&config->power_good_gpio, GPIO_INT_EDGE_BOTH);
|
|
if (rc) {
|
|
gpio_pin_configure_dt(&config->power_good_gpio, GPIO_DISCONNECTED);
|
|
LOG_ERR("Failed to configure GPIO interrupt");
|
|
goto unconfigure_interrupt;
|
|
}
|
|
|
|
gpio_init_callback(&data->callback, pd_gpio_monitor_callback,
|
|
BIT(config->power_good_gpio.pin));
|
|
rc = gpio_add_callback_dt(&config->power_good_gpio, &data->callback);
|
|
if (rc) {
|
|
LOG_ERR("Failed to add GPIO callback");
|
|
goto remove_callback;
|
|
}
|
|
|
|
pm_device_init_suspended(dev);
|
|
return pm_device_runtime_enable(dev);
|
|
remove_callback:
|
|
gpio_remove_callback(config->power_good_gpio.port, &data->callback);
|
|
unconfigure_interrupt:
|
|
gpio_pin_interrupt_configure_dt(&config->power_good_gpio, GPIO_INT_DISABLE);
|
|
unconfigure_pin:
|
|
gpio_pin_configure_dt(&config->power_good_gpio, GPIO_DISCONNECTED);
|
|
return rc;
|
|
}
|
|
|
|
#define POWER_DOMAIN_DEVICE(inst) \
|
|
static const struct pd_gpio_monitor_config pd_gpio_monitor_config_##inst = { \
|
|
.power_good_gpio = GPIO_DT_SPEC_INST_GET(inst, gpios), \
|
|
}; \
|
|
static struct pd_gpio_monitor_data pd_gpio_monitor_data_##inst; \
|
|
PM_DEVICE_DT_INST_DEFINE(inst, pd_gpio_monitor_pm_action); \
|
|
DEVICE_DT_INST_DEFINE(inst, pd_gpio_monitor_init, \
|
|
PM_DEVICE_DT_INST_GET(inst), &pd_gpio_monitor_data_##inst, \
|
|
&pd_gpio_monitor_config_##inst, POST_KERNEL, \
|
|
CONFIG_POWER_DOMAIN_INIT_PRIORITY, NULL);
|
|
|
|
DT_INST_FOREACH_STATUS_OKAY(POWER_DOMAIN_DEVICE)
|