linux-imx

/*

 * TI Palma series PMIC's GPIO driver.

 *

 * Copyright (c) 2012, NVIDIA CORPORATION.  All rights reserved.

 *

 * Author: Laxman Dewangan <ldewangan@nvidia.com>

 *

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

 * under the terms and conditions of the GNU General Public License,

 * version 2, as published by the Free Software Foundation.

 *

 * This program is distributed in the hope it will be useful, but WITHOUT

 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or

 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for

 * more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program.  If not, see <http://www.gnu.org/licenses/>.

 */

​

#include <linux/gpio/driver.h>

#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/mfd/palmas.h>

#include <linux/of.h>

#include <linux/of_device.h>

#include <linux/platform_device.h>

​

struct palmas_gpio {

    struct gpio_chip gpio_chip;

    struct palmas *palmas;

};

​

struct palmas_device_data {

    int ngpio;

};

​

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

{

    struct palmas_gpio *pg = gpiochip_get_data(gc);

    struct palmas *palmas = pg->palmas;

    unsigned int val;

    int ret;

    unsigned int reg;

    int gpio16 = (offset/8);

​

    offset %= 8;

    reg = (gpio16) ? PALMAS_GPIO_DATA_DIR2 : PALMAS_GPIO_DATA_DIR;

​

    ret = palmas_read(palmas, PALMAS_GPIO_BASE, reg, &val);

    if (ret < 0) {

        dev_err(gc->parent, "Reg 0x%02x read failed, %d\n", reg, ret);

        return ret;

    }

​

    if (val & BIT(offset))

        reg = (gpio16) ? PALMAS_GPIO_DATA_OUT2 : PALMAS_GPIO_DATA_OUT;

    else

        reg = (gpio16) ? PALMAS_GPIO_DATA_IN2 : PALMAS_GPIO_DATA_IN;

​

    ret = palmas_read(palmas, PALMAS_GPIO_BASE, reg, &val);

    if (ret < 0) {

        dev_err(gc->parent, "Reg 0x%02x read failed, %d\n", reg, ret);

        return ret;

    }

    return !!(val & BIT(offset));

}

​

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

            int value)

{

    struct palmas_gpio *pg = gpiochip_get_data(gc);

    struct palmas *palmas = pg->palmas;

    int ret;

    unsigned int reg;

    int gpio16 = (offset/8);

​

    offset %= 8;

    if (gpio16)

        reg = (value) ?

            PALMAS_GPIO_SET_DATA_OUT2 : PALMAS_GPIO_CLEAR_DATA_OUT2;

    else

        reg = (value) ?

            PALMAS_GPIO_SET_DATA_OUT : PALMAS_GPIO_CLEAR_DATA_OUT;

​

    ret = palmas_write(palmas, PALMAS_GPIO_BASE, reg, BIT(offset));

    if (ret < 0)

        dev_err(gc->parent, "Reg 0x%02x write failed, %d\n", reg, ret);

}

​

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

                int value)