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