power_supply: Fix NULL pointer dereference during bq27x00_battery probe
[deliverable/linux.git] / drivers / power / power_supply_core.c
CommitLineData
4a11b59d
AV
1/*
2 * Universal power supply monitor class
3 *
4 * Copyright © 2007 Anton Vorontsov <cbou@mail.ru>
5 * Copyright © 2004 Szabolcs Gyurko
6 * Copyright © 2003 Ian Molton <spyro@f2s.com>
7 *
8 * Modified: 2004, Oct Szabolcs Gyurko
9 *
10 * You may use this code as per GPL version 2
11 */
12
13#include <linux/module.h>
14#include <linux/types.h>
15#include <linux/init.h>
5f487cd3 16#include <linux/slab.h>
4a11b59d 17#include <linux/device.h>
d36240d2 18#include <linux/notifier.h>
4a11b59d
AV
19#include <linux/err.h>
20#include <linux/power_supply.h>
3be330bf 21#include <linux/thermal.h>
4a11b59d
AV
22#include "power_supply.h"
23
ff3417e7 24/* exported for the APM Power driver, APM emulation */
4a11b59d 25struct class *power_supply_class;
ff3417e7 26EXPORT_SYMBOL_GPL(power_supply_class);
4a11b59d 27
d36240d2
PR
28ATOMIC_NOTIFIER_HEAD(power_supply_notifier);
29EXPORT_SYMBOL_GPL(power_supply_notifier);
30
5f487cd3
AV
31static struct device_type power_supply_dev_type;
32
5e0848c6
RK
33static bool __power_supply_is_supplied_by(struct power_supply *supplier,
34 struct power_supply *supply)
35{
36 int i;
37
38 if (!supply->supplied_from && !supplier->supplied_to)
39 return false;
40
41 /* Support both supplied_to and supplied_from modes */
42 if (supply->supplied_from) {
297d716f 43 if (!supplier->desc->name)
5e0848c6
RK
44 return false;
45 for (i = 0; i < supply->num_supplies; i++)
297d716f 46 if (!strcmp(supplier->desc->name, supply->supplied_from[i]))
5e0848c6
RK
47 return true;
48 } else {
297d716f 49 if (!supply->desc->name)
5e0848c6
RK
50 return false;
51 for (i = 0; i < supplier->num_supplicants; i++)
297d716f 52 if (!strcmp(supplier->supplied_to[i], supply->desc->name))
5e0848c6
RK
53 return true;
54 }
55
56 return false;
57}
58
443cad92
DY
59static int __power_supply_changed_work(struct device *dev, void *data)
60{
e80cf421 61 struct power_supply *psy = data;
443cad92 62 struct power_supply *pst = dev_get_drvdata(dev);
443cad92 63
5e0848c6 64 if (__power_supply_is_supplied_by(psy, pst)) {
297d716f
KK
65 if (pst->desc->external_power_changed)
66 pst->desc->external_power_changed(pst);
5e0848c6
RK
67 }
68
443cad92
DY
69 return 0;
70}
71
4a11b59d
AV
72static void power_supply_changed_work(struct work_struct *work)
73{
948dcf96 74 unsigned long flags;
4a11b59d
AV
75 struct power_supply *psy = container_of(work, struct power_supply,
76 changed_work);
4a11b59d 77
297d716f 78 dev_dbg(&psy->dev, "%s\n", __func__);
4a11b59d 79
948dcf96 80 spin_lock_irqsave(&psy->changed_lock, flags);
061f3806
VK
81 /*
82 * Check 'changed' here to avoid issues due to race between
83 * power_supply_changed() and this routine. In worst case
84 * power_supply_changed() can be called again just before we take above
85 * lock. During the first call of this routine we will mark 'changed' as
86 * false and it will stay false for the next call as well.
87 */
88 if (likely(psy->changed)) {
948dcf96
ZM
89 psy->changed = false;
90 spin_unlock_irqrestore(&psy->changed_lock, flags);
91 class_for_each_device(power_supply_class, NULL, psy,
92 __power_supply_changed_work);
93 power_supply_update_leds(psy);
d36240d2
PR
94 atomic_notifier_call_chain(&power_supply_notifier,
95 PSY_EVENT_PROP_CHANGED, psy);
297d716f 96 kobject_uevent(&psy->dev.kobj, KOBJ_CHANGE);
948dcf96
ZM
97 spin_lock_irqsave(&psy->changed_lock, flags);
98 }
061f3806 99
948dcf96 100 /*
061f3806
VK
101 * Hold the wakeup_source until all events are processed.
102 * power_supply_changed() might have called again and have set 'changed'
103 * to true.
948dcf96 104 */
061f3806 105 if (likely(!psy->changed))
297d716f 106 pm_relax(&psy->dev);
948dcf96 107 spin_unlock_irqrestore(&psy->changed_lock, flags);
4a11b59d
AV
108}
109
110void power_supply_changed(struct power_supply *psy)
111{
948dcf96
ZM
112 unsigned long flags;
113
297d716f 114 dev_dbg(&psy->dev, "%s\n", __func__);
4a11b59d 115
948dcf96
ZM
116 spin_lock_irqsave(&psy->changed_lock, flags);
117 psy->changed = true;
297d716f 118 pm_stay_awake(&psy->dev);
948dcf96 119 spin_unlock_irqrestore(&psy->changed_lock, flags);
4a11b59d 120 schedule_work(&psy->changed_work);
4a11b59d 121}
ff3417e7 122EXPORT_SYMBOL_GPL(power_supply_changed);
4a11b59d 123
f6e0b081
RK
124#ifdef CONFIG_OF
125#include <linux/of.h>
126
127static int __power_supply_populate_supplied_from(struct device *dev,
128 void *data)
129{
e80cf421 130 struct power_supply *psy = data;
f6e0b081
RK
131 struct power_supply *epsy = dev_get_drvdata(dev);
132 struct device_node *np;
133 int i = 0;
134
135 do {
136 np = of_parse_phandle(psy->of_node, "power-supplies", i++);
137 if (!np)
a0f93b42 138 break;
f6e0b081
RK
139
140 if (np == epsy->of_node) {
297d716f
KK
141 dev_info(&psy->dev, "%s: Found supply : %s\n",
142 psy->desc->name, epsy->desc->name);
143 psy->supplied_from[i-1] = (char *)epsy->desc->name;
f6e0b081 144 psy->num_supplies++;
2054d6e9 145 of_node_put(np);
f6e0b081
RK
146 break;
147 }
2054d6e9 148 of_node_put(np);
f6e0b081
RK
149 } while (np);
150
151 return 0;
152}
153
154static int power_supply_populate_supplied_from(struct power_supply *psy)
155{
156 int error;
157
158 error = class_for_each_device(power_supply_class, NULL, psy,
159 __power_supply_populate_supplied_from);
160
297d716f 161 dev_dbg(&psy->dev, "%s %d\n", __func__, error);
f6e0b081
RK
162
163 return error;
164}
165
166static int __power_supply_find_supply_from_node(struct device *dev,
167 void *data)
168{
e80cf421 169 struct device_node *np = data;
f6e0b081
RK
170 struct power_supply *epsy = dev_get_drvdata(dev);
171
585b0087 172 /* returning non-zero breaks out of class_for_each_device loop */
f6e0b081 173 if (epsy->of_node == np)
585b0087 174 return 1;
f6e0b081
RK
175
176 return 0;
177}
178
179static int power_supply_find_supply_from_node(struct device_node *supply_node)
180{
181 int error;
f6e0b081
RK
182
183 /*
585b0087
VK
184 * class_for_each_device() either returns its own errors or values
185 * returned by __power_supply_find_supply_from_node().
186 *
187 * __power_supply_find_supply_from_node() will return 0 (no match)
188 * or 1 (match).
189 *
190 * We return 0 if class_for_each_device() returned 1, -EPROBE_DEFER if
191 * it returned 0, or error as returned by it.
f6e0b081
RK
192 */
193 error = class_for_each_device(power_supply_class, NULL, supply_node,
194 __power_supply_find_supply_from_node);
195
585b0087 196 return error ? (error == 1 ? 0 : error) : -EPROBE_DEFER;
f6e0b081
RK
197}
198
199static int power_supply_check_supplies(struct power_supply *psy)
200{
201 struct device_node *np;
202 int cnt = 0;
203
204 /* If there is already a list honor it */
205 if (psy->supplied_from && psy->num_supplies > 0)
206 return 0;
207
208 /* No device node found, nothing to do */
209 if (!psy->of_node)
210 return 0;
211
212 do {
213 int ret;
214
215 np = of_parse_phandle(psy->of_node, "power-supplies", cnt++);
216 if (!np)
a0f93b42 217 break;
f6e0b081
RK
218
219 ret = power_supply_find_supply_from_node(np);
8468b029
VK
220 of_node_put(np);
221
f6e0b081 222 if (ret) {
297d716f 223 dev_dbg(&psy->dev, "Failed to find supply!\n");
f5b89aff 224 return ret;
f6e0b081
RK
225 }
226 } while (np);
227
f9c85486
VK
228 /* Missing valid "power-supplies" entries */
229 if (cnt == 1)
230 return 0;
231
f6e0b081 232 /* All supplies found, allocate char ** array for filling */
297d716f 233 psy->supplied_from = devm_kzalloc(&psy->dev, sizeof(psy->supplied_from),
f6e0b081
RK
234 GFP_KERNEL);
235 if (!psy->supplied_from) {
297d716f 236 dev_err(&psy->dev, "Couldn't allocate memory for supply list\n");
f6e0b081
RK
237 return -ENOMEM;
238 }
239
297d716f
KK
240 *psy->supplied_from = devm_kzalloc(&psy->dev,
241 sizeof(char *) * (cnt - 1),
f6e0b081
RK
242 GFP_KERNEL);
243 if (!*psy->supplied_from) {
297d716f 244 dev_err(&psy->dev, "Couldn't allocate memory for supply list\n");
f6e0b081
RK
245 return -ENOMEM;
246 }
247
248 return power_supply_populate_supplied_from(psy);
249}
250#else
251static inline int power_supply_check_supplies(struct power_supply *psy)
252{
253 return 0;
254}
255#endif
256
443cad92 257static int __power_supply_am_i_supplied(struct device *dev, void *data)
4a11b59d
AV
258{
259 union power_supply_propval ret = {0,};
e80cf421 260 struct power_supply *psy = data;
443cad92 261 struct power_supply *epsy = dev_get_drvdata(dev);
443cad92 262
5e0848c6 263 if (__power_supply_is_supplied_by(epsy, psy))
297d716f
KK
264 if (!epsy->desc->get_property(epsy, POWER_SUPPLY_PROP_ONLINE,
265 &ret))
1c42a389 266 return ret.intval;
5e0848c6 267
443cad92
DY
268 return 0;
269}
270
271int power_supply_am_i_supplied(struct power_supply *psy)
272{
273 int error;
274
93562b53 275 error = class_for_each_device(power_supply_class, NULL, psy,
443cad92 276 __power_supply_am_i_supplied);
4a11b59d 277
297d716f 278 dev_dbg(&psy->dev, "%s %d\n", __func__, error);
4a11b59d 279
443cad92 280 return error;
4a11b59d 281}
ff3417e7 282EXPORT_SYMBOL_GPL(power_supply_am_i_supplied);
4a11b59d 283
942ed161
MG
284static int __power_supply_is_system_supplied(struct device *dev, void *data)
285{
286 union power_supply_propval ret = {0,};
287 struct power_supply *psy = dev_get_drvdata(dev);
2530daa1 288 unsigned int *count = data;
942ed161 289
2530daa1 290 (*count)++;
297d716f
KK
291 if (psy->desc->type != POWER_SUPPLY_TYPE_BATTERY)
292 if (!psy->desc->get_property(psy, POWER_SUPPLY_PROP_ONLINE,
293 &ret))
942ed161 294 return ret.intval;
1c42a389 295
942ed161
MG
296 return 0;
297}
298
299int power_supply_is_system_supplied(void)
300{
301 int error;
2530daa1 302 unsigned int count = 0;
942ed161 303
2530daa1 304 error = class_for_each_device(power_supply_class, NULL, &count,
942ed161
MG
305 __power_supply_is_system_supplied);
306
2530daa1
JD
307 /*
308 * If no power class device was found at all, most probably we are
309 * running on a desktop system, so assume we are on mains power.
310 */
311 if (count == 0)
312 return 1;
313
942ed161
MG
314 return error;
315}
ff3417e7 316EXPORT_SYMBOL_GPL(power_supply_is_system_supplied);
942ed161 317
e5f5ccb6
DM
318int power_supply_set_battery_charged(struct power_supply *psy)
319{
bc154056 320 if (atomic_read(&psy->use_cnt) >= 0 &&
297d716f
KK
321 psy->desc->type == POWER_SUPPLY_TYPE_BATTERY &&
322 psy->desc->set_charged) {
323 psy->desc->set_charged(psy);
e5f5ccb6
DM
324 return 0;
325 }
326
327 return -EINVAL;
328}
329EXPORT_SYMBOL_GPL(power_supply_set_battery_charged);
330
9f3b795a 331static int power_supply_match_device_by_name(struct device *dev, const void *data)
e5f5ccb6
DM
332{
333 const char *name = data;
334 struct power_supply *psy = dev_get_drvdata(dev);
335
297d716f 336 return strcmp(psy->desc->name, name) == 0;
e5f5ccb6
DM
337}
338
1a352462
KK
339/**
340 * power_supply_get_by_name() - Search for a power supply and returns its ref
341 * @name: Power supply name to fetch
342 *
343 * If power supply was found, it increases reference count for the
344 * internal power supply's device. The user should power_supply_put()
345 * after usage.
346 *
347 * Return: On success returns a reference to a power supply with
348 * matching name equals to @name, a NULL otherwise.
349 */
9f3b795a 350struct power_supply *power_supply_get_by_name(const char *name)
e5f5ccb6 351{
03e81acc 352 struct power_supply *psy = NULL;
e5f5ccb6
DM
353 struct device *dev = class_find_device(power_supply_class, NULL, name,
354 power_supply_match_device_by_name);
355
03e81acc
KK
356 if (dev) {
357 psy = dev_get_drvdata(dev);
358 atomic_inc(&psy->use_cnt);
359 }
360
361 return psy;
e5f5ccb6
DM
362}
363EXPORT_SYMBOL_GPL(power_supply_get_by_name);
364
1a352462
KK
365/**
366 * power_supply_put() - Drop reference obtained with power_supply_get_by_name
367 * @psy: Reference to put
368 *
369 * The reference to power supply should be put before unregistering
370 * the power supply.
371 */
372void power_supply_put(struct power_supply *psy)
373{
374 might_sleep();
375
03e81acc 376 atomic_dec(&psy->use_cnt);
1a352462
KK
377 put_device(&psy->dev);
378}
379EXPORT_SYMBOL_GPL(power_supply_put);
380
abce9770
SR
381#ifdef CONFIG_OF
382static int power_supply_match_device_node(struct device *dev, const void *data)
383{
384 return dev->parent && dev->parent->of_node == data;
385}
386
1a352462
KK
387/**
388 * power_supply_get_by_phandle() - Search for a power supply and returns its ref
389 * @np: Pointer to device node holding phandle property
390 * @phandle_name: Name of property holding a power supply name
391 *
392 * If power supply was found, it increases reference count for the
393 * internal power supply's device. The user should power_supply_put()
394 * after usage.
395 *
396 * Return: On success returns a reference to a power supply with
397 * matching name equals to value under @property, NULL or ERR_PTR otherwise.
398 */
abce9770
SR
399struct power_supply *power_supply_get_by_phandle(struct device_node *np,
400 const char *property)
401{
402 struct device_node *power_supply_np;
03e81acc 403 struct power_supply *psy = NULL;
abce9770
SR
404 struct device *dev;
405
406 power_supply_np = of_parse_phandle(np, property, 0);
407 if (!power_supply_np)
408 return ERR_PTR(-ENODEV);
409
410 dev = class_find_device(power_supply_class, NULL, power_supply_np,
411 power_supply_match_device_node);
412
413 of_node_put(power_supply_np);
414
03e81acc
KK
415 if (dev) {
416 psy = dev_get_drvdata(dev);
417 atomic_inc(&psy->use_cnt);
418 }
419
420 return psy;
abce9770
SR
421}
422EXPORT_SYMBOL_GPL(power_supply_get_by_phandle);
423#endif /* CONFIG_OF */
424
bc154056
KK
425int power_supply_get_property(struct power_supply *psy,
426 enum power_supply_property psp,
427 union power_supply_propval *val)
428{
429 if (atomic_read(&psy->use_cnt) <= 0)
430 return -ENODEV;
431
297d716f 432 return psy->desc->get_property(psy, psp, val);
bc154056
KK
433}
434EXPORT_SYMBOL_GPL(power_supply_get_property);
435
436int power_supply_set_property(struct power_supply *psy,
437 enum power_supply_property psp,
438 const union power_supply_propval *val)
439{
297d716f 440 if (atomic_read(&psy->use_cnt) <= 0 || !psy->desc->set_property)
bc154056
KK
441 return -ENODEV;
442
297d716f 443 return psy->desc->set_property(psy, psp, val);
bc154056
KK
444}
445EXPORT_SYMBOL_GPL(power_supply_set_property);
446
447int power_supply_property_is_writeable(struct power_supply *psy,
448 enum power_supply_property psp)
449{
297d716f
KK
450 if (atomic_read(&psy->use_cnt) <= 0 ||
451 !psy->desc->property_is_writeable)
bc154056
KK
452 return -ENODEV;
453
297d716f 454 return psy->desc->property_is_writeable(psy, psp);
bc154056
KK
455}
456EXPORT_SYMBOL_GPL(power_supply_property_is_writeable);
457
458void power_supply_external_power_changed(struct power_supply *psy)
459{
297d716f
KK
460 if (atomic_read(&psy->use_cnt) <= 0 ||
461 !psy->desc->external_power_changed)
bc154056
KK
462 return;
463
297d716f 464 psy->desc->external_power_changed(psy);
bc154056
KK
465}
466EXPORT_SYMBOL_GPL(power_supply_external_power_changed);
467
83516651
JF
468int power_supply_powers(struct power_supply *psy, struct device *dev)
469{
297d716f 470 return sysfs_create_link(&psy->dev.kobj, &dev->kobj, "powers");
83516651
JF
471}
472EXPORT_SYMBOL_GPL(power_supply_powers);
473
5f487cd3
AV
474static void power_supply_dev_release(struct device *dev)
475{
297d716f 476 struct power_supply *psy = container_of(dev, struct power_supply, dev);
5f487cd3 477 pr_debug("device: '%s': %s\n", dev_name(dev), __func__);
297d716f 478 kfree(psy);
5f487cd3
AV
479}
480
d36240d2
PR
481int power_supply_reg_notifier(struct notifier_block *nb)
482{
483 return atomic_notifier_chain_register(&power_supply_notifier, nb);
484}
485EXPORT_SYMBOL_GPL(power_supply_reg_notifier);
486
487void power_supply_unreg_notifier(struct notifier_block *nb)
488{
489 atomic_notifier_chain_unregister(&power_supply_notifier, nb);
490}
491EXPORT_SYMBOL_GPL(power_supply_unreg_notifier);
492
3be330bf
JT
493#ifdef CONFIG_THERMAL
494static int power_supply_read_temp(struct thermal_zone_device *tzd,
495 unsigned long *temp)
496{
497 struct power_supply *psy;
498 union power_supply_propval val;
499 int ret;
500
501 WARN_ON(tzd == NULL);
502 psy = tzd->devdata;
297d716f 503 ret = psy->desc->get_property(psy, POWER_SUPPLY_PROP_TEMP, &val);
3be330bf
JT
504
505 /* Convert tenths of degree Celsius to milli degree Celsius. */
506 if (!ret)
507 *temp = val.intval * 100;
508
509 return ret;
510}
511
512static struct thermal_zone_device_ops psy_tzd_ops = {
513 .get_temp = power_supply_read_temp,
514};
515
516static int psy_register_thermal(struct power_supply *psy)
517{
518 int i;
519
297d716f 520 if (psy->desc->no_thermal)
a69d82b9
KK
521 return 0;
522
3be330bf 523 /* Register battery zone device psy reports temperature */
297d716f
KK
524 for (i = 0; i < psy->desc->num_properties; i++) {
525 if (psy->desc->properties[i] == POWER_SUPPLY_PROP_TEMP) {
526 psy->tzd = thermal_zone_device_register(psy->desc->name,
527 0, 0, psy, &psy_tzd_ops, NULL, 0, 0);
9d2410c7 528 return PTR_ERR_OR_ZERO(psy->tzd);
3be330bf
JT
529 }
530 }
531 return 0;
532}
533
534static void psy_unregister_thermal(struct power_supply *psy)
535{
536 if (IS_ERR_OR_NULL(psy->tzd))
537 return;
538 thermal_zone_device_unregister(psy->tzd);
539}
952aeeb3
RP
540
541/* thermal cooling device callbacks */
542static int ps_get_max_charge_cntl_limit(struct thermal_cooling_device *tcd,
543 unsigned long *state)
544{
545 struct power_supply *psy;
546 union power_supply_propval val;
547 int ret;
548
549 psy = tcd->devdata;
297d716f 550 ret = psy->desc->get_property(psy,
952aeeb3
RP
551 POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT_MAX, &val);
552 if (!ret)
553 *state = val.intval;
554
555 return ret;
556}
557
558static int ps_get_cur_chrage_cntl_limit(struct thermal_cooling_device *tcd,
559 unsigned long *state)
560{
561 struct power_supply *psy;
562 union power_supply_propval val;
563 int ret;
564
565 psy = tcd->devdata;
297d716f 566 ret = psy->desc->get_property(psy,
952aeeb3
RP
567 POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT, &val);
568 if (!ret)
569 *state = val.intval;
570
571 return ret;
572}
573
574static int ps_set_cur_charge_cntl_limit(struct thermal_cooling_device *tcd,
575 unsigned long state)
576{
577 struct power_supply *psy;
578 union power_supply_propval val;
579 int ret;
580
581 psy = tcd->devdata;
582 val.intval = state;
297d716f 583 ret = psy->desc->set_property(psy,
952aeeb3
RP
584 POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT, &val);
585
586 return ret;
587}
588
589static struct thermal_cooling_device_ops psy_tcd_ops = {
590 .get_max_state = ps_get_max_charge_cntl_limit,
591 .get_cur_state = ps_get_cur_chrage_cntl_limit,
592 .set_cur_state = ps_set_cur_charge_cntl_limit,
593};
594
595static int psy_register_cooler(struct power_supply *psy)
596{
597 int i;
598
599 /* Register for cooling device if psy can control charging */
297d716f
KK
600 for (i = 0; i < psy->desc->num_properties; i++) {
601 if (psy->desc->properties[i] ==
952aeeb3
RP
602 POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT) {
603 psy->tcd = thermal_cooling_device_register(
297d716f 604 (char *)psy->desc->name,
952aeeb3 605 psy, &psy_tcd_ops);
9d2410c7 606 return PTR_ERR_OR_ZERO(psy->tcd);
952aeeb3
RP
607 }
608 }
609 return 0;
610}
611
612static void psy_unregister_cooler(struct power_supply *psy)
613{
614 if (IS_ERR_OR_NULL(psy->tcd))
615 return;
616 thermal_cooling_device_unregister(psy->tcd);
617}
3be330bf
JT
618#else
619static int psy_register_thermal(struct power_supply *psy)
620{
621 return 0;
622}
623
624static void psy_unregister_thermal(struct power_supply *psy)
625{
626}
952aeeb3
RP
627
628static int psy_register_cooler(struct power_supply *psy)
629{
630 return 0;
631}
632
633static void psy_unregister_cooler(struct power_supply *psy)
634{
635}
3be330bf
JT
636#endif
637
297d716f
KK
638static struct power_supply *__must_check
639__power_supply_register(struct device *parent,
640 const struct power_supply_desc *desc,
2dc9215d
KK
641 const struct power_supply_config *cfg,
642 bool ws)
4a11b59d 643{
5f487cd3 644 struct device *dev;
297d716f 645 struct power_supply *psy;
5f487cd3 646 int rc;
4a11b59d 647
297d716f
KK
648 psy = kzalloc(sizeof(*psy), GFP_KERNEL);
649 if (!psy)
650 return ERR_PTR(-ENOMEM);
651
652 dev = &psy->dev;
4a11b59d 653
5f487cd3 654 device_initialize(dev);
4a11b59d 655
5f487cd3
AV
656 dev->class = power_supply_class;
657 dev->type = &power_supply_dev_type;
658 dev->parent = parent;
659 dev->release = power_supply_dev_release;
660 dev_set_drvdata(dev, psy);
297d716f 661 psy->desc = desc;
2dc9215d
KK
662 if (cfg) {
663 psy->drv_data = cfg->drv_data;
664 psy->of_node = cfg->of_node;
665 psy->supplied_to = cfg->supplied_to;
666 psy->num_supplicants = cfg->num_supplicants;
667 }
5f487cd3 668
297d716f 669 rc = dev_set_name(dev, "%s", desc->name);
80c6463e
SK
670 if (rc)
671 goto dev_set_name_failed;
672
97774672
LPC
673 INIT_WORK(&psy->changed_work, power_supply_changed_work);
674
f6e0b081
RK
675 rc = power_supply_check_supplies(psy);
676 if (rc) {
677 dev_info(dev, "Not all required supplies found, defer probe\n");
678 goto check_supplies_failed;
679 }
680
948dcf96 681 spin_lock_init(&psy->changed_lock);
9113e260 682 rc = device_init_wakeup(dev, ws);
948dcf96
ZM
683 if (rc)
684 goto wakeup_init_failed;
685
5f487cd3 686 rc = device_add(dev);
4a11b59d 687 if (rc)
5f487cd3
AV
688 goto device_add_failed;
689
3be330bf
JT
690 rc = psy_register_thermal(psy);
691 if (rc)
692 goto register_thermal_failed;
693
952aeeb3
RP
694 rc = psy_register_cooler(psy);
695 if (rc)
696 goto register_cooler_failed;
697
4a11b59d
AV
698 rc = power_supply_create_triggers(psy);
699 if (rc)
700 goto create_triggers_failed;
701
8e59c7f2
KK
702 /*
703 * Update use_cnt after any uevents (most notably from device_add()).
704 * We are here still during driver's probe but
705 * the power_supply_uevent() calls back driver's get_property
706 * method so:
707 * 1. Driver did not assigned the returned struct power_supply,
708 * 2. Driver could not finish initialization (anything in its probe
709 * after calling power_supply_register()).
710 */
711 atomic_inc(&psy->use_cnt);
4a11b59d
AV
712 power_supply_changed(psy);
713
297d716f 714 return psy;
4a11b59d
AV
715
716create_triggers_failed:
952aeeb3
RP
717 psy_unregister_cooler(psy);
718register_cooler_failed:
3be330bf
JT
719 psy_unregister_thermal(psy);
720register_thermal_failed:
3a2dbd61 721 device_del(dev);
5f487cd3 722device_add_failed:
80c6463e 723wakeup_init_failed:
f6e0b081 724check_supplies_failed:
80c6463e 725dev_set_name_failed:
3a2dbd61 726 put_device(dev);
297d716f 727 return ERR_PTR(rc);
4a11b59d 728}
9113e260 729
297d716f
KK
730/**
731 * power_supply_register() - Register new power supply
732 * @parent: Device to be a parent of power supply's device
733 * @desc: Description of power supply, must be valid through whole
734 * lifetime of this power supply
735 * @cfg: Run-time specific configuration accessed during registering,
736 * may be NULL
737 *
738 * Return: A pointer to newly allocated power_supply on success
739 * or ERR_PTR otherwise.
740 * Use power_supply_unregister() on returned power_supply pointer to release
741 * resources.
742 */
743struct power_supply *__must_check power_supply_register(struct device *parent,
744 const struct power_supply_desc *desc,
2dc9215d 745 const struct power_supply_config *cfg)
9113e260 746{
297d716f 747 return __power_supply_register(parent, desc, cfg, true);
9113e260 748}
ff3417e7 749EXPORT_SYMBOL_GPL(power_supply_register);
4a11b59d 750
297d716f
KK
751/**
752 * power_supply_register() - Register new non-waking-source power supply
753 * @parent: Device to be a parent of power supply's device
754 * @desc: Description of power supply, must be valid through whole
755 * lifetime of this power supply
756 * @cfg: Run-time specific configuration accessed during registering,
757 * may be NULL
758 *
759 * Return: A pointer to newly allocated power_supply on success
760 * or ERR_PTR otherwise.
761 * Use power_supply_unregister() on returned power_supply pointer to release
762 * resources.
763 */
764struct power_supply *__must_check
765power_supply_register_no_ws(struct device *parent,
766 const struct power_supply_desc *desc,
2dc9215d 767 const struct power_supply_config *cfg)
9113e260 768{
297d716f 769 return __power_supply_register(parent, desc, cfg, false);
9113e260
ZR
770}
771EXPORT_SYMBOL_GPL(power_supply_register_no_ws);
772
5d8a4219
N
773static void devm_power_supply_release(struct device *dev, void *res)
774{
775 struct power_supply **psy = res;
776
777 power_supply_unregister(*psy);
778}
779
297d716f
KK
780/**
781 * power_supply_register() - Register managed power supply
782 * @parent: Device to be a parent of power supply's device
783 * @desc: Description of power supply, must be valid through whole
784 * lifetime of this power supply
785 * @cfg: Run-time specific configuration accessed during registering,
786 * may be NULL
787 *
788 * Return: A pointer to newly allocated power_supply on success
789 * or ERR_PTR otherwise.
790 * The returned power_supply pointer will be automatically unregistered
791 * on driver detach.
792 */
793struct power_supply *__must_check
794devm_power_supply_register(struct device *parent,
795 const struct power_supply_desc *desc,
2dc9215d 796 const struct power_supply_config *cfg)
5d8a4219 797{
297d716f
KK
798 struct power_supply **ptr, *psy;
799
800 ptr = devres_alloc(devm_power_supply_release, sizeof(*ptr), GFP_KERNEL);
5d8a4219
N
801
802 if (!ptr)
297d716f
KK
803 return ERR_PTR(-ENOMEM);
804 psy = __power_supply_register(parent, desc, cfg, true);
805 if (IS_ERR(psy)) {
5d8a4219 806 devres_free(ptr);
297d716f 807 } else {
5d8a4219
N
808 *ptr = psy;
809 devres_add(parent, ptr);
810 }
297d716f 811 return psy;
5d8a4219
N
812}
813EXPORT_SYMBOL_GPL(devm_power_supply_register);
814
297d716f
KK
815/**
816 * power_supply_register() - Register managed non-waking-source power supply
817 * @parent: Device to be a parent of power supply's device
818 * @desc: Description of power supply, must be valid through whole
819 * lifetime of this power supply
820 * @cfg: Run-time specific configuration accessed during registering,
821 * may be NULL
822 *
823 * Return: A pointer to newly allocated power_supply on success
824 * or ERR_PTR otherwise.
825 * The returned power_supply pointer will be automatically unregistered
826 * on driver detach.
827 */
828struct power_supply *__must_check
829devm_power_supply_register_no_ws(struct device *parent,
830 const struct power_supply_desc *desc,
2dc9215d 831 const struct power_supply_config *cfg)
5d8a4219 832{
297d716f
KK
833 struct power_supply **ptr, *psy;
834
835 ptr = devres_alloc(devm_power_supply_release, sizeof(*ptr), GFP_KERNEL);
5d8a4219
N
836
837 if (!ptr)
297d716f
KK
838 return ERR_PTR(-ENOMEM);
839 psy = __power_supply_register(parent, desc, cfg, false);
840 if (IS_ERR(psy)) {
5d8a4219 841 devres_free(ptr);
297d716f 842 } else {
5d8a4219
N
843 *ptr = psy;
844 devres_add(parent, ptr);
845 }
297d716f 846 return psy;
5d8a4219
N
847}
848EXPORT_SYMBOL_GPL(devm_power_supply_register_no_ws);
849
297d716f
KK
850/**
851 * power_supply_unregister() - Remove this power supply from system
852 * @psy: Pointer to power supply to unregister
853 *
854 * Remove this power supply from the system. The resources of power supply
855 * will be freed here or on last power_supply_put() call.
856 */
4a11b59d
AV
857void power_supply_unregister(struct power_supply *psy)
858{
bc154056 859 WARN_ON(atomic_dec_return(&psy->use_cnt));
bc51e7ff 860 cancel_work_sync(&psy->changed_work);
297d716f 861 sysfs_remove_link(&psy->dev.kobj, "powers");
4a11b59d 862 power_supply_remove_triggers(psy);
952aeeb3 863 psy_unregister_cooler(psy);
3be330bf 864 psy_unregister_thermal(psy);
297d716f
KK
865 device_init_wakeup(&psy->dev, false);
866 device_unregister(&psy->dev);
4a11b59d 867}
ff3417e7 868EXPORT_SYMBOL_GPL(power_supply_unregister);
4a11b59d 869
e44ea364
KK
870void *power_supply_get_drvdata(struct power_supply *psy)
871{
872 return psy->drv_data;
873}
874EXPORT_SYMBOL_GPL(power_supply_get_drvdata);
875
4a11b59d
AV
876static int __init power_supply_class_init(void)
877{
878 power_supply_class = class_create(THIS_MODULE, "power_supply");
879
880 if (IS_ERR(power_supply_class))
881 return PTR_ERR(power_supply_class);
882
883 power_supply_class->dev_uevent = power_supply_uevent;
5f487cd3 884 power_supply_init_attrs(&power_supply_dev_type);
4a11b59d
AV
885
886 return 0;
887}
888
889static void __exit power_supply_class_exit(void)
890{
891 class_destroy(power_supply_class);
4a11b59d
AV
892}
893
4a11b59d
AV
894subsys_initcall(power_supply_class_init);
895module_exit(power_supply_class_exit);
896
897MODULE_DESCRIPTION("Universal power supply monitor class");
898MODULE_AUTHOR("Ian Molton <spyro@f2s.com>, "
899 "Szabolcs Gyurko, "
900 "Anton Vorontsov <cbou@mail.ru>");
901MODULE_LICENSE("GPL");
This page took 0.552568 seconds and 5 git commands to generate.