GNU Linux-libre 4.9.328-gnu1
[releases.git] / drivers / gpio / gpio-amdpt.c
1 /*
2  * AMD Promontory GPIO driver
3  *
4  * Copyright (C) 2015 ASMedia Technology Inc.
5  * Author: YD Tseng <yd_tseng@asmedia.com.tw>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  */
11
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/gpio/driver.h>
15 #include <linux/spinlock.h>
16 #include <linux/acpi.h>
17 #include <linux/platform_device.h>
18
19 #define PT_TOTAL_GPIO 8
20
21 /* PCI-E MMIO register offsets */
22 #define PT_DIRECTION_REG   0x00
23 #define PT_INPUTDATA_REG   0x04
24 #define PT_OUTPUTDATA_REG  0x08
25 #define PT_CLOCKRATE_REG   0x0C
26 #define PT_SYNC_REG        0x28
27
28 struct pt_gpio_chip {
29         struct gpio_chip         gc;
30         void __iomem             *reg_base;
31 };
32
33 static int pt_gpio_request(struct gpio_chip *gc, unsigned offset)
34 {
35         struct pt_gpio_chip *pt_gpio = gpiochip_get_data(gc);
36         unsigned long flags;
37         u32 using_pins;
38
39         dev_dbg(gc->parent, "pt_gpio_request offset=%x\n", offset);
40
41         spin_lock_irqsave(&gc->bgpio_lock, flags);
42
43         using_pins = readl(pt_gpio->reg_base + PT_SYNC_REG);
44         if (using_pins & BIT(offset)) {
45                 dev_warn(gc->parent, "PT GPIO pin %x reconfigured\n",
46                          offset);
47                 spin_unlock_irqrestore(&gc->bgpio_lock, flags);
48                 return -EINVAL;
49         }
50
51         writel(using_pins | BIT(offset), pt_gpio->reg_base + PT_SYNC_REG);
52
53         spin_unlock_irqrestore(&gc->bgpio_lock, flags);
54
55         return 0;
56 }
57
58 static void pt_gpio_free(struct gpio_chip *gc, unsigned offset)
59 {
60         struct pt_gpio_chip *pt_gpio = gpiochip_get_data(gc);
61         unsigned long flags;
62         u32 using_pins;
63
64         spin_lock_irqsave(&gc->bgpio_lock, flags);
65
66         using_pins = readl(pt_gpio->reg_base + PT_SYNC_REG);
67         using_pins &= ~BIT(offset);
68         writel(using_pins, pt_gpio->reg_base + PT_SYNC_REG);
69
70         spin_unlock_irqrestore(&gc->bgpio_lock, flags);
71
72         dev_dbg(gc->parent, "pt_gpio_free offset=%x\n", offset);
73 }
74
75 static int pt_gpio_probe(struct platform_device *pdev)
76 {
77         struct device *dev = &pdev->dev;
78         struct acpi_device *acpi_dev;
79         acpi_handle handle = ACPI_HANDLE(dev);
80         struct pt_gpio_chip *pt_gpio;
81         struct resource *res_mem;
82         int ret = 0;
83
84         if (acpi_bus_get_device(handle, &acpi_dev)) {
85                 dev_err(dev, "PT GPIO device node not found\n");
86                 return -ENODEV;
87         }
88
89         pt_gpio = devm_kzalloc(dev, sizeof(struct pt_gpio_chip), GFP_KERNEL);
90         if (!pt_gpio)
91                 return -ENOMEM;
92
93         res_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
94         if (!res_mem) {
95                 dev_err(&pdev->dev, "Failed to get MMIO resource for PT GPIO.\n");
96                 return -EINVAL;
97         }
98         pt_gpio->reg_base = devm_ioremap_resource(dev, res_mem);
99         if (IS_ERR(pt_gpio->reg_base)) {
100                 dev_err(&pdev->dev, "Failed to map MMIO resource for PT GPIO.\n");
101                 return PTR_ERR(pt_gpio->reg_base);
102         }
103
104         ret = bgpio_init(&pt_gpio->gc, dev, 4,
105                          pt_gpio->reg_base + PT_INPUTDATA_REG,
106                          pt_gpio->reg_base + PT_OUTPUTDATA_REG, NULL,
107                          pt_gpio->reg_base + PT_DIRECTION_REG, NULL,
108                          BGPIOF_READ_OUTPUT_REG_SET);
109         if (ret) {
110                 dev_err(&pdev->dev, "bgpio_init failed\n");
111                 return ret;
112         }
113
114         pt_gpio->gc.owner            = THIS_MODULE;
115         pt_gpio->gc.request          = pt_gpio_request;
116         pt_gpio->gc.free             = pt_gpio_free;
117         pt_gpio->gc.ngpio            = PT_TOTAL_GPIO;
118 #if defined(CONFIG_OF_GPIO)
119         pt_gpio->gc.of_node          = pdev->dev.of_node;
120 #endif
121         ret = gpiochip_add_data(&pt_gpio->gc, pt_gpio);
122         if (ret) {
123                 dev_err(&pdev->dev, "Failed to register GPIO lib\n");
124                 return ret;
125         }
126
127         platform_set_drvdata(pdev, pt_gpio);
128
129         /* initialize register setting */
130         writel(0, pt_gpio->reg_base + PT_SYNC_REG);
131         writel(0, pt_gpio->reg_base + PT_CLOCKRATE_REG);
132
133         dev_dbg(&pdev->dev, "PT GPIO driver loaded\n");
134         return ret;
135 }
136
137 static int pt_gpio_remove(struct platform_device *pdev)
138 {
139         struct pt_gpio_chip *pt_gpio = platform_get_drvdata(pdev);
140
141         gpiochip_remove(&pt_gpio->gc);
142
143         return 0;
144 }
145
146 static const struct acpi_device_id pt_gpio_acpi_match[] = {
147         { "AMDF030", 0 },
148         { "AMDIF030", 0 },
149         { },
150 };
151 MODULE_DEVICE_TABLE(acpi, pt_gpio_acpi_match);
152
153 static struct platform_driver pt_gpio_driver = {
154         .driver = {
155                 .name = "pt-gpio",
156                 .acpi_match_table = ACPI_PTR(pt_gpio_acpi_match),
157         },
158         .probe = pt_gpio_probe,
159         .remove = pt_gpio_remove,
160 };
161
162 module_platform_driver(pt_gpio_driver);
163
164 MODULE_LICENSE("GPL");
165 MODULE_AUTHOR("YD Tseng <yd_tseng@asmedia.com.tw>");
166 MODULE_DESCRIPTION("AMD Promontory GPIO Driver");