drivers/power/gpio-charger.c

   1 /*
   2  *  Copyright (C) 2010, Lars-Peter Clausen <lars@metafoo.de>
   3  *  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  */
  15
  16 #include <linux/device.h>
  17 #include <linux/gpio.h>
  18 #include <linux/init.h>
  19 #include <linux/interrupt.h>
  20 #include <linux/kernel.h>
  21 #include <linux/module.h>
  22 #include <linux/platform_device.h>
  23 #include <linux/power_supply.h>
  24 #include <linux/slab.h>
  25 #include <linux/of.h>
  26 #include <linux/of_gpio.h>
  27
  28 #include <linux/power/gpio-charger.h>
  29
  30 struct gpio_charger {
  31         const struct gpio_charger_platform_data *pdata;
  32         unsigned int irq;
  33         bool wakeup_enabled;
  34
  35         struct power_supply charger;
  36 };
  37
  38 static irqreturn_t gpio_charger_irq(int irq, void *devid)
  39 {
  40         struct power_supply *charger = devid;
  41
  42         power_supply_changed(charger);
  43
  44         return IRQ_HANDLED;
  45 }
  46
  47 static inline struct gpio_charger *psy_to_gpio_charger(struct power_supply *psy)
  48 {
  49         return container_of(psy, struct gpio_charger, charger);
  50 }
  51
  52 static int gpio_charger_get_property(struct power_supply *psy,
  53                 enum power_supply_property psp, union power_supply_propval *val)
  54 {
  55         struct gpio_charger *gpio_charger = psy_to_gpio_charger(psy);
  56         const struct gpio_charger_platform_data *pdata = gpio_charger->pdata;
  57
  58         switch (psp) {
  59         case POWER_SUPPLY_PROP_ONLINE:
  60                 val->intval = !!gpio_get_value_cansleep(pdata->gpio);
  61                 val->intval ^= pdata->gpio_active_low;
  62                 break;
  63         default:
  64                 return -EINVAL;
  65         }
  66
  67         return 0;
  68 }
  69
  70 static enum power_supply_property gpio_charger_properties[] = {
  71         POWER_SUPPLY_PROP_ONLINE,
  72 };
  73
  74 static
  75 struct gpio_charger_platform_data *gpio_charger_parse_dt(struct device *dev)
  76 {
  77         struct device_node *np = dev->of_node;
  78         struct gpio_charger_platform_data *pdata;
  79         const char *chargetype;
  80         enum of_gpio_flags flags;
  81         int ret;
  82
  83         if (!np)
  84                 return ERR_PTR(-ENOENT);
  85
  86         pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
  87         if (!pdata)
  88                 return ERR_PTR(-ENOMEM);
  89
  90         pdata->name = np->name;
  91
  92         pdata->gpio = of_get_gpio_flags(np, 0, &flags);
  93         if (pdata->gpio < 0) {
  94                 if (pdata->gpio != -EPROBE_DEFER)
  95                         dev_err(dev, "could not get charger gpio\n");
  96                 return ERR_PTR(pdata->gpio);
  97         }
  98
  99         pdata->gpio_active_low = !!(flags & OF_GPIO_ACTIVE_LOW);
 100
 101         pdata->type = POWER_SUPPLY_TYPE_UNKNOWN;
 102         ret = of_property_read_string(np, "charger-type", &chargetype);
 103         if (ret >= 0) {
 104                 if (!strncmp("unknown", chargetype, 7))
 105                         pdata->type = POWER_SUPPLY_TYPE_UNKNOWN;
 106                 else if (!strncmp("battery", chargetype, 7))
 107                         pdata->type = POWER_SUPPLY_TYPE_BATTERY;
 108                 else if (!strncmp("ups", chargetype, 3))
 109                         pdata->type = POWER_SUPPLY_TYPE_UPS;
 110                 else if (!strncmp("mains", chargetype, 5))
 111                         pdata->type = POWER_SUPPLY_TYPE_MAINS;
 112                 else if (!strncmp("usb-sdp", chargetype, 7))
 113                         pdata->type = POWER_SUPPLY_TYPE_USB;
 114                 else if (!strncmp("usb-dcp", chargetype, 7))
 115                         pdata->type = POWER_SUPPLY_TYPE_USB_DCP;
 116                 else if (!strncmp("usb-cdp", chargetype, 7))
 117                         pdata->type = POWER_SUPPLY_TYPE_USB_CDP;
 118                 else if (!strncmp("usb-aca", chargetype, 7))
 119                         pdata->type = POWER_SUPPLY_TYPE_USB_ACA;
 120                 else
 121                         dev_warn(dev, "unknown charger type %s\n", chargetype);
 122         }
 123
 124         return pdata;
 125 }
 126
 127 static int gpio_charger_probe(struct platform_device *pdev)
 128 {
 129         const struct gpio_charger_platform_data *pdata = pdev->dev.platform_data;
 130         struct power_supply_config psy_cfg = {};
 131         struct gpio_charger *gpio_charger;
 132         struct power_supply *charger;
 133         int ret;
 134         int irq;
 135
 136         if (!pdata) {
 137                 pdata = gpio_charger_parse_dt(&pdev->dev);
 138                 if (IS_ERR(pdata)) {
 139                         ret = PTR_ERR(pdata);
 140                         if (ret != -EPROBE_DEFER)
 141                                 dev_err(&pdev->dev, "No platform data\n");
 142                         return ret;
 143                 }
 144         }
 145
 146         if (!gpio_is_valid(pdata->gpio)) {
 147                 dev_err(&pdev->dev, "Invalid gpio pin\n");
 148                 return -EINVAL;
 149         }
 150
 151         gpio_charger = devm_kzalloc(&pdev->dev, sizeof(*gpio_charger),
 152                                         GFP_KERNEL);
 153         if (!gpio_charger) {
 154                 dev_err(&pdev->dev, "Failed to alloc driver structure\n");
 155                 return -ENOMEM;
 156         }
 157
 158         charger = &gpio_charger->charger;
 159
 160         charger->name = pdata->name ? pdata->name : "gpio-charger";
 161         charger->type = pdata->type;
 162         charger->properties = gpio_charger_properties;
 163         charger->num_properties = ARRAY_SIZE(gpio_charger_properties);
 164         charger->get_property = gpio_charger_get_property;
 165
 166         psy_cfg.supplied_to = pdata->supplied_to;
 167         psy_cfg.num_supplicants = pdata->num_supplicants;
 168         psy_cfg.of_node = pdev->dev.of_node;
 169
 170         ret = gpio_request(pdata->gpio, dev_name(&pdev->dev));
 171         if (ret) {
 172                 dev_err(&pdev->dev, "Failed to request gpio pin: %d\n", ret);
 173                 goto err_free;
 174         }
 175         ret = gpio_direction_input(pdata->gpio);
 176         if (ret) {
 177                 dev_err(&pdev->dev, "Failed to set gpio to input: %d\n", ret);
 178                 goto err_gpio_free;
 179         }
 180
 181         gpio_charger->pdata = pdata;
 182
 183         ret = power_supply_register(&pdev->dev, charger, &psy_cfg);
 184         if (ret < 0) {
 185                 dev_err(&pdev->dev, "Failed to register power supply: %d\n",
 186                         ret);
 187                 goto err_gpio_free;
 188         }
 189
 190         irq = gpio_to_irq(pdata->gpio);
 191         if (irq > 0) {
 192                 ret = request_any_context_irq(irq, gpio_charger_irq,
 193                                 IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING,
 194                                 dev_name(&pdev->dev), charger);
 195                 if (ret < 0)
 196                         dev_warn(&pdev->dev, "Failed to request irq: %d\n", ret);
 197                 else
 198                         gpio_charger->irq = irq;
 199         }
 200
 201         platform_set_drvdata(pdev, gpio_charger);
 202
 203         device_init_wakeup(&pdev->dev, 1);
 204
 205         return 0;
 206
 207 err_gpio_free:
 208         gpio_free(pdata->gpio);
 209 err_free:
 210         return ret;
 211 }
 212
 213 static int gpio_charger_remove(struct platform_device *pdev)
 214 {
 215         struct gpio_charger *gpio_charger = platform_get_drvdata(pdev);
 216
 217         if (gpio_charger->irq)
 218                 free_irq(gpio_charger->irq, &gpio_charger->charger);
 219
 220         power_supply_unregister(&gpio_charger->charger);
 221
 222         gpio_free(gpio_charger->pdata->gpio);
 223
 224         return 0;
 225 }
 226
 227 #ifdef CONFIG_PM_SLEEP
 228 static int gpio_charger_suspend(struct device *dev)
 229 {
 230         struct gpio_charger *gpio_charger = dev_get_drvdata(dev);
 231
 232         if (device_may_wakeup(dev))
 233                 gpio_charger->wakeup_enabled =
 234                         !enable_irq_wake(gpio_charger->irq);
 235
 236         return 0;
 237 }
 238
 239 static int gpio_charger_resume(struct device *dev)
 240 {
 241         struct platform_device *pdev = to_platform_device(dev);
 242         struct gpio_charger *gpio_charger = platform_get_drvdata(pdev);
 243
 244         if (device_may_wakeup(dev) && gpio_charger->wakeup_enabled)
 245                 disable_irq_wake(gpio_charger->irq);
 246         power_supply_changed(&gpio_charger->charger);
 247
 248         return 0;
 249 }
 250 #endif
 251
 252 static SIMPLE_DEV_PM_OPS(gpio_charger_pm_ops,
 253                 gpio_charger_suspend, gpio_charger_resume);
 254
 255 static const struct of_device_id gpio_charger_match[] = {
 256         { .compatible = "gpio-charger" },
 257         { }
 258 };
 259 MODULE_DEVICE_TABLE(of, gpio_charger_match);
 260
 261 static struct platform_driver gpio_charger_driver = {
 262         .probe = gpio_charger_probe,
 263         .remove = gpio_charger_remove,
 264         .driver = {
 265                 .name = "gpio-charger",
 266                 .pm = &gpio_charger_pm_ops,
 267                 .of_match_table = gpio_charger_match,
 268         },
 269 };
 270
 271 module_platform_driver(gpio_charger_driver);
 272
 273 MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
 274 MODULE_DESCRIPTION("Driver for chargers which report their online status through a GPIO");
 275 MODULE_LICENSE("GPL");
 276 MODULE_ALIAS("platform:gpio-charger");