linux-imx

/*

 * Copyright (C) 2016 Texas Instruments Incorporated - http://www.ti.com/

 *  Keerthy <j-keerthy@ti.com>

 *

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

 * modify it under the terms of the GNU General Public License version 2 as

 * published by the Free Software Foundation.

 *

 * This program is distributed "as is" WITHOUT ANY WARRANTY of any

 * kind, whether expressed or implied; without even the implied warranty

 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 * GNU General Public License version 2 for more details.

 *

 * Based on the TPS65218 driver

 */

​

#include <linux/gpio/driver.h>

#include <linux/module.h>

#include <linux/platform_device.h>

#include <linux/regmap.h>

​

#include <linux/mfd/lp873x.h>

​

#define BITS_PER_GPO        0x4

#define LP873X_GPO_CTRL_OD  0x2

​

struct lp873x_gpio {

    struct gpio_chip chip;

    struct lp873x *lp873;

};

​

static int lp873x_gpio_get_direction(struct gpio_chip *chip,

                     unsigned int offset)

{

    /* This device is output only */

    return 0;

}

​

static int lp873x_gpio_direction_input(struct gpio_chip *chip,

                       unsigned int offset)

{

    /* This device is output only */

    return -EINVAL;

}

​

static int lp873x_gpio_direction_output(struct gpio_chip *chip,

                    unsigned int offset, int value)

{

    struct lp873x_gpio *gpio = gpiochip_get_data(chip);

​

    /* Set the initial value */

    return regmap_update_bits(gpio->lp873->regmap, LP873X_REG_GPO_CTRL,

                  BIT(offset * BITS_PER_GPO),

                  value ? BIT(offset * BITS_PER_GPO) : 0);

}

​

static int lp873x_gpio_get(struct gpio_chip *chip, unsigned int offset)

{

    struct lp873x_gpio *gpio = gpiochip_get_data(chip);

    int ret, val;

​

    ret = regmap_read(gpio->lp873->regmap, LP873X_REG_GPO_CTRL, &val);

    if (ret < 0)