| .. | .. |
|---|
| 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) { |
|---|