]>
Commit | Line | Data |
---|---|---|
dae5f0af | 1 | // SPDX-License-Identifier: GPL-2.0 |
e29482e8 MN |
2 | /* |
3 | * ACPI helpers for GPIO API | |
4 | * | |
5 | * Copyright (C) 2012, Intel Corporation | |
6 | * Authors: Mathias Nyman <mathias.nyman@linux.intel.com> | |
7 | * Mika Westerberg <mika.westerberg@linux.intel.com> | |
e29482e8 MN |
8 | */ |
9 | ||
10 | #include <linux/errno.h> | |
936e15dd | 11 | #include <linux/gpio/consumer.h> |
5ccff852 | 12 | #include <linux/gpio/driver.h> |
031ba28a | 13 | #include <linux/gpio/machine.h> |
e29482e8 | 14 | #include <linux/export.h> |
e29482e8 | 15 | #include <linux/acpi.h> |
0d1c28a4 | 16 | #include <linux/interrupt.h> |
473ed7be | 17 | #include <linux/mutex.h> |
354567e6 | 18 | #include <linux/pinctrl/pinctrl.h> |
e29482e8 | 19 | |
5ccff852 MW |
20 | #include "gpiolib.h" |
21 | ||
e59f5e08 HG |
22 | /** |
23 | * struct acpi_gpio_event - ACPI GPIO event handler data | |
24 | * | |
25 | * @node: list-entry of the events list of the struct acpi_gpio_chip | |
26 | * @handle: handle of ACPI method to execute when the IRQ triggers | |
27 | * @handler: irq_handler to pass to request_irq when requesting the IRQ | |
28 | * @pin: GPIO pin number on the gpio_chip | |
29 | * @irq: Linux IRQ number for the event, for request_ / free_irq | |
30 | * @irqflags: flags to pass to request_irq when requesting the IRQ | |
31 | * @irq_is_wake: If the ACPI flags indicate the IRQ is a wakeup source | |
32 | * @is_requested: True if request_irq has been done | |
33 | * @desc: gpio_desc for the GPIO pin for this event | |
34 | */ | |
4b01a14b | 35 | struct acpi_gpio_event { |
7fc7acb9 | 36 | struct list_head node; |
4b01a14b | 37 | acpi_handle handle; |
e59f5e08 | 38 | irq_handler_t handler; |
7fc7acb9 RW |
39 | unsigned int pin; |
40 | unsigned int irq; | |
e59f5e08 HG |
41 | unsigned long irqflags; |
42 | bool irq_is_wake; | |
43 | bool irq_requested; | |
e46cf32c | 44 | struct gpio_desc *desc; |
7fc7acb9 RW |
45 | }; |
46 | ||
473ed7be MW |
47 | struct acpi_gpio_connection { |
48 | struct list_head node; | |
e46cf32c | 49 | unsigned int pin; |
473ed7be MW |
50 | struct gpio_desc *desc; |
51 | }; | |
52 | ||
aa92b6f6 | 53 | struct acpi_gpio_chip { |
473ed7be MW |
54 | /* |
55 | * ACPICA requires that the first field of the context parameter | |
56 | * passed to acpi_install_address_space_handler() is large enough | |
57 | * to hold struct acpi_connection_info. | |
58 | */ | |
59 | struct acpi_connection_info conn_info; | |
60 | struct list_head conns; | |
61 | struct mutex conn_lock; | |
aa92b6f6 | 62 | struct gpio_chip *chip; |
4b01a14b | 63 | struct list_head events; |
78d3a92e | 64 | struct list_head deferred_req_irqs_list_entry; |
aa92b6f6 MW |
65 | }; |
66 | ||
78d3a92e HG |
67 | /* |
68 | * For gpiochips which call acpi_gpiochip_request_interrupts() before late_init | |
e59f5e08 | 69 | * (so builtin drivers) we register the ACPI GpioInt IRQ handlers from a |
78d3a92e HG |
70 | * late_initcall_sync handler, so that other builtin drivers can register their |
71 | * OpRegions before the event handlers can run. This list contains gpiochips | |
e59f5e08 | 72 | * for which the acpi_gpiochip_request_irqs() call has been deferred. |
78d3a92e HG |
73 | */ |
74 | static DEFINE_MUTEX(acpi_gpio_deferred_req_irqs_lock); | |
75 | static LIST_HEAD(acpi_gpio_deferred_req_irqs_list); | |
76 | static bool acpi_gpio_deferred_req_irqs_done; | |
ca876c74 | 77 | |
e29482e8 MN |
78 | static int acpi_gpiochip_find(struct gpio_chip *gc, void *data) |
79 | { | |
58383c78 | 80 | if (!gc->parent) |
e29482e8 MN |
81 | return false; |
82 | ||
58383c78 | 83 | return ACPI_HANDLE(gc->parent) == data; |
e29482e8 MN |
84 | } |
85 | ||
86 | /** | |
936e15dd | 87 | * acpi_get_gpiod() - Translate ACPI GPIO pin to GPIO descriptor usable with GPIO API |
e29482e8 MN |
88 | * @path: ACPI GPIO controller full path name, (e.g. "\\_SB.GPO1") |
89 | * @pin: ACPI GPIO pin number (0-based, controller-relative) | |
90 | * | |
f35bbf61 MW |
91 | * Return: GPIO descriptor to use with Linux generic GPIO API, or ERR_PTR |
92 | * error value. Specifically returns %-EPROBE_DEFER if the referenced GPIO | |
93 | * controller does not have gpiochip registered at the moment. This is to | |
94 | * support probe deferral. | |
e29482e8 | 95 | */ |
936e15dd | 96 | static struct gpio_desc *acpi_get_gpiod(char *path, int pin) |
e29482e8 MN |
97 | { |
98 | struct gpio_chip *chip; | |
99 | acpi_handle handle; | |
100 | acpi_status status; | |
101 | ||
102 | status = acpi_get_handle(NULL, path, &handle); | |
103 | if (ACPI_FAILURE(status)) | |
936e15dd | 104 | return ERR_PTR(-ENODEV); |
e29482e8 MN |
105 | |
106 | chip = gpiochip_find(handle, acpi_gpiochip_find); | |
107 | if (!chip) | |
f35bbf61 | 108 | return ERR_PTR(-EPROBE_DEFER); |
e29482e8 | 109 | |
03c4749d | 110 | return gpiochip_get_desc(chip, pin); |
e29482e8 | 111 | } |
0d1c28a4 | 112 | |
0d1c28a4 MN |
113 | static irqreturn_t acpi_gpio_irq_handler(int irq, void *data) |
114 | { | |
6072b9dc | 115 | struct acpi_gpio_event *event = data; |
0d1c28a4 | 116 | |
6072b9dc | 117 | acpi_evaluate_object(event->handle, NULL, NULL, NULL); |
0d1c28a4 MN |
118 | |
119 | return IRQ_HANDLED; | |
120 | } | |
121 | ||
7fc7acb9 RW |
122 | static irqreturn_t acpi_gpio_irq_handler_evt(int irq, void *data) |
123 | { | |
4b01a14b | 124 | struct acpi_gpio_event *event = data; |
7fc7acb9 | 125 | |
4b01a14b | 126 | acpi_execute_simple_method(event->handle, NULL, event->pin); |
7fc7acb9 RW |
127 | |
128 | return IRQ_HANDLED; | |
129 | } | |
130 | ||
aa92b6f6 | 131 | static void acpi_gpio_chip_dh(acpi_handle handle, void *data) |
7fc7acb9 RW |
132 | { |
133 | /* The address of this function is used as a key. */ | |
134 | } | |
135 | ||
25e3ef89 AS |
136 | bool acpi_gpio_get_irq_resource(struct acpi_resource *ares, |
137 | struct acpi_resource_gpio **agpio) | |
138 | { | |
139 | struct acpi_resource_gpio *gpio; | |
140 | ||
141 | if (ares->type != ACPI_RESOURCE_TYPE_GPIO) | |
142 | return false; | |
143 | ||
144 | gpio = &ares->data.gpio; | |
145 | if (gpio->connection_type != ACPI_RESOURCE_GPIO_TYPE_INT) | |
146 | return false; | |
147 | ||
148 | *agpio = gpio; | |
149 | return true; | |
150 | } | |
151 | EXPORT_SYMBOL_GPL(acpi_gpio_get_irq_resource); | |
152 | ||
e59f5e08 HG |
153 | static void acpi_gpiochip_request_irq(struct acpi_gpio_chip *acpi_gpio, |
154 | struct acpi_gpio_event *event) | |
155 | { | |
156 | int ret, value; | |
157 | ||
158 | ret = request_threaded_irq(event->irq, NULL, event->handler, | |
159 | event->irqflags, "ACPI:Event", event); | |
160 | if (ret) { | |
161 | dev_err(acpi_gpio->chip->parent, | |
162 | "Failed to setup interrupt handler for %d\n", | |
163 | event->irq); | |
164 | return; | |
165 | } | |
166 | ||
167 | if (event->irq_is_wake) | |
168 | enable_irq_wake(event->irq); | |
169 | ||
170 | event->irq_requested = true; | |
171 | ||
172 | /* Make sure we trigger the initial state of edge-triggered IRQs */ | |
173 | value = gpiod_get_raw_value_cansleep(event->desc); | |
174 | if (((event->irqflags & IRQF_TRIGGER_RISING) && value == 1) || | |
175 | ((event->irqflags & IRQF_TRIGGER_FALLING) && value == 0)) | |
176 | event->handler(event->irq, event); | |
177 | } | |
178 | ||
179 | static void acpi_gpiochip_request_irqs(struct acpi_gpio_chip *acpi_gpio) | |
180 | { | |
181 | struct acpi_gpio_event *event; | |
182 | ||
183 | list_for_each_entry(event, &acpi_gpio->events, node) | |
184 | acpi_gpiochip_request_irq(acpi_gpio, event); | |
185 | } | |
186 | ||
187 | static acpi_status acpi_gpiochip_alloc_event(struct acpi_resource *ares, | |
188 | void *context) | |
0d1c28a4 | 189 | { |
6072b9dc | 190 | struct acpi_gpio_chip *acpi_gpio = context; |
aa92b6f6 | 191 | struct gpio_chip *chip = acpi_gpio->chip; |
6072b9dc | 192 | struct acpi_resource_gpio *agpio; |
7fc7acb9 | 193 | acpi_handle handle, evt_handle; |
6072b9dc MW |
194 | struct acpi_gpio_event *event; |
195 | irq_handler_t handler = NULL; | |
196 | struct gpio_desc *desc; | |
e59f5e08 | 197 | int ret, pin, irq; |
0d1c28a4 | 198 | |
25e3ef89 | 199 | if (!acpi_gpio_get_irq_resource(ares, &agpio)) |
6072b9dc | 200 | return AE_OK; |
0d1c28a4 | 201 | |
58383c78 | 202 | handle = ACPI_HANDLE(chip->parent); |
6072b9dc MW |
203 | pin = agpio->pin_table[0]; |
204 | ||
205 | if (pin <= 255) { | |
206 | char ev_name[5]; | |
e40a3ae1 | 207 | sprintf(ev_name, "_%c%02hhX", |
6072b9dc MW |
208 | agpio->triggering == ACPI_EDGE_SENSITIVE ? 'E' : 'L', |
209 | pin); | |
210 | if (ACPI_SUCCESS(acpi_get_handle(handle, ev_name, &evt_handle))) | |
211 | handler = acpi_gpio_irq_handler; | |
212 | } | |
213 | if (!handler) { | |
214 | if (ACPI_SUCCESS(acpi_get_handle(handle, "_EVT", &evt_handle))) | |
215 | handler = acpi_gpio_irq_handler_evt; | |
216 | } | |
217 | if (!handler) | |
c06632ea | 218 | return AE_OK; |
0d1c28a4 | 219 | |
21abf103 | 220 | desc = gpiochip_request_own_desc(chip, pin, "ACPI:Event", 0); |
6072b9dc | 221 | if (IS_ERR(desc)) { |
58383c78 | 222 | dev_err(chip->parent, "Failed to request GPIO\n"); |
6072b9dc MW |
223 | return AE_ERROR; |
224 | } | |
0d1c28a4 | 225 | |
6072b9dc | 226 | gpiod_direction_input(desc); |
0d1c28a4 | 227 | |
e3a2e878 | 228 | ret = gpiochip_lock_as_irq(chip, pin); |
6072b9dc | 229 | if (ret) { |
58383c78 | 230 | dev_err(chip->parent, "Failed to lock GPIO as interrupt\n"); |
6072b9dc MW |
231 | goto fail_free_desc; |
232 | } | |
0d1c28a4 | 233 | |
6072b9dc MW |
234 | irq = gpiod_to_irq(desc); |
235 | if (irq < 0) { | |
58383c78 | 236 | dev_err(chip->parent, "Failed to translate GPIO to IRQ\n"); |
6072b9dc MW |
237 | goto fail_unlock_irq; |
238 | } | |
7fc7acb9 | 239 | |
e59f5e08 HG |
240 | event = kzalloc(sizeof(*event), GFP_KERNEL); |
241 | if (!event) | |
242 | goto fail_unlock_irq; | |
243 | ||
244 | event->irqflags = IRQF_ONESHOT; | |
6072b9dc MW |
245 | if (agpio->triggering == ACPI_LEVEL_SENSITIVE) { |
246 | if (agpio->polarity == ACPI_ACTIVE_HIGH) | |
e59f5e08 | 247 | event->irqflags |= IRQF_TRIGGER_HIGH; |
6072b9dc | 248 | else |
e59f5e08 | 249 | event->irqflags |= IRQF_TRIGGER_LOW; |
6072b9dc MW |
250 | } else { |
251 | switch (agpio->polarity) { | |
252 | case ACPI_ACTIVE_HIGH: | |
e59f5e08 | 253 | event->irqflags |= IRQF_TRIGGER_RISING; |
6072b9dc MW |
254 | break; |
255 | case ACPI_ACTIVE_LOW: | |
e59f5e08 | 256 | event->irqflags |= IRQF_TRIGGER_FALLING; |
6072b9dc MW |
257 | break; |
258 | default: | |
e59f5e08 HG |
259 | event->irqflags |= IRQF_TRIGGER_RISING | |
260 | IRQF_TRIGGER_FALLING; | |
6072b9dc | 261 | break; |
7fc7acb9 | 262 | } |
6072b9dc | 263 | } |
aa92b6f6 | 264 | |
6072b9dc | 265 | event->handle = evt_handle; |
e59f5e08 | 266 | event->handler = handler; |
6072b9dc | 267 | event->irq = irq; |
e59f5e08 | 268 | event->irq_is_wake = agpio->wake_capable == ACPI_WAKE_CAPABLE; |
6072b9dc | 269 | event->pin = pin; |
e46cf32c | 270 | event->desc = desc; |
7fc7acb9 | 271 | |
6072b9dc | 272 | list_add_tail(&event->node, &acpi_gpio->events); |
ca876c74 | 273 | |
6072b9dc MW |
274 | return AE_OK; |
275 | ||
6072b9dc | 276 | fail_unlock_irq: |
e3a2e878 | 277 | gpiochip_unlock_as_irq(chip, pin); |
6072b9dc MW |
278 | fail_free_desc: |
279 | gpiochip_free_own_desc(desc); | |
280 | ||
281 | return AE_ERROR; | |
0d1c28a4 | 282 | } |
7fc7acb9 | 283 | |
70b53411 | 284 | /** |
6072b9dc | 285 | * acpi_gpiochip_request_interrupts() - Register isr for gpio chip ACPI events |
afa82fab | 286 | * @chip: GPIO chip |
70b53411 | 287 | * |
6072b9dc MW |
288 | * ACPI5 platforms can use GPIO signaled ACPI events. These GPIO interrupts are |
289 | * handled by ACPI event methods which need to be called from the GPIO | |
290 | * chip's interrupt handler. acpi_gpiochip_request_interrupts finds out which | |
291 | * gpio pins have acpi event methods and assigns interrupt handlers that calls | |
292 | * the acpi event methods for those pins. | |
293 | */ | |
afa82fab | 294 | void acpi_gpiochip_request_interrupts(struct gpio_chip *chip) |
6072b9dc | 295 | { |
afa82fab MW |
296 | struct acpi_gpio_chip *acpi_gpio; |
297 | acpi_handle handle; | |
298 | acpi_status status; | |
78d3a92e | 299 | bool defer; |
afa82fab | 300 | |
58383c78 | 301 | if (!chip->parent || !chip->to_irq) |
afa82fab | 302 | return; |
6072b9dc | 303 | |
58383c78 | 304 | handle = ACPI_HANDLE(chip->parent); |
afa82fab MW |
305 | if (!handle) |
306 | return; | |
307 | ||
308 | status = acpi_get_data(handle, acpi_gpio_chip_dh, (void **)&acpi_gpio); | |
309 | if (ACPI_FAILURE(status)) | |
6072b9dc MW |
310 | return; |
311 | ||
e59f5e08 HG |
312 | acpi_walk_resources(handle, "_AEI", |
313 | acpi_gpiochip_alloc_event, acpi_gpio); | |
314 | ||
78d3a92e HG |
315 | mutex_lock(&acpi_gpio_deferred_req_irqs_lock); |
316 | defer = !acpi_gpio_deferred_req_irqs_done; | |
317 | if (defer) | |
318 | list_add(&acpi_gpio->deferred_req_irqs_list_entry, | |
319 | &acpi_gpio_deferred_req_irqs_list); | |
320 | mutex_unlock(&acpi_gpio_deferred_req_irqs_lock); | |
321 | ||
322 | if (defer) | |
323 | return; | |
324 | ||
e59f5e08 | 325 | acpi_gpiochip_request_irqs(acpi_gpio); |
6072b9dc | 326 | } |
2b528fff | 327 | EXPORT_SYMBOL_GPL(acpi_gpiochip_request_interrupts); |
6072b9dc MW |
328 | |
329 | /** | |
330 | * acpi_gpiochip_free_interrupts() - Free GPIO ACPI event interrupts. | |
afa82fab | 331 | * @chip: GPIO chip |
70b53411 | 332 | * |
6072b9dc MW |
333 | * Free interrupts associated with GPIO ACPI event method for the given |
334 | * GPIO chip. | |
70b53411 | 335 | */ |
afa82fab | 336 | void acpi_gpiochip_free_interrupts(struct gpio_chip *chip) |
70b53411 | 337 | { |
afa82fab | 338 | struct acpi_gpio_chip *acpi_gpio; |
4b01a14b | 339 | struct acpi_gpio_event *event, *ep; |
afa82fab MW |
340 | acpi_handle handle; |
341 | acpi_status status; | |
342 | ||
58383c78 | 343 | if (!chip->parent || !chip->to_irq) |
afa82fab | 344 | return; |
70b53411 | 345 | |
58383c78 | 346 | handle = ACPI_HANDLE(chip->parent); |
afa82fab MW |
347 | if (!handle) |
348 | return; | |
349 | ||
350 | status = acpi_get_data(handle, acpi_gpio_chip_dh, (void **)&acpi_gpio); | |
351 | if (ACPI_FAILURE(status)) | |
70b53411 MW |
352 | return; |
353 | ||
78d3a92e HG |
354 | mutex_lock(&acpi_gpio_deferred_req_irqs_lock); |
355 | if (!list_empty(&acpi_gpio->deferred_req_irqs_list_entry)) | |
356 | list_del_init(&acpi_gpio->deferred_req_irqs_list_entry); | |
357 | mutex_unlock(&acpi_gpio_deferred_req_irqs_lock); | |
358 | ||
4b01a14b | 359 | list_for_each_entry_safe_reverse(event, ep, &acpi_gpio->events, node) { |
e59f5e08 HG |
360 | if (event->irq_requested) { |
361 | if (event->irq_is_wake) | |
362 | disable_irq_wake(event->irq); | |
363 | ||
364 | free_irq(event->irq, event); | |
365 | } | |
8a146fbe | 366 | |
e3a2e878 | 367 | gpiochip_unlock_as_irq(chip, event->pin); |
86252329 | 368 | gpiochip_free_own_desc(event->desc); |
4b01a14b MW |
369 | list_del(&event->node); |
370 | kfree(event); | |
70b53411 | 371 | } |
70b53411 | 372 | } |
2b528fff | 373 | EXPORT_SYMBOL_GPL(acpi_gpiochip_free_interrupts); |
70b53411 | 374 | |
f028d524 RW |
375 | int acpi_dev_add_driver_gpios(struct acpi_device *adev, |
376 | const struct acpi_gpio_mapping *gpios) | |
377 | { | |
378 | if (adev && gpios) { | |
379 | adev->driver_gpios = gpios; | |
380 | return 0; | |
381 | } | |
382 | return -EINVAL; | |
383 | } | |
384 | EXPORT_SYMBOL_GPL(acpi_dev_add_driver_gpios); | |
385 | ||
85c73d50 AS |
386 | static void devm_acpi_dev_release_driver_gpios(struct device *dev, void *res) |
387 | { | |
388 | acpi_dev_remove_driver_gpios(ACPI_COMPANION(dev)); | |
389 | } | |
390 | ||
391 | int devm_acpi_dev_add_driver_gpios(struct device *dev, | |
392 | const struct acpi_gpio_mapping *gpios) | |
393 | { | |
394 | void *res; | |
395 | int ret; | |
396 | ||
397 | res = devres_alloc(devm_acpi_dev_release_driver_gpios, 0, GFP_KERNEL); | |
398 | if (!res) | |
399 | return -ENOMEM; | |
400 | ||
401 | ret = acpi_dev_add_driver_gpios(ACPI_COMPANION(dev), gpios); | |
402 | if (ret) { | |
403 | devres_free(res); | |
404 | return ret; | |
405 | } | |
406 | devres_add(dev, res); | |
407 | return 0; | |
408 | } | |
409 | EXPORT_SYMBOL_GPL(devm_acpi_dev_add_driver_gpios); | |
410 | ||
411 | void devm_acpi_dev_remove_driver_gpios(struct device *dev) | |
412 | { | |
413 | WARN_ON(devres_release(dev, devm_acpi_dev_release_driver_gpios, NULL, NULL)); | |
414 | } | |
415 | EXPORT_SYMBOL_GPL(devm_acpi_dev_remove_driver_gpios); | |
416 | ||
f028d524 RW |
417 | static bool acpi_get_driver_gpio_data(struct acpi_device *adev, |
418 | const char *name, int index, | |
977d5ad3 | 419 | struct fwnode_reference_args *args, |
ce0929d2 | 420 | unsigned int *quirks) |
f028d524 RW |
421 | { |
422 | const struct acpi_gpio_mapping *gm; | |
423 | ||
424 | if (!adev->driver_gpios) | |
425 | return false; | |
426 | ||
427 | for (gm = adev->driver_gpios; gm->name; gm++) | |
428 | if (!strcmp(name, gm->name) && gm->data && index < gm->size) { | |
429 | const struct acpi_gpio_params *par = gm->data + index; | |
430 | ||
977d5ad3 | 431 | args->fwnode = acpi_fwnode_handle(adev); |
f028d524 RW |
432 | args->args[0] = par->crs_entry_index; |
433 | args->args[1] = par->line_index; | |
434 | args->args[2] = par->active_low; | |
435 | args->nargs = 3; | |
ce0929d2 AS |
436 | |
437 | *quirks = gm->quirks; | |
f028d524 RW |
438 | return true; |
439 | } | |
440 | ||
441 | return false; | |
442 | } | |
443 | ||
2eca25af AS |
444 | static enum gpiod_flags |
445 | acpi_gpio_to_gpiod_flags(const struct acpi_resource_gpio *agpio) | |
446 | { | |
447 | bool pull_up = agpio->pin_config == ACPI_PIN_CONFIG_PULLUP; | |
448 | ||
449 | switch (agpio->io_restriction) { | |
450 | case ACPI_IO_RESTRICT_INPUT: | |
451 | return GPIOD_IN; | |
452 | case ACPI_IO_RESTRICT_OUTPUT: | |
453 | /* | |
454 | * ACPI GPIO resources don't contain an initial value for the | |
455 | * GPIO. Therefore we deduce that value from the pull field | |
456 | * instead. If the pin is pulled up we assume default to be | |
457 | * high, otherwise low. | |
458 | */ | |
459 | return pull_up ? GPIOD_OUT_HIGH : GPIOD_OUT_LOW; | |
460 | default: | |
461 | /* | |
462 | * Assume that the BIOS has configured the direction and pull | |
463 | * accordingly. | |
464 | */ | |
465 | return GPIOD_ASIS; | |
466 | } | |
467 | } | |
468 | ||
5c34b6c1 AS |
469 | static int |
470 | __acpi_gpio_update_gpiod_flags(enum gpiod_flags *flags, enum gpiod_flags update) | |
a31f5c3a AS |
471 | { |
472 | int ret = 0; | |
473 | ||
474 | /* | |
475 | * Check if the BIOS has IoRestriction with explicitly set direction | |
476 | * and update @flags accordingly. Otherwise use whatever caller asked | |
477 | * for. | |
478 | */ | |
479 | if (update & GPIOD_FLAGS_BIT_DIR_SET) { | |
480 | enum gpiod_flags diff = *flags ^ update; | |
481 | ||
482 | /* | |
483 | * Check if caller supplied incompatible GPIO initialization | |
484 | * flags. | |
485 | * | |
486 | * Return %-EINVAL to notify that firmware has different | |
487 | * settings and we are going to use them. | |
488 | */ | |
489 | if (((*flags & GPIOD_FLAGS_BIT_DIR_SET) && (diff & GPIOD_FLAGS_BIT_DIR_OUT)) || | |
490 | ((*flags & GPIOD_FLAGS_BIT_DIR_OUT) && (diff & GPIOD_FLAGS_BIT_DIR_VAL))) | |
491 | ret = -EINVAL; | |
492 | *flags = update; | |
493 | } | |
494 | return ret; | |
495 | } | |
496 | ||
5c34b6c1 AS |
497 | int |
498 | acpi_gpio_update_gpiod_flags(enum gpiod_flags *flags, struct acpi_gpio_info *info) | |
499 | { | |
500 | struct device *dev = &info->adev->dev; | |
1b2ca32a | 501 | enum gpiod_flags old = *flags; |
5c34b6c1 AS |
502 | int ret; |
503 | ||
1b2ca32a AS |
504 | ret = __acpi_gpio_update_gpiod_flags(&old, info->flags); |
505 | if (info->quirks & ACPI_GPIO_QUIRK_NO_IO_RESTRICTION) { | |
506 | if (ret) | |
507 | dev_warn(dev, FW_BUG "GPIO not in correct mode, fixing\n"); | |
508 | } else { | |
509 | if (ret) | |
510 | dev_dbg(dev, "Override GPIO initialization flags\n"); | |
511 | *flags = old; | |
512 | } | |
5c34b6c1 AS |
513 | |
514 | return ret; | |
515 | } | |
516 | ||
12028d2d MW |
517 | struct acpi_gpio_lookup { |
518 | struct acpi_gpio_info info; | |
519 | int index; | |
0d9a693c | 520 | int pin_index; |
d079524a | 521 | bool active_low; |
936e15dd | 522 | struct gpio_desc *desc; |
12028d2d MW |
523 | int n; |
524 | }; | |
525 | ||
031ba28a | 526 | static int acpi_populate_gpio_lookup(struct acpi_resource *ares, void *data) |
12028d2d MW |
527 | { |
528 | struct acpi_gpio_lookup *lookup = data; | |
529 | ||
530 | if (ares->type != ACPI_RESOURCE_TYPE_GPIO) | |
531 | return 1; | |
532 | ||
936e15dd | 533 | if (lookup->n++ == lookup->index && !lookup->desc) { |
12028d2d | 534 | const struct acpi_resource_gpio *agpio = &ares->data.gpio; |
0d9a693c MW |
535 | int pin_index = lookup->pin_index; |
536 | ||
537 | if (pin_index >= agpio->pin_table_length) | |
538 | return 1; | |
12028d2d | 539 | |
936e15dd | 540 | lookup->desc = acpi_get_gpiod(agpio->resource_source.string_ptr, |
0d9a693c | 541 | agpio->pin_table[pin_index]); |
12028d2d MW |
542 | lookup->info.gpioint = |
543 | agpio->connection_type == ACPI_RESOURCE_GPIO_TYPE_INT; | |
0d9a693c MW |
544 | |
545 | /* | |
e567c35f AS |
546 | * Polarity and triggering are only specified for GpioInt |
547 | * resource. | |
52044723 CR |
548 | * Note: we expect here: |
549 | * - ACPI_ACTIVE_LOW == GPIO_ACTIVE_LOW | |
550 | * - ACPI_ACTIVE_HIGH == GPIO_ACTIVE_HIGH | |
0d9a693c | 551 | */ |
52044723 | 552 | if (lookup->info.gpioint) { |
a31f5c3a | 553 | lookup->info.flags = GPIOD_IN; |
52044723 CR |
554 | lookup->info.polarity = agpio->polarity; |
555 | lookup->info.triggering = agpio->triggering; | |
a31f5c3a AS |
556 | } else { |
557 | lookup->info.flags = acpi_gpio_to_gpiod_flags(agpio); | |
f67a6c11 | 558 | lookup->info.polarity = lookup->active_low; |
52044723 | 559 | } |
12028d2d MW |
560 | } |
561 | ||
562 | return 1; | |
563 | } | |
564 | ||
d079524a RW |
565 | static int acpi_gpio_resource_lookup(struct acpi_gpio_lookup *lookup, |
566 | struct acpi_gpio_info *info) | |
567 | { | |
5870cff4 | 568 | struct acpi_device *adev = lookup->info.adev; |
d079524a RW |
569 | struct list_head res_list; |
570 | int ret; | |
571 | ||
572 | INIT_LIST_HEAD(&res_list); | |
573 | ||
5870cff4 | 574 | ret = acpi_dev_get_resources(adev, &res_list, |
031ba28a | 575 | acpi_populate_gpio_lookup, |
d079524a RW |
576 | lookup); |
577 | if (ret < 0) | |
578 | return ret; | |
579 | ||
580 | acpi_dev_free_resource_list(&res_list); | |
581 | ||
582 | if (!lookup->desc) | |
583 | return -ENOENT; | |
584 | ||
f67a6c11 | 585 | if (info) |
d079524a | 586 | *info = lookup->info; |
d079524a RW |
587 | return 0; |
588 | } | |
589 | ||
504a3374 | 590 | static int acpi_gpio_property_lookup(struct fwnode_handle *fwnode, |
d079524a RW |
591 | const char *propname, int index, |
592 | struct acpi_gpio_lookup *lookup) | |
593 | { | |
977d5ad3 | 594 | struct fwnode_reference_args args; |
ce0929d2 | 595 | unsigned int quirks = 0; |
d079524a RW |
596 | int ret; |
597 | ||
598 | memset(&args, 0, sizeof(args)); | |
6f7194a1 MW |
599 | ret = __acpi_node_get_property_reference(fwnode, propname, index, 3, |
600 | &args); | |
504a3374 RW |
601 | if (ret) { |
602 | struct acpi_device *adev = to_acpi_device_node(fwnode); | |
d079524a | 603 | |
504a3374 RW |
604 | if (!adev) |
605 | return ret; | |
606 | ||
ce0929d2 AS |
607 | if (!acpi_get_driver_gpio_data(adev, propname, index, &args, |
608 | &quirks)) | |
504a3374 RW |
609 | return ret; |
610 | } | |
d079524a RW |
611 | /* |
612 | * The property was found and resolved, so need to lookup the GPIO based | |
613 | * on returned args. | |
614 | */ | |
977d5ad3 SA |
615 | if (!to_acpi_device_node(args.fwnode)) |
616 | return -EINVAL; | |
6f7194a1 MW |
617 | if (args.nargs != 3) |
618 | return -EPROTO; | |
619 | ||
620 | lookup->index = args.args[0]; | |
621 | lookup->pin_index = args.args[1]; | |
622 | lookup->active_low = !!args.args[2]; | |
623 | ||
977d5ad3 | 624 | lookup->info.adev = to_acpi_device_node(args.fwnode); |
ce0929d2 | 625 | lookup->info.quirks = quirks; |
977d5ad3 | 626 | |
d079524a RW |
627 | return 0; |
628 | } | |
629 | ||
12028d2d | 630 | /** |
936e15dd | 631 | * acpi_get_gpiod_by_index() - get a GPIO descriptor from device resources |
0d9a693c MW |
632 | * @adev: pointer to a ACPI device to get GPIO from |
633 | * @propname: Property name of the GPIO (optional) | |
12028d2d MW |
634 | * @index: index of GpioIo/GpioInt resource (starting from %0) |
635 | * @info: info pointer to fill in (optional) | |
636 | * | |
0d9a693c | 637 | * Function goes through ACPI resources for @adev and based on @index looks |
936e15dd | 638 | * up a GpioIo/GpioInt resource, translates it to the Linux GPIO descriptor, |
12028d2d MW |
639 | * and returns it. @index matches GpioIo/GpioInt resources only so if there |
640 | * are total %3 GPIO resources, the index goes from %0 to %2. | |
641 | * | |
0d9a693c MW |
642 | * If @propname is specified the GPIO is looked using device property. In |
643 | * that case @index is used to select the GPIO entry in the property value | |
644 | * (in case of multiple). | |
645 | * | |
936e15dd | 646 | * If the GPIO cannot be translated or there is an error an ERR_PTR is |
12028d2d MW |
647 | * returned. |
648 | * | |
649 | * Note: if the GPIO resource has multiple entries in the pin list, this | |
650 | * function only returns the first. | |
651 | */ | |
031ba28a | 652 | static struct gpio_desc *acpi_get_gpiod_by_index(struct acpi_device *adev, |
0d9a693c | 653 | const char *propname, int index, |
936e15dd | 654 | struct acpi_gpio_info *info) |
12028d2d MW |
655 | { |
656 | struct acpi_gpio_lookup lookup; | |
12028d2d MW |
657 | int ret; |
658 | ||
0d9a693c | 659 | if (!adev) |
936e15dd | 660 | return ERR_PTR(-ENODEV); |
12028d2d MW |
661 | |
662 | memset(&lookup, 0, sizeof(lookup)); | |
663 | lookup.index = index; | |
12028d2d | 664 | |
0d9a693c | 665 | if (propname) { |
0d9a693c MW |
666 | dev_dbg(&adev->dev, "GPIO: looking up %s\n", propname); |
667 | ||
504a3374 RW |
668 | ret = acpi_gpio_property_lookup(acpi_fwnode_handle(adev), |
669 | propname, index, &lookup); | |
d079524a RW |
670 | if (ret) |
671 | return ERR_PTR(ret); | |
0d9a693c | 672 | |
d079524a | 673 | dev_dbg(&adev->dev, "GPIO: _DSD returned %s %d %d %u\n", |
5870cff4 | 674 | dev_name(&lookup.info.adev->dev), lookup.index, |
d079524a | 675 | lookup.pin_index, lookup.active_low); |
0d9a693c MW |
676 | } else { |
677 | dev_dbg(&adev->dev, "GPIO: looking up %d in _CRS\n", index); | |
5870cff4 | 678 | lookup.info.adev = adev; |
0d9a693c MW |
679 | } |
680 | ||
d079524a RW |
681 | ret = acpi_gpio_resource_lookup(&lookup, info); |
682 | return ret ? ERR_PTR(ret) : lookup.desc; | |
12028d2d | 683 | } |
664e3e5a | 684 | |
031ba28a LW |
685 | struct gpio_desc *acpi_find_gpio(struct device *dev, |
686 | const char *con_id, | |
687 | unsigned int idx, | |
a31f5c3a | 688 | enum gpiod_flags *dflags, |
031ba28a LW |
689 | enum gpio_lookup_flags *lookupflags) |
690 | { | |
691 | struct acpi_device *adev = ACPI_COMPANION(dev); | |
692 | struct acpi_gpio_info info; | |
693 | struct gpio_desc *desc; | |
694 | char propname[32]; | |
695 | int i; | |
696 | ||
697 | /* Try first from _DSD */ | |
698 | for (i = 0; i < ARRAY_SIZE(gpio_suffixes); i++) { | |
9e66504a | 699 | if (con_id) { |
031ba28a LW |
700 | snprintf(propname, sizeof(propname), "%s-%s", |
701 | con_id, gpio_suffixes[i]); | |
702 | } else { | |
703 | snprintf(propname, sizeof(propname), "%s", | |
704 | gpio_suffixes[i]); | |
705 | } | |
706 | ||
707 | desc = acpi_get_gpiod_by_index(adev, propname, idx, &info); | |
693bdaa1 | 708 | if (!IS_ERR(desc)) |
031ba28a | 709 | break; |
693bdaa1 DT |
710 | if (PTR_ERR(desc) == -EPROBE_DEFER) |
711 | return ERR_CAST(desc); | |
031ba28a LW |
712 | } |
713 | ||
714 | /* Then from plain _CRS GPIOs */ | |
715 | if (IS_ERR(desc)) { | |
716 | if (!acpi_can_fallback_to_crs(adev, con_id)) | |
717 | return ERR_PTR(-ENOENT); | |
718 | ||
719 | desc = acpi_get_gpiod_by_index(adev, NULL, idx, &info); | |
720 | if (IS_ERR(desc)) | |
721 | return desc; | |
fe06b56c | 722 | } |
031ba28a | 723 | |
fe06b56c | 724 | if (info.gpioint && |
a31f5c3a | 725 | (*dflags == GPIOD_OUT_LOW || *dflags == GPIOD_OUT_HIGH)) { |
fe06b56c AS |
726 | dev_dbg(dev, "refusing GpioInt() entry when doing GPIOD_OUT_* lookup\n"); |
727 | return ERR_PTR(-ENOENT); | |
031ba28a LW |
728 | } |
729 | ||
730 | if (info.polarity == GPIO_ACTIVE_LOW) | |
731 | *lookupflags |= GPIO_ACTIVE_LOW; | |
732 | ||
5c34b6c1 | 733 | acpi_gpio_update_gpiod_flags(dflags, &info); |
031ba28a LW |
734 | return desc; |
735 | } | |
736 | ||
504a3374 RW |
737 | /** |
738 | * acpi_node_get_gpiod() - get a GPIO descriptor from ACPI resources | |
739 | * @fwnode: pointer to an ACPI firmware node to get the GPIO information from | |
740 | * @propname: Property name of the GPIO | |
741 | * @index: index of GpioIo/GpioInt resource (starting from %0) | |
742 | * @info: info pointer to fill in (optional) | |
743 | * | |
744 | * If @fwnode is an ACPI device object, call %acpi_get_gpiod_by_index() for it. | |
745 | * Otherwise (ie. it is a data-only non-device object), use the property-based | |
746 | * GPIO lookup to get to the GPIO resource with the relevant information and use | |
747 | * that to obtain the GPIO descriptor to return. | |
748 | */ | |
749 | struct gpio_desc *acpi_node_get_gpiod(struct fwnode_handle *fwnode, | |
750 | const char *propname, int index, | |
751 | struct acpi_gpio_info *info) | |
752 | { | |
753 | struct acpi_gpio_lookup lookup; | |
754 | struct acpi_device *adev; | |
755 | int ret; | |
12028d2d | 756 | |
504a3374 RW |
757 | adev = to_acpi_device_node(fwnode); |
758 | if (adev) | |
759 | return acpi_get_gpiod_by_index(adev, propname, index, info); | |
12028d2d | 760 | |
504a3374 RW |
761 | if (!is_acpi_data_node(fwnode)) |
762 | return ERR_PTR(-ENODEV); | |
763 | ||
764 | if (!propname) | |
765 | return ERR_PTR(-EINVAL); | |
766 | ||
767 | memset(&lookup, 0, sizeof(lookup)); | |
768 | lookup.index = index; | |
769 | ||
770 | ret = acpi_gpio_property_lookup(fwnode, propname, index, &lookup); | |
771 | if (ret) | |
772 | return ERR_PTR(ret); | |
12028d2d | 773 | |
504a3374 RW |
774 | ret = acpi_gpio_resource_lookup(&lookup, info); |
775 | return ret ? ERR_PTR(ret) : lookup.desc; | |
12028d2d | 776 | } |
664e3e5a | 777 | |
c884fbd4 MW |
778 | /** |
779 | * acpi_dev_gpio_irq_get() - Find GpioInt and translate it to Linux IRQ number | |
780 | * @adev: pointer to a ACPI device to get IRQ from | |
781 | * @index: index of GpioInt resource (starting from %0) | |
782 | * | |
783 | * If the device has one or more GpioInt resources, this function can be | |
784 | * used to translate from the GPIO offset in the resource to the Linux IRQ | |
785 | * number. | |
786 | * | |
a31f5c3a AS |
787 | * The function is idempotent, though each time it runs it will configure GPIO |
788 | * pin direction according to the flags in GpioInt resource. | |
789 | * | |
db05c7ef | 790 | * Return: Linux IRQ number (> %0) on success, negative errno on failure. |
c884fbd4 MW |
791 | */ |
792 | int acpi_dev_gpio_irq_get(struct acpi_device *adev, int index) | |
793 | { | |
794 | int idx, i; | |
52044723 | 795 | unsigned int irq_flags; |
a31f5c3a | 796 | int ret; |
c884fbd4 MW |
797 | |
798 | for (i = 0, idx = 0; idx <= index; i++) { | |
799 | struct acpi_gpio_info info; | |
800 | struct gpio_desc *desc; | |
801 | ||
802 | desc = acpi_get_gpiod_by_index(adev, NULL, i, &info); | |
6798d727 HG |
803 | |
804 | /* Ignore -EPROBE_DEFER, it only matters if idx matches */ | |
805 | if (IS_ERR(desc) && PTR_ERR(desc) != -EPROBE_DEFER) | |
806 | return PTR_ERR(desc); | |
807 | ||
52044723 | 808 | if (info.gpioint && idx++ == index) { |
a31f5c3a | 809 | char label[32]; |
6798d727 | 810 | int irq; |
52044723 | 811 | |
6798d727 HG |
812 | if (IS_ERR(desc)) |
813 | return PTR_ERR(desc); | |
52044723 | 814 | |
6798d727 | 815 | irq = gpiod_to_irq(desc); |
52044723 CR |
816 | if (irq < 0) |
817 | return irq; | |
818 | ||
a31f5c3a AS |
819 | snprintf(label, sizeof(label), "GpioInt() %d", index); |
820 | ret = gpiod_configure_flags(desc, label, 0, info.flags); | |
821 | if (ret < 0) | |
822 | return ret; | |
823 | ||
52044723 CR |
824 | irq_flags = acpi_dev_get_irq_type(info.triggering, |
825 | info.polarity); | |
826 | ||
827 | /* Set type if specified and different than the current one */ | |
828 | if (irq_flags != IRQ_TYPE_NONE && | |
829 | irq_flags != irq_get_trigger_type(irq)) | |
830 | irq_set_irq_type(irq, irq_flags); | |
831 | ||
832 | return irq; | |
833 | } | |
834 | ||
c884fbd4 | 835 | } |
6798d727 | 836 | return -ENOENT; |
c884fbd4 MW |
837 | } |
838 | EXPORT_SYMBOL_GPL(acpi_dev_gpio_irq_get); | |
839 | ||
473ed7be MW |
840 | static acpi_status |
841 | acpi_gpio_adr_space_handler(u32 function, acpi_physical_address address, | |
842 | u32 bits, u64 *value, void *handler_context, | |
843 | void *region_context) | |
844 | { | |
845 | struct acpi_gpio_chip *achip = region_context; | |
846 | struct gpio_chip *chip = achip->chip; | |
847 | struct acpi_resource_gpio *agpio; | |
848 | struct acpi_resource *ares; | |
c15d821d | 849 | int pin_index = (int)address; |
473ed7be | 850 | acpi_status status; |
c15d821d | 851 | int length; |
473ed7be MW |
852 | int i; |
853 | ||
854 | status = acpi_buffer_to_resource(achip->conn_info.connection, | |
855 | achip->conn_info.length, &ares); | |
856 | if (ACPI_FAILURE(status)) | |
857 | return status; | |
858 | ||
859 | if (WARN_ON(ares->type != ACPI_RESOURCE_TYPE_GPIO)) { | |
860 | ACPI_FREE(ares); | |
861 | return AE_BAD_PARAMETER; | |
862 | } | |
863 | ||
864 | agpio = &ares->data.gpio; | |
473ed7be MW |
865 | |
866 | if (WARN_ON(agpio->io_restriction == ACPI_IO_RESTRICT_INPUT && | |
867 | function == ACPI_WRITE)) { | |
868 | ACPI_FREE(ares); | |
869 | return AE_BAD_PARAMETER; | |
870 | } | |
871 | ||
c15d821d SP |
872 | length = min(agpio->pin_table_length, (u16)(pin_index + bits)); |
873 | for (i = pin_index; i < length; ++i) { | |
a4811622 | 874 | int pin = agpio->pin_table[i]; |
473ed7be MW |
875 | struct acpi_gpio_connection *conn; |
876 | struct gpio_desc *desc; | |
877 | bool found; | |
878 | ||
473ed7be MW |
879 | mutex_lock(&achip->conn_lock); |
880 | ||
881 | found = false; | |
882 | list_for_each_entry(conn, &achip->conns, node) { | |
e46cf32c | 883 | if (conn->pin == pin) { |
473ed7be | 884 | found = true; |
e46cf32c | 885 | desc = conn->desc; |
473ed7be MW |
886 | break; |
887 | } | |
888 | } | |
c103a10f MW |
889 | |
890 | /* | |
891 | * The same GPIO can be shared between operation region and | |
892 | * event but only if the access here is ACPI_READ. In that | |
893 | * case we "borrow" the event GPIO instead. | |
894 | */ | |
895 | if (!found && agpio->sharable == ACPI_SHARED && | |
896 | function == ACPI_READ) { | |
897 | struct acpi_gpio_event *event; | |
898 | ||
899 | list_for_each_entry(event, &achip->events, node) { | |
900 | if (event->pin == pin) { | |
901 | desc = event->desc; | |
902 | found = true; | |
903 | break; | |
904 | } | |
905 | } | |
906 | } | |
907 | ||
473ed7be | 908 | if (!found) { |
2eca25af AS |
909 | enum gpiod_flags flags = acpi_gpio_to_gpiod_flags(agpio); |
910 | const char *label = "ACPI:OpRegion"; | |
2eca25af | 911 | |
21abf103 LW |
912 | desc = gpiochip_request_own_desc(chip, pin, label, |
913 | flags); | |
e46cf32c | 914 | if (IS_ERR(desc)) { |
473ed7be MW |
915 | status = AE_ERROR; |
916 | mutex_unlock(&achip->conn_lock); | |
917 | goto out; | |
918 | } | |
919 | ||
473ed7be MW |
920 | conn = kzalloc(sizeof(*conn), GFP_KERNEL); |
921 | if (!conn) { | |
922 | status = AE_NO_MEMORY; | |
923 | gpiochip_free_own_desc(desc); | |
924 | mutex_unlock(&achip->conn_lock); | |
925 | goto out; | |
926 | } | |
927 | ||
e46cf32c | 928 | conn->pin = pin; |
473ed7be MW |
929 | conn->desc = desc; |
930 | list_add_tail(&conn->node, &achip->conns); | |
931 | } | |
932 | ||
933 | mutex_unlock(&achip->conn_lock); | |
934 | ||
935 | if (function == ACPI_WRITE) | |
dc62b56a AL |
936 | gpiod_set_raw_value_cansleep(desc, |
937 | !!((1 << i) & *value)); | |
473ed7be | 938 | else |
dc62b56a | 939 | *value |= (u64)gpiod_get_raw_value_cansleep(desc) << i; |
473ed7be MW |
940 | } |
941 | ||
942 | out: | |
943 | ACPI_FREE(ares); | |
944 | return status; | |
945 | } | |
946 | ||
947 | static void acpi_gpiochip_request_regions(struct acpi_gpio_chip *achip) | |
948 | { | |
949 | struct gpio_chip *chip = achip->chip; | |
58383c78 | 950 | acpi_handle handle = ACPI_HANDLE(chip->parent); |
473ed7be MW |
951 | acpi_status status; |
952 | ||
953 | INIT_LIST_HEAD(&achip->conns); | |
954 | mutex_init(&achip->conn_lock); | |
955 | status = acpi_install_address_space_handler(handle, ACPI_ADR_SPACE_GPIO, | |
956 | acpi_gpio_adr_space_handler, | |
957 | NULL, achip); | |
958 | if (ACPI_FAILURE(status)) | |
58383c78 LW |
959 | dev_err(chip->parent, |
960 | "Failed to install GPIO OpRegion handler\n"); | |
473ed7be MW |
961 | } |
962 | ||
963 | static void acpi_gpiochip_free_regions(struct acpi_gpio_chip *achip) | |
964 | { | |
965 | struct gpio_chip *chip = achip->chip; | |
58383c78 | 966 | acpi_handle handle = ACPI_HANDLE(chip->parent); |
473ed7be MW |
967 | struct acpi_gpio_connection *conn, *tmp; |
968 | acpi_status status; | |
969 | ||
970 | status = acpi_remove_address_space_handler(handle, ACPI_ADR_SPACE_GPIO, | |
971 | acpi_gpio_adr_space_handler); | |
972 | if (ACPI_FAILURE(status)) { | |
58383c78 LW |
973 | dev_err(chip->parent, |
974 | "Failed to remove GPIO OpRegion handler\n"); | |
473ed7be MW |
975 | return; |
976 | } | |
977 | ||
978 | list_for_each_entry_safe_reverse(conn, tmp, &achip->conns, node) { | |
979 | gpiochip_free_own_desc(conn->desc); | |
980 | list_del(&conn->node); | |
981 | kfree(conn); | |
982 | } | |
983 | } | |
984 | ||
550a9532 WY |
985 | static struct gpio_desc *acpi_gpiochip_parse_own_gpio( |
986 | struct acpi_gpio_chip *achip, struct fwnode_handle *fwnode, | |
987 | const char **name, unsigned int *lflags, unsigned int *dflags) | |
c80f1ba7 MW |
988 | { |
989 | struct gpio_chip *chip = achip->chip; | |
990 | struct gpio_desc *desc; | |
991 | u32 gpios[2]; | |
992 | int ret; | |
993 | ||
c82064f2 AB |
994 | *lflags = 0; |
995 | *dflags = 0; | |
996 | *name = NULL; | |
997 | ||
c80f1ba7 MW |
998 | ret = fwnode_property_read_u32_array(fwnode, "gpios", gpios, |
999 | ARRAY_SIZE(gpios)); | |
1000 | if (ret < 0) | |
1001 | return ERR_PTR(ret); | |
1002 | ||
03c4749d | 1003 | desc = gpiochip_get_desc(chip, gpios[0]); |
c80f1ba7 MW |
1004 | if (IS_ERR(desc)) |
1005 | return desc; | |
1006 | ||
c80f1ba7 MW |
1007 | if (gpios[1]) |
1008 | *lflags |= GPIO_ACTIVE_LOW; | |
1009 | ||
1010 | if (fwnode_property_present(fwnode, "input")) | |
1011 | *dflags |= GPIOD_IN; | |
1012 | else if (fwnode_property_present(fwnode, "output-low")) | |
1013 | *dflags |= GPIOD_OUT_LOW; | |
1014 | else if (fwnode_property_present(fwnode, "output-high")) | |
1015 | *dflags |= GPIOD_OUT_HIGH; | |
1016 | else | |
1017 | return ERR_PTR(-EINVAL); | |
1018 | ||
1019 | fwnode_property_read_string(fwnode, "line-name", name); | |
1020 | ||
1021 | return desc; | |
1022 | } | |
1023 | ||
1024 | static void acpi_gpiochip_scan_gpios(struct acpi_gpio_chip *achip) | |
1025 | { | |
1026 | struct gpio_chip *chip = achip->chip; | |
1027 | struct fwnode_handle *fwnode; | |
1028 | ||
1029 | device_for_each_child_node(chip->parent, fwnode) { | |
1030 | unsigned int lflags, dflags; | |
1031 | struct gpio_desc *desc; | |
1032 | const char *name; | |
1033 | int ret; | |
1034 | ||
1035 | if (!fwnode_property_present(fwnode, "gpio-hog")) | |
1036 | continue; | |
1037 | ||
1038 | desc = acpi_gpiochip_parse_own_gpio(achip, fwnode, &name, | |
1039 | &lflags, &dflags); | |
1040 | if (IS_ERR(desc)) | |
1041 | continue; | |
1042 | ||
1043 | ret = gpiod_hog(desc, name, lflags, dflags); | |
1044 | if (ret) { | |
1045 | dev_err(chip->parent, "Failed to hog GPIO\n"); | |
1b6998c9 | 1046 | fwnode_handle_put(fwnode); |
c80f1ba7 MW |
1047 | return; |
1048 | } | |
1049 | } | |
1050 | } | |
1051 | ||
664e3e5a MW |
1052 | void acpi_gpiochip_add(struct gpio_chip *chip) |
1053 | { | |
aa92b6f6 MW |
1054 | struct acpi_gpio_chip *acpi_gpio; |
1055 | acpi_handle handle; | |
1056 | acpi_status status; | |
1057 | ||
58383c78 | 1058 | if (!chip || !chip->parent) |
e9595f84 MW |
1059 | return; |
1060 | ||
58383c78 | 1061 | handle = ACPI_HANDLE(chip->parent); |
aa92b6f6 MW |
1062 | if (!handle) |
1063 | return; | |
1064 | ||
1065 | acpi_gpio = kzalloc(sizeof(*acpi_gpio), GFP_KERNEL); | |
1066 | if (!acpi_gpio) { | |
58383c78 | 1067 | dev_err(chip->parent, |
aa92b6f6 MW |
1068 | "Failed to allocate memory for ACPI GPIO chip\n"); |
1069 | return; | |
1070 | } | |
1071 | ||
1072 | acpi_gpio->chip = chip; | |
c103a10f | 1073 | INIT_LIST_HEAD(&acpi_gpio->events); |
78d3a92e | 1074 | INIT_LIST_HEAD(&acpi_gpio->deferred_req_irqs_list_entry); |
aa92b6f6 MW |
1075 | |
1076 | status = acpi_attach_data(handle, acpi_gpio_chip_dh, acpi_gpio); | |
1077 | if (ACPI_FAILURE(status)) { | |
58383c78 | 1078 | dev_err(chip->parent, "Failed to attach ACPI GPIO chip\n"); |
aa92b6f6 MW |
1079 | kfree(acpi_gpio); |
1080 | return; | |
1081 | } | |
1082 | ||
4035cc15 | 1083 | if (!chip->names) |
82270335 | 1084 | devprop_gpiochip_set_names(chip, dev_fwnode(chip->parent)); |
4035cc15 | 1085 | |
473ed7be | 1086 | acpi_gpiochip_request_regions(acpi_gpio); |
c80f1ba7 | 1087 | acpi_gpiochip_scan_gpios(acpi_gpio); |
3f86a635 | 1088 | acpi_walk_dep_device_list(handle); |
664e3e5a MW |
1089 | } |
1090 | ||
1091 | void acpi_gpiochip_remove(struct gpio_chip *chip) | |
1092 | { | |
aa92b6f6 MW |
1093 | struct acpi_gpio_chip *acpi_gpio; |
1094 | acpi_handle handle; | |
1095 | acpi_status status; | |
1096 | ||
58383c78 | 1097 | if (!chip || !chip->parent) |
e9595f84 MW |
1098 | return; |
1099 | ||
58383c78 | 1100 | handle = ACPI_HANDLE(chip->parent); |
aa92b6f6 MW |
1101 | if (!handle) |
1102 | return; | |
1103 | ||
1104 | status = acpi_get_data(handle, acpi_gpio_chip_dh, (void **)&acpi_gpio); | |
1105 | if (ACPI_FAILURE(status)) { | |
58383c78 | 1106 | dev_warn(chip->parent, "Failed to retrieve ACPI GPIO chip\n"); |
aa92b6f6 MW |
1107 | return; |
1108 | } | |
1109 | ||
473ed7be | 1110 | acpi_gpiochip_free_regions(acpi_gpio); |
aa92b6f6 MW |
1111 | |
1112 | acpi_detach_data(handle, acpi_gpio_chip_dh); | |
1113 | kfree(acpi_gpio); | |
664e3e5a | 1114 | } |
66858527 | 1115 | |
6f7194a1 | 1116 | static int acpi_gpio_package_count(const union acpi_object *obj) |
66858527 RI |
1117 | { |
1118 | const union acpi_object *element = obj->package.elements; | |
1119 | const union acpi_object *end = element + obj->package.count; | |
1120 | unsigned int count = 0; | |
1121 | ||
1122 | while (element < end) { | |
6f7194a1 MW |
1123 | switch (element->type) { |
1124 | case ACPI_TYPE_LOCAL_REFERENCE: | |
1125 | element += 3; | |
1126 | /* Fallthrough */ | |
1127 | case ACPI_TYPE_INTEGER: | |
1128 | element++; | |
66858527 | 1129 | count++; |
6f7194a1 | 1130 | break; |
66858527 | 1131 | |
6f7194a1 MW |
1132 | default: |
1133 | return -EPROTO; | |
1134 | } | |
66858527 | 1135 | } |
6f7194a1 | 1136 | |
66858527 RI |
1137 | return count; |
1138 | } | |
1139 | ||
1140 | static int acpi_find_gpio_count(struct acpi_resource *ares, void *data) | |
1141 | { | |
1142 | unsigned int *count = data; | |
1143 | ||
1144 | if (ares->type == ACPI_RESOURCE_TYPE_GPIO) | |
1145 | *count += ares->data.gpio.pin_table_length; | |
1146 | ||
1147 | return 1; | |
1148 | } | |
1149 | ||
1150 | /** | |
1151 | * acpi_gpio_count - return the number of GPIOs associated with a | |
1152 | * device / function or -ENOENT if no GPIO has been | |
1153 | * assigned to the requested function. | |
1154 | * @dev: GPIO consumer, can be NULL for system-global GPIOs | |
1155 | * @con_id: function within the GPIO consumer | |
1156 | */ | |
1157 | int acpi_gpio_count(struct device *dev, const char *con_id) | |
1158 | { | |
1159 | struct acpi_device *adev = ACPI_COMPANION(dev); | |
1160 | const union acpi_object *obj; | |
1161 | const struct acpi_gpio_mapping *gm; | |
1162 | int count = -ENOENT; | |
1163 | int ret; | |
1164 | char propname[32]; | |
1165 | unsigned int i; | |
1166 | ||
1167 | /* Try first from _DSD */ | |
1168 | for (i = 0; i < ARRAY_SIZE(gpio_suffixes); i++) { | |
9e66504a | 1169 | if (con_id) |
66858527 RI |
1170 | snprintf(propname, sizeof(propname), "%s-%s", |
1171 | con_id, gpio_suffixes[i]); | |
1172 | else | |
1173 | snprintf(propname, sizeof(propname), "%s", | |
1174 | gpio_suffixes[i]); | |
1175 | ||
1176 | ret = acpi_dev_get_property(adev, propname, ACPI_TYPE_ANY, | |
1177 | &obj); | |
1178 | if (ret == 0) { | |
1179 | if (obj->type == ACPI_TYPE_LOCAL_REFERENCE) | |
1180 | count = 1; | |
1181 | else if (obj->type == ACPI_TYPE_PACKAGE) | |
1182 | count = acpi_gpio_package_count(obj); | |
1183 | } else if (adev->driver_gpios) { | |
1184 | for (gm = adev->driver_gpios; gm->name; gm++) | |
1185 | if (strcmp(propname, gm->name) == 0) { | |
1186 | count = gm->size; | |
1187 | break; | |
1188 | } | |
1189 | } | |
4ed55016 | 1190 | if (count > 0) |
66858527 RI |
1191 | break; |
1192 | } | |
1193 | ||
1194 | /* Then from plain _CRS GPIOs */ | |
1195 | if (count < 0) { | |
1196 | struct list_head resource_list; | |
1197 | unsigned int crs_count = 0; | |
1198 | ||
6fe9da42 AS |
1199 | if (!acpi_can_fallback_to_crs(adev, con_id)) |
1200 | return count; | |
1201 | ||
66858527 RI |
1202 | INIT_LIST_HEAD(&resource_list); |
1203 | acpi_dev_get_resources(adev, &resource_list, | |
1204 | acpi_find_gpio_count, &crs_count); | |
1205 | acpi_dev_free_resource_list(&resource_list); | |
1206 | if (crs_count > 0) | |
1207 | count = crs_count; | |
1208 | } | |
4ed55016 | 1209 | return count ? count : -ENOENT; |
66858527 | 1210 | } |
10cf4899 | 1211 | |
10cf4899 DT |
1212 | bool acpi_can_fallback_to_crs(struct acpi_device *adev, const char *con_id) |
1213 | { | |
10cf4899 | 1214 | /* Never allow fallback if the device has properties */ |
5f5e4890 | 1215 | if (acpi_dev_has_props(adev) || adev->driver_gpios) |
10cf4899 DT |
1216 | return false; |
1217 | ||
f10e4bf6 | 1218 | return con_id == NULL; |
10cf4899 | 1219 | } |
ca876c74 | 1220 | |
e59f5e08 HG |
1221 | /* Run deferred acpi_gpiochip_request_irqs() */ |
1222 | static int acpi_gpio_handle_deferred_request_irqs(void) | |
ca876c74 | 1223 | { |
78d3a92e HG |
1224 | struct acpi_gpio_chip *acpi_gpio, *tmp; |
1225 | ||
1226 | mutex_lock(&acpi_gpio_deferred_req_irqs_lock); | |
1227 | list_for_each_entry_safe(acpi_gpio, tmp, | |
1228 | &acpi_gpio_deferred_req_irqs_list, | |
e59f5e08 HG |
1229 | deferred_req_irqs_list_entry) |
1230 | acpi_gpiochip_request_irqs(acpi_gpio); | |
78d3a92e HG |
1231 | |
1232 | acpi_gpio_deferred_req_irqs_done = true; | |
1233 | mutex_unlock(&acpi_gpio_deferred_req_irqs_lock); | |
ca876c74 BT |
1234 | |
1235 | return 0; | |
1236 | } | |
1237 | /* We must use _sync so that this runs after the first deferred_probe run */ | |
e59f5e08 | 1238 | late_initcall_sync(acpi_gpio_handle_deferred_request_irqs); |