linux-imx

/*

 * Copyright 2015 Verifone Int.

 *

 * Author: Nicolas Saenz Julienne <nicolassaenzj@gmail.com>

 *

 * This program is free software; you can redistribute it and/or modify i t

 * under  the terms of the GNU General  Public License as published by th e

 * Free Software Foundation;  either version 2 of the License, or (at you r

 * option) any later version.

 *

 * This driver is based on the gpio-tps65912 implementation.

 */

​

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/errno.h>

#include <linux/gpio/driver.h>

#include <linux/platform_device.h>

#include <linux/regmap.h>

#include <linux/mfd/tps65218.h>

​

struct tps65218_gpio {

    struct tps65218 *tps65218;

    struct gpio_chip gpio_chip;

};

​

static int tps65218_gpio_get(struct gpio_chip *gc, unsigned offset)

{

    struct tps65218_gpio *tps65218_gpio = gpiochip_get_data(gc);

    struct tps65218 *tps65218 = tps65218_gpio->tps65218;

    unsigned int val;

    int ret;

​

    ret = regmap_read(tps65218->regmap, TPS65218_REG_ENABLE2, &val);

    if (ret)

        return ret;

​

    return !!(val & (TPS65218_ENABLE2_GPIO1 << offset));

}

​

static void tps65218_gpio_set(struct gpio_chip *gc, unsigned offset,

                  int value)

{

    struct tps65218_gpio *tps65218_gpio = gpiochip_get_data(gc);

    struct tps65218 *tps65218 = tps65218_gpio->tps65218;

​

    if (value)

        tps65218_set_bits(tps65218, TPS65218_REG_ENABLE2,

                  TPS65218_ENABLE2_GPIO1 << offset,

                  TPS65218_ENABLE2_GPIO1 << offset,

                  TPS65218_PROTECT_L1);

    else

        tps65218_clear_bits(tps65218, TPS65218_REG_ENABLE2,

                    TPS65218_ENABLE2_GPIO1 << offset,

                    TPS65218_PROTECT_L1);

}

​

static int tps65218_gpio_output(struct gpio_chip *gc, unsigned offset,

                int value)

{

    /* Only drives GPOs */

    tps65218_gpio_set(gc, offset, value);

    return 0;