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