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