[s3c24xx] Add glamo gpiolib support.

SVN-Revision: 17078

diff --git a/target/linux/s3c24xx/files-2.6.30/drivers/mfd/glamo/glamo-gpio.c b/target/linux/s3c24xx/files-2.6.30/drivers/mfd/glamo/glamo-gpio.c
index 45d0bf91268ea59810fa1c6dcb2f22e60262397b..5e73b22ae869731121e7ef620d6a6780b5d76578 100644 (file)
--- a/target/linux/s3c24xx/files-2.6.30/drivers/mfd/glamo/glamo-gpio.c
+++ b/target/linux/s3c24xx/files-2.6.30/drivers/mfd/glamo/glamo-gpio.c
@@ -1,62 +1,281 @@
+/* Smedia Glamo 336x/337x gpio driver
+ *
+ * (C) 2009 Lars-Peter Clausen
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License as
+ * published by the Free Software Foundation; either version 2 of
+ * the License, or (at your option) any later version.
+ *
+ * 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/kernel.h>
+#include <linux/init.h>
 #include <linux/module.h>
 #include <linux/spinlock.h>
 #include <linux/io.h>
+#include <linux/platform_device.h>
 
-#include <linux/glamo-gpio.h>
+#include <linux/gpio.h>
+#include <linux/mfd/glamo.h>
 
 #include "glamo-core.h"
 #include "glamo-regs.h"
 
-void glamo_gpio_setpin(struct glamo_core *glamo, unsigned int pin,
-                      unsigned int value)
+#define GLAMO_NR_GPIO 21
+#define GLAMO_NR_GPIO_REGS DIV_ROUND_UP(GLAMO_NR_GPIO, 4)
+
+#define GLAMO_REG_GPIO(x) (((x) * 2) + GLAMO_REG_GPIO_GEN1)
+
+struct glamo_gpio {
+       struct glamo_core *glamo;
+       struct gpio_chip chip;
+       uint16_t saved_regs[GLAMO_NR_GPIO_REGS];
+};
+
+#define REG_OF_GPIO(gpio)   (GLAMO_REG_GPIO(gpio >> 2))
+#define NUM_OF_GPIO(gpio)      (gpio & 0x3)
+#define DIRECTION_BIT(gpio)    (1 << (NUM_OF_GPIO(gpio) + 0))
+#define OUTPUT_BIT(gpio)       (1 << (NUM_OF_GPIO(gpio) + 4))
+#define INPUT_BIT(gpio)                (1 << (NUM_OF_GPIO(gpio) + 8))
+#define FUNC_BIT(gpio)         (1 << (NUM_OF_GPIO(gpio) + 12))
+
+
+static inline struct glamo_core *chip_to_glamo(struct gpio_chip *chip)
 {
-       unsigned int reg = REG_OF_GPIO(pin);
+       return container_of(chip, struct glamo_gpio, chip)->glamo;
+}
+
+static void glamo_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
+{
+       struct glamo_core *glamo = chip_to_glamo(chip);
+       unsigned int reg = REG_OF_GPIO(offset);
        u_int16_t tmp;
 
        spin_lock(&glamo->lock);
        tmp = readw(glamo->base + reg);
        if (value)
-               tmp |= OUTPUT_BIT(pin);
+               tmp |= OUTPUT_BIT(offset);
        else
-               tmp &= ~OUTPUT_BIT(pin);
+               tmp &= ~OUTPUT_BIT(offset);
        writew(tmp, glamo->base + reg);
        spin_unlock(&glamo->lock);
 }
-EXPORT_SYMBOL(glamo_gpio_setpin);
 
-int glamo_gpio_getpin(struct glamo_core *glamo, unsigned int pin)
+static int glamo_gpio_get(struct gpio_chip *chip, unsigned offset)
 {
-       return readw(REG_OF_GPIO(pin)) & INPUT_BIT(pin) ? 1 : 0;
+       struct glamo_core *glamo = chip_to_glamo(chip);
+       return readw(glamo->base + REG_OF_GPIO(offset)) & INPUT_BIT(offset) ? 1 : 0;
 }
-EXPORT_SYMBOL(glamo_gpio_getpin);
 
-void glamo_gpio_cfgpin(struct glamo_core *glamo, unsigned int pinfunc)
+static int glamo_gpio_request(struct gpio_chip *chip, unsigned offset)
 {
-       unsigned int reg = REG_OF_GPIO(pinfunc);
+       struct glamo_core *glamo = chip_to_glamo(chip);
+       unsigned int reg = REG_OF_GPIO(offset);
        u_int16_t tmp;
 
        spin_lock(&glamo->lock);
        tmp = readw(glamo->base + reg);
+       if ((tmp & FUNC_BIT(offset)) == 0) {
+               tmp |= FUNC_BIT(offset);
+               writew(tmp, glamo->base + reg);
+       }
+       spin_unlock(&glamo->lock);
 
-       if ((pinfunc & 0x00f0) == GLAMO_GPIO_F_FUNC) {
-               /* pin is a function pin: clear gpio bit */
-               tmp &= ~FUNC_BIT(pinfunc);
-       } else {
-               /* pin is gpio: set gpio bit */
-               tmp |= FUNC_BIT(pinfunc);
-
-               if (pinfunc & GLAMO_GPIO_F_IN) {
-                       /* gpio input: set bit to disable output mode */
-                       tmp |= GPIO_OUT_BIT(pinfunc);
-               } else if (pinfunc & GLAMO_GPIO_F_OUT) {
-                       /* gpio output: clear bit to enable output mode */
-                       tmp &= ~GPIO_OUT_BIT(pinfunc);
-               }
+       return 0;
+}
+
+static void glamo_gpio_free(struct gpio_chip *chip, unsigned offset)
+{
+       struct glamo_core *glamo = chip_to_glamo(chip);
+       unsigned int reg = REG_OF_GPIO(offset);
+       u_int16_t tmp;
+
+       spin_lock(&glamo->lock);
+       tmp = readw(glamo->base + reg);
+       if ((tmp & FUNC_BIT(offset)) == 1) {
+               tmp &= ~FUNC_BIT(offset);
+               writew(tmp, glamo->base + reg);
        }
+       spin_unlock(&glamo->lock);
+}
+
+static int glamo_gpio_direction_output(struct gpio_chip *chip, unsigned offset,
+                                               int value)
+{
+       struct glamo_core *glamo = chip_to_glamo(chip);
+       unsigned int reg = REG_OF_GPIO(offset);
+       u_int16_t tmp;
+
+       spin_lock(&glamo->lock);
+       tmp = readw(glamo->base + reg);
+    tmp &= ~DIRECTION_BIT(offset);
+
+       if (value)
+               tmp |= OUTPUT_BIT(offset);
+       else
+               tmp &= ~OUTPUT_BIT(offset);
+
        writew(tmp, glamo->base + reg);
        spin_unlock(&glamo->lock);
+
+       return 0;
+}
+
+static int glamo_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
+{
+       struct glamo_core *glamo = chip_to_glamo(chip);
+       unsigned int reg = REG_OF_GPIO(offset);
+       u_int16_t tmp;
+
+       spin_lock(&glamo->lock);
+       tmp = readw(glamo->base + reg);
+       if ((tmp & DIRECTION_BIT(offset)) == 0) {
+               tmp |= DIRECTION_BIT(offset);
+               writew(tmp, glamo->base + reg);
+       }
+       spin_unlock(&glamo->lock);
+
+       return 0;
 }
