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