linux-imx

/*

 * AppliedMicro X-Gene SoC GPIO Driver

 *

 * Copyright (c) 2014, Applied Micro Circuits Corporation

 * Author: Feng Kan <fkan@apm.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 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, see <http://www.gnu.org/licenses/>.

 */

​

#include <linux/acpi.h>

#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/io.h>

#include <linux/spinlock.h>

#include <linux/platform_device.h>

#include <linux/gpio/driver.h>

#include <linux/types.h>

#include <linux/bitops.h>

​

#define GPIO_SET_DR_OFFSET  0x0C

#define GPIO_DATA_OFFSET    0x14

#define GPIO_BANK_STRIDE    0x0C

​

#define XGENE_GPIOS_PER_BANK    16

#define XGENE_MAX_GPIO_BANKS    3

#define XGENE_MAX_GPIOS     (XGENE_GPIOS_PER_BANK * XGENE_MAX_GPIO_BANKS)

​

#define GPIO_BIT_OFFSET(x)  (x % XGENE_GPIOS_PER_BANK)

#define GPIO_BANK_OFFSET(x) ((x / XGENE_GPIOS_PER_BANK) * GPIO_BANK_STRIDE)

​

struct xgene_gpio {

    struct gpio_chip    chip;

    void __iomem        *base;

    spinlock_t      lock;

    u32         set_dr_val[XGENE_MAX_GPIO_BANKS];

};

​

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

{

    struct xgene_gpio *chip = gpiochip_get_data(gc);

    unsigned long bank_offset;

    u32 bit_offset;

​

    bank_offset = GPIO_DATA_OFFSET + GPIO_BANK_OFFSET(offset);

    bit_offset = GPIO_BIT_OFFSET(offset);

    return !!(ioread32(chip->base + bank_offset) & BIT(bit_offset));

}

​

static void __xgene_gpio_set(struct gpio_chip *gc, unsigned int offset, int val)

{

    struct xgene_gpio *chip = gpiochip_get_data(gc);

    unsigned long bank_offset;

    u32 setval, bit_offset;