Merge branch 'linus' into perf/urgent
[firefly-linux-kernel-4.4.55.git] / drivers / gpio / bt8xxgpio.c
1 /*
2
3     bt8xx GPIO abuser
4
5     Copyright (C) 2008 Michael Buesch <mb@bu3sch.de>
6
7     Please do _only_ contact the people listed _above_ with issues related to this driver.
8     All the other people listed below are not related to this driver. Their names
9     are only here, because this driver is derived from the bt848 driver.
10
11
12     Derived from the bt848 driver:
13
14     Copyright (C) 1996,97,98 Ralph  Metzler
15                            & Marcus Metzler
16     (c) 1999-2002 Gerd Knorr
17
18     some v4l2 code lines are taken from Justin's bttv2 driver which is
19     (c) 2000 Justin Schoeman
20
21     V4L1 removal from:
22     (c) 2005-2006 Nickolay V. Shmyrev
23
24     Fixes to be fully V4L2 compliant by
25     (c) 2006 Mauro Carvalho Chehab
26
27     Cropping and overscan support
28     Copyright (C) 2005, 2006 Michael H. Schimek
29     Sponsored by OPQ Systems AB
30
31     This program is free software; you can redistribute it and/or modify
32     it under the terms of the GNU General Public License as published by
33     the Free Software Foundation; either version 2 of the License, or
34     (at your option) any later version.
35
36     This program is distributed in the hope that it will be useful,
37     but WITHOUT ANY WARRANTY; without even the implied warranty of
38     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
39     GNU General Public License for more details.
40
41     You should have received a copy of the GNU General Public License
42     along with this program; if not, write to the Free Software
43     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
44 */
45
46 #include <linux/module.h>
47 #include <linux/pci.h>
48 #include <linux/spinlock.h>
49 #include <linux/gpio.h>
50 #include <linux/slab.h>
51
52 /* Steal the hardware definitions from the bttv driver. */
53 #include "../media/video/bt8xx/bt848.h"
54
55
56 #define BT8XXGPIO_NR_GPIOS              24 /* We have 24 GPIO pins */
57
58
59 struct bt8xxgpio {
60         spinlock_t lock;
61
62         void __iomem *mmio;
63         struct pci_dev *pdev;
64         struct gpio_chip gpio;
65
66 #ifdef CONFIG_PM
67         u32 saved_outen;
68         u32 saved_data;
69 #endif
70 };
71
72 #define bgwrite(dat, adr)       writel((dat), bg->mmio+(adr))
73 #define bgread(adr)             readl(bg->mmio+(adr))
74
75
76 static int modparam_gpiobase = -1/* dynamic */;
77 module_param_named(gpiobase, modparam_gpiobase, int, 0444);
78 MODULE_PARM_DESC(gpiobase, "The GPIO number base. -1 means dynamic, which is the default.");
79
80
81 static int bt8xxgpio_gpio_direction_input(struct gpio_chip *gpio, unsigned nr)
82 {
83         struct bt8xxgpio *bg = container_of(gpio, struct bt8xxgpio, gpio);
84         unsigned long flags;
85         u32 outen, data;
86
87         spin_lock_irqsave(&bg->lock, flags);
88
89         data = bgread(BT848_GPIO_DATA);
90         data &= ~(1 << nr);
91         bgwrite(data, BT848_GPIO_DATA);
92
93         outen = bgread(BT848_GPIO_OUT_EN);
94         outen &= ~(1 << nr);
95         bgwrite(outen, BT848_GPIO_OUT_EN);
96
97         spin_unlock_irqrestore(&bg->lock, flags);
98
99         return 0;
100 }
101
102 static int bt8xxgpio_gpio_get(struct gpio_chip *gpio, unsigned nr)
103 {
104         struct bt8xxgpio *bg = container_of(gpio, struct bt8xxgpio, gpio);
105         unsigned long flags;
106         u32 val;
107
108         spin_lock_irqsave(&bg->lock, flags);
109         val = bgread(BT848_GPIO_DATA);
110         spin_unlock_irqrestore(&bg->lock, flags);
111
112         return !!(val & (1 << nr));
113 }
114
115 static int bt8xxgpio_gpio_direction_output(struct gpio_chip *gpio,
116                                         unsigned nr, int val)
117 {
118         struct bt8xxgpio *bg = container_of(gpio, struct bt8xxgpio, gpio);
119         unsigned long flags;
120         u32 outen, data;
121
122         spin_lock_irqsave(&bg->lock, flags);
123
124         outen = bgread(BT848_GPIO_OUT_EN);
125         outen |= (1 << nr);
126         bgwrite(outen, BT848_GPIO_OUT_EN);
127
128         data = bgread(BT848_GPIO_DATA);
129         if (val)
130                 data |= (1 << nr);
131         else
132                 data &= ~(1 << nr);
133         bgwrite(data, BT848_GPIO_DATA);
134
135         spin_unlock_irqrestore(&bg->lock, flags);
136
137         return 0;
138 }
139
140 static void bt8xxgpio_gpio_set(struct gpio_chip *gpio,
141                             unsigned nr, int val)
142 {
143         struct bt8xxgpio *bg = container_of(gpio, struct bt8xxgpio, gpio);
144         unsigned long flags;
145         u32 data;
146
147         spin_lock_irqsave(&bg->lock, flags);
148
149         data = bgread(BT848_GPIO_DATA);
150         if (val)
151                 data |= (1 << nr);
152         else
153                 data &= ~(1 << nr);
154         bgwrite(data, BT848_GPIO_DATA);
155
156         spin_unlock_irqrestore(&bg->lock, flags);
157 }
158
159 static void bt8xxgpio_gpio_setup(struct bt8xxgpio *bg)
160 {
161         struct gpio_chip *c = &bg->gpio;
162
163         c->label = dev_name(&bg->pdev->dev);
164         c->owner = THIS_MODULE;
165         c->direction_input = bt8xxgpio_gpio_direction_input;
166         c->get = bt8xxgpio_gpio_get;
167         c->direction_output = bt8xxgpio_gpio_direction_output;
168         c->set = bt8xxgpio_gpio_set;
169         c->dbg_show = NULL;
170         c->base = modparam_gpiobase;
171         c->ngpio = BT8XXGPIO_NR_GPIOS;
172         c->can_sleep = 0;
173 }
174
175 static int bt8xxgpio_probe(struct pci_dev *dev,
176                         const struct pci_device_id *pci_id)
177 {
178         struct bt8xxgpio *bg;
179         int err;
180
181         bg = kzalloc(sizeof(*bg), GFP_KERNEL);
182         if (!bg)
183                 return -ENOMEM;
184
185         bg->pdev = dev;
186         spin_lock_init(&bg->lock);
187
188         err = pci_enable_device(dev);
189         if (err) {
190                 printk(KERN_ERR "bt8xxgpio: Can't enable device.\n");
191                 goto err_freebg;
192         }
193         if (!request_mem_region(pci_resource_start(dev, 0),
194                                 pci_resource_len(dev, 0),
195                                 "bt8xxgpio")) {
196                 printk(KERN_WARNING "bt8xxgpio: Can't request iomem (0x%llx).\n",
197                        (unsigned long long)pci_resource_start(dev, 0));
198                 err = -EBUSY;
199                 goto err_disable;
200         }
201         pci_set_master(dev);
202         pci_set_drvdata(dev, bg);
203
204         bg->mmio = ioremap(pci_resource_start(dev, 0), 0x1000);
205         if (!bg->mmio) {
206                 printk(KERN_ERR "bt8xxgpio: ioremap() failed\n");
207                 err = -EIO;
208                 goto err_release_mem;
209         }
210
211         /* Disable interrupts */
212         bgwrite(0, BT848_INT_MASK);
213
214         /* gpio init */
215         bgwrite(0, BT848_GPIO_DMA_CTL);
216         bgwrite(0, BT848_GPIO_REG_INP);
217         bgwrite(0, BT848_GPIO_OUT_EN);
218
219         bt8xxgpio_gpio_setup(bg);
220         err = gpiochip_add(&bg->gpio);
221         if (err) {
222                 printk(KERN_ERR "bt8xxgpio: Failed to register GPIOs\n");
223                 goto err_release_mem;
224         }
225
226         printk(KERN_INFO "bt8xxgpio: Abusing BT8xx card for GPIOs %d to %d\n",
227                bg->gpio.base, bg->gpio.base + BT8XXGPIO_NR_GPIOS - 1);
228
229         return 0;
230
231 err_release_mem:
232         release_mem_region(pci_resource_start(dev, 0),
233                            pci_resource_len(dev, 0));
234         pci_set_drvdata(dev, NULL);
235 err_disable:
236         pci_disable_device(dev);
237 err_freebg:
238         kfree(bg);
239
240         return err;
241 }
242
243 static void bt8xxgpio_remove(struct pci_dev *pdev)
244 {
245         struct bt8xxgpio *bg = pci_get_drvdata(pdev);
246
247         gpiochip_remove(&bg->gpio);
248
249         bgwrite(0, BT848_INT_MASK);
250         bgwrite(~0x0, BT848_INT_STAT);
251         bgwrite(0x0, BT848_GPIO_OUT_EN);
252
253         iounmap(bg->mmio);
254         release_mem_region(pci_resource_start(pdev, 0),
255                            pci_resource_len(pdev, 0));
256         pci_disable_device(pdev);
257
258         pci_set_drvdata(pdev, NULL);
259         kfree(bg);
260 }
261
262 #ifdef CONFIG_PM
263 static int bt8xxgpio_suspend(struct pci_dev *pdev, pm_message_t state)
264 {
265         struct bt8xxgpio *bg = pci_get_drvdata(pdev);
266         unsigned long flags;
267
268         spin_lock_irqsave(&bg->lock, flags);
269
270         bg->saved_outen = bgread(BT848_GPIO_OUT_EN);
271         bg->saved_data = bgread(BT848_GPIO_DATA);
272
273         bgwrite(0, BT848_INT_MASK);
274         bgwrite(~0x0, BT848_INT_STAT);
275         bgwrite(0x0, BT848_GPIO_OUT_EN);
276
277         spin_unlock_irqrestore(&bg->lock, flags);
278
279         pci_save_state(pdev);
280         pci_disable_device(pdev);
281         pci_set_power_state(pdev, pci_choose_state(pdev, state));
282
283         return 0;
284 }
285
286 static int bt8xxgpio_resume(struct pci_dev *pdev)
287 {
288         struct bt8xxgpio *bg = pci_get_drvdata(pdev);
289         unsigned long flags;
290         int err;
291
292         pci_set_power_state(pdev, 0);
293         err = pci_enable_device(pdev);
294         if (err)
295                 return err;
296         pci_restore_state(pdev);
297
298         spin_lock_irqsave(&bg->lock, flags);
299
300         bgwrite(0, BT848_INT_MASK);
301         bgwrite(0, BT848_GPIO_DMA_CTL);
302         bgwrite(0, BT848_GPIO_REG_INP);
303         bgwrite(bg->saved_outen, BT848_GPIO_OUT_EN);
304         bgwrite(bg->saved_data & bg->saved_outen,
305                 BT848_GPIO_DATA);
306
307         spin_unlock_irqrestore(&bg->lock, flags);
308
309         return 0;
310 }
311 #else
312 #define bt8xxgpio_suspend NULL
313 #define bt8xxgpio_resume NULL
314 #endif /* CONFIG_PM */
315
316 static struct pci_device_id bt8xxgpio_pci_tbl[] = {
317         { PCI_DEVICE(PCI_VENDOR_ID_BROOKTREE, PCI_DEVICE_ID_BT848) },
318         { PCI_DEVICE(PCI_VENDOR_ID_BROOKTREE, PCI_DEVICE_ID_BT849) },
319         { PCI_DEVICE(PCI_VENDOR_ID_BROOKTREE, PCI_DEVICE_ID_BT878) },
320         { PCI_DEVICE(PCI_VENDOR_ID_BROOKTREE, PCI_DEVICE_ID_BT879) },
321         { 0, },
322 };
323 MODULE_DEVICE_TABLE(pci, bt8xxgpio_pci_tbl);
324
325 static struct pci_driver bt8xxgpio_pci_driver = {
326         .name           = "bt8xxgpio",
327         .id_table       = bt8xxgpio_pci_tbl,
328         .probe          = bt8xxgpio_probe,
329         .remove         = bt8xxgpio_remove,
330         .suspend        = bt8xxgpio_suspend,
331         .resume         = bt8xxgpio_resume,
332 };
333
334 static int __init bt8xxgpio_init(void)
335 {
336         return pci_register_driver(&bt8xxgpio_pci_driver);
337 }
338 module_init(bt8xxgpio_init)
339
340 static void __exit bt8xxgpio_exit(void)
341 {
342         pci_unregister_driver(&bt8xxgpio_pci_driver);
343 }
344 module_exit(bt8xxgpio_exit)
345
346 MODULE_LICENSE("GPL");
347 MODULE_AUTHOR("Michael Buesch");
348 MODULE_DESCRIPTION("Abuse a BT8xx framegrabber card as generic GPIO card");