?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
arm64: alternatives: add enable parameter to conditional asm macros
[linux/fpc-iii.git] / drivers / power / bq2415x_charger.c
blobe98dcb661cc9bfd2730eb966978488513f5e2deb
1 /*
2 * bq2415x charger driver
3 *
4 * Copyright (C) 2011-2013 Pali Rohár <pali.rohar@gmail.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * Datasheets:
17 * http://www.ti.com/product/bq24150
18 * http://www.ti.com/product/bq24150a
19 * http://www.ti.com/product/bq24152
20 * http://www.ti.com/product/bq24153
21 * http://www.ti.com/product/bq24153a
22 * http://www.ti.com/product/bq24155
23 * http://www.ti.com/product/bq24157s
24 * http://www.ti.com/product/bq24158
25 */
26
27 #include <linux/kernel.h>
28 #include <linux/module.h>
29 #include <linux/param.h>
30 #include <linux/err.h>
31 #include <linux/workqueue.h>
32 #include <linux/sysfs.h>
33 #include <linux/platform_device.h>
34 #include <linux/power_supply.h>
35 #include <linux/idr.h>
36 #include <linux/i2c.h>
37 #include <linux/slab.h>
38 #include <linux/acpi.h>
39
40 #include <linux/power/bq2415x_charger.h>
41
42 /* timeout for resetting chip timer */
43 #define BQ2415X_TIMER_TIMEOUT 10
44
45 #define BQ2415X_REG_STATUS 0x00
46 #define BQ2415X_REG_CONTROL 0x01
47 #define BQ2415X_REG_VOLTAGE 0x02
48 #define BQ2415X_REG_VENDER 0x03
49 #define BQ2415X_REG_CURRENT 0x04
50
51 /* reset state for all registers */
52 #define BQ2415X_RESET_STATUS BIT(6)
53 #define BQ2415X_RESET_CONTROL (BIT(4)|BIT(5))
54 #define BQ2415X_RESET_VOLTAGE (BIT(1)|BIT(3))
55 #define BQ2415X_RESET_CURRENT (BIT(0)|BIT(3)|BIT(7))
56
57 /* status register */
58 #define BQ2415X_BIT_TMR_RST 7
59 #define BQ2415X_BIT_OTG 7
60 #define BQ2415X_BIT_EN_STAT 6
61 #define BQ2415X_MASK_STAT (BIT(4)|BIT(5))
62 #define BQ2415X_SHIFT_STAT 4
63 #define BQ2415X_BIT_BOOST 3
64 #define BQ2415X_MASK_FAULT (BIT(0)|BIT(1)|BIT(2))
65 #define BQ2415X_SHIFT_FAULT 0
66
67 /* control register */
68 #define BQ2415X_MASK_LIMIT (BIT(6)|BIT(7))
69 #define BQ2415X_SHIFT_LIMIT 6
70 #define BQ2415X_MASK_VLOWV (BIT(4)|BIT(5))
71 #define BQ2415X_SHIFT_VLOWV 4
72 #define BQ2415X_BIT_TE 3
73 #define BQ2415X_BIT_CE 2
74 #define BQ2415X_BIT_HZ_MODE 1
75 #define BQ2415X_BIT_OPA_MODE 0
76
77 /* voltage register */
78 #define BQ2415X_MASK_VO (BIT(2)|BIT(3)|BIT(4)|BIT(5)|BIT(6)|BIT(7))
79 #define BQ2415X_SHIFT_VO 2
80 #define BQ2415X_BIT_OTG_PL 1
81 #define BQ2415X_BIT_OTG_EN 0
82
83 /* vender register */
84 #define BQ2415X_MASK_VENDER (BIT(5)|BIT(6)|BIT(7))
85 #define BQ2415X_SHIFT_VENDER 5
86 #define BQ2415X_MASK_PN (BIT(3)|BIT(4))
87 #define BQ2415X_SHIFT_PN 3
88 #define BQ2415X_MASK_REVISION (BIT(0)|BIT(1)|BIT(2))
89 #define BQ2415X_SHIFT_REVISION 0
90
91 /* current register */
92 #define BQ2415X_MASK_RESET BIT(7)
93 #define BQ2415X_MASK_VI_CHRG (BIT(4)|BIT(5)|BIT(6))
94 #define BQ2415X_SHIFT_VI_CHRG 4
95 /* N/A BIT(3) */
96 #define BQ2415X_MASK_VI_TERM (BIT(0)|BIT(1)|BIT(2))
97 #define BQ2415X_SHIFT_VI_TERM 0
98
99
100 enum bq2415x_command {
101 BQ2415X_TIMER_RESET,
102 BQ2415X_OTG_STATUS,
103 BQ2415X_STAT_PIN_STATUS,
104 BQ2415X_STAT_PIN_ENABLE,
105 BQ2415X_STAT_PIN_DISABLE,
106 BQ2415X_CHARGE_STATUS,
107 BQ2415X_BOOST_STATUS,
108 BQ2415X_FAULT_STATUS,
109
110 BQ2415X_CHARGE_TERMINATION_STATUS,
111 BQ2415X_CHARGE_TERMINATION_ENABLE,
112 BQ2415X_CHARGE_TERMINATION_DISABLE,
113 BQ2415X_CHARGER_STATUS,
114 BQ2415X_CHARGER_ENABLE,
115 BQ2415X_CHARGER_DISABLE,
116 BQ2415X_HIGH_IMPEDANCE_STATUS,
117 BQ2415X_HIGH_IMPEDANCE_ENABLE,
118 BQ2415X_HIGH_IMPEDANCE_DISABLE,
119 BQ2415X_BOOST_MODE_STATUS,
120 BQ2415X_BOOST_MODE_ENABLE,
121 BQ2415X_BOOST_MODE_DISABLE,
122
123 BQ2415X_OTG_LEVEL,
124 BQ2415X_OTG_ACTIVATE_HIGH,
125 BQ2415X_OTG_ACTIVATE_LOW,
126 BQ2415X_OTG_PIN_STATUS,
127 BQ2415X_OTG_PIN_ENABLE,
128 BQ2415X_OTG_PIN_DISABLE,
129
130 BQ2415X_VENDER_CODE,
131 BQ2415X_PART_NUMBER,
132 BQ2415X_REVISION,
133 };
134
135 enum bq2415x_chip {
136 BQUNKNOWN,
137 BQ24150,
138 BQ24150A,
139 BQ24151,
140 BQ24151A,
141 BQ24152,
142 BQ24153,
143 BQ24153A,
144 BQ24155,
145 BQ24156,
146 BQ24156A,
147 BQ24157S,
148 BQ24158,
149 };
150
151 static char *bq2415x_chip_name[] = {
152 "unknown",
153 "bq24150",
154 "bq24150a",
155 "bq24151",
156 "bq24151a",
157 "bq24152",
158 "bq24153",
159 "bq24153a",
160 "bq24155",
161 "bq24156",
162 "bq24156a",
163 "bq24157s",
164 "bq24158",
165 };
166
167 struct bq2415x_device {
168 struct device *dev;
169 struct bq2415x_platform_data init_data;
170 struct power_supply *charger;
171 struct power_supply_desc charger_desc;
172 struct delayed_work work;
173 struct power_supply *notify_psy;
174 struct notifier_block nb;
175 enum bq2415x_mode reported_mode;/* mode reported by hook function */
176 enum bq2415x_mode mode; /* currently configured mode */
177 enum bq2415x_chip chip;
178 const char *timer_error;
179 char *model;
180 char *name;
181 int autotimer; /* 1 - if driver automatically reset timer, 0 - not */
182 int automode; /* 1 - enabled, 0 - disabled; -1 - not supported */
183 int id;
184 };
185
186 /* each registered chip must have unique id */
187 static DEFINE_IDR(bq2415x_id);
188
189 static DEFINE_MUTEX(bq2415x_id_mutex);
190 static DEFINE_MUTEX(bq2415x_timer_mutex);
191 static DEFINE_MUTEX(bq2415x_i2c_mutex);
192
193 /**** i2c read functions ****/
194
195 /* read value from register */
196 static int bq2415x_i2c_read(struct bq2415x_device *bq, u8 reg)
197 {
198 struct i2c_client *client = to_i2c_client(bq->dev);
199 struct i2c_msg msg[2];
200 u8 val;
201 int ret;
202
203 if (!client->adapter)
204 return -ENODEV;
205
206 msg[0].addr = client->addr;
207 msg[0].flags = 0;
208 msg[0].buf = &reg;
209 msg[0].len = sizeof(reg);
210 msg[1].addr = client->addr;
211 msg[1].flags = I2C_M_RD;
212 msg[1].buf = &val;
213 msg[1].len = sizeof(val);
214
215 mutex_lock(&bq2415x_i2c_mutex);
216 ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
217 mutex_unlock(&bq2415x_i2c_mutex);
218
219 if (ret < 0)
220 return ret;
221
222 return val;
223 }
224
225 /* read value from register, apply mask and right shift it */
226 static int bq2415x_i2c_read_mask(struct bq2415x_device *bq, u8 reg,
227 u8 mask, u8 shift)
228 {
229 int ret;
230
231 if (shift > 8)
232 return -EINVAL;
233
234 ret = bq2415x_i2c_read(bq, reg);
235 if (ret < 0)
236 return ret;
237 return (ret & mask) >> shift;
238 }
239
240 /* read value from register and return one specified bit */
241 static int bq2415x_i2c_read_bit(struct bq2415x_device *bq, u8 reg, u8 bit)
242 {
243 if (bit > 8)
244 return -EINVAL;
245 return bq2415x_i2c_read_mask(bq, reg, BIT(bit), bit);
246 }
247
248 /**** i2c write functions ****/
249
250 /* write value to register */
251 static int bq2415x_i2c_write(struct bq2415x_device *bq, u8 reg, u8 val)
252 {
253 struct i2c_client *client = to_i2c_client(bq->dev);
254 struct i2c_msg msg[1];
255 u8 data[2];
256 int ret;
257
258 data[0] = reg;
259 data[1] = val;
260
261 msg[0].addr = client->addr;
262 msg[0].flags = 0;
263 msg[0].buf = data;
264 msg[0].len = ARRAY_SIZE(data);
265
266 mutex_lock(&bq2415x_i2c_mutex);
267 ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
268 mutex_unlock(&bq2415x_i2c_mutex);
269
270 /* i2c_transfer returns number of messages transferred */
271 if (ret < 0)
272 return ret;
273 else if (ret != 1)
274 return -EIO;
275
276 return 0;
277 }
278
279 /* read value from register, change it with mask left shifted and write back */
280 static int bq2415x_i2c_write_mask(struct bq2415x_device *bq, u8 reg, u8 val,
281 u8 mask, u8 shift)
282 {
283 int ret;
284
285 if (shift > 8)
286 return -EINVAL;
287
288 ret = bq2415x_i2c_read(bq, reg);
289 if (ret < 0)
290 return ret;
291
292 ret &= ~mask;
293 ret |= val << shift;
294
295 return bq2415x_i2c_write(bq, reg, ret);
296 }
297
298 /* change only one bit in register */
299 static int bq2415x_i2c_write_bit(struct bq2415x_device *bq, u8 reg,
300 bool val, u8 bit)
301 {
302 if (bit > 8)
303 return -EINVAL;
304 return bq2415x_i2c_write_mask(bq, reg, val, BIT(bit), bit);
305 }
306
307 /**** global functions ****/
308
309 /* exec command function */
310 static int bq2415x_exec_command(struct bq2415x_device *bq,
311 enum bq2415x_command command)
312 {
313 int ret;
314
315 switch (command) {
316 case BQ2415X_TIMER_RESET:
317 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS,
318 1, BQ2415X_BIT_TMR_RST);
319 case BQ2415X_OTG_STATUS:
320 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
321 BQ2415X_BIT_OTG);
322 case BQ2415X_STAT_PIN_STATUS:
323 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
324 BQ2415X_BIT_EN_STAT);
325 case BQ2415X_STAT_PIN_ENABLE:
326 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 1,
327 BQ2415X_BIT_EN_STAT);
328 case BQ2415X_STAT_PIN_DISABLE:
329 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 0,
330 BQ2415X_BIT_EN_STAT);
331 case BQ2415X_CHARGE_STATUS:
332 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
333 BQ2415X_MASK_STAT, BQ2415X_SHIFT_STAT);
334 case BQ2415X_BOOST_STATUS:
335 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
336 BQ2415X_BIT_BOOST);
337 case BQ2415X_FAULT_STATUS:
338 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
339 BQ2415X_MASK_FAULT, BQ2415X_SHIFT_FAULT);
340
341 case BQ2415X_CHARGE_TERMINATION_STATUS:
342 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
343 BQ2415X_BIT_TE);
344 case BQ2415X_CHARGE_TERMINATION_ENABLE:
345 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
346 1, BQ2415X_BIT_TE);
347 case BQ2415X_CHARGE_TERMINATION_DISABLE:
348 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
349 0, BQ2415X_BIT_TE);
350 case BQ2415X_CHARGER_STATUS:
351 ret = bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
352 BQ2415X_BIT_CE);
353 if (ret < 0)
354 return ret;
355 return ret > 0 ? 0 : 1;
356 case BQ2415X_CHARGER_ENABLE:
357 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
358 0, BQ2415X_BIT_CE);
359 case BQ2415X_CHARGER_DISABLE:
360 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
361 1, BQ2415X_BIT_CE);
362 case BQ2415X_HIGH_IMPEDANCE_STATUS:
363 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
364 BQ2415X_BIT_HZ_MODE);
365 case BQ2415X_HIGH_IMPEDANCE_ENABLE:
366 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
367 1, BQ2415X_BIT_HZ_MODE);
368 case BQ2415X_HIGH_IMPEDANCE_DISABLE:
369 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
370 0, BQ2415X_BIT_HZ_MODE);
371 case BQ2415X_BOOST_MODE_STATUS:
372 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
373 BQ2415X_BIT_OPA_MODE);
374 case BQ2415X_BOOST_MODE_ENABLE:
375 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
376 1, BQ2415X_BIT_OPA_MODE);
377 case BQ2415X_BOOST_MODE_DISABLE:
378 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
379 0, BQ2415X_BIT_OPA_MODE);
380
381 case BQ2415X_OTG_LEVEL:
382 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
383 BQ2415X_BIT_OTG_PL);
384 case BQ2415X_OTG_ACTIVATE_HIGH:
385 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
386 1, BQ2415X_BIT_OTG_PL);
387 case BQ2415X_OTG_ACTIVATE_LOW:
388 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
389 0, BQ2415X_BIT_OTG_PL);
390 case BQ2415X_OTG_PIN_STATUS:
391 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
392 BQ2415X_BIT_OTG_EN);
393 case BQ2415X_OTG_PIN_ENABLE:
394 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
395 1, BQ2415X_BIT_OTG_EN);
396 case BQ2415X_OTG_PIN_DISABLE:
397 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
398 0, BQ2415X_BIT_OTG_EN);
399
400 case BQ2415X_VENDER_CODE:
401 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
402 BQ2415X_MASK_VENDER, BQ2415X_SHIFT_VENDER);
403 case BQ2415X_PART_NUMBER:
404 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
405 BQ2415X_MASK_PN, BQ2415X_SHIFT_PN);
406 case BQ2415X_REVISION:
407 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
408 BQ2415X_MASK_REVISION, BQ2415X_SHIFT_REVISION);
409 }
410 return -EINVAL;
411 }
412
413 /* detect chip type */
414 static enum bq2415x_chip bq2415x_detect_chip(struct bq2415x_device *bq)
415 {
416 struct i2c_client *client = to_i2c_client(bq->dev);
417 int ret = bq2415x_exec_command(bq, BQ2415X_PART_NUMBER);
418
419 if (ret < 0)
420 return ret;
421
422 switch (client->addr) {
423 case 0x6b:
424 switch (ret) {
425 case 0:
426 if (bq->chip == BQ24151A)
427 return bq->chip;
428 return BQ24151;
429 case 1:
430 if (bq->chip == BQ24150A ||
431 bq->chip == BQ24152 ||
432 bq->chip == BQ24155)
433 return bq->chip;
434 return BQ24150;
435 case 2:
436 if (bq->chip == BQ24153A)
437 return bq->chip;
438 return BQ24153;
439 default:
440 return BQUNKNOWN;
441 }
442 break;
443
444 case 0x6a:
445 switch (ret) {
446 case 0:
447 if (bq->chip == BQ24156A)
448 return bq->chip;
449 return BQ24156;
450 case 2:
451 if (bq->chip == BQ24157S)
452 return bq->chip;
453 return BQ24158;
454 default:
455 return BQUNKNOWN;
456 }
457 break;
458 }
459
460 return BQUNKNOWN;
461 }
462
463 /* detect chip revision */
464 static int bq2415x_detect_revision(struct bq2415x_device *bq)
465 {
466 int ret = bq2415x_exec_command(bq, BQ2415X_REVISION);
467 int chip = bq2415x_detect_chip(bq);
468
469 if (ret < 0 || chip < 0)
470 return -1;
471
472 switch (chip) {
473 case BQ24150:
474 case BQ24150A:
475 case BQ24151:
476 case BQ24151A:
477 case BQ24152:
478 if (ret >= 0 && ret <= 3)
479 return ret;
480 return -1;
481 case BQ24153:
482 case BQ24153A:
483 case BQ24156:
484 case BQ24156A:
485 case BQ24157S:
486 case BQ24158:
487 if (ret == 3)
488 return 0;
489 else if (ret == 1)
490 return 1;
491 return -1;
492 case BQ24155:
493 if (ret == 3)
494 return 3;
495 return -1;
496 case BQUNKNOWN:
497 return -1;
498 }
499
500 return -1;
501 }
502
503 /* return chip vender code */
504 static int bq2415x_get_vender_code(struct bq2415x_device *bq)
505 {
506 int ret;
507
508 ret = bq2415x_exec_command(bq, BQ2415X_VENDER_CODE);
509 if (ret < 0)
510 return 0;
511
512 /* convert to binary */
513 return (ret & 0x1) +
514 ((ret >> 1) & 0x1) * 10 +
515 ((ret >> 2) & 0x1) * 100;
516 }
517
518 /* reset all chip registers to default state */
519 static void bq2415x_reset_chip(struct bq2415x_device *bq)
520 {
521 bq2415x_i2c_write(bq, BQ2415X_REG_CURRENT, BQ2415X_RESET_CURRENT);
522 bq2415x_i2c_write(bq, BQ2415X_REG_VOLTAGE, BQ2415X_RESET_VOLTAGE);
523 bq2415x_i2c_write(bq, BQ2415X_REG_CONTROL, BQ2415X_RESET_CONTROL);
524 bq2415x_i2c_write(bq, BQ2415X_REG_STATUS, BQ2415X_RESET_STATUS);
525 bq->timer_error = NULL;
526 }
527
528 /**** properties functions ****/
529
530 /* set current limit in mA */
531 static int bq2415x_set_current_limit(struct bq2415x_device *bq, int mA)
532 {
533 int val;
534
535 if (mA <= 100)
536 val = 0;
537 else if (mA <= 500)
538 val = 1;
539 else if (mA <= 800)
540 val = 2;
541 else
542 val = 3;
543
544 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
545 BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
546 }
547
548 /* get current limit in mA */
549 static int bq2415x_get_current_limit(struct bq2415x_device *bq)
550 {
551 int ret;
552
553 ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
554 BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
555 if (ret < 0)
556 return ret;
557 else if (ret == 0)
558 return 100;
559 else if (ret == 1)
560 return 500;
561 else if (ret == 2)
562 return 800;
563 else if (ret == 3)
564 return 1800;
565 return -EINVAL;
566 }
567
568 /* set weak battery voltage in mV */
569 static int bq2415x_set_weak_battery_voltage(struct bq2415x_device *bq, int mV)
570 {
571 int val;
572
573 /* round to 100mV */
574 if (mV <= 3400 + 50)
575 val = 0;
576 else if (mV <= 3500 + 50)
577 val = 1;
578 else if (mV <= 3600 + 50)
579 val = 2;
580 else
581 val = 3;
582
583 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
584 BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
585 }
586
587 /* get weak battery voltage in mV */
588 static int bq2415x_get_weak_battery_voltage(struct bq2415x_device *bq)
589 {
590 int ret;
591
592 ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
593 BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
594 if (ret < 0)
595 return ret;
596 return 100 * (34 + ret);
597 }
598
599 /* set battery regulation voltage in mV */
600 static int bq2415x_set_battery_regulation_voltage(struct bq2415x_device *bq,
601 int mV)
602 {
603 int val = (mV/10 - 350) / 2;
604
605 /*
606 * According to datasheet, maximum battery regulation voltage is
607 * 4440mV which is b101111 = 47.
608 */
609 if (val < 0)
610 val = 0;
611 else if (val > 47)
612 return -EINVAL;
613
614 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_VOLTAGE, val,
615 BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
616 }
617
618 /* get battery regulation voltage in mV */
619 static int bq2415x_get_battery_regulation_voltage(struct bq2415x_device *bq)
620 {
621 int ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_VOLTAGE,
622 BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
623
624 if (ret < 0)
625 return ret;
626 return 10 * (350 + 2*ret);
627 }
628
629 /* set charge current in mA (platform data must provide resistor sense) */
630 static int bq2415x_set_charge_current(struct bq2415x_device *bq, int mA)
631 {
632 int val;
633
634 if (bq->init_data.resistor_sense <= 0)
635 return -EINVAL;
636
637 val = (mA * bq->init_data.resistor_sense - 37400) / 6800;
638 if (val < 0)
639 val = 0;
640 else if (val > 7)
641 val = 7;
642
643 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
644 BQ2415X_MASK_VI_CHRG | BQ2415X_MASK_RESET,
645 BQ2415X_SHIFT_VI_CHRG);
646 }
647
648 /* get charge current in mA (platform data must provide resistor sense) */
649 static int bq2415x_get_charge_current(struct bq2415x_device *bq)
650 {
651 int ret;
652
653 if (bq->init_data.resistor_sense <= 0)
654 return -EINVAL;
655
656 ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
657 BQ2415X_MASK_VI_CHRG, BQ2415X_SHIFT_VI_CHRG);
658 if (ret < 0)
659 return ret;
660 return (37400 + 6800*ret) / bq->init_data.resistor_sense;
661 }
662
663 /* set termination current in mA (platform data must provide resistor sense) */
664 static int bq2415x_set_termination_current(struct bq2415x_device *bq, int mA)
665 {
666 int val;
667
668 if (bq->init_data.resistor_sense <= 0)
669 return -EINVAL;
670
671 val = (mA * bq->init_data.resistor_sense - 3400) / 3400;
672 if (val < 0)
673 val = 0;
674 else if (val > 7)
675 val = 7;
676
677 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
678 BQ2415X_MASK_VI_TERM | BQ2415X_MASK_RESET,
679 BQ2415X_SHIFT_VI_TERM);
680 }
681
682 /* get termination current in mA (platform data must provide resistor sense) */
683 static int bq2415x_get_termination_current(struct bq2415x_device *bq)
684 {
685 int ret;
686
687 if (bq->init_data.resistor_sense <= 0)
688 return -EINVAL;
689
690 ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
691 BQ2415X_MASK_VI_TERM, BQ2415X_SHIFT_VI_TERM);
692 if (ret < 0)
693 return ret;
694 return (3400 + 3400*ret) / bq->init_data.resistor_sense;
695 }
696
697 /* set default value of property */
698 #define bq2415x_set_default_value(bq, prop) \
699 do { \
700 int ret = 0; \
701 if (bq->init_data.prop != -1) \
702 ret = bq2415x_set_##prop(bq, bq->init_data.prop); \
703 if (ret < 0) \
704 return ret; \
705 } while (0)
706
707 /* set default values of all properties */
708 static int bq2415x_set_defaults(struct bq2415x_device *bq)
709 {
710 bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
711 bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
712 bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_DISABLE);
713
714 bq2415x_set_default_value(bq, current_limit);
715 bq2415x_set_default_value(bq, weak_battery_voltage);
716 bq2415x_set_default_value(bq, battery_regulation_voltage);
717
718 if (bq->init_data.resistor_sense > 0) {
719 bq2415x_set_default_value(bq, charge_current);
720 bq2415x_set_default_value(bq, termination_current);
721 bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_ENABLE);
722 }
723
724 bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
725 return 0;
726 }
727
728 /**** charger mode functions ****/
729
730 /* set charger mode */
731 static int bq2415x_set_mode(struct bq2415x_device *bq, enum bq2415x_mode mode)
732 {
733 int ret = 0;
734 int charger = 0;
735 int boost = 0;
736
737 if (mode == BQ2415X_MODE_BOOST)
738 boost = 1;
739 else if (mode != BQ2415X_MODE_OFF)
740 charger = 1;
741
742 if (!charger)
743 ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
744
745 if (!boost)
746 ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
747
748 if (ret < 0)
749 return ret;
750
751 switch (mode) {
752 case BQ2415X_MODE_OFF:
753 dev_dbg(bq->dev, "changing mode to: Offline\n");
754 ret = bq2415x_set_current_limit(bq, 100);
755 break;
756 case BQ2415X_MODE_NONE:
757 dev_dbg(bq->dev, "changing mode to: N/A\n");
758 ret = bq2415x_set_current_limit(bq, 100);
759 break;
760 case BQ2415X_MODE_HOST_CHARGER:
761 dev_dbg(bq->dev, "changing mode to: Host/HUB charger\n");
762 ret = bq2415x_set_current_limit(bq, 500);
763 break;
764 case BQ2415X_MODE_DEDICATED_CHARGER:
765 dev_dbg(bq->dev, "changing mode to: Dedicated charger\n");
766 ret = bq2415x_set_current_limit(bq, 1800);
767 break;
768 case BQ2415X_MODE_BOOST: /* Boost mode */
769 dev_dbg(bq->dev, "changing mode to: Boost\n");
770 ret = bq2415x_set_current_limit(bq, 100);
771 break;
772 }
773
774 if (ret < 0)
775 return ret;
776
777 if (charger)
778 ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
779 else if (boost)
780 ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_ENABLE);
781
782 if (ret < 0)
783 return ret;
784
785 bq2415x_set_default_value(bq, weak_battery_voltage);
786 bq2415x_set_default_value(bq, battery_regulation_voltage);
787
788 bq->mode = mode;
789 sysfs_notify(&bq->charger->dev.kobj, NULL, "mode");
790
791 return 0;
792
793 }
794
795 static int bq2415x_notifier_call(struct notifier_block *nb,
796 unsigned long val, void *v)
797 {
798 struct bq2415x_device *bq =
799 container_of(nb, struct bq2415x_device, nb);
800 struct power_supply *psy = v;
801 enum bq2415x_mode mode;
802 union power_supply_propval prop;
803 int ret;
804 int mA;
805
806 if (val != PSY_EVENT_PROP_CHANGED)
807 return NOTIFY_OK;
808
809 if (psy != bq->notify_psy)
810 return NOTIFY_OK;
811
812 dev_dbg(bq->dev, "notifier call was called\n");
813
814 ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_CURRENT_MAX,
815 &prop);
816 if (ret != 0)
817 return NOTIFY_OK;
818
819 mA = prop.intval;
820
821 if (mA == 0)
822 mode = BQ2415X_MODE_OFF;
823 else if (mA < 500)
824 mode = BQ2415X_MODE_NONE;
825 else if (mA < 1800)
826 mode = BQ2415X_MODE_HOST_CHARGER;
827 else
828 mode = BQ2415X_MODE_DEDICATED_CHARGER;
829
830 if (bq->reported_mode == mode)
831 return NOTIFY_OK;
832
833 bq->reported_mode = mode;
834
835 /* if automode is not enabled do not tell about reported_mode */
836 if (bq->automode < 1)
837 return NOTIFY_OK;
838
839 schedule_delayed_work(&bq->work, 0);
840
841 return NOTIFY_OK;
842 }
843
844 /**** timer functions ****/
845
846 /* enable/disable auto resetting chip timer */
847 static void bq2415x_set_autotimer(struct bq2415x_device *bq, int state)
848 {
849 mutex_lock(&bq2415x_timer_mutex);
850
851 if (bq->autotimer == state) {
852 mutex_unlock(&bq2415x_timer_mutex);
853 return;
854 }
855
856 bq->autotimer = state;
857
858 if (state) {
859 schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
860 bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
861 bq->timer_error = NULL;
862 } else {
863 cancel_delayed_work_sync(&bq->work);
864 }
865
866 mutex_unlock(&bq2415x_timer_mutex);
867 }
868
869 /* called by bq2415x_timer_work on timer error */
870 static void bq2415x_timer_error(struct bq2415x_device *bq, const char *msg)
871 {
872 bq->timer_error = msg;
873 sysfs_notify(&bq->charger->dev.kobj, NULL, "timer");
874 dev_err(bq->dev, "%s\n", msg);
875 if (bq->automode > 0)
876 bq->automode = 0;
877 bq2415x_set_mode(bq, BQ2415X_MODE_OFF);
878 bq2415x_set_autotimer(bq, 0);
879 }
880
881 /* delayed work function for auto resetting chip timer */
882 static void bq2415x_timer_work(struct work_struct *work)
883 {
884 struct bq2415x_device *bq = container_of(work, struct bq2415x_device,
885 work.work);
886 int ret;
887 int error;
888 int boost;
889
890 if (bq->automode > 0 && (bq->reported_mode != bq->mode)) {
891 sysfs_notify(&bq->charger->dev.kobj, NULL, "reported_mode");
892 bq2415x_set_mode(bq, bq->reported_mode);
893 }
894
895 if (!bq->autotimer)
896 return;
897
898 ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
899 if (ret < 0) {
900 bq2415x_timer_error(bq, "Resetting timer failed");
901 return;
902 }
903
904 boost = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_STATUS);
905 if (boost < 0) {
906 bq2415x_timer_error(bq, "Unknown error");
907 return;
908 }
909
910 error = bq2415x_exec_command(bq, BQ2415X_FAULT_STATUS);
911 if (error < 0) {
912 bq2415x_timer_error(bq, "Unknown error");
913 return;
914 }
915
916 if (boost) {
917 switch (error) {
918 /* Non fatal errors, chip is OK */
919 case 0: /* No error */
920 break;
921 case 6: /* Timer expired */
922 dev_err(bq->dev, "Timer expired\n");
923 break;
924 case 3: /* Battery voltage too low */
925 dev_err(bq->dev, "Battery voltage to low\n");
926 break;
927
928 /* Fatal errors, disable and reset chip */
929 case 1: /* Overvoltage protection (chip fried) */
930 bq2415x_timer_error(bq,
931 "Overvoltage protection (chip fried)");
932 return;
933 case 2: /* Overload */
934 bq2415x_timer_error(bq, "Overload");
935 return;
936 case 4: /* Battery overvoltage protection */
937 bq2415x_timer_error(bq,
938 "Battery overvoltage protection");
939 return;
940 case 5: /* Thermal shutdown (too hot) */
941 bq2415x_timer_error(bq,
942 "Thermal shutdown (too hot)");
943 return;
944 case 7: /* N/A */
945 bq2415x_timer_error(bq, "Unknown error");
946 return;
947 }
948 } else {
949 switch (error) {
950 /* Non fatal errors, chip is OK */
951 case 0: /* No error */
952 break;
953 case 2: /* Sleep mode */
954 dev_err(bq->dev, "Sleep mode\n");
955 break;
956 case 3: /* Poor input source */
957 dev_err(bq->dev, "Poor input source\n");
958 break;
959 case 6: /* Timer expired */
960 dev_err(bq->dev, "Timer expired\n");
961 break;
962 case 7: /* No battery */
963 dev_err(bq->dev, "No battery\n");
964 break;
965
966 /* Fatal errors, disable and reset chip */
967 case 1: /* Overvoltage protection (chip fried) */
968 bq2415x_timer_error(bq,
969 "Overvoltage protection (chip fried)");
970 return;
971 case 4: /* Battery overvoltage protection */
972 bq2415x_timer_error(bq,
973 "Battery overvoltage protection");
974 return;
975 case 5: /* Thermal shutdown (too hot) */
976 bq2415x_timer_error(bq,
977 "Thermal shutdown (too hot)");
978 return;
979 }
980 }
981
982 schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
983 }
984
985 /**** power supply interface code ****/
986
987 static enum power_supply_property bq2415x_power_supply_props[] = {
988 /* TODO: maybe add more power supply properties */
989 POWER_SUPPLY_PROP_STATUS,
990 POWER_SUPPLY_PROP_MODEL_NAME,
991 };
992
993 static int bq2415x_power_supply_get_property(struct power_supply *psy,
994 enum power_supply_property psp,
995 union power_supply_propval *val)
996 {
997 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
998 int ret;
999
1000 switch (psp) {
1001 case POWER_SUPPLY_PROP_STATUS:
1002 ret = bq2415x_exec_command(bq, BQ2415X_CHARGE_STATUS);
1003 if (ret < 0)
1004 return ret;
1005 else if (ret == 0) /* Ready */
1006 val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
1007 else if (ret == 1) /* Charge in progress */
1008 val->intval = POWER_SUPPLY_STATUS_CHARGING;
1009 else if (ret == 2) /* Charge done */
1010 val->intval = POWER_SUPPLY_STATUS_FULL;
1011 else
1012 val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
1013 break;
1014 case POWER_SUPPLY_PROP_MODEL_NAME:
1015 val->strval = bq->model;
1016 break;
1017 default:
1018 return -EINVAL;
1019 }
1020 return 0;
1021 }
1022
1023 static int bq2415x_power_supply_init(struct bq2415x_device *bq)
1024 {
1025 int ret;
1026 int chip;
1027 char revstr[8];
1028 struct power_supply_config psy_cfg = { .drv_data = bq, };
1029
1030 bq->charger_desc.name = bq->name;
1031 bq->charger_desc.type = POWER_SUPPLY_TYPE_USB;
1032 bq->charger_desc.properties = bq2415x_power_supply_props;
1033 bq->charger_desc.num_properties =
1034 ARRAY_SIZE(bq2415x_power_supply_props);
1035 bq->charger_desc.get_property = bq2415x_power_supply_get_property;
1036
1037 ret = bq2415x_detect_chip(bq);
1038 if (ret < 0)
1039 chip = BQUNKNOWN;
1040 else
1041 chip = ret;
1042
1043 ret = bq2415x_detect_revision(bq);
1044 if (ret < 0)
1045 strcpy(revstr, "unknown");
1046 else
1047 sprintf(revstr, "1.%d", ret);
1048
1049 bq->model = kasprintf(GFP_KERNEL,
1050 "chip %s, revision %s, vender code %.3d",
1051 bq2415x_chip_name[chip], revstr,
1052 bq2415x_get_vender_code(bq));
1053 if (!bq->model) {
1054 dev_err(bq->dev, "failed to allocate model name\n");
1055 return -ENOMEM;
1056 }
1057
1058 bq->charger = power_supply_register(bq->dev, &bq->charger_desc,
1059 &psy_cfg);
1060 if (IS_ERR(bq->charger)) {
1061 kfree(bq->model);
1062 return PTR_ERR(bq->charger);
1063 }
1064
1065 return 0;
1066 }
1067
1068 static void bq2415x_power_supply_exit(struct bq2415x_device *bq)
1069 {
1070 bq->autotimer = 0;
1071 if (bq->automode > 0)
1072 bq->automode = 0;
1073 cancel_delayed_work_sync(&bq->work);
1074 power_supply_unregister(bq->charger);
1075 kfree(bq->model);
1076 }
1077
1078 /**** additional sysfs entries for power supply interface ****/
1079
1080 /* show *_status entries */
1081 static ssize_t bq2415x_sysfs_show_status(struct device *dev,
1082 struct device_attribute *attr,
1083 char *buf)
1084 {
1085 struct power_supply *psy = dev_get_drvdata(dev);
1086 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1087 enum bq2415x_command command;
1088 int ret;
1089
1090 if (strcmp(attr->attr.name, "otg_status") == 0)
1091 command = BQ2415X_OTG_STATUS;
1092 else if (strcmp(attr->attr.name, "charge_status") == 0)
1093 command = BQ2415X_CHARGE_STATUS;
1094 else if (strcmp(attr->attr.name, "boost_status") == 0)
1095 command = BQ2415X_BOOST_STATUS;
1096 else if (strcmp(attr->attr.name, "fault_status") == 0)
1097 command = BQ2415X_FAULT_STATUS;
1098 else
1099 return -EINVAL;
1100
1101 ret = bq2415x_exec_command(bq, command);
1102 if (ret < 0)
1103 return ret;
1104 return sprintf(buf, "%d\n", ret);
1105 }
1106
1107 /*
1108 * set timer entry:
1109 * auto - enable auto mode
1110 * off - disable auto mode
1111 * (other values) - reset chip timer
1112 */
1113 static ssize_t bq2415x_sysfs_set_timer(struct device *dev,
1114 struct device_attribute *attr,
1115 const char *buf,
1116 size_t count)
1117 {
1118 struct power_supply *psy = dev_get_drvdata(dev);
1119 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1120 int ret = 0;
1121
1122 if (strncmp(buf, "auto", 4) == 0)
1123 bq2415x_set_autotimer(bq, 1);
1124 else if (strncmp(buf, "off", 3) == 0)
1125 bq2415x_set_autotimer(bq, 0);
1126 else
1127 ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
1128
1129 if (ret < 0)
1130 return ret;
1131 return count;
1132 }
1133
1134 /* show timer entry (auto or off) */
1135 static ssize_t bq2415x_sysfs_show_timer(struct device *dev,
1136 struct device_attribute *attr,
1137 char *buf)
1138 {
1139 struct power_supply *psy = dev_get_drvdata(dev);
1140 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1141
1142 if (bq->timer_error)
1143 return sprintf(buf, "%s\n", bq->timer_error);
1144
1145 if (bq->autotimer)
1146 return sprintf(buf, "auto\n");
1147 return sprintf(buf, "off\n");
1148 }
1149
1150 /*
1151 * set mode entry:
1152 * auto - if automode is supported, enable it and set mode to reported
1153 * none - disable charger and boost mode
1154 * host - charging mode for host/hub chargers (current limit 500mA)
1155 * dedicated - charging mode for dedicated chargers (unlimited current limit)
1156 * boost - disable charger and enable boost mode
1157 */
1158 static ssize_t bq2415x_sysfs_set_mode(struct device *dev,
1159 struct device_attribute *attr,
1160 const char *buf,
1161 size_t count)
1162 {
1163 struct power_supply *psy = dev_get_drvdata(dev);
1164 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1165 enum bq2415x_mode mode;
1166 int ret = 0;
1167
1168 if (strncmp(buf, "auto", 4) == 0) {
1169 if (bq->automode < 0)
1170 return -EINVAL;
1171 bq->automode = 1;
1172 mode = bq->reported_mode;
1173 } else if (strncmp(buf, "off", 3) == 0) {
1174 if (bq->automode > 0)
1175 bq->automode = 0;
1176 mode = BQ2415X_MODE_OFF;
1177 } else if (strncmp(buf, "none", 4) == 0) {
1178 if (bq->automode > 0)
1179 bq->automode = 0;
1180 mode = BQ2415X_MODE_NONE;
1181 } else if (strncmp(buf, "host", 4) == 0) {
1182 if (bq->automode > 0)
1183 bq->automode = 0;
1184 mode = BQ2415X_MODE_HOST_CHARGER;
1185 } else if (strncmp(buf, "dedicated", 9) == 0) {
1186 if (bq->automode > 0)
1187 bq->automode = 0;
1188 mode = BQ2415X_MODE_DEDICATED_CHARGER;
1189 } else if (strncmp(buf, "boost", 5) == 0) {
1190 if (bq->automode > 0)
1191 bq->automode = 0;
1192 mode = BQ2415X_MODE_BOOST;
1193 } else if (strncmp(buf, "reset", 5) == 0) {
1194 bq2415x_reset_chip(bq);
1195 bq2415x_set_defaults(bq);
1196 if (bq->automode <= 0)
1197 return count;
1198 bq->automode = 1;
1199 mode = bq->reported_mode;
1200 } else {
1201 return -EINVAL;
1202 }
1203
1204 ret = bq2415x_set_mode(bq, mode);
1205 if (ret < 0)
1206 return ret;
1207 return count;
1208 }
1209
1210 /* show mode entry (auto, none, host, dedicated or boost) */
1211 static ssize_t bq2415x_sysfs_show_mode(struct device *dev,
1212 struct device_attribute *attr,
1213 char *buf)
1214 {
1215 struct power_supply *psy = dev_get_drvdata(dev);
1216 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1217 ssize_t ret = 0;
1218
1219 if (bq->automode > 0)
1220 ret += sprintf(buf+ret, "auto (");
1221
1222 switch (bq->mode) {
1223 case BQ2415X_MODE_OFF:
1224 ret += sprintf(buf+ret, "off");
1225 break;
1226 case BQ2415X_MODE_NONE:
1227 ret += sprintf(buf+ret, "none");
1228 break;
1229 case BQ2415X_MODE_HOST_CHARGER:
1230 ret += sprintf(buf+ret, "host");
1231 break;
1232 case BQ2415X_MODE_DEDICATED_CHARGER:
1233 ret += sprintf(buf+ret, "dedicated");
1234 break;
1235 case BQ2415X_MODE_BOOST:
1236 ret += sprintf(buf+ret, "boost");
1237 break;
1238 }
1239
1240 if (bq->automode > 0)
1241 ret += sprintf(buf+ret, ")");
1242
1243 ret += sprintf(buf+ret, "\n");
1244 return ret;
1245 }
1246
1247 /* show reported_mode entry (none, host, dedicated or boost) */
1248 static ssize_t bq2415x_sysfs_show_reported_mode(struct device *dev,
1249 struct device_attribute *attr,
1250 char *buf)
1251 {
1252 struct power_supply *psy = dev_get_drvdata(dev);
1253 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1254
1255 if (bq->automode < 0)
1256 return -EINVAL;
1257
1258 switch (bq->reported_mode) {
1259 case BQ2415X_MODE_OFF:
1260 return sprintf(buf, "off\n");
1261 case BQ2415X_MODE_NONE:
1262 return sprintf(buf, "none\n");
1263 case BQ2415X_MODE_HOST_CHARGER:
1264 return sprintf(buf, "host\n");
1265 case BQ2415X_MODE_DEDICATED_CHARGER:
1266 return sprintf(buf, "dedicated\n");
1267 case BQ2415X_MODE_BOOST:
1268 return sprintf(buf, "boost\n");
1269 }
1270
1271 return -EINVAL;
1272 }
1273
1274 /* directly set raw value to chip register, format: 'register value' */
1275 static ssize_t bq2415x_sysfs_set_registers(struct device *dev,
1276 struct device_attribute *attr,
1277 const char *buf,
1278 size_t count)
1279 {
1280 struct power_supply *psy = dev_get_drvdata(dev);
1281 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1282 ssize_t ret = 0;
1283 unsigned int reg;
1284 unsigned int val;
1285
1286 if (sscanf(buf, "%x %x", &reg, &val) != 2)
1287 return -EINVAL;
1288
1289 if (reg > 4 || val > 255)
1290 return -EINVAL;
1291
1292 ret = bq2415x_i2c_write(bq, reg, val);
1293 if (ret < 0)
1294 return ret;
1295 return count;
1296 }
1297
1298 /* print value of chip register, format: 'register=value' */
1299 static ssize_t bq2415x_sysfs_print_reg(struct bq2415x_device *bq,
1300 u8 reg,
1301 char *buf)
1302 {
1303 int ret = bq2415x_i2c_read(bq, reg);
1304
1305 if (ret < 0)
1306 return sprintf(buf, "%#.2x=error %d\n", reg, ret);
1307 return sprintf(buf, "%#.2x=%#.2x\n", reg, ret);
1308 }
1309
1310 /* show all raw values of chip register, format per line: 'register=value' */
1311 static ssize_t bq2415x_sysfs_show_registers(struct device *dev,
1312 struct device_attribute *attr,
1313 char *buf)
1314 {
1315 struct power_supply *psy = dev_get_drvdata(dev);
1316 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1317 ssize_t ret = 0;
1318
1319 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_STATUS, buf+ret);
1320 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CONTROL, buf+ret);
1321 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VOLTAGE, buf+ret);
1322 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VENDER, buf+ret);
1323 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CURRENT, buf+ret);
1324 return ret;
1325 }
1326
1327 /* set current and voltage limit entries (in mA or mV) */
1328 static ssize_t bq2415x_sysfs_set_limit(struct device *dev,
1329 struct device_attribute *attr,
1330 const char *buf,
1331 size_t count)
1332 {
1333 struct power_supply *psy = dev_get_drvdata(dev);
1334 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1335 long val;
1336 int ret;
1337
1338 if (kstrtol(buf, 10, &val) < 0)
1339 return -EINVAL;
1340
1341 if (strcmp(attr->attr.name, "current_limit") == 0)
1342 ret = bq2415x_set_current_limit(bq, val);
1343 else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1344 ret = bq2415x_set_weak_battery_voltage(bq, val);
1345 else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1346 ret = bq2415x_set_battery_regulation_voltage(bq, val);
1347 else if (strcmp(attr->attr.name, "charge_current") == 0)
1348 ret = bq2415x_set_charge_current(bq, val);
1349 else if (strcmp(attr->attr.name, "termination_current") == 0)
1350 ret = bq2415x_set_termination_current(bq, val);
1351 else
1352 return -EINVAL;
1353
1354 if (ret < 0)
1355 return ret;
1356 return count;
1357 }
1358
1359 /* show current and voltage limit entries (in mA or mV) */
1360 static ssize_t bq2415x_sysfs_show_limit(struct device *dev,
1361 struct device_attribute *attr,
1362 char *buf)
1363 {
1364 struct power_supply *psy = dev_get_drvdata(dev);
1365 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1366 int ret;
1367
1368 if (strcmp(attr->attr.name, "current_limit") == 0)
1369 ret = bq2415x_get_current_limit(bq);
1370 else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1371 ret = bq2415x_get_weak_battery_voltage(bq);
1372 else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1373 ret = bq2415x_get_battery_regulation_voltage(bq);
1374 else if (strcmp(attr->attr.name, "charge_current") == 0)
1375 ret = bq2415x_get_charge_current(bq);
1376 else if (strcmp(attr->attr.name, "termination_current") == 0)
1377 ret = bq2415x_get_termination_current(bq);
1378 else
1379 return -EINVAL;
1380
1381 if (ret < 0)
1382 return ret;
1383 return sprintf(buf, "%d\n", ret);
1384 }
1385
1386 /* set *_enable entries */
1387 static ssize_t bq2415x_sysfs_set_enable(struct device *dev,
1388 struct device_attribute *attr,
1389 const char *buf,
1390 size_t count)
1391 {
1392 struct power_supply *psy = dev_get_drvdata(dev);
1393 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1394 enum bq2415x_command command;
1395 long val;
1396 int ret;
1397
1398 if (kstrtol(buf, 10, &val) < 0)
1399 return -EINVAL;
1400
1401 if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1402 command = val ? BQ2415X_CHARGE_TERMINATION_ENABLE :
1403 BQ2415X_CHARGE_TERMINATION_DISABLE;
1404 else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1405 command = val ? BQ2415X_HIGH_IMPEDANCE_ENABLE :
1406 BQ2415X_HIGH_IMPEDANCE_DISABLE;
1407 else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1408 command = val ? BQ2415X_OTG_PIN_ENABLE :
1409 BQ2415X_OTG_PIN_DISABLE;
1410 else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1411 command = val ? BQ2415X_STAT_PIN_ENABLE :
1412 BQ2415X_STAT_PIN_DISABLE;
1413 else
1414 return -EINVAL;
1415
1416 ret = bq2415x_exec_command(bq, command);
1417 if (ret < 0)
1418 return ret;
1419 return count;
1420 }
1421
1422 /* show *_enable entries */
1423 static ssize_t bq2415x_sysfs_show_enable(struct device *dev,
1424 struct device_attribute *attr,
1425 char *buf)
1426 {
1427 struct power_supply *psy = dev_get_drvdata(dev);
1428 struct bq2415x_device *bq = power_supply_get_drvdata(psy);
1429 enum bq2415x_command command;
1430 int ret;
1431
1432 if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1433 command = BQ2415X_CHARGE_TERMINATION_STATUS;
1434 else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1435 command = BQ2415X_HIGH_IMPEDANCE_STATUS;
1436 else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1437 command = BQ2415X_OTG_PIN_STATUS;
1438 else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1439 command = BQ2415X_STAT_PIN_STATUS;
1440 else
1441 return -EINVAL;
1442
1443 ret = bq2415x_exec_command(bq, command);
1444 if (ret < 0)
1445 return ret;
1446 return sprintf(buf, "%d\n", ret);
1447 }
1448
1449 static DEVICE_ATTR(current_limit, S_IWUSR | S_IRUGO,
1450 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1451 static DEVICE_ATTR(weak_battery_voltage, S_IWUSR | S_IRUGO,
1452 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1453 static DEVICE_ATTR(battery_regulation_voltage, S_IWUSR | S_IRUGO,
1454 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1455 static DEVICE_ATTR(charge_current, S_IWUSR | S_IRUGO,
1456 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1457 static DEVICE_ATTR(termination_current, S_IWUSR | S_IRUGO,
1458 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1459
1460 static DEVICE_ATTR(charge_termination_enable, S_IWUSR | S_IRUGO,
1461 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1462 static DEVICE_ATTR(high_impedance_enable, S_IWUSR | S_IRUGO,
1463 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1464 static DEVICE_ATTR(otg_pin_enable, S_IWUSR | S_IRUGO,
1465 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1466 static DEVICE_ATTR(stat_pin_enable, S_IWUSR | S_IRUGO,
1467 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1468
1469 static DEVICE_ATTR(reported_mode, S_IRUGO,
1470 bq2415x_sysfs_show_reported_mode, NULL);
1471 static DEVICE_ATTR(mode, S_IWUSR | S_IRUGO,
1472 bq2415x_sysfs_show_mode, bq2415x_sysfs_set_mode);
1473 static DEVICE_ATTR(timer, S_IWUSR | S_IRUGO,
1474 bq2415x_sysfs_show_timer, bq2415x_sysfs_set_timer);
1475
1476 static DEVICE_ATTR(registers, S_IWUSR | S_IRUGO,
1477 bq2415x_sysfs_show_registers, bq2415x_sysfs_set_registers);
1478
1479 static DEVICE_ATTR(otg_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1480 static DEVICE_ATTR(charge_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1481 static DEVICE_ATTR(boost_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1482 static DEVICE_ATTR(fault_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1483
1484 static struct attribute *bq2415x_sysfs_attributes[] = {
1485 /*
1486 * TODO: some (appropriate) of these attrs should be switched to
1487 * use power supply class props.
1488 */
1489 &dev_attr_current_limit.attr,
1490 &dev_attr_weak_battery_voltage.attr,
1491 &dev_attr_battery_regulation_voltage.attr,
1492 &dev_attr_charge_current.attr,
1493 &dev_attr_termination_current.attr,
1494
1495 &dev_attr_charge_termination_enable.attr,
1496 &dev_attr_high_impedance_enable.attr,
1497 &dev_attr_otg_pin_enable.attr,
1498 &dev_attr_stat_pin_enable.attr,
1499
1500 &dev_attr_reported_mode.attr,
1501 &dev_attr_mode.attr,
1502 &dev_attr_timer.attr,
1503
1504 &dev_attr_registers.attr,
1505
1506 &dev_attr_otg_status.attr,
1507 &dev_attr_charge_status.attr,
1508 &dev_attr_boost_status.attr,
1509 &dev_attr_fault_status.attr,
1510 NULL,
1511 };
1512
1513 static const struct attribute_group bq2415x_sysfs_attr_group = {
1514 .attrs = bq2415x_sysfs_attributes,
1515 };
1516
1517 static int bq2415x_sysfs_init(struct bq2415x_device *bq)
1518 {
1519 return sysfs_create_group(&bq->charger->dev.kobj,
1520 &bq2415x_sysfs_attr_group);
1521 }
1522
1523 static void bq2415x_sysfs_exit(struct bq2415x_device *bq)
1524 {
1525 sysfs_remove_group(&bq->charger->dev.kobj, &bq2415x_sysfs_attr_group);
1526 }
1527
1528 /* main bq2415x probe function */
1529 static int bq2415x_probe(struct i2c_client *client,
1530 const struct i2c_device_id *id)
1531 {
1532 int ret;
1533 int num;
1534 char *name = NULL;
1535 struct bq2415x_device *bq;
1536 struct device_node *np = client->dev.of_node;
1537 struct bq2415x_platform_data *pdata = client->dev.platform_data;
1538 const struct acpi_device_id *acpi_id = NULL;
1539
1540 if (!np && !pdata && !ACPI_HANDLE(&client->dev)) {
1541 dev_err(&client->dev, "Neither devicetree, nor platform data, nor ACPI support\n");
1542 return -ENODEV;
1543 }
1544
1545 /* Get new ID for the new device */
1546 mutex_lock(&bq2415x_id_mutex);
1547 num = idr_alloc(&bq2415x_id, client, 0, 0, GFP_KERNEL);
1548 mutex_unlock(&bq2415x_id_mutex);
1549 if (num < 0)
1550 return num;
1551
1552 if (id) {
1553 name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
1554 } else if (ACPI_HANDLE(&client->dev)) {
1555 acpi_id =
1556 acpi_match_device(client->dev.driver->acpi_match_table,
1557 &client->dev);
1558 name = kasprintf(GFP_KERNEL, "%s-%d", acpi_id->id, num);
1559 }
1560 if (!name) {
1561 dev_err(&client->dev, "failed to allocate device name\n");
1562 ret = -ENOMEM;
1563 goto error_1;
1564 }
1565
1566 bq = devm_kzalloc(&client->dev, sizeof(*bq), GFP_KERNEL);
1567 if (!bq) {
1568 ret = -ENOMEM;
1569 goto error_2;
1570 }
1571
1572 if (np) {
1573 bq->notify_psy = power_supply_get_by_phandle(np,
1574 "ti,usb-charger-detection");
1575
1576 if (IS_ERR(bq->notify_psy)) {
1577 dev_info(&client->dev,
1578 "no 'ti,usb-charger-detection' property (err=%ld)\n",
1579 PTR_ERR(bq->notify_psy));
1580 bq->notify_psy = NULL;
1581 } else if (!bq->notify_psy) {
1582 ret = -EPROBE_DEFER;
1583 goto error_2;
1584 }
1585 } else if (pdata && pdata->notify_device) {
1586 bq->notify_psy = power_supply_get_by_name(pdata->notify_device);
1587 } else {
1588 bq->notify_psy = NULL;
1589 }
1590
1591 i2c_set_clientdata(client, bq);
1592
1593 bq->id = num;
1594 bq->dev = &client->dev;
1595 if (id)
1596 bq->chip = id->driver_data;
1597 else if (ACPI_HANDLE(bq->dev))
1598 bq->chip = acpi_id->driver_data;
1599 bq->name = name;
1600 bq->mode = BQ2415X_MODE_OFF;
1601 bq->reported_mode = BQ2415X_MODE_OFF;
1602 bq->autotimer = 0;
1603 bq->automode = 0;
1604
1605 if (np || ACPI_HANDLE(bq->dev)) {
1606 ret = device_property_read_u32(bq->dev,
1607 "ti,current-limit",
1608 &bq->init_data.current_limit);
1609 if (ret)
1610 goto error_3;
1611 ret = device_property_read_u32(bq->dev,
1612 "ti,weak-battery-voltage",
1613 &bq->init_data.weak_battery_voltage);
1614 if (ret)
1615 goto error_3;
1616 ret = device_property_read_u32(bq->dev,
1617 "ti,battery-regulation-voltage",
1618 &bq->init_data.battery_regulation_voltage);
1619 if (ret)
1620 goto error_3;
1621 ret = device_property_read_u32(bq->dev,
1622 "ti,charge-current",
1623 &bq->init_data.charge_current);
1624 if (ret)
1625 goto error_3;
1626 ret = device_property_read_u32(bq->dev,
1627 "ti,termination-current",
1628 &bq->init_data.termination_current);
1629 if (ret)
1630 goto error_3;
1631 ret = device_property_read_u32(bq->dev,
1632 "ti,resistor-sense",
1633 &bq->init_data.resistor_sense);
1634 if (ret)
1635 goto error_3;
1636 } else {
1637 memcpy(&bq->init_data, pdata, sizeof(bq->init_data));
1638 }
1639
1640 bq2415x_reset_chip(bq);
1641
1642 ret = bq2415x_power_supply_init(bq);
1643 if (ret) {
1644 dev_err(bq->dev, "failed to register power supply: %d\n", ret);
1645 goto error_3;
1646 }
1647
1648 ret = bq2415x_sysfs_init(bq);
1649 if (ret) {
1650 dev_err(bq->dev, "failed to create sysfs entries: %d\n", ret);
1651 goto error_4;
1652 }
1653
1654 ret = bq2415x_set_defaults(bq);
1655 if (ret) {
1656 dev_err(bq->dev, "failed to set default values: %d\n", ret);
1657 goto error_5;
1658 }
1659
1660 if (bq->notify_psy) {
1661 bq->nb.notifier_call = bq2415x_notifier_call;
1662 ret = power_supply_reg_notifier(&bq->nb);
1663 if (ret) {
1664 dev_err(bq->dev, "failed to reg notifier: %d\n", ret);
1665 goto error_6;
1666 }
1667
1668 /* Query for initial reported_mode and set it */
1669 bq2415x_notifier_call(&bq->nb, PSY_EVENT_PROP_CHANGED,
1670 bq->notify_psy);
1671 bq2415x_set_mode(bq, bq->reported_mode);
1672
1673 bq->automode = 1;
1674 dev_info(bq->dev, "automode enabled\n");
1675 } else {
1676 bq->automode = -1;
1677 dev_info(bq->dev, "automode not supported\n");
1678 }
1679
1680 INIT_DELAYED_WORK(&bq->work, bq2415x_timer_work);
1681 bq2415x_set_autotimer(bq, 1);
1682
1683 dev_info(bq->dev, "driver registered\n");
1684 return 0;
1685
1686 error_6:
1687 error_5:
1688 bq2415x_sysfs_exit(bq);
1689 error_4:
1690 bq2415x_power_supply_exit(bq);
1691 error_3:
1692 if (bq->notify_psy)
1693 power_supply_put(bq->notify_psy);
1694 error_2:
1695 kfree(name);
1696 error_1:
1697 mutex_lock(&bq2415x_id_mutex);
1698 idr_remove(&bq2415x_id, num);
1699 mutex_unlock(&bq2415x_id_mutex);
1700
1701 return ret;
1702 }
1703
1704 /* main bq2415x remove function */
1705
1706 static int bq2415x_remove(struct i2c_client *client)
1707 {
1708 struct bq2415x_device *bq = i2c_get_clientdata(client);
1709
1710 if (bq->notify_psy) {
1711 power_supply_unreg_notifier(&bq->nb);
1712 power_supply_put(bq->notify_psy);
1713 }
1714
1715 bq2415x_sysfs_exit(bq);
1716 bq2415x_power_supply_exit(bq);
1717
1718 bq2415x_reset_chip(bq);
1719
1720 mutex_lock(&bq2415x_id_mutex);
1721 idr_remove(&bq2415x_id, bq->id);
1722 mutex_unlock(&bq2415x_id_mutex);
1723
1724 dev_info(bq->dev, "driver unregistered\n");
1725
1726 kfree(bq->name);
1727
1728 return 0;
1729 }
1730
1731 static const struct i2c_device_id bq2415x_i2c_id_table[] = {
1732 { "bq2415x", BQUNKNOWN },
1733 { "bq24150", BQ24150 },
1734 { "bq24150a", BQ24150A },
1735 { "bq24151", BQ24151 },
1736 { "bq24151a", BQ24151A },
1737 { "bq24152", BQ24152 },
1738 { "bq24153", BQ24153 },
1739 { "bq24153a", BQ24153A },
1740 { "bq24155", BQ24155 },
1741 { "bq24156", BQ24156 },
1742 { "bq24156a", BQ24156A },
1743 { "bq24157s", BQ24157S },
1744 { "bq24158", BQ24158 },
1745 {},
1746 };
1747 MODULE_DEVICE_TABLE(i2c, bq2415x_i2c_id_table);
1748
1749 static const struct acpi_device_id bq2415x_i2c_acpi_match[] = {
1750 { "BQ2415X", BQUNKNOWN },
1751 { "BQ241500", BQ24150 },
1752 { "BQA24150", BQ24150A },
1753 { "BQ241510", BQ24151 },
1754 { "BQA24151", BQ24151A },
1755 { "BQ241520", BQ24152 },
1756 { "BQ241530", BQ24153 },
1757 { "BQA24153", BQ24153A },
1758 { "BQ241550", BQ24155 },
1759 { "BQ241560", BQ24156 },
1760 { "BQA24156", BQ24156A },
1761 { "BQS24157", BQ24157S },
1762 { "BQ241580", BQ24158 },
1763 {},
1764 };
1765 MODULE_DEVICE_TABLE(acpi, bq2415x_i2c_acpi_match);
1766
1767 static struct i2c_driver bq2415x_driver = {
1768 .driver = {
1769 .name = "bq2415x-charger",
1770 .acpi_match_table = ACPI_PTR(bq2415x_i2c_acpi_match),
1771 },
1772 .probe = bq2415x_probe,
1773 .remove = bq2415x_remove,
1774 .id_table = bq2415x_i2c_id_table,
1775 };
1776 module_i2c_driver(bq2415x_driver);
1777
1778 MODULE_AUTHOR("Pali Rohár <pali.rohar@gmail.com>");
1779 MODULE_DESCRIPTION("bq2415x charger driver");
1780 MODULE_LICENSE("GPL");
Linux with added FPC-III support