1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * TI LP8788 MFD - battery charger driver
4 *
5 * Copyright 2012 Texas Instruments
6 *
7 * Author: Milo(Woogyom) Kim <milo.kim@ti.com>
8 */
9
10#include <linux/err.h>
11#include <linux/iio/consumer.h>
12#include <linux/interrupt.h>
13#include <linux/irqdomain.h>
14#include <linux/mfd/lp8788.h>
15#include <linux/module.h>
16#include <linux/platform_device.h>
17#include <linux/power_supply.h>
18#include <linux/slab.h>
19#include <linux/workqueue.h>
20
21/* register address */
22#define LP8788_CHG_STATUS 0x07
23#define LP8788_CHG_IDCIN 0x13
24#define LP8788_CHG_IBATT 0x14
25#define LP8788_CHG_VTERM 0x15
26#define LP8788_CHG_EOC 0x16
27
28/* mask/shift bits */
29#define LP8788_CHG_INPUT_STATE_M 0x03 /* Addr 07h */
30#define LP8788_CHG_STATE_M 0x3C
31#define LP8788_CHG_STATE_S 2
32#define LP8788_NO_BATT_M BIT(6)
33#define LP8788_BAD_BATT_M BIT(7)
34#define LP8788_CHG_IBATT_M 0x1F /* Addr 14h */
35#define LP8788_CHG_VTERM_M 0x0F /* Addr 15h */
36#define LP8788_CHG_EOC_LEVEL_M 0x30 /* Addr 16h */
37#define LP8788_CHG_EOC_LEVEL_S 4
38#define LP8788_CHG_EOC_TIME_M 0x0E
39#define LP8788_CHG_EOC_TIME_S 1
40#define LP8788_CHG_EOC_MODE_M BIT(0)
41
42#define LP8788_CHARGER_NAME "charger"
43#define LP8788_BATTERY_NAME "main_batt"
44
45#define LP8788_CHG_START 0x11
46#define LP8788_CHG_END 0x1C
47
48#define LP8788_ISEL_MAX 23
49#define LP8788_ISEL_STEP 50
50#define LP8788_VTERM_MIN 4100
51#define LP8788_VTERM_STEP 25
52#define LP8788_MAX_BATT_CAPACITY 100
53#define LP8788_MAX_CHG_IRQS 11
54
55enum lp8788_charging_state {
56 LP8788_OFF,
57 LP8788_WARM_UP,
58 LP8788_LOW_INPUT = 0x3,
59 LP8788_PRECHARGE,
60 LP8788_CC,
61 LP8788_CV,
62 LP8788_MAINTENANCE,
63 LP8788_BATTERY_FAULT,
64 LP8788_SYSTEM_SUPPORT = 0xC,
65 LP8788_HIGH_CURRENT = 0xF,
66 LP8788_MAX_CHG_STATE,
67};
68
69enum lp8788_charger_adc_sel {
70 LP8788_VBATT,
71 LP8788_BATT_TEMP,
72 LP8788_NUM_CHG_ADC,
73};
74
75enum lp8788_charger_input_state {
76 LP8788_SYSTEM_SUPPLY = 1,
77 LP8788_FULL_FUNCTION,
78};
79
80/*
81 * struct lp8788_chg_irq
82 * @which : lp8788 interrupt id
83 * @virq : Linux IRQ number from irq_domain
84 */
85struct lp8788_chg_irq {
86 enum lp8788_int_id which;
87 int virq;
88};
89
90/*
91 * struct lp8788_charger
92 * @lp : used for accessing the registers of mfd lp8788 device
93 * @charger : power supply driver for the battery charger
94 * @battery : power supply driver for the battery
95 * @charger_work : work queue for charger input interrupts
96 * @chan : iio channels for getting adc values
97 * eg) battery voltage, capacity and temperature
98 * @irqs : charger dedicated interrupts
99 * @num_irqs : total numbers of charger interrupts
100 * @pdata : charger platform specific data
101 */
102struct lp8788_charger {
103 struct lp8788 *lp;
104 struct power_supply *charger;
105 struct power_supply *battery;
106 struct work_struct charger_work;
107 struct iio_channel *chan[LP8788_NUM_CHG_ADC];
108 struct lp8788_chg_irq irqs[LP8788_MAX_CHG_IRQS];
109 int num_irqs;
110 struct lp8788_charger_platform_data *pdata;
111};
112
113static char *battery_supplied_to[] = {
114 LP8788_BATTERY_NAME,
115};
116
117static enum power_supply_property lp8788_charger_prop[] = {
118 POWER_SUPPLY_PROP_ONLINE,
119 POWER_SUPPLY_PROP_CURRENT_MAX,
120};
121
122static enum power_supply_property lp8788_battery_prop[] = {
123 POWER_SUPPLY_PROP_STATUS,
124 POWER_SUPPLY_PROP_HEALTH,
125 POWER_SUPPLY_PROP_PRESENT,
126 POWER_SUPPLY_PROP_VOLTAGE_NOW,
127 POWER_SUPPLY_PROP_CAPACITY,
128 POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT,
129 POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX,
130 POWER_SUPPLY_PROP_TEMP,
131};
132
133static bool lp8788_is_charger_detected(struct lp8788_charger *pchg)
134{
135 u8 data;
136
137 lp8788_read_byte(lp: pchg->lp, LP8788_CHG_STATUS, data: &data);
138 data &= LP8788_CHG_INPUT_STATE_M;
139
140 return data == LP8788_SYSTEM_SUPPLY || data == LP8788_FULL_FUNCTION;
141}
142
143static int lp8788_charger_get_property(struct power_supply *psy,
144 enum power_supply_property psp,
145 union power_supply_propval *val)
146{
147 struct lp8788_charger *pchg = dev_get_drvdata(dev: psy->dev.parent);
148 u8 read;
149
150 switch (psp) {
151 case POWER_SUPPLY_PROP_ONLINE:
152 val->intval = lp8788_is_charger_detected(pchg);
153 break;
154 case POWER_SUPPLY_PROP_CURRENT_MAX:
155 lp8788_read_byte(lp: pchg->lp, LP8788_CHG_IDCIN, data: &read);
156 val->intval = LP8788_ISEL_STEP *
157 (min_t(int, read, LP8788_ISEL_MAX) + 1);
158 break;
159 default:
160 return -EINVAL;
161 }
162
163 return 0;
164}
165
166static int lp8788_get_battery_status(struct lp8788_charger *pchg,
167 union power_supply_propval *val)
168{
169 enum lp8788_charging_state state;
170 u8 data;
171 int ret;
172
173 ret = lp8788_read_byte(lp: pchg->lp, LP8788_CHG_STATUS, data: &data);
174 if (ret)
175 return ret;
176
177 state = (data & LP8788_CHG_STATE_M) >> LP8788_CHG_STATE_S;
178 switch (state) {
179 case LP8788_OFF:
180 val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
181 break;
182 case LP8788_PRECHARGE:
183 case LP8788_CC:
184 case LP8788_CV:
185 case LP8788_HIGH_CURRENT:
186 val->intval = POWER_SUPPLY_STATUS_CHARGING;
187 break;
188 case LP8788_MAINTENANCE:
189 val->intval = POWER_SUPPLY_STATUS_FULL;
190 break;
191 default:
192 val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
193 break;
194 }
195
196 return 0;
197}
198
199static int lp8788_get_battery_health(struct lp8788_charger *pchg,
200 union power_supply_propval *val)
201{
202 u8 data;
203 int ret;
204
205 ret = lp8788_read_byte(lp: pchg->lp, LP8788_CHG_STATUS, data: &data);
206 if (ret)
207 return ret;
208
209 if (data & LP8788_NO_BATT_M)
210 val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
211 else if (data & LP8788_BAD_BATT_M)
212 val->intval = POWER_SUPPLY_HEALTH_DEAD;
213 else
214 val->intval = POWER_SUPPLY_HEALTH_GOOD;
215
216 return 0;
217}
218
219static int lp8788_get_battery_present(struct lp8788_charger *pchg,
220 union power_supply_propval *val)
221{
222 u8 data;
223 int ret;
224
225 ret = lp8788_read_byte(lp: pchg->lp, LP8788_CHG_STATUS, data: &data);
226 if (ret)
227 return ret;
228
229 val->intval = !(data & LP8788_NO_BATT_M);
230 return 0;
231}
232
233static int lp8788_get_vbatt_adc(struct lp8788_charger *pchg, int *result)
234{
235 struct iio_channel *channel = pchg->chan[LP8788_VBATT];
236
237 if (!channel)
238 return -EINVAL;
239
240 return iio_read_channel_processed(chan: channel, val: result);
241}
242
243static int lp8788_get_battery_voltage(struct lp8788_charger *pchg,
244 union power_supply_propval *val)
245{
246 return lp8788_get_vbatt_adc(pchg, result: &val->intval);
247}
248
249static int lp8788_get_battery_capacity(struct lp8788_charger *pchg,
250 union power_supply_propval *val)
251{
252 struct lp8788 *lp = pchg->lp;
253 struct lp8788_charger_platform_data *pdata = pchg->pdata;
254 unsigned int max_vbatt;
255 int vbatt;
256 enum lp8788_charging_state state;
257 u8 data;
258 int ret;
259
260 if (!pdata)
261 return -EINVAL;
262
263 max_vbatt = pdata->max_vbatt_mv;
264 if (max_vbatt == 0)
265 return -EINVAL;
266
267 ret = lp8788_read_byte(lp, LP8788_CHG_STATUS, data: &data);
268 if (ret)
269 return ret;
270
271 state = (data & LP8788_CHG_STATE_M) >> LP8788_CHG_STATE_S;
272
273 if (state == LP8788_MAINTENANCE) {
274 val->intval = LP8788_MAX_BATT_CAPACITY;
275 } else {
276 ret = lp8788_get_vbatt_adc(pchg, result: &vbatt);
277 if (ret)
278 return ret;
279
280 val->intval = (vbatt * LP8788_MAX_BATT_CAPACITY) / max_vbatt;
281 val->intval = min(val->intval, LP8788_MAX_BATT_CAPACITY);
282 }
283
284 return 0;
285}
286
287static int lp8788_get_battery_temperature(struct lp8788_charger *pchg,
288 union power_supply_propval *val)
289{
290 struct iio_channel *channel = pchg->chan[LP8788_BATT_TEMP];
291 int result;
292 int ret;
293
294 if (!channel)
295 return -EINVAL;
296
297 ret = iio_read_channel_processed(chan: channel, val: &result);
298 if (ret < 0)
299 return -EINVAL;
300
301 /* unit: 0.1 'C */
302 val->intval = result * 10;
303
304 return 0;
305}
306
307static int lp8788_get_battery_charging_current(struct lp8788_charger *pchg,
308 union power_supply_propval *val)
309{
310 u8 read;
311
312 lp8788_read_byte(lp: pchg->lp, LP8788_CHG_IBATT, data: &read);
313 read &= LP8788_CHG_IBATT_M;
314 val->intval = LP8788_ISEL_STEP *
315 (min_t(int, read, LP8788_ISEL_MAX) + 1);
316
317 return 0;
318}
319
320static int lp8788_get_charging_termination_voltage(struct lp8788_charger *pchg,
321 union power_supply_propval *val)
322{
323 u8 read;
324
325 lp8788_read_byte(lp: pchg->lp, LP8788_CHG_VTERM, data: &read);
326 read &= LP8788_CHG_VTERM_M;
327 val->intval = LP8788_VTERM_MIN + LP8788_VTERM_STEP * read;
328
329 return 0;
330}
331
332static int lp8788_battery_get_property(struct power_supply *psy,
333 enum power_supply_property psp,
334 union power_supply_propval *val)
335{
336 struct lp8788_charger *pchg = dev_get_drvdata(dev: psy->dev.parent);
337
338 switch (psp) {
339 case POWER_SUPPLY_PROP_STATUS:
340 return lp8788_get_battery_status(pchg, val);
341 case POWER_SUPPLY_PROP_HEALTH:
342 return lp8788_get_battery_health(pchg, val);
343 case POWER_SUPPLY_PROP_PRESENT:
344 return lp8788_get_battery_present(pchg, val);
345 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
346 return lp8788_get_battery_voltage(pchg, val);
347 case POWER_SUPPLY_PROP_CAPACITY:
348 return lp8788_get_battery_capacity(pchg, val);
349 case POWER_SUPPLY_PROP_TEMP:
350 return lp8788_get_battery_temperature(pchg, val);
351 case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
352 return lp8788_get_battery_charging_current(pchg, val);
353 case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
354 return lp8788_get_charging_termination_voltage(pchg, val);
355 default:
356 return -EINVAL;
357 }
358}
359
360static inline bool lp8788_is_valid_charger_register(u8 addr)
361{
362 return addr >= LP8788_CHG_START && addr <= LP8788_CHG_END;
363}
364
365static int lp8788_update_charger_params(struct platform_device *pdev,
366 struct lp8788_charger *pchg)
367{
368 struct lp8788 *lp = pchg->lp;
369 struct lp8788_charger_platform_data *pdata = pchg->pdata;
370 struct lp8788_chg_param *param;
371 int i;
372 int ret;
373
374 if (!pdata || !pdata->chg_params) {
375 dev_info(&pdev->dev, "skip updating charger parameters\n");
376 return 0;
377 }
378
379 /* setting charging parameters */
380 for (i = 0; i < pdata->num_chg_params; i++) {
381 param = pdata->chg_params + i;
382
383 if (lp8788_is_valid_charger_register(addr: param->addr)) {
384 ret = lp8788_write_byte(lp, reg: param->addr, data: param->val);
385 if (ret)
386 return ret;
387 }
388 }
389
390 return 0;
391}
392
393static const struct power_supply_desc lp8788_psy_charger_desc = {
394 .name = LP8788_CHARGER_NAME,
395 .type = POWER_SUPPLY_TYPE_MAINS,
396 .properties = lp8788_charger_prop,
397 .num_properties = ARRAY_SIZE(lp8788_charger_prop),
398 .get_property = lp8788_charger_get_property,
399};
400
401static const struct power_supply_desc lp8788_psy_battery_desc = {
402 .name = LP8788_BATTERY_NAME,
403 .type = POWER_SUPPLY_TYPE_BATTERY,
404 .properties = lp8788_battery_prop,
405 .num_properties = ARRAY_SIZE(lp8788_battery_prop),
406 .get_property = lp8788_battery_get_property,
407};
408
409static void lp8788_psy_unregister(struct lp8788_charger *pchg)
410{
411 power_supply_unregister(psy: pchg->battery);
412 power_supply_unregister(psy: pchg->charger);
413}
414
415static void lp8788_charger_event(struct work_struct *work)
416{
417 struct lp8788_charger *pchg =
418 container_of(work, struct lp8788_charger, charger_work);
419 struct lp8788_charger_platform_data *pdata = pchg->pdata;
420 enum lp8788_charger_event event = lp8788_is_charger_detected(pchg);
421
422 pdata->charger_event(pchg->lp, event);
423}
424
425static bool lp8788_find_irq_id(struct lp8788_charger *pchg, int virq, int *id)
426{
427 bool found = false;
428 int i;
429
430 for (i = 0; i < pchg->num_irqs; i++) {
431 if (pchg->irqs[i].virq == virq) {
432 *id = pchg->irqs[i].which;
433 found = true;
434 break;
435 }
436 }
437
438 return found;
439}
440
441static irqreturn_t lp8788_charger_irq_thread(int virq, void *ptr)
442{
443 struct lp8788_charger *pchg = ptr;
444 struct lp8788_charger_platform_data *pdata = pchg->pdata;
445 int id = -1;
446
447 if (!lp8788_find_irq_id(pchg, virq, id: &id))
448 return IRQ_NONE;
449
450 switch (id) {
451 case LP8788_INT_CHG_INPUT_STATE:
452 case LP8788_INT_CHG_STATE:
453 case LP8788_INT_EOC:
454 case LP8788_INT_BATT_LOW:
455 case LP8788_INT_NO_BATT:
456 power_supply_changed(psy: pchg->charger);
457 power_supply_changed(psy: pchg->battery);
458 break;
459 default:
460 break;
461 }
462
463 /* report charger dectection event if used */
464 if (!pdata)
465 goto irq_handled;
466
467 if (pdata->charger_event && id == LP8788_INT_CHG_INPUT_STATE)
468 schedule_work(work: &pchg->charger_work);
469
470irq_handled:
471 return IRQ_HANDLED;
472}
473
474static int lp8788_set_irqs(struct platform_device *pdev,
475 struct lp8788_charger *pchg, const char *name)
476{
477 struct resource *r;
478 struct irq_domain *irqdm = pchg->lp->irqdm;
479 int irq_start;
480 int irq_end;
481 int virq;
482 int nr_irq;
483 int i;
484 int ret;
485
486 /* no error even if no irq resource */
487 r = platform_get_resource_byname(pdev, IORESOURCE_IRQ, name);
488 if (!r)
489 return 0;
490
491 irq_start = r->start;
492 irq_end = r->end;
493
494 for (i = irq_start; i <= irq_end; i++) {
495 nr_irq = pchg->num_irqs;
496
497 virq = irq_create_mapping(host: irqdm, hwirq: i);
498 pchg->irqs[nr_irq].virq = virq;
499 pchg->irqs[nr_irq].which = i;
500 pchg->num_irqs++;
501
502 ret = request_threaded_irq(irq: virq, NULL,
503 thread_fn: lp8788_charger_irq_thread,
504 IRQF_ONESHOT, name, dev: pchg);
505 if (ret)
506 break;
507 }
508
509 if (i <= irq_end)
510 goto err_free_irq;
511
512 return 0;
513
514err_free_irq:
515 for (i = 0; i < pchg->num_irqs; i++)
516 free_irq(pchg->irqs[i].virq, pchg);
517 return ret;
518}
519
520static int lp8788_irq_register(struct platform_device *pdev,
521 struct lp8788_charger *pchg)
522{
523 static const char * const name[] = {
524 LP8788_CHG_IRQ, LP8788_PRSW_IRQ, LP8788_BATT_IRQ
525 };
526 int i;
527 int ret;
528
529 INIT_WORK(&pchg->charger_work, lp8788_charger_event);
530 pchg->num_irqs = 0;
531
532 for (i = 0; i < ARRAY_SIZE(name); i++) {
533 ret = lp8788_set_irqs(pdev, pchg, name: name[i]);
534 if (ret) {
535 dev_warn(&pdev->dev, "irq setup failed: %s\n", name[i]);
536 return ret;
537 }
538 }
539
540 if (pchg->num_irqs > LP8788_MAX_CHG_IRQS) {
541 dev_err(&pdev->dev, "invalid total number of irqs: %d\n",
542 pchg->num_irqs);
543 return -EINVAL;
544 }
545
546
547 return 0;
548}
549
550static void lp8788_irq_unregister(struct platform_device *pdev,
551 struct lp8788_charger *pchg)
552{
553 int i;
554 int irq;
555
556 for (i = 0; i < pchg->num_irqs; i++) {
557 irq = pchg->irqs[i].virq;
558 if (!irq)
559 continue;
560
561 free_irq(irq, pchg);
562 }
563}
564
565static void lp8788_setup_adc_channel(struct device *dev,
566 struct lp8788_charger *pchg)
567{
568 struct lp8788_charger_platform_data *pdata = pchg->pdata;
569 struct iio_channel *chan;
570
571 if (!pdata)
572 return;
573
574 /* ADC channel for battery voltage */
575 chan = devm_iio_channel_get(dev, consumer_channel: pdata->adc_vbatt);
576 pchg->chan[LP8788_VBATT] = IS_ERR(ptr: chan) ? NULL : chan;
577
578 /* ADC channel for battery temperature */
579 chan = devm_iio_channel_get(dev, consumer_channel: pdata->adc_batt_temp);
580 pchg->chan[LP8788_BATT_TEMP] = IS_ERR(ptr: chan) ? NULL : chan;
581}
582
583static ssize_t lp8788_show_charger_status(struct device *dev,
584 struct device_attribute *attr, char *buf)
585{
586 struct lp8788_charger *pchg = dev_get_drvdata(dev);
587 enum lp8788_charging_state state;
588 static const char * const desc[LP8788_MAX_CHG_STATE] = {
589 [LP8788_OFF] = "CHARGER OFF",
590 [LP8788_WARM_UP] = "WARM UP",
591 [LP8788_LOW_INPUT] = "LOW INPUT STATE",
592 [LP8788_PRECHARGE] = "CHARGING - PRECHARGE",
593 [LP8788_CC] = "CHARGING - CC",
594 [LP8788_CV] = "CHARGING - CV",
595 [LP8788_MAINTENANCE] = "NO CHARGING - MAINTENANCE",
596 [LP8788_BATTERY_FAULT] = "BATTERY FAULT",
597 [LP8788_SYSTEM_SUPPORT] = "SYSTEM SUPPORT",
598 [LP8788_HIGH_CURRENT] = "HIGH CURRENT",
599 };
600 u8 data;
601
602 lp8788_read_byte(lp: pchg->lp, LP8788_CHG_STATUS, data: &data);
603 state = (data & LP8788_CHG_STATE_M) >> LP8788_CHG_STATE_S;
604
605 return sysfs_emit(buf, fmt: "%s\n", desc[state]);
606}
607
608static ssize_t lp8788_show_eoc_time(struct device *dev,
609 struct device_attribute *attr, char *buf)
610{
611 struct lp8788_charger *pchg = dev_get_drvdata(dev);
612 static const char * const stime[] = {
613 "400ms", "5min", "10min", "15min",
614 "20min", "25min", "30min", "No timeout"
615 };
616 u8 val;
617
618 lp8788_read_byte(lp: pchg->lp, LP8788_CHG_EOC, data: &val);
619 val = (val & LP8788_CHG_EOC_TIME_M) >> LP8788_CHG_EOC_TIME_S;
620
621 return sysfs_emit(buf, fmt: "End Of Charge Time: %s\n", stime[val]);
622}
623
624static ssize_t lp8788_show_eoc_level(struct device *dev,
625 struct device_attribute *attr, char *buf)
626{
627 struct lp8788_charger *pchg = dev_get_drvdata(dev);
628 static const char * const abs_level[] = {
629 "25mA", "49mA", "75mA", "98mA"
630 };
631 static const char * const relative_level[] = {
632 "5%", "10%", "15%", "20%"
633 };
634 const char *level;
635 u8 val;
636 u8 mode;
637
638 lp8788_read_byte(lp: pchg->lp, LP8788_CHG_EOC, data: &val);
639
640 mode = val & LP8788_CHG_EOC_MODE_M;
641 val = (val & LP8788_CHG_EOC_LEVEL_M) >> LP8788_CHG_EOC_LEVEL_S;
642 level = mode ? abs_level[val] : relative_level[val];
643
644 return sysfs_emit(buf, fmt: "End Of Charge Level: %s\n", level);
645}
646
647static DEVICE_ATTR(charger_status, S_IRUSR, lp8788_show_charger_status, NULL);
648static DEVICE_ATTR(eoc_time, S_IRUSR, lp8788_show_eoc_time, NULL);
649static DEVICE_ATTR(eoc_level, S_IRUSR, lp8788_show_eoc_level, NULL);
650
651static struct attribute *lp8788_charger_sysfs_attrs[] = {
652 &dev_attr_charger_status.attr,
653 &dev_attr_eoc_time.attr,
654 &dev_attr_eoc_level.attr,
655 NULL,
656};
657
658ATTRIBUTE_GROUPS(lp8788_charger_sysfs);
659
660static int lp8788_psy_register(struct platform_device *pdev,
661 struct lp8788_charger *pchg)
662{
663 struct power_supply_config charger_cfg = {};
664
665 charger_cfg.attr_grp = lp8788_charger_sysfs_groups;
666 charger_cfg.supplied_to = battery_supplied_to;
667 charger_cfg.num_supplicants = ARRAY_SIZE(battery_supplied_to);
668
669 pchg->charger = power_supply_register(parent: &pdev->dev,
670 desc: &lp8788_psy_charger_desc,
671 cfg: &charger_cfg);
672 if (IS_ERR(ptr: pchg->charger))
673 return -EPERM;
674
675 pchg->battery = power_supply_register(parent: &pdev->dev,
676 desc: &lp8788_psy_battery_desc, NULL);
677 if (IS_ERR(ptr: pchg->battery)) {
678 power_supply_unregister(psy: pchg->charger);
679 return -EPERM;
680 }
681
682 return 0;
683}
684
685static int lp8788_charger_probe(struct platform_device *pdev)
686{
687 struct lp8788 *lp = dev_get_drvdata(dev: pdev->dev.parent);
688 struct lp8788_charger *pchg;
689 struct device *dev = &pdev->dev;
690 int ret;
691
692 pchg = devm_kzalloc(dev, size: sizeof(struct lp8788_charger), GFP_KERNEL);
693 if (!pchg)
694 return -ENOMEM;
695
696 pchg->lp = lp;
697 pchg->pdata = lp->pdata ? lp->pdata->chg_pdata : NULL;
698 platform_set_drvdata(pdev, data: pchg);
699
700 ret = lp8788_update_charger_params(pdev, pchg);
701 if (ret)
702 return ret;
703
704 lp8788_setup_adc_channel(dev: &pdev->dev, pchg);
705
706 ret = lp8788_psy_register(pdev, pchg);
707 if (ret)
708 return ret;
709
710 ret = lp8788_irq_register(pdev, pchg);
711 if (ret)
712 dev_warn(dev, "failed to register charger irq: %d\n", ret);
713
714 return 0;
715}
716
717static void lp8788_charger_remove(struct platform_device *pdev)
718{
719 struct lp8788_charger *pchg = platform_get_drvdata(pdev);
720
721 flush_work(work: &pchg->charger_work);
722 lp8788_irq_unregister(pdev, pchg);
723 lp8788_psy_unregister(pchg);
724}
725
726static struct platform_driver lp8788_charger_driver = {
727 .probe = lp8788_charger_probe,
728 .remove_new = lp8788_charger_remove,
729 .driver = {
730 .name = LP8788_DEV_CHARGER,
731 },
732};
733module_platform_driver(lp8788_charger_driver);
734
735MODULE_DESCRIPTION("TI LP8788 Charger Driver");
736MODULE_AUTHOR("Milo Kim");
737MODULE_LICENSE("GPL");
738MODULE_ALIAS("platform:lp8788-charger");
739

source code of linux/drivers/power/supply/lp8788-charger.c