Pete Johanson
4 years ago
committed by
GitHub
13 changed files with 255 additions and 12 deletions
@ -0,0 +1,20 @@ |
|||||||
|
# |
||||||
|
# Copyright (c) 2020, The ZMK Contributors |
||||||
|
# SPDX-License-Identifier: MIT |
||||||
|
# |
||||||
|
|
||||||
|
description: | |
||||||
|
Generic driver for controlling the external power output |
||||||
|
by toggling the control-gpio pin status |
||||||
|
(Only in supported hardware) |
||||||
|
|
||||||
|
compatible: "zmk,ext-power-generic" |
||||||
|
|
||||||
|
properties: |
||||||
|
control-gpios: |
||||||
|
type: phandle-array |
||||||
|
required: true |
||||||
|
label: |
||||||
|
type: string |
||||||
|
required: true |
||||||
|
|
@ -0,0 +1,104 @@ |
|||||||
|
/*
|
||||||
|
* Copyright (c) 2020 The ZMK Contributors |
||||||
|
* |
||||||
|
* SPDX-License-Identifier: MIT |
||||||
|
*/ |
||||||
|
|
||||||
|
#pragma once |
||||||
|
|
||||||
|
#include <zephyr/types.h> |
||||||
|
#include <stddef.h> |
||||||
|
#include <device.h> |
||||||
|
|
||||||
|
#ifdef __cplusplus |
||||||
|
extern "C" { |
||||||
|
#endif |
||||||
|
|
||||||
|
/**
|
||||||
|
* @cond INTERNAL_HIDDEN |
||||||
|
* |
||||||
|
* Behavior driver API definition and system call entry points. |
||||||
|
* |
||||||
|
* (Internal use only.) |
||||||
|
*/ |
||||||
|
|
||||||
|
typedef int (*ext_power_enable_t)(struct device *dev); |
||||||
|
typedef int (*ext_power_disable_t)(struct device *dev); |
||||||
|
typedef int (*ext_power_get_t)(struct device *dev); |
||||||
|
|
||||||
|
__subsystem struct ext_power_api { |
||||||
|
ext_power_enable_t enable; |
||||||
|
ext_power_disable_t disable; |
||||||
|
ext_power_get_t get; |
||||||
|
}; |
||||||
|
/**
|
||||||
|
* @endcond |
||||||
|
*/ |
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Enable the external power output |
||||||
|
* @param dev Pointer to the device structure for the driver instance. |
||||||
|
* |
||||||
|
* @retval 0 If successful. |
||||||
|
* @retval Negative errno code if failure. |
||||||
|
*/ |
||||||
|
__syscall int ext_power_enable(struct device *dev); |
||||||
|
|
||||||
|
static inline int z_impl_ext_power_enable(struct device *dev) { |
||||||
|
const struct ext_power_api *api = (const struct ext_power_api *)dev->driver_api; |
||||||
|
|
||||||
|
if (api->enable == NULL) { |
||||||
|
return -ENOTSUP; |
||||||
|
} |
||||||
|
|
||||||
|
return api->enable(dev); |
||||||
|
} |
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Disable the external power output |
||||||
|
* @param dev Pointer to the device structure for the driver instance. |
||||||
|
* |
||||||
|
* @retval 0 If successful. |
||||||
|
* @retval Negative errno code if failure. |
||||||
|
*/ |
||||||
|
__syscall int ext_power_disable(struct device *dev); |
||||||
|
|
||||||
|
static inline int z_impl_ext_power_disable(struct device *dev) { |
||||||
|
const struct ext_power_api *api = (const struct ext_power_api *)dev->driver_api; |
||||||
|
|
||||||
|
if (api->disable == NULL) { |
||||||
|
return -ENOTSUP; |
||||||
|
} |
||||||
|
|
||||||
|
return api->disable(dev); |
||||||
|
} |
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Get the current status of the external power output |
||||||
|
* @param dev Pointer to the device structure for the driver instance. |
||||||
|
* |
||||||
|
* @retval 0 If ext power is disabled. |
||||||
|
* @retval 1 if ext power is enabled. |
||||||
|
* @retval Negative errno code if failure. |
||||||
|
*/ |
||||||
|
__syscall int ext_power_get(struct device *dev); |
||||||
|
|
||||||
|
static inline int z_impl_ext_power_get(struct device *dev) { |
||||||
|
const struct ext_power_api *api = (const struct ext_power_api *)dev->driver_api; |
||||||
|
|
||||||
|
if (api->get == NULL) { |
||||||
|
return -ENOTSUP; |
||||||
|
} |
||||||
|
|
||||||
|
return api->get(dev); |
||||||
|
} |
||||||
|
|
||||||
|
#ifdef __cplusplus |
||||||
|
} |
||||||
|
#endif |
||||||
|
|
||||||
|
/**
|
||||||
|
* @} |
||||||
|
*/ |
||||||
|
|
||||||
|
#include <syscalls/ext_power.h> |
@ -0,0 +1,91 @@ |
|||||||
|
/*
|
||||||
|
* Copyright (c) 2020 The ZMK Contributors |
||||||
|
* |
||||||
|
* SPDX-License-Identifier: MIT |
||||||
|
*/ |
||||||
|
|
||||||
|
#define DT_DRV_COMPAT zmk_ext_power_generic |
||||||
|
|
||||||
|
#include <device.h> |
||||||
|
#include <init.h> |
||||||
|
#include <drivers/gpio.h> |
||||||
|
#include <drivers/ext_power.h> |
||||||
|
|
||||||
|
#if DT_HAS_COMPAT_STATUS_OKAY(DT_DRV_COMPAT) |
||||||
|
|
||||||
|
#include <logging/log.h> |
||||||
|
LOG_MODULE_DECLARE(zmk, CONFIG_ZMK_LOG_LEVEL); |
||||||
|
|
||||||
|
struct ext_power_generic_config { |
||||||
|
const char *label; |
||||||
|
const u8_t pin; |
||||||
|
const u8_t flags; |
||||||
|
}; |
||||||
|
|
||||||
|
struct ext_power_generic_data { |
||||||
|
struct device *gpio; |
||||||
|
bool status; |
||||||
|
}; |
||||||
|
|
||||||
|
static int ext_power_generic_enable(struct device *dev) { |
||||||
|
struct ext_power_generic_data *data = dev->driver_data; |
||||||
|
const struct ext_power_generic_config *config = dev->config_info; |
||||||
|
|
||||||
|
if (gpio_pin_set(data->gpio, config->pin, 1)) { |
||||||
|
LOG_WRN("Failed to set ext-power control pin"); |
||||||
|
return -EIO; |
||||||
|
} |
||||||
|
data->status = true; |
||||||
|
return 0; |
||||||
|
} |
||||||
|
|
||||||
|
static int ext_power_generic_disable(struct device *dev) { |
||||||
|
struct ext_power_generic_data *data = dev->driver_data; |
||||||
|
const struct ext_power_generic_config *config = dev->config_info; |
||||||
|
|
||||||
|
if (gpio_pin_set(data->gpio, config->pin, 0)) { |
||||||
|
LOG_WRN("Failed to clear ext-power control pin"); |
||||||
|
return -EIO; |
||||||
|
} |
||||||
|
data->status = false; |
||||||
|
return 0; |
||||||
|
} |
||||||
|
|
||||||
|
static int ext_power_generic_get(struct device *dev) { |
||||||
|
struct ext_power_generic_data *data = dev->driver_data; |
||||||
|
return data->status; |
||||||
|
} |
||||||
|
|
||||||
|
static int ext_power_generic_init(struct device *dev) { |
||||||
|
struct ext_power_generic_data *data = dev->driver_data; |
||||||
|
const struct ext_power_generic_config *config = dev->config_info; |
||||||
|
|
||||||
|
data->gpio = device_get_binding(config->label); |
||||||
|
if (data->gpio == NULL) { |
||||||
|
LOG_ERR("Failed to get ext-power control device"); |
||||||
|
return -EINVAL; |
||||||
|
} |
||||||
|
|
||||||
|
if (gpio_pin_configure(data->gpio, config->pin, config->flags | GPIO_OUTPUT)) { |
||||||
|
LOG_ERR("Failed to configure ext-power control pin"); |
||||||
|
return -EIO; |
||||||
|
} |
||||||
|
|
||||||
|
return 0; |
||||||
|
} |
||||||
|
|
||||||
|
static const struct ext_power_generic_config config = { |
||||||
|
.label = DT_INST_GPIO_LABEL(0, control_gpios), |
||||||
|
.pin = DT_INST_GPIO_PIN(0, control_gpios), |
||||||
|
.flags = DT_INST_GPIO_FLAGS(0, control_gpios)}; |
||||||
|
|
||||||
|
static struct ext_power_generic_data data = {.status = false}; |
||||||
|
|
||||||
|
static const struct ext_power_api api = {.enable = ext_power_generic_enable, |
||||||
|
.disable = ext_power_generic_disable, |
||||||
|
.get = ext_power_generic_get}; |
||||||
|
|
||||||
|
DEVICE_AND_API_INIT(ext_power_generic, DT_INST_LABEL(0), ext_power_generic_init, &data, &config, |
||||||
|
APPLICATION, CONFIG_KERNEL_INIT_PRIORITY_DEFAULT, &api); |
||||||
|
|
||||||
|
#endif /* DT_HAS_COMPAT_STATUS_OKAY(DT_DRV_COMPAT) */ |
Loading…
Reference in new issue