101 lines
2.3 KiB
C
101 lines
2.3 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2016 Intel Corporation.
|
||
|
|
*
|
||
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
||
|
|
* you may not use this file except in compliance with the License.
|
||
|
|
* You may obtain a copy of the License at
|
||
|
|
*
|
||
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
||
|
|
*
|
||
|
|
* Unless required by applicable law or agreed to in writing, software
|
||
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
||
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||
|
|
* See the License for the specific language governing permissions and
|
||
|
|
* limitations under the License.
|
||
|
|
*/
|
||
|
|
|
||
|
|
/**
|
||
|
|
* @file Implementation of the API 1.0 GPIO compatibility layer
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <gpio.h>
|
||
|
|
#include <misc/util.h>
|
||
|
|
|
||
|
|
#include "gpio_api_compat.h"
|
||
|
|
|
||
|
|
/** These are maintained in a dedicated .gpio_compat section
|
||
|
|
* See relevant arch's linker definitions in include/arch/
|
||
|
|
*/
|
||
|
|
extern struct gpio_compat_cb __gpio_compat_start[];
|
||
|
|
extern struct gpio_compat_cb __gpio_compat_end[];
|
||
|
|
|
||
|
|
static struct gpio_compat_cb *_gpio_compat_dev_lookup(struct device *dev)
|
||
|
|
{
|
||
|
|
struct gpio_compat_cb *cb;
|
||
|
|
|
||
|
|
for (cb = __gpio_compat_start; cb != __gpio_compat_end; cb++) {
|
||
|
|
if (cb->dev == dev) {
|
||
|
|
return cb;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
return NULL;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void _gpio_compat_handler(struct device *dev,
|
||
|
|
struct gpio_callback *cb, uint32_t pins)
|
||
|
|
{
|
||
|
|
struct _gpio_compat_data *data;
|
||
|
|
int bit;
|
||
|
|
|
||
|
|
data = CONTAINER_OF(cb, struct _gpio_compat_data, cb);
|
||
|
|
|
||
|
|
for (bit = 0; bit < 32; bit++) {
|
||
|
|
if (pins & BIT(bit)) {
|
||
|
|
data->handler(dev, bit);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int gpio_set_callback(struct device *dev, gpio_callback_t callback)
|
||
|
|
{
|
||
|
|
struct gpio_compat_cb *compat = _gpio_compat_dev_lookup(dev);
|
||
|
|
int ret;
|
||
|
|
|
||
|
|
if (!compat) {
|
||
|
|
return DEV_FAIL;
|
||
|
|
}
|
||
|
|
|
||
|
|
ret = gpio_remove_callback(dev, &compat->d->cb);
|
||
|
|
if (ret != DEV_OK) {
|
||
|
|
return ret;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (!callback) {
|
||
|
|
return DEV_OK;
|
||
|
|
}
|
||
|
|
|
||
|
|
compat->d->handler = callback;
|
||
|
|
compat->d->cb.handler = _gpio_compat_handler;
|
||
|
|
|
||
|
|
return gpio_add_callback(dev, &compat->d->cb);
|
||
|
|
}
|
||
|
|
|
||
|
|
void _gpio_enable_callback(struct device *dev, uint32_t pins)
|
||
|
|
{
|
||
|
|
struct gpio_compat_cb *compat = _gpio_compat_dev_lookup(dev);
|
||
|
|
|
||
|
|
if (compat) {
|
||
|
|
compat->d->cb.pin_mask |= pins;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void _gpio_disable_callback(struct device *dev, uint32_t pins)
|
||
|
|
{
|
||
|
|
struct gpio_compat_cb *compat = _gpio_compat_dev_lookup(dev);
|
||
|
|
|
||
|
|
if (compat) {
|
||
|
|
compat->d->cb.pin_mask &= ~(pins);
|
||
|
|
}
|
||
|
|
}
|