Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 | /* * Copyright 2011 Texas Instruments Inc. * * Author: Margarita Olaya <magi@slimlogic.co.uk> * * 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 driver is based on wm8350 implementation. */ #include <linux/kernel.h> #include <linux/module.h> #include <linux/errno.h> #include <linux/gpio.h> #include <linux/mfd/core.h> #include <linux/platform_device.h> #include <linux/seq_file.h> #include <linux/slab.h> #include <linux/mfd/tps65912.h> struct tps65912_gpio_data { struct tps65912 *tps65912; struct gpio_chip gpio_chip; }; static int tps65912_gpio_get(struct gpio_chip *gc, unsigned offset) { struct tps65912 *tps65912 = container_of(gc, struct tps65912, gpio); int val; val = tps65912_reg_read(tps65912, TPS65912_GPIO1 + offset); if (val & GPIO_STS_MASK) return 1; return 0; } static void tps65912_gpio_set(struct gpio_chip *gc, unsigned offset, int value) { struct tps65912 *tps65912 = container_of(gc, struct tps65912, gpio); if (value) tps65912_set_bits(tps65912, TPS65912_GPIO1 + offset, GPIO_SET_MASK); else tps65912_clear_bits(tps65912, TPS65912_GPIO1 + offset, GPIO_SET_MASK); } static int tps65912_gpio_output(struct gpio_chip *gc, unsigned offset, int value) { struct tps65912 *tps65912 = container_of(gc, struct tps65912, gpio); /* Set the initial value */ tps65912_gpio_set(gc, offset, value); return tps65912_set_bits(tps65912, TPS65912_GPIO1 + offset, GPIO_CFG_MASK); } static int tps65912_gpio_input(struct gpio_chip *gc, unsigned offset) { struct tps65912 *tps65912 = container_of(gc, struct tps65912, gpio); return tps65912_clear_bits(tps65912, TPS65912_GPIO1 + offset, GPIO_CFG_MASK); } static struct gpio_chip template_chip = { .label = "tps65912", .owner = THIS_MODULE, .direction_input = tps65912_gpio_input, .direction_output = tps65912_gpio_output, .get = tps65912_gpio_get, .set = tps65912_gpio_set, .can_sleep = 1, .ngpio = 5, .base = -1, }; static int __devinit tps65912_gpio_probe(struct platform_device *pdev) { struct tps65912 *tps65912 = dev_get_drvdata(pdev->dev.parent); struct tps65912_board *pdata = tps65912->dev->platform_data; struct tps65912_gpio_data *tps65912_gpio; int ret; tps65912_gpio = kzalloc(sizeof(*tps65912_gpio), GFP_KERNEL); if (tps65912_gpio == NULL) return -ENOMEM; tps65912_gpio->tps65912 = tps65912; tps65912_gpio->gpio_chip = template_chip; tps65912_gpio->gpio_chip.dev = &pdev->dev; if (pdata && pdata->gpio_base) tps65912_gpio->gpio_chip.base = pdata->gpio_base; ret = gpiochip_add(&tps65912_gpio->gpio_chip); if (ret < 0) { dev_err(&pdev->dev, "Failed to register gpiochip, %d\n", ret); goto err; } platform_set_drvdata(pdev, tps65912_gpio); return ret; err: kfree(tps65912_gpio); return ret; } static int __devexit tps65912_gpio_remove(struct platform_device *pdev) { struct tps65912_gpio_data *tps65912_gpio = platform_get_drvdata(pdev); int ret; ret = gpiochip_remove(&tps65912_gpio->gpio_chip); if (ret == 0) kfree(tps65912_gpio); return ret; } static struct platform_driver tps65912_gpio_driver = { .driver = { .name = "tps65912-gpio", .owner = THIS_MODULE, }, .probe = tps65912_gpio_probe, .remove = __devexit_p(tps65912_gpio_remove), }; static int __init tps65912_gpio_init(void) { return platform_driver_register(&tps65912_gpio_driver); } subsys_initcall(tps65912_gpio_init); static void __exit tps65912_gpio_exit(void) { platform_driver_unregister(&tps65912_gpio_driver); } module_exit(tps65912_gpio_exit); MODULE_AUTHOR("Margarita Olaya Cabrera <magi@slimlogic.co.uk>"); MODULE_DESCRIPTION("GPIO interface for TPS65912 PMICs"); MODULE_LICENSE("GPL v2"); MODULE_ALIAS("platform:tps65912-gpio"); |