1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Fuel gauge driver for CellWise 2013 / 2015
4 *
5 * Copyright (C) 2012, RockChip
6 * Copyright (C) 2020, Tobias Schramm
7 *
8 * Authors: xuhuicong <xhc@rock-chips.com>
9 * Authors: Tobias Schramm <t.schramm@manjaro.org>
10 */
11
12#include <linux/bits.h>
13#include <linux/delay.h>
14#include <linux/i2c.h>
15#include <linux/gfp.h>
16#include <linux/gpio/consumer.h>
17#include <linux/kernel.h>
18#include <linux/module.h>
19#include <linux/power_supply.h>
20#include <linux/property.h>
21#include <linux/regmap.h>
22#include <linux/time.h>
23#include <linux/workqueue.h>
24#include <linux/devm-helpers.h>
25
26#define CW2015_SIZE_BATINFO 64
27
28#define CW2015_RESET_TRIES 5
29
30#define CW2015_REG_VERSION 0x00
31#define CW2015_REG_VCELL 0x02
32#define CW2015_REG_SOC 0x04
33#define CW2015_REG_RRT_ALERT 0x06
34#define CW2015_REG_CONFIG 0x08
35#define CW2015_REG_MODE 0x0A
36#define CW2015_REG_BATINFO 0x10
37
38#define CW2015_MODE_SLEEP_MASK GENMASK(7, 6)
39#define CW2015_MODE_SLEEP (0x03 << 6)
40#define CW2015_MODE_NORMAL (0x00 << 6)
41#define CW2015_MODE_QUICK_START (0x03 << 4)
42#define CW2015_MODE_RESTART (0x0f << 0)
43
44#define CW2015_CONFIG_UPDATE_FLG (0x01 << 1)
45#define CW2015_ATHD(x) ((x) << 3)
46#define CW2015_MASK_ATHD GENMASK(7, 3)
47#define CW2015_MASK_SOC GENMASK(12, 0)
48
49/* reset gauge of no valid state of charge could be polled for 40s */
50#define CW2015_BAT_SOC_ERROR_MS (40 * MSEC_PER_SEC)
51/* reset gauge if state of charge stuck for half an hour during charging */
52#define CW2015_BAT_CHARGING_STUCK_MS (1800 * MSEC_PER_SEC)
53
54/* poll interval from CellWise GPL Android driver example */
55#define CW2015_DEFAULT_POLL_INTERVAL_MS 8000
56
57#define CW2015_AVERAGING_SAMPLES 3
58
59struct cw_battery {
60 struct device *dev;
61 struct workqueue_struct *battery_workqueue;
62 struct delayed_work battery_delay_work;
63 struct regmap *regmap;
64 struct power_supply *rk_bat;
65 struct power_supply_battery_info *battery;
66 u8 *bat_profile;
67
68 bool charger_attached;
69 bool battery_changed;
70
71 int soc;
72 int voltage_mv;
73 int status;
74 int time_to_empty;
75 int charge_count;
76
77 u32 poll_interval_ms;
78 u8 alert_level;
79
80 unsigned int read_errors;
81 unsigned int charge_stuck_cnt;
82};
83
84static int cw_read_word(struct cw_battery *cw_bat, u8 reg, u16 *val)
85{
86 __be16 value;
87 int ret;
88
89 ret = regmap_bulk_read(map: cw_bat->regmap, reg, val: &value, val_count: sizeof(value));
90 if (ret)
91 return ret;
92
93 *val = be16_to_cpu(value);
94 return 0;
95}
96
97static int cw_update_profile(struct cw_battery *cw_bat)
98{
99 int ret;
100 unsigned int reg_val;
101 u8 reset_val;
102
103 /* make sure gauge is not in sleep mode */
104 ret = regmap_read(map: cw_bat->regmap, CW2015_REG_MODE, val: &reg_val);
105 if (ret)
106 return ret;
107
108 reset_val = reg_val;
109 if ((reg_val & CW2015_MODE_SLEEP_MASK) == CW2015_MODE_SLEEP) {
110 dev_err(cw_bat->dev,
111 "Gauge is in sleep mode, can't update battery info\n");
112 return -EINVAL;
113 }
114
115 /* write new battery info */
116 ret = regmap_raw_write(map: cw_bat->regmap, CW2015_REG_BATINFO,
117 val: cw_bat->bat_profile,
118 CW2015_SIZE_BATINFO);
119 if (ret)
120 return ret;
121
122 /* set config update flag */
123 reg_val |= CW2015_CONFIG_UPDATE_FLG;
124 reg_val &= ~CW2015_MASK_ATHD;
125 reg_val |= CW2015_ATHD(cw_bat->alert_level);
126 ret = regmap_write(map: cw_bat->regmap, CW2015_REG_CONFIG, val: reg_val);
127 if (ret)
128 return ret;
129
130 /* reset gauge to apply new battery profile */
131 reset_val &= ~CW2015_MODE_RESTART;
132 reg_val = reset_val | CW2015_MODE_RESTART;
133 ret = regmap_write(map: cw_bat->regmap, CW2015_REG_MODE, val: reg_val);
134 if (ret)
135 return ret;
136
137 /* wait for gauge to reset */
138 msleep(msecs: 20);
139
140 /* clear reset flag */
141 ret = regmap_write(map: cw_bat->regmap, CW2015_REG_MODE, val: reset_val);
142 if (ret)
143 return ret;
144
145 /* wait for gauge to become ready */
146 ret = regmap_read_poll_timeout(cw_bat->regmap, CW2015_REG_SOC,
147 reg_val, reg_val <= 100,
148 10 * USEC_PER_MSEC, 10 * USEC_PER_SEC);
149 if (ret)
150 dev_err(cw_bat->dev,
151 "Gauge did not become ready after profile upload\n");
152 else
153 dev_dbg(cw_bat->dev, "Battery profile updated\n");
154
155 return ret;
156}
157
158static int cw_init(struct cw_battery *cw_bat)
159{
160 int ret;
161 unsigned int reg_val = CW2015_MODE_SLEEP;
162
163 if ((reg_val & CW2015_MODE_SLEEP_MASK) == CW2015_MODE_SLEEP) {
164 reg_val = CW2015_MODE_NORMAL;
165 ret = regmap_write(map: cw_bat->regmap, CW2015_REG_MODE, val: reg_val);
166 if (ret)
167 return ret;
168 }
169
170 ret = regmap_read(map: cw_bat->regmap, CW2015_REG_CONFIG, val: &reg_val);
171 if (ret)
172 return ret;
173
174 if ((reg_val & CW2015_MASK_ATHD) != CW2015_ATHD(cw_bat->alert_level)) {
175 dev_dbg(cw_bat->dev, "Setting new alert level\n");
176 reg_val &= ~CW2015_MASK_ATHD;
177 reg_val |= ~CW2015_ATHD(cw_bat->alert_level);
178 ret = regmap_write(map: cw_bat->regmap, CW2015_REG_CONFIG, val: reg_val);
179 if (ret)
180 return ret;
181 }
182
183 ret = regmap_read(map: cw_bat->regmap, CW2015_REG_CONFIG, val: &reg_val);
184 if (ret)
185 return ret;
186
187 if (!(reg_val & CW2015_CONFIG_UPDATE_FLG)) {
188 dev_dbg(cw_bat->dev,
189 "Battery profile not present, uploading battery profile\n");
190 if (cw_bat->bat_profile) {
191 ret = cw_update_profile(cw_bat);
192 if (ret) {
193 dev_err(cw_bat->dev,
194 "Failed to upload battery profile\n");
195 return ret;
196 }
197 } else {
198 dev_warn(cw_bat->dev,
199 "No profile specified, continuing without profile\n");
200 }
201 } else if (cw_bat->bat_profile) {
202 u8 bat_info[CW2015_SIZE_BATINFO];
203
204 ret = regmap_raw_read(map: cw_bat->regmap, CW2015_REG_BATINFO,
205 val: bat_info, CW2015_SIZE_BATINFO);
206 if (ret) {
207 dev_err(cw_bat->dev,
208 "Failed to read stored battery profile\n");
209 return ret;
210 }
211
212 if (memcmp(p: bat_info, q: cw_bat->bat_profile, CW2015_SIZE_BATINFO)) {
213 dev_warn(cw_bat->dev, "Replacing stored battery profile\n");
214 ret = cw_update_profile(cw_bat);
215 if (ret)
216 return ret;
217 }
218 } else {
219 dev_warn(cw_bat->dev,
220 "Can't check current battery profile, no profile provided\n");
221 }
222
223 dev_dbg(cw_bat->dev, "Battery profile configured\n");
224 return 0;
225}
226
227static int cw_power_on_reset(struct cw_battery *cw_bat)
228{
229 int ret;
230 unsigned char reset_val;
231
232 reset_val = CW2015_MODE_SLEEP;
233 ret = regmap_write(map: cw_bat->regmap, CW2015_REG_MODE, val: reset_val);
234 if (ret)
235 return ret;
236
237 /* wait for gauge to enter sleep */
238 msleep(msecs: 20);
239
240 reset_val = CW2015_MODE_NORMAL;
241 ret = regmap_write(map: cw_bat->regmap, CW2015_REG_MODE, val: reset_val);
242 if (ret)
243 return ret;
244
245 ret = cw_init(cw_bat);
246 if (ret)
247 return ret;
248 return 0;
249}
250
251#define HYSTERESIS(current, previous, up, down) \
252 (((current) < (previous) + (up)) && ((current) > (previous) - (down)))
253
254static int cw_get_soc(struct cw_battery *cw_bat)
255{
256 unsigned int soc;
257 int ret;
258
259 ret = regmap_read(map: cw_bat->regmap, CW2015_REG_SOC, val: &soc);
260 if (ret)
261 return ret;
262
263 if (soc > 100) {
264 int max_error_cycles =
265 CW2015_BAT_SOC_ERROR_MS / cw_bat->poll_interval_ms;
266
267 dev_err(cw_bat->dev, "Invalid SoC %d%%\n", soc);
268 cw_bat->read_errors++;
269 if (cw_bat->read_errors > max_error_cycles) {
270 dev_warn(cw_bat->dev,
271 "Too many invalid SoC reports, resetting gauge\n");
272 cw_power_on_reset(cw_bat);
273 cw_bat->read_errors = 0;
274 }
275 return cw_bat->soc;
276 }
277 cw_bat->read_errors = 0;
278
279 /* Reset gauge if stuck while charging */
280 if (cw_bat->status == POWER_SUPPLY_STATUS_CHARGING && soc == cw_bat->soc) {
281 int max_stuck_cycles =
282 CW2015_BAT_CHARGING_STUCK_MS / cw_bat->poll_interval_ms;
283
284 cw_bat->charge_stuck_cnt++;
285 if (cw_bat->charge_stuck_cnt > max_stuck_cycles) {
286 dev_warn(cw_bat->dev,
287 "SoC stuck @%u%%, resetting gauge\n", soc);
288 cw_power_on_reset(cw_bat);
289 cw_bat->charge_stuck_cnt = 0;
290 }
291 } else {
292 cw_bat->charge_stuck_cnt = 0;
293 }
294
295 /* Ignore voltage dips during charge */
296 if (cw_bat->charger_attached && HYSTERESIS(soc, cw_bat->soc, 0, 3))
297 soc = cw_bat->soc;
298
299 /* Ignore voltage spikes during discharge */
300 if (!cw_bat->charger_attached && HYSTERESIS(soc, cw_bat->soc, 3, 0))
301 soc = cw_bat->soc;
302
303 return soc;
304}
305
306static int cw_get_voltage(struct cw_battery *cw_bat)
307{
308 int ret, i, voltage_mv;
309 u16 reg_val;
310 u32 avg = 0;
311
312 for (i = 0; i < CW2015_AVERAGING_SAMPLES; i++) {
313 ret = cw_read_word(cw_bat, CW2015_REG_VCELL, val: &reg_val);
314 if (ret)
315 return ret;
316
317 avg += reg_val;
318 }
319 avg /= CW2015_AVERAGING_SAMPLES;
320
321 /*
322 * 305 uV per ADC step
323 * Use 312 / 1024 as efficient approximation of 305 / 1000
324 * Negligible error of 0.1%
325 */
326 voltage_mv = avg * 312 / 1024;
327
328 dev_dbg(cw_bat->dev, "Read voltage: %d mV, raw=0x%04x\n",
329 voltage_mv, reg_val);
330 return voltage_mv;
331}
332
333static int cw_get_time_to_empty(struct cw_battery *cw_bat)
334{
335 int ret;
336 u16 value16;
337
338 ret = cw_read_word(cw_bat, CW2015_REG_RRT_ALERT, val: &value16);
339 if (ret)
340 return ret;
341
342 return value16 & CW2015_MASK_SOC;
343}
344
345static void cw_update_charge_status(struct cw_battery *cw_bat)
346{
347 int ret;
348
349 ret = power_supply_am_i_supplied(psy: cw_bat->rk_bat);
350 if (ret < 0) {
351 dev_warn(cw_bat->dev, "Failed to get supply state: %d\n", ret);
352 } else {
353 bool charger_attached;
354
355 charger_attached = !!ret;
356 if (cw_bat->charger_attached != charger_attached) {
357 cw_bat->battery_changed = true;
358 if (charger_attached)
359 cw_bat->charge_count++;
360 }
361 cw_bat->charger_attached = charger_attached;
362 }
363}
364
365static void cw_update_soc(struct cw_battery *cw_bat)
366{
367 int soc;
368
369 soc = cw_get_soc(cw_bat);
370 if (soc < 0)
371 dev_err(cw_bat->dev, "Failed to get SoC from gauge: %d\n", soc);
372 else if (cw_bat->soc != soc) {
373 cw_bat->soc = soc;
374 cw_bat->battery_changed = true;
375 }
376}
377
378static void cw_update_voltage(struct cw_battery *cw_bat)
379{
380 int voltage_mv;
381
382 voltage_mv = cw_get_voltage(cw_bat);
383 if (voltage_mv < 0)
384 dev_err(cw_bat->dev, "Failed to get voltage from gauge: %d\n",
385 voltage_mv);
386 else
387 cw_bat->voltage_mv = voltage_mv;
388}
389
390static void cw_update_status(struct cw_battery *cw_bat)
391{
392 int status = POWER_SUPPLY_STATUS_DISCHARGING;
393
394 if (cw_bat->charger_attached) {
395 if (cw_bat->soc >= 100)
396 status = POWER_SUPPLY_STATUS_FULL;
397 else
398 status = POWER_SUPPLY_STATUS_CHARGING;
399 }
400
401 if (cw_bat->status != status)
402 cw_bat->battery_changed = true;
403 cw_bat->status = status;
404}
405
406static void cw_update_time_to_empty(struct cw_battery *cw_bat)
407{
408 int time_to_empty;
409
410 time_to_empty = cw_get_time_to_empty(cw_bat);
411 if (time_to_empty < 0)
412 dev_err(cw_bat->dev, "Failed to get time to empty from gauge: %d\n",
413 time_to_empty);
414 else if (cw_bat->time_to_empty != time_to_empty) {
415 cw_bat->time_to_empty = time_to_empty;
416 cw_bat->battery_changed = true;
417 }
418}
419
420static void cw_bat_work(struct work_struct *work)
421{
422 struct delayed_work *delay_work;
423 struct cw_battery *cw_bat;
424 int ret;
425 unsigned int reg_val;
426
427 delay_work = to_delayed_work(work);
428 cw_bat = container_of(delay_work, struct cw_battery, battery_delay_work);
429 ret = regmap_read(map: cw_bat->regmap, CW2015_REG_MODE, val: &reg_val);
430 if (ret) {
431 dev_err(cw_bat->dev, "Failed to read mode from gauge: %d\n", ret);
432 } else {
433 if ((reg_val & CW2015_MODE_SLEEP_MASK) == CW2015_MODE_SLEEP) {
434 int i;
435
436 for (i = 0; i < CW2015_RESET_TRIES; i++) {
437 if (!cw_power_on_reset(cw_bat))
438 break;
439 }
440 }
441 cw_update_soc(cw_bat);
442 cw_update_voltage(cw_bat);
443 cw_update_charge_status(cw_bat);
444 cw_update_status(cw_bat);
445 cw_update_time_to_empty(cw_bat);
446 }
447 dev_dbg(cw_bat->dev, "charger_attached = %d\n", cw_bat->charger_attached);
448 dev_dbg(cw_bat->dev, "status = %d\n", cw_bat->status);
449 dev_dbg(cw_bat->dev, "soc = %d%%\n", cw_bat->soc);
450 dev_dbg(cw_bat->dev, "voltage = %dmV\n", cw_bat->voltage_mv);
451
452 if (cw_bat->battery_changed)
453 power_supply_changed(psy: cw_bat->rk_bat);
454 cw_bat->battery_changed = false;
455
456 queue_delayed_work(wq: cw_bat->battery_workqueue,
457 dwork: &cw_bat->battery_delay_work,
458 delay: msecs_to_jiffies(m: cw_bat->poll_interval_ms));
459}
460
461static bool cw_battery_valid_time_to_empty(struct cw_battery *cw_bat)
462{
463 return cw_bat->time_to_empty > 0 &&
464 cw_bat->time_to_empty < CW2015_MASK_SOC &&
465 cw_bat->status == POWER_SUPPLY_STATUS_DISCHARGING;
466}
467
468static int cw_battery_get_property(struct power_supply *psy,
469 enum power_supply_property psp,
470 union power_supply_propval *val)
471{
472 struct cw_battery *cw_bat;
473
474 cw_bat = power_supply_get_drvdata(psy);
475 switch (psp) {
476 case POWER_SUPPLY_PROP_CAPACITY:
477 val->intval = cw_bat->soc;
478 break;
479
480 case POWER_SUPPLY_PROP_STATUS:
481 val->intval = cw_bat->status;
482 break;
483
484 case POWER_SUPPLY_PROP_PRESENT:
485 val->intval = !!cw_bat->voltage_mv;
486 break;
487
488 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
489 val->intval = cw_bat->voltage_mv * 1000;
490 break;
491
492 case POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW:
493 if (cw_battery_valid_time_to_empty(cw_bat))
494 val->intval = cw_bat->time_to_empty * 60;
495 else
496 val->intval = 0;
497 break;
498
499 case POWER_SUPPLY_PROP_TECHNOLOGY:
500 val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
501 break;
502
503 case POWER_SUPPLY_PROP_CHARGE_COUNTER:
504 val->intval = cw_bat->charge_count;
505 break;
506
507 case POWER_SUPPLY_PROP_CHARGE_FULL:
508 case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
509 val->intval = max(cw_bat->battery->charge_full_design_uah, 0);
510 break;
511
512 case POWER_SUPPLY_PROP_CHARGE_NOW:
513 val->intval = cw_bat->battery->charge_full_design_uah;
514 val->intval = val->intval * cw_bat->soc / 100;
515 break;
516
517 case POWER_SUPPLY_PROP_CURRENT_NOW:
518 if (cw_battery_valid_time_to_empty(cw_bat) &&
519 cw_bat->battery->charge_full_design_uah > 0) {
520 /* calculate remaining capacity */
521 val->intval = cw_bat->battery->charge_full_design_uah;
522 val->intval = val->intval * cw_bat->soc / 100;
523
524 /* estimate current based on time to empty */
525 val->intval = 60 * val->intval / cw_bat->time_to_empty;
526 } else {
527 val->intval = 0;
528 }
529
530 break;
531
532 default:
533 break;
534 }
535 return 0;
536}
537
538static enum power_supply_property cw_battery_properties[] = {
539 POWER_SUPPLY_PROP_CAPACITY,
540 POWER_SUPPLY_PROP_STATUS,
541 POWER_SUPPLY_PROP_PRESENT,
542 POWER_SUPPLY_PROP_VOLTAGE_NOW,
543 POWER_SUPPLY_PROP_TIME_TO_EMPTY_NOW,
544 POWER_SUPPLY_PROP_TECHNOLOGY,
545 POWER_SUPPLY_PROP_CHARGE_COUNTER,
546 POWER_SUPPLY_PROP_CHARGE_FULL,
547 POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
548 POWER_SUPPLY_PROP_CHARGE_NOW,
549 POWER_SUPPLY_PROP_CURRENT_NOW,
550};
551
552static const struct power_supply_desc cw2015_bat_desc = {
553 .name = "cw2015-battery",
554 .type = POWER_SUPPLY_TYPE_BATTERY,
555 .properties = cw_battery_properties,
556 .num_properties = ARRAY_SIZE(cw_battery_properties),
557 .get_property = cw_battery_get_property,
558};
559
560static int cw2015_parse_properties(struct cw_battery *cw_bat)
561{
562 struct device *dev = cw_bat->dev;
563 int length;
564 int ret;
565
566 length = device_property_count_u8(dev, propname: "cellwise,battery-profile");
567 if (length < 0) {
568 dev_warn(cw_bat->dev,
569 "No battery-profile found, using current flash contents\n");
570 } else if (length != CW2015_SIZE_BATINFO) {
571 dev_err(cw_bat->dev, "battery-profile must be %d bytes\n",
572 CW2015_SIZE_BATINFO);
573 return -EINVAL;
574 } else {
575 cw_bat->bat_profile = devm_kzalloc(dev, size: length, GFP_KERNEL);
576 if (!cw_bat->bat_profile)
577 return -ENOMEM;
578
579 ret = device_property_read_u8_array(dev,
580 propname: "cellwise,battery-profile",
581 val: cw_bat->bat_profile,
582 nval: length);
583 if (ret)
584 return ret;
585 }
586
587 ret = device_property_read_u32(dev, propname: "cellwise,monitor-interval-ms",
588 val: &cw_bat->poll_interval_ms);
589 if (ret) {
590 dev_dbg(cw_bat->dev, "Using default poll interval\n");
591 cw_bat->poll_interval_ms = CW2015_DEFAULT_POLL_INTERVAL_MS;
592 }
593
594 return 0;
595}
596
597static const struct regmap_range regmap_ranges_rd_yes[] = {
598 regmap_reg_range(CW2015_REG_VERSION, CW2015_REG_VERSION),
599 regmap_reg_range(CW2015_REG_VCELL, CW2015_REG_CONFIG),
600 regmap_reg_range(CW2015_REG_MODE, CW2015_REG_MODE),
601 regmap_reg_range(CW2015_REG_BATINFO,
602 CW2015_REG_BATINFO + CW2015_SIZE_BATINFO - 1),
603};
604
605static const struct regmap_access_table regmap_rd_table = {
606 .yes_ranges = regmap_ranges_rd_yes,
607 .n_yes_ranges = 4,
608};
609
610static const struct regmap_range regmap_ranges_wr_yes[] = {
611 regmap_reg_range(CW2015_REG_RRT_ALERT, CW2015_REG_CONFIG),
612 regmap_reg_range(CW2015_REG_MODE, CW2015_REG_MODE),
613 regmap_reg_range(CW2015_REG_BATINFO,
614 CW2015_REG_BATINFO + CW2015_SIZE_BATINFO - 1),
615};
616
617static const struct regmap_access_table regmap_wr_table = {
618 .yes_ranges = regmap_ranges_wr_yes,
619 .n_yes_ranges = 3,
620};
621
622static const struct regmap_range regmap_ranges_vol_yes[] = {
623 regmap_reg_range(CW2015_REG_VCELL, CW2015_REG_SOC + 1),
624};
625
626static const struct regmap_access_table regmap_vol_table = {
627 .yes_ranges = regmap_ranges_vol_yes,
628 .n_yes_ranges = 1,
629};
630
631static const struct regmap_config cw2015_regmap_config = {
632 .reg_bits = 8,
633 .val_bits = 8,
634 .rd_table = &regmap_rd_table,
635 .wr_table = &regmap_wr_table,
636 .volatile_table = &regmap_vol_table,
637 .max_register = CW2015_REG_BATINFO + CW2015_SIZE_BATINFO - 1,
638};
639
640static int cw_bat_probe(struct i2c_client *client)
641{
642 int ret;
643 struct cw_battery *cw_bat;
644 struct power_supply_config psy_cfg = { 0 };
645
646 cw_bat = devm_kzalloc(dev: &client->dev, size: sizeof(*cw_bat), GFP_KERNEL);
647 if (!cw_bat)
648 return -ENOMEM;
649
650 i2c_set_clientdata(client, data: cw_bat);
651 cw_bat->dev = &client->dev;
652 cw_bat->soc = 1;
653
654 ret = cw2015_parse_properties(cw_bat);
655 if (ret) {
656 dev_err(cw_bat->dev, "Failed to parse cw2015 properties\n");
657 return ret;
658 }
659
660 cw_bat->regmap = devm_regmap_init_i2c(client, &cw2015_regmap_config);
661 if (IS_ERR(ptr: cw_bat->regmap)) {
662 dev_err(cw_bat->dev, "Failed to allocate regmap: %ld\n",
663 PTR_ERR(cw_bat->regmap));
664 return PTR_ERR(ptr: cw_bat->regmap);
665 }
666
667 ret = cw_init(cw_bat);
668 if (ret) {
669 dev_err(cw_bat->dev, "Init failed: %d\n", ret);
670 return ret;
671 }
672
673 psy_cfg.drv_data = cw_bat;
674 psy_cfg.fwnode = dev_fwnode(cw_bat->dev);
675
676 cw_bat->rk_bat = devm_power_supply_register(parent: &client->dev,
677 desc: &cw2015_bat_desc,
678 cfg: &psy_cfg);
679 if (IS_ERR(ptr: cw_bat->rk_bat)) {
680 /* try again if this happens */
681 dev_err_probe(dev: &client->dev, err: PTR_ERR(ptr: cw_bat->rk_bat),
682 fmt: "Failed to register power supply\n");
683 return PTR_ERR(ptr: cw_bat->rk_bat);
684 }
685
686 ret = power_supply_get_battery_info(psy: cw_bat->rk_bat, info_out: &cw_bat->battery);
687 if (ret) {
688 /* Allocate an empty battery */
689 cw_bat->battery = devm_kzalloc(dev: &client->dev,
690 size: sizeof(*cw_bat->battery),
691 GFP_KERNEL);
692 if (!cw_bat->battery)
693 return -ENOMEM;
694 dev_warn(cw_bat->dev,
695 "No monitored battery, some properties will be missing\n");
696 }
697
698 cw_bat->battery_workqueue = create_singlethread_workqueue("rk_battery");
699 if (!cw_bat->battery_workqueue)
700 return -ENOMEM;
701
702 ret = devm_delayed_work_autocancel(dev: &client->dev, w: &cw_bat->battery_delay_work, worker: cw_bat_work);
703 if (ret) {
704 dev_err_probe(dev: &client->dev, err: ret,
705 fmt: "Failed to register delayed work\n");
706 return ret;
707 }
708
709 queue_delayed_work(wq: cw_bat->battery_workqueue,
710 dwork: &cw_bat->battery_delay_work, delay: msecs_to_jiffies(m: 10));
711 return 0;
712}
713
714static int __maybe_unused cw_bat_suspend(struct device *dev)
715{
716 struct i2c_client *client = to_i2c_client(dev);
717 struct cw_battery *cw_bat = i2c_get_clientdata(client);
718
719 cancel_delayed_work_sync(dwork: &cw_bat->battery_delay_work);
720 return 0;
721}
722
723static int __maybe_unused cw_bat_resume(struct device *dev)
724{
725 struct i2c_client *client = to_i2c_client(dev);
726 struct cw_battery *cw_bat = i2c_get_clientdata(client);
727
728 queue_delayed_work(wq: cw_bat->battery_workqueue,
729 dwork: &cw_bat->battery_delay_work, delay: 0);
730 return 0;
731}
732
733static SIMPLE_DEV_PM_OPS(cw_bat_pm_ops, cw_bat_suspend, cw_bat_resume);
734
735static const struct i2c_device_id cw_bat_id_table[] = {
736 { "cw2015" },
737 { }
738};
739
740static const struct of_device_id cw2015_of_match[] = {
741 { .compatible = "cellwise,cw2015" },
742 { }
743};
744MODULE_DEVICE_TABLE(of, cw2015_of_match);
745
746static struct i2c_driver cw_bat_driver = {
747 .driver = {
748 .name = "cw2015",
749 .of_match_table = cw2015_of_match,
750 .pm = &cw_bat_pm_ops,
751 },
752 .probe = cw_bat_probe,
753 .id_table = cw_bat_id_table,
754};
755
756module_i2c_driver(cw_bat_driver);
757
758MODULE_AUTHOR("xhc<xhc@rock-chips.com>");
759MODULE_AUTHOR("Tobias Schramm <t.schramm@manjaro.org>");
760MODULE_DESCRIPTION("cw2015/cw2013 battery driver");
761MODULE_LICENSE("GPL");
762

source code of linux/drivers/power/supply/cw2015_battery.c