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