Commit | Line | Data |
---|---|---|
a3b8d4a5 AS |
1 | /* |
2 | * CLPS711X GPIO driver | |
3 | * | |
55fe14ab | 4 | * Copyright (C) 2012,2013 Alexander Shiyan <shc_work@mail.ru> |
a3b8d4a5 AS |
5 | * |
6 | * This program is free software; you can redistribute it and/or modify | |
7 | * it under the terms of the GNU General Public License as published by | |
8 | * the Free Software Foundation; either version 2 of the License, or | |
9 | * (at your option) any later version. | |
10 | */ | |
11 | ||
55fe14ab | 12 | #include <linux/err.h> |
a3b8d4a5 AS |
13 | #include <linux/gpio.h> |
14 | #include <linux/module.h> | |
55fe14ab | 15 | #include <linux/basic_mmio_gpio.h> |
a3b8d4a5 AS |
16 | #include <linux/platform_device.h> |
17 | ||
55fe14ab | 18 | static int clps711x_gpio_probe(struct platform_device *pdev) |
a3b8d4a5 | 19 | { |
a180132f | 20 | struct device_node *np = pdev->dev.of_node; |
55fe14ab AS |
21 | void __iomem *dat, *dir; |
22 | struct bgpio_chip *bgc; | |
23 | struct resource *res; | |
a180132f | 24 | int err, id = np ? of_alias_get_id(np, "gpio") : pdev->id; |
a3b8d4a5 | 25 | |
55fe14ab AS |
26 | if ((id < 0) || (id > 4)) |
27 | return -ENODEV; | |
a3b8d4a5 | 28 | |
55fe14ab AS |
29 | bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL); |
30 | if (!bgc) | |
31 | return -ENOMEM; | |
a3b8d4a5 | 32 | |
55fe14ab AS |
33 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
34 | dat = devm_ioremap_resource(&pdev->dev, res); | |
35 | if (IS_ERR(dat)) | |
36 | return PTR_ERR(dat); | |
37 | ||
38 | res = platform_get_resource(pdev, IORESOURCE_MEM, 1); | |
39 | dir = devm_ioremap_resource(&pdev->dev, res); | |
40 | if (IS_ERR(dir)) | |
41 | return PTR_ERR(dir); | |
42 | ||
43 | switch (id) { | |
44 | case 3: | |
45 | /* PORTD is inverted logic for direction register */ | |
46 | err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL, | |
47 | NULL, dir, 0); | |
48 | break; | |
49 | default: | |
50 | err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL, | |
51 | dir, NULL, 0); | |
52 | break; | |
53 | } | |
a3b8d4a5 | 54 | |
55fe14ab AS |
55 | if (err) |
56 | return err; | |
a3b8d4a5 | 57 | |
55fe14ab AS |
58 | switch (id) { |
59 | case 4: | |
60 | /* PORTE is 3 lines only */ | |
61 | bgc->gc.ngpio = 3; | |
62 | break; | |
63 | default: | |
64 | break; | |
65 | } | |
d6a2fa04 | 66 | |
55fe14ab AS |
67 | bgc->gc.base = id * 8; |
68 | platform_set_drvdata(pdev, bgc); | |
d6a2fa04 | 69 | |
55fe14ab | 70 | return gpiochip_add(&bgc->gc); |
d6a2fa04 AS |
71 | } |
72 | ||
55fe14ab | 73 | static int clps711x_gpio_remove(struct platform_device *pdev) |
d6a2fa04 | 74 | { |
55fe14ab | 75 | struct bgpio_chip *bgc = platform_get_drvdata(pdev); |
d6a2fa04 | 76 | |
55fe14ab | 77 | return bgpio_remove(bgc); |
d6a2fa04 AS |
78 | } |
79 | ||
a180132f AS |
80 | static const struct of_device_id clps711x_gpio_ids[] = { |
81 | { .compatible = "cirrus,clps711x-gpio" }, | |
82 | { } | |
83 | }; | |
84 | MODULE_DEVICE_TABLE(of, clps711x_gpio_ids); | |
85 | ||
55fe14ab AS |
86 | static struct platform_driver clps711x_gpio_driver = { |
87 | .driver = { | |
a180132f AS |
88 | .name = "clps711x-gpio", |
89 | .owner = THIS_MODULE, | |
90 | .of_match_table = of_match_ptr(clps711x_gpio_ids), | |
55fe14ab AS |
91 | }, |
92 | .probe = clps711x_gpio_probe, | |
93 | .remove = clps711x_gpio_remove, | |
a3b8d4a5 | 94 | }; |
55fe14ab | 95 | module_platform_driver(clps711x_gpio_driver); |
a3b8d4a5 | 96 | |
55fe14ab | 97 | MODULE_LICENSE("GPL"); |
a3b8d4a5 AS |
98 | MODULE_AUTHOR("Alexander Shiyan <shc_work@mail.ru>"); |
99 | MODULE_DESCRIPTION("CLPS711X GPIO driver"); |