.. | .. |
---|
| 1 | +// SPDX-License-Identifier: GPL-2.0-or-later |
---|
1 | 2 | /* |
---|
2 | 3 | * Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de> |
---|
3 | 4 | * Driver for chargers which report their online status through a GPIO pin |
---|
4 | | - * |
---|
5 | | - * This program is free software; you can redistribute it and/or modify it |
---|
6 | | - * under the terms of the GNU General Public License as published by the |
---|
7 | | - * Free Software Foundation; either version 2 of the License, or (at your |
---|
8 | | - * option) any later version. |
---|
9 | | - * |
---|
10 | | - * You should have received a copy of the GNU General Public License along |
---|
11 | | - * with this program; if not, write to the Free Software Foundation, Inc., |
---|
12 | | - * 675 Mass Ave, Cambridge, MA 02139, USA. |
---|
13 | | - * |
---|
14 | 5 | */ |
---|
15 | 6 | |
---|
16 | | -#include <linux/extcon-provider.h> |
---|
17 | 7 | #include <linux/device.h> |
---|
18 | 8 | #include <linux/init.h> |
---|
19 | 9 | #include <linux/interrupt.h> |
---|
.. | .. |
---|
40 | 30 | |
---|
41 | 31 | struct power_supply *charger; |
---|
42 | 32 | struct power_supply_desc charger_desc; |
---|
43 | | - struct extcon_dev *edev; |
---|
44 | 33 | struct gpio_desc *gpiod; |
---|
45 | 34 | struct gpio_desc *charge_status; |
---|
46 | 35 | |
---|
47 | 36 | struct gpio_descs *current_limit_gpios; |
---|
48 | 37 | struct gpio_mapping *current_limit_map; |
---|
49 | | - struct notifier_block cable_cg_nb; |
---|
50 | 38 | u32 current_limit_map_size; |
---|
51 | 39 | u32 charge_current_limit; |
---|
52 | 40 | }; |
---|
.. | .. |
---|
249 | 237 | return 0; |
---|
250 | 238 | } |
---|
251 | 239 | |
---|
252 | | -static int gpio_charger_evt_notifier(struct notifier_block *nb, |
---|
253 | | - unsigned long event, void *ptr) |
---|
254 | | -{ |
---|
255 | | - int limit_ua; |
---|
256 | | - struct gpio_charger *charger = |
---|
257 | | - container_of(nb, struct gpio_charger, cable_cg_nb); |
---|
258 | | - |
---|
259 | | - limit_ua = charger->current_limit_map[charger->current_limit_map_size - 1].limit_ua; |
---|
260 | | - if (extcon_get_state(charger->edev, EXTCON_CHG_USB_DCP) > 0) |
---|
261 | | - limit_ua = charger->current_limit_map[0].limit_ua; |
---|
262 | | - |
---|
263 | | - set_charge_current_limit(charger, limit_ua); |
---|
264 | | - |
---|
265 | | - return NOTIFY_DONE; |
---|
266 | | -} |
---|
267 | | - |
---|
268 | 240 | /* |
---|
269 | 241 | * The entries will be overwritten by driver's probe routine depending |
---|
270 | 242 | * on the available features. This list ensures, that the array is big |
---|
.. | .. |
---|
280 | 252 | { |
---|
281 | 253 | struct device *dev = &pdev->dev; |
---|
282 | 254 | const struct gpio_charger_platform_data *pdata = dev->platform_data; |
---|
283 | | - struct extcon_dev *edev; |
---|
284 | 255 | struct power_supply_config psy_cfg = {}; |
---|
285 | 256 | struct gpio_charger *gpio_charger; |
---|
286 | 257 | struct power_supply_desc *charger_desc; |
---|
.. | .. |
---|
299 | 270 | return -ENOMEM; |
---|
300 | 271 | gpio_charger->dev = dev; |
---|
301 | 272 | |
---|
302 | | - if (of_property_read_bool(dev->of_node, "extcon")) { |
---|
303 | | - edev = extcon_get_edev_by_phandle(dev, 0); |
---|
304 | | - if (IS_ERR(edev)) { |
---|
305 | | - if (PTR_ERR(edev) != -EPROBE_DEFER) |
---|
306 | | - dev_err(dev, "Invalid or missing extcon\n"); |
---|
307 | | - return PTR_ERR(edev); |
---|
308 | | - } |
---|
309 | | - gpio_charger->edev = edev; |
---|
310 | | - gpio_charger->cable_cg_nb.notifier_call = |
---|
311 | | - gpio_charger_evt_notifier; |
---|
312 | | - ret = devm_extcon_register_notifier(dev, edev, |
---|
313 | | - EXTCON_CHG_USB_DCP, |
---|
314 | | - &gpio_charger->cable_cg_nb); |
---|
315 | | - if (ret) { |
---|
316 | | - dev_err(dev, "failed to register notifier for CDP\n"); |
---|
317 | | - return ret; |
---|
318 | | - } |
---|
319 | | - } else { |
---|
320 | | - gpio_charger->edev = ERR_PTR(-ENODEV); |
---|
321 | | - } |
---|
322 | | - |
---|
323 | 273 | /* |
---|
324 | 274 | * This will fetch a GPIO descriptor from device tree, ACPI or |
---|
325 | 275 | * boardfile descriptor tables. It's good to try this first. |
---|
.. | .. |
---|
327 | 277 | gpio_charger->gpiod = devm_gpiod_get_optional(dev, NULL, GPIOD_IN); |
---|
328 | 278 | if (IS_ERR(gpio_charger->gpiod)) { |
---|
329 | 279 | /* Just try again if this happens */ |
---|
330 | | - if (PTR_ERR(gpio_charger->gpiod) == -EPROBE_DEFER) |
---|
331 | | - return -EPROBE_DEFER; |
---|
332 | | - dev_err(dev, "error getting GPIO descriptor\n"); |
---|
333 | | - return PTR_ERR(gpio_charger->gpiod); |
---|
| 280 | + return dev_err_probe(dev, PTR_ERR(gpio_charger->gpiod), |
---|
| 281 | + "error getting GPIO descriptor\n"); |
---|
334 | 282 | } |
---|
335 | 283 | |
---|
336 | 284 | if (gpio_charger->gpiod) { |
---|