-EXPORT_SYMBOL(glamo_gpio_cfgpin);
 
+static const struct __devinit gpio_chip glamo_gpio_chip = {
+       .label                          = "glamo",
+       .request                        = glamo_gpio_request,
+       .free                           = glamo_gpio_free,
+       .direction_input        = glamo_gpio_direction_input,
+       .get                            = glamo_gpio_get,
+       .direction_output       = glamo_gpio_direction_output,
+       .set                            = glamo_gpio_set,
+       .base                           = -1,
+       .ngpio                          = GLAMO_NR_GPIO,
+       .can_sleep                      = 0,
+       .owner             = THIS_MODULE,
+};
+
+static int __devinit glamo_gpio_probe(struct platform_device *pdev)
+{
+       struct glamo_platform_data *pdata = pdev->dev.parent->platform_data;
+       struct glamo_gpio *glamo_gpio;
+       int ret;
+
+       glamo_gpio = kzalloc(sizeof(struct glamo_gpio), GFP_KERNEL);
+       if (!glamo_gpio)
+               return -ENOMEM;
+
+       glamo_gpio->glamo = dev_get_drvdata(pdev->dev.parent);
+       glamo_gpio->chip = glamo_gpio_chip;
+       glamo_gpio->chip.dev = &pdev->dev;
+       if (pdata)
+               glamo_gpio->chip.base = pdata->gpio_base;
+
+       ret = gpiochip_add(&glamo_gpio->chip);
+
+       if (ret) {
+               dev_err(&pdev->dev, "Could not register gpio chip: %d\n", ret);
+               goto err;
+       }
+
+       platform_set_drvdata(pdev, glamo_gpio);
+       return 0;
+err:
+       kfree(glamo_gpio);
+       return ret;
+}
+
+static int __devexit glamo_gpio_remove(struct platform_device *pdev)
+{
+       struct glamo_gpio *glamo_gpio = platform_get_drvdata(pdev);
+       int ret;
+
+       ret = gpiochip_remove(&glamo_gpio->chip);
+       if (!ret)
+               goto done;
+
+       platform_set_drvdata(pdev, NULL);
+       kfree(glamo_gpio);
+
+done:
+       return ret;
+}
+
+#ifdef CONFIG_PM
+
+static int glamo_gpio_suspend(struct device *dev)
+{
+       struct glamo_gpio *glamo_gpio = dev_get_drvdata(dev);
+       struct glamo_core *glamo = glamo_gpio->glamo;
+       uint16_t *saved_regs = glamo_gpio->saved_regs;
+       int i;
+
+       spin_lock(&glamo->lock);
+       for (i = 0; i < GLAMO_NR_GPIO / 4; ++i)
+               saved_regs[i] = readw(glamo->base + GLAMO_REG_GPIO(i));
+       spin_unlock(&glamo->lock);
+
+       return 0;
+}
+
+static int glamo_gpio_resume(struct device *dev)
+{
+       struct glamo_gpio *glamo_gpio = dev_get_drvdata(dev);
+       struct glamo_core *glamo = glamo_gpio->glamo;
+       uint16_t *saved_regs = glamo_gpio->saved_regs;
+       int i;
+
+       spin_lock(&glamo->lock);
+       for (i = 0; i < GLAMO_NR_GPIO_REGS; ++i)
+               writew(saved_regs[i], glamo->base + GLAMO_REG_GPIO(i));
+       spin_unlock(&glamo->lock);
+       return 0;
+}
+
+static const struct dev_pm_ops glamo_pm_ops = {
+       .suspend = glamo_gpio_suspend,
+       .resume  = glamo_gpio_resume,
+       .freeze  = glamo_gpio_suspend,
+       .thaw    = glamo_gpio_resume,
+};
+
+#define GLAMO_GPIO_PM_OPS (&glamo_pm_ops)
+
+#else
+#define GLAMO_GPIO_OPS NULL
+#endif
+
+static struct platform_driver glamo_gpio_driver = {
+       .driver = {
+               .name  = "glamo-gpio",
+               .owner = THIS_MODULE,
+               .pm    = GLAMO_GPIO_PM_OPS,
+       },
+       .probe = glamo_gpio_probe,
+       .remove = __devexit_p(glamo_gpio_remove),
+};
+
+static int __devinit glamo_gpio_init(void)
+{
+       return platform_driver_register(&glamo_gpio_driver);
+}
+
+static void __exit glamo_gpio_exit(void)
+{
+       platform_driver_unregister(&glamo_gpio_driver);
+}
+
+module_init(glamo_gpio_init);
+module_exit(glamo_gpio_exit);
+
+MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
+MODULE_DESCRIPTION("GPIO interface for the Glamo multimedia device");
+MODULE_LICENSE("GPL");
+MODULE_ALIAS("platform:glamo-gpio");