119 строки
2.9 KiB
C
119 строки
2.9 KiB
C
/*
|
|
* TI TPS6591x GPIO driver
|
|
*
|
|
* Copyright 2010 Texas Instruments Inc.
|
|
*
|
|
* Author: Graeme Gregory <gg@slimlogic.co.uk>
|
|
* Author: Jorge Eduardo Candelaria jedu@slimlogic.co.uk>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License as published by the
|
|
* Free Software Foundation; either version 2 of the License, or (at your
|
|
* option) any later version.
|
|
*
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/mfd/tps65910.h>
|
|
|
|
static int tps65910_gpio_get(struct gpio_chip *gc, unsigned offset)
|
|
{
|
|
struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio);
|
|
uint8_t val;
|
|
|
|
tps65910->read(tps65910, TPS65910_GPIO0 + offset, 1, &val);
|
|
|
|
if (val & GPIO_STS_MASK)
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void tps65910_gpio_set(struct gpio_chip *gc, unsigned offset,
|
|
int value)
|
|
{
|
|
struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio);
|
|
|
|
if (value)
|
|
tps65910_set_bits(tps65910, TPS65910_GPIO0 + offset,
|
|
GPIO_SET_MASK);
|
|
else
|
|
tps65910_clear_bits(tps65910, TPS65910_GPIO0 + offset,
|
|
GPIO_SET_MASK);
|
|
}
|
|
|
|
static int tps65910_gpio_output(struct gpio_chip *gc, unsigned offset,
|
|
int value)
|
|
{
|
|
struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio);
|
|
|
|
/* Set the initial value */
|
|
tps65910_gpio_set(gc, offset, value);
|
|
|
|
return tps65910_set_bits(tps65910, TPS65910_GPIO0 + offset,
|
|
GPIO_CFG_MASK);
|
|
}
|
|
|
|
static int tps65910_gpio_input(struct gpio_chip *gc, unsigned offset)
|
|
{
|
|
struct tps65910 *tps65910 = container_of(gc, struct tps65910, gpio);
|
|
|
|
return tps65910_clear_bits(tps65910, TPS65910_GPIO0 + offset,
|
|
GPIO_CFG_MASK);
|
|
}
|
|
|
|
void tps65910_gpio_init(struct tps65910 *tps65910, int gpio_base)
|
|
{
|
|
int ret;
|
|
struct tps65910_board *board_data;
|
|
|
|
if (!gpio_base)
|
|
return;
|
|
|
|
tps65910->gpio.owner = THIS_MODULE;
|
|
tps65910->gpio.label = tps65910->i2c_client->name;
|
|
tps65910->gpio.dev = tps65910->dev;
|
|
tps65910->gpio.base = gpio_base;
|
|
|
|
switch(tps65910_chip_id(tps65910)) {
|
|
case TPS65910:
|
|
tps65910->gpio.ngpio = TPS65910_NUM_GPIO;
|
|
break;
|
|
case TPS65911:
|
|
tps65910->gpio.ngpio = TPS65911_NUM_GPIO;
|
|
break;
|
|
default:
|
|
return;
|
|
}
|
|
tps65910->gpio.can_sleep = 1;
|
|
|
|
tps65910->gpio.direction_input = tps65910_gpio_input;
|
|
tps65910->gpio.direction_output = tps65910_gpio_output;
|
|
tps65910->gpio.set = tps65910_gpio_set;
|
|
tps65910->gpio.get = tps65910_gpio_get;
|
|
|
|
/* Configure sleep control for gpios */
|
|
board_data = dev_get_platdata(tps65910->dev);
|
|
if (board_data) {
|
|
int i;
|
|
for (i = 0; i < tps65910->gpio.ngpio; ++i) {
|
|
if (board_data->en_gpio_sleep[i]) {
|
|
ret = tps65910_set_bits(tps65910,
|
|
TPS65910_GPIO0 + i, GPIO_SLEEP_MASK);
|
|
if (ret < 0)
|
|
dev_warn(tps65910->dev,
|
|
"GPIO Sleep setting failed\n");
|
|
}
|
|
}
|
|
}
|
|
|
|
ret = gpiochip_add(&tps65910->gpio);
|
|
|
|
if (ret)
|
|
dev_warn(tps65910->dev, "GPIO registration failed: %d\n", ret);
|
|
}
|