linux-imx

/*

 * STMicroelectronics ConneXt (STA2X11) GPIO driver

 *

 * Copyright 2012 ST Microelectronics (Alessandro Rubini)

 * Based on gpio-ml-ioh.c, Copyright 2010 OKI Semiconductors Ltd.

 * Also based on previous sta2x11 work, Copyright 2011 Wind River Systems, Inc.

 *

 * 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 in the hope that 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, write to the Free Software

 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA

 *

 */

​

#include <linux/init.h>

#include <linux/kernel.h>

#include <linux/slab.h>

#include <linux/gpio/driver.h>

#include <linux/bitops.h>

#include <linux/interrupt.h>

#include <linux/irq.h>

#include <linux/pci.h>

#include <linux/platform_device.h>

#include <linux/mfd/sta2x11-mfd.h>

​

struct gsta_regs {

    u32 dat;        /* 0x00 */

    u32 dats;

    u32 datc;

    u32 pdis;

    u32 dir;        /* 0x10 */

    u32 dirs;

    u32 dirc;

    u32 unused_1c;

    u32 afsela;     /* 0x20 */

    u32 unused_24[7];

    u32 rimsc;      /* 0x40 */

    u32 fimsc;

    u32 is;

    u32 ic;

};

​

struct gsta_gpio {

    spinlock_t          lock;

    struct device           *dev;

    void __iomem            *reg_base;

    struct gsta_regs __iomem    *regs[GSTA_NR_BLOCKS];

    struct gpio_chip        gpio;

    int             irq_base;

    /* FIXME: save the whole config here (AF, ...) */

    unsigned            irq_type[GSTA_NR_GPIO];

};

​

/*

 * gpio methods

 */

​

static void gsta_gpio_set(struct gpio_chip *gpio, unsigned nr, int val)

{

    struct gsta_gpio *chip = gpiochip_get_data(gpio);

    struct gsta_regs __iomem *regs = chip->regs[nr / GSTA_GPIO_PER_BLOCK];

    u32 bit = BIT(nr % GSTA_GPIO_PER_BLOCK);

​

    if (val)

        writel(bit, &regs->dats);

    else

        writel(bit, &regs->datc);

}

​

static int gsta_gpio_get(struct gpio_chip *gpio, unsigned nr)

{

    struct gsta_gpio *chip = gpiochip_get_data(gpio);

    struct gsta_regs __iomem *regs = chip->regs[nr / GSTA_GPIO_PER_BLOCK];

    u32 bit = BIT(nr % GSTA_GPIO_PER_BLOCK);

​

    return !!(readl(&regs->dat) & bit);

}

​

static int gsta_gpio_direction_output(struct gpio_chip *gpio, unsigned nr,

                      int val)

{

    struct gsta_gpio *chip = gpiochip_get_data(gpio);

    struct gsta_regs __iomem *regs = chip->regs[nr / GSTA_GPIO_PER_BLOCK];

    u32 bit = BIT(nr % GSTA_GPIO_PER_BLOCK);