/* Smedia Glamo 336x/337x gpio driver * * (C) 2009 Lars-Peter Clausen * All rights reserved. * * 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 #include #include #include #include #include #include #include #include "glamo-core.h" #include "glamo-regs.h" #define GLAMO_NR_GPIOS 21 #define GLAMO_NR_GPIO_REGS DIV_ROUND_UP(GLAMO_NR_GPIOS, 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) BIT(NUM_OF_GPIO(gpio) + 0) #define OUTPUT_BIT(gpio) BIT(NUM_OF_GPIO(gpio) + 4) #define OUTPUT_VALUE(gpio, value) (value << (NUM_OF_GPIO(gpio) + 4)) #define INPUT_BIT(gpio) BIT(NUM_OF_GPIO(gpio) + 8) #define FUNC_BIT(gpio) BIT(NUM_OF_GPIO(gpio) + 12) static inline struct glamo_core *chip_to_glamo(struct gpio_chip *chip) { 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); glamo_reg_set_bit_mask(reg, OUTPUT_VALUE(offset, !!value), OUTPUT_BIT(offset)); } static int glamo_gpio_get(struct gpio_chip *chip, unsigned offset) { struct glamo_core *glamo = chip_to_glamo(chip); return !!(glamo_reg_read(glamo, REG_OF_GPIO(offset)) & INPUT_BIT(offset)); } static int glamo_gpio_request(struct gpio_chip *chip, unsigned offset) { struct glamo_core *glamo = chip_to_glamo(chip); unsigned int reg = REG_OF_GPIO(offset); glamo_reg_set_bit(glamo, reg, FUNC_BIT(offset)); 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); glamo_reg_clear_bit(glamo, reg, FUNC_BIT(offset)); } 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); uint16_t mask = DIRECTION_BIT(offset) | OUTPUT_BIT(offset); uint16_t value = DIRECTION_BIT(offset); if (value) value |= OUTPUT_BIT(offset); glamo_reg_set_bit_mask(glamo, reg, mask, value); 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); glamo_reg_set_bit(glamo, reg, DIRECTION_BIT(offset)); return 0; } 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_GPIOS, .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_REGS; ++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); printk("glamo-gpio resume\n"); 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_PM_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 "); MODULE_DESCRIPTION("GPIO interface for the Glamo multimedia device"); MODULE_LICENSE("GPL"); MODULE_ALIAS("platform:glamo-gpio");