blob: 0727f9256138589cf0184756b46adc5f216df4bd [file] [log] [blame]
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001/*
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08002 * bq2415x charger driver
3 *
4 * Copyright (C) 2011-2012 Pali Rohár <pali.rohar@gmail.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
19 */
Pali Rohár0bc98cc2012-11-02 20:18:11 +010020
21/*
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -080022 * Datasheets:
23 * http://www.ti.com/product/bq24150
24 * http://www.ti.com/product/bq24150a
25 * http://www.ti.com/product/bq24152
26 * http://www.ti.com/product/bq24153
27 * http://www.ti.com/product/bq24153a
28 * http://www.ti.com/product/bq24155
29 */
Pali Rohár0bc98cc2012-11-02 20:18:11 +010030
Pali Rohár0bc98cc2012-11-02 20:18:11 +010031#include <linux/kernel.h>
32#include <linux/module.h>
33#include <linux/param.h>
34#include <linux/err.h>
35#include <linux/workqueue.h>
36#include <linux/sysfs.h>
37#include <linux/platform_device.h>
38#include <linux/power_supply.h>
39#include <linux/idr.h>
40#include <linux/i2c.h>
41#include <linux/slab.h>
42
43#include <linux/power/bq2415x_charger.h>
44
45/* timeout for resetting chip timer */
46#define BQ2415X_TIMER_TIMEOUT 10
47
48#define BQ2415X_REG_STATUS 0x00
49#define BQ2415X_REG_CONTROL 0x01
50#define BQ2415X_REG_VOLTAGE 0x02
51#define BQ2415X_REG_VENDER 0x03
52#define BQ2415X_REG_CURRENT 0x04
53
54/* reset state for all registers */
55#define BQ2415X_RESET_STATUS BIT(6)
56#define BQ2415X_RESET_CONTROL (BIT(4)|BIT(5))
57#define BQ2415X_RESET_VOLTAGE (BIT(1)|BIT(3))
58#define BQ2415X_RESET_CURRENT (BIT(0)|BIT(3)|BIT(7))
59
60/* status register */
61#define BQ2415X_BIT_TMR_RST 7
62#define BQ2415X_BIT_OTG 7
63#define BQ2415X_BIT_EN_STAT 6
64#define BQ2415X_MASK_STAT (BIT(4)|BIT(5))
65#define BQ2415X_SHIFT_STAT 4
66#define BQ2415X_BIT_BOOST 3
67#define BQ2415X_MASK_FAULT (BIT(0)|BIT(1)|BIT(2))
68#define BQ2415X_SHIFT_FAULT 0
69
70/* control register */
71#define BQ2415X_MASK_LIMIT (BIT(6)|BIT(7))
72#define BQ2415X_SHIFT_LIMIT 6
73#define BQ2415X_MASK_VLOWV (BIT(4)|BIT(5))
74#define BQ2415X_SHIFT_VLOWV 4
75#define BQ2415X_BIT_TE 3
76#define BQ2415X_BIT_CE 2
77#define BQ2415X_BIT_HZ_MODE 1
78#define BQ2415X_BIT_OPA_MODE 0
79
80/* voltage register */
81#define BQ2415X_MASK_VO (BIT(2)|BIT(3)|BIT(4)|BIT(5)|BIT(6)|BIT(7))
82#define BQ2415X_SHIFT_VO 2
83#define BQ2415X_BIT_OTG_PL 1
84#define BQ2415X_BIT_OTG_EN 0
85
86/* vender register */
87#define BQ2415X_MASK_VENDER (BIT(5)|BIT(6)|BIT(7))
88#define BQ2415X_SHIFT_VENDER 5
89#define BQ2415X_MASK_PN (BIT(3)|BIT(4))
90#define BQ2415X_SHIFT_PN 3
91#define BQ2415X_MASK_REVISION (BIT(0)|BIT(1)|BIT(2))
92#define BQ2415X_SHIFT_REVISION 0
93
94/* current register */
95#define BQ2415X_MASK_RESET BIT(7)
96#define BQ2415X_MASK_VI_CHRG (BIT(4)|BIT(5)|BIT(6))
97#define BQ2415X_SHIFT_VI_CHRG 4
98/* N/A BIT(3) */
99#define BQ2415X_MASK_VI_TERM (BIT(0)|BIT(1)|BIT(2))
100#define BQ2415X_SHIFT_VI_TERM 0
101
102
103enum bq2415x_command {
104 BQ2415X_TIMER_RESET,
105 BQ2415X_OTG_STATUS,
106 BQ2415X_STAT_PIN_STATUS,
107 BQ2415X_STAT_PIN_ENABLE,
108 BQ2415X_STAT_PIN_DISABLE,
109 BQ2415X_CHARGE_STATUS,
110 BQ2415X_BOOST_STATUS,
111 BQ2415X_FAULT_STATUS,
112
113 BQ2415X_CHARGE_TERMINATION_STATUS,
114 BQ2415X_CHARGE_TERMINATION_ENABLE,
115 BQ2415X_CHARGE_TERMINATION_DISABLE,
116 BQ2415X_CHARGER_STATUS,
117 BQ2415X_CHARGER_ENABLE,
118 BQ2415X_CHARGER_DISABLE,
119 BQ2415X_HIGH_IMPEDANCE_STATUS,
120 BQ2415X_HIGH_IMPEDANCE_ENABLE,
121 BQ2415X_HIGH_IMPEDANCE_DISABLE,
122 BQ2415X_BOOST_MODE_STATUS,
123 BQ2415X_BOOST_MODE_ENABLE,
124 BQ2415X_BOOST_MODE_DISABLE,
125
126 BQ2415X_OTG_LEVEL,
127 BQ2415X_OTG_ACTIVATE_HIGH,
128 BQ2415X_OTG_ACTIVATE_LOW,
129 BQ2415X_OTG_PIN_STATUS,
130 BQ2415X_OTG_PIN_ENABLE,
131 BQ2415X_OTG_PIN_DISABLE,
132
133 BQ2415X_VENDER_CODE,
134 BQ2415X_PART_NUMBER,
135 BQ2415X_REVISION,
136};
137
138enum bq2415x_chip {
139 BQUNKNOWN,
140 BQ24150,
141 BQ24150A,
142 BQ24151,
143 BQ24151A,
144 BQ24152,
145 BQ24153,
146 BQ24153A,
147 BQ24155,
148 BQ24156,
149 BQ24156A,
150 BQ24158,
151};
152
153static char *bq2415x_chip_name[] = {
154 "unknown",
155 "bq24150",
156 "bq24150a",
157 "bq24151",
158 "bq24151a",
159 "bq24152",
160 "bq24153",
161 "bq24153a",
162 "bq24155",
163 "bq24156",
164 "bq24156a",
165 "bq24158",
166};
167
168struct bq2415x_device {
169 struct device *dev;
170 struct bq2415x_platform_data init_data;
171 struct power_supply charger;
172 struct delayed_work work;
173 enum bq2415x_mode reported_mode;/* mode reported by hook function */
174 enum bq2415x_mode mode; /* current configured mode */
175 enum bq2415x_chip chip;
176 const char *timer_error;
177 char *model;
178 char *name;
179 int autotimer; /* 1 - if driver automatically reset timer, 0 - not */
180 int automode; /* 1 - enabled, 0 - disabled; -1 - not supported */
181 int id;
182};
183
184/* each registered chip must have unique id */
185static DEFINE_IDR(bq2415x_id);
186
187static DEFINE_MUTEX(bq2415x_id_mutex);
188static DEFINE_MUTEX(bq2415x_timer_mutex);
189static DEFINE_MUTEX(bq2415x_i2c_mutex);
190
191/**** i2c read functions ****/
192
193/* read value from register */
194static int bq2415x_i2c_read(struct bq2415x_device *bq, u8 reg)
195{
196 struct i2c_client *client = to_i2c_client(bq->dev);
197 struct i2c_msg msg[2];
198 u8 val;
199 int ret;
200
201 if (!client->adapter)
202 return -ENODEV;
203
204 msg[0].addr = client->addr;
205 msg[0].flags = 0;
206 msg[0].buf = &reg;
207 msg[0].len = sizeof(reg);
208 msg[1].addr = client->addr;
209 msg[1].flags = I2C_M_RD;
210 msg[1].buf = &val;
211 msg[1].len = sizeof(val);
212
213 mutex_lock(&bq2415x_i2c_mutex);
214 ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
215 mutex_unlock(&bq2415x_i2c_mutex);
216
217 if (ret < 0)
218 return ret;
219
220 return val;
221}
222
223/* read value from register, apply mask and right shift it */
224static int bq2415x_i2c_read_mask(struct bq2415x_device *bq, u8 reg,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800225 u8 mask, u8 shift)
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100226{
227 int ret;
228
229 if (shift > 8)
230 return -EINVAL;
231
232 ret = bq2415x_i2c_read(bq, reg);
233 if (ret < 0)
234 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800235 return (ret & mask) >> shift;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100236}
237
238/* read value from register and return one specified bit */
239static int bq2415x_i2c_read_bit(struct bq2415x_device *bq, u8 reg, u8 bit)
240{
241 if (bit > 8)
242 return -EINVAL;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800243 return bq2415x_i2c_read_mask(bq, reg, BIT(bit), bit);
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100244}
245
246/**** i2c write functions ****/
247
248/* write value to register */
249static int bq2415x_i2c_write(struct bq2415x_device *bq, u8 reg, u8 val)
250{
251 struct i2c_client *client = to_i2c_client(bq->dev);
252 struct i2c_msg msg[1];
253 u8 data[2];
254 int ret;
255
256 data[0] = reg;
257 data[1] = val;
258
259 msg[0].addr = client->addr;
260 msg[0].flags = 0;
261 msg[0].buf = data;
262 msg[0].len = ARRAY_SIZE(data);
263
264 mutex_lock(&bq2415x_i2c_mutex);
265 ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
266 mutex_unlock(&bq2415x_i2c_mutex);
267
268 /* i2c_transfer returns number of messages transferred */
269 if (ret < 0)
270 return ret;
271 else if (ret != 1)
272 return -EIO;
273
274 return 0;
275}
276
277/* read value from register, change it with mask left shifted and write back */
278static int bq2415x_i2c_write_mask(struct bq2415x_device *bq, u8 reg, u8 val,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800279 u8 mask, u8 shift)
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100280{
281 int ret;
282
283 if (shift > 8)
284 return -EINVAL;
285
286 ret = bq2415x_i2c_read(bq, reg);
287 if (ret < 0)
288 return ret;
289
290 ret &= ~mask;
291 ret |= val << shift;
292
293 return bq2415x_i2c_write(bq, reg, ret);
294}
295
296/* change only one bit in register */
297static int bq2415x_i2c_write_bit(struct bq2415x_device *bq, u8 reg,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800298 bool val, u8 bit)
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100299{
300 if (bit > 8)
301 return -EINVAL;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800302 return bq2415x_i2c_write_mask(bq, reg, val, BIT(bit), bit);
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100303}
304
305/**** global functions ****/
306
307/* exec command function */
308static int bq2415x_exec_command(struct bq2415x_device *bq,
309 enum bq2415x_command command)
310{
311 int ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800312
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100313 switch (command) {
314 case BQ2415X_TIMER_RESET:
315 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS,
316 1, BQ2415X_BIT_TMR_RST);
317 case BQ2415X_OTG_STATUS:
318 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
319 BQ2415X_BIT_OTG);
320 case BQ2415X_STAT_PIN_STATUS:
321 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
322 BQ2415X_BIT_EN_STAT);
323 case BQ2415X_STAT_PIN_ENABLE:
324 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 1,
325 BQ2415X_BIT_EN_STAT);
326 case BQ2415X_STAT_PIN_DISABLE:
327 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 0,
328 BQ2415X_BIT_EN_STAT);
329 case BQ2415X_CHARGE_STATUS:
330 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
331 BQ2415X_MASK_STAT, BQ2415X_SHIFT_STAT);
332 case BQ2415X_BOOST_STATUS:
333 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
334 BQ2415X_BIT_BOOST);
335 case BQ2415X_FAULT_STATUS:
336 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
337 BQ2415X_MASK_FAULT, BQ2415X_SHIFT_FAULT);
338
339 case BQ2415X_CHARGE_TERMINATION_STATUS:
340 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
341 BQ2415X_BIT_TE);
342 case BQ2415X_CHARGE_TERMINATION_ENABLE:
343 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
344 1, BQ2415X_BIT_TE);
345 case BQ2415X_CHARGE_TERMINATION_DISABLE:
346 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
347 0, BQ2415X_BIT_TE);
348 case BQ2415X_CHARGER_STATUS:
349 ret = bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
350 BQ2415X_BIT_CE);
351 if (ret < 0)
352 return ret;
353 else
354 return ret > 0 ? 0 : 1;
355 case BQ2415X_CHARGER_ENABLE:
356 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
357 0, BQ2415X_BIT_CE);
358 case BQ2415X_CHARGER_DISABLE:
359 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
360 1, BQ2415X_BIT_CE);
361 case BQ2415X_HIGH_IMPEDANCE_STATUS:
362 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
363 BQ2415X_BIT_HZ_MODE);
364 case BQ2415X_HIGH_IMPEDANCE_ENABLE:
365 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
366 1, BQ2415X_BIT_HZ_MODE);
367 case BQ2415X_HIGH_IMPEDANCE_DISABLE:
368 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
369 0, BQ2415X_BIT_HZ_MODE);
370 case BQ2415X_BOOST_MODE_STATUS:
371 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
372 BQ2415X_BIT_OPA_MODE);
373 case BQ2415X_BOOST_MODE_ENABLE:
374 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
375 1, BQ2415X_BIT_OPA_MODE);
376 case BQ2415X_BOOST_MODE_DISABLE:
377 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
378 0, BQ2415X_BIT_OPA_MODE);
379
380 case BQ2415X_OTG_LEVEL:
381 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
382 BQ2415X_BIT_OTG_PL);
383 case BQ2415X_OTG_ACTIVATE_HIGH:
384 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
385 1, BQ2415X_BIT_OTG_PL);
386 case BQ2415X_OTG_ACTIVATE_LOW:
387 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
388 0, BQ2415X_BIT_OTG_PL);
389 case BQ2415X_OTG_PIN_STATUS:
390 return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
391 BQ2415X_BIT_OTG_EN);
392 case BQ2415X_OTG_PIN_ENABLE:
393 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
394 1, BQ2415X_BIT_OTG_EN);
395 case BQ2415X_OTG_PIN_DISABLE:
396 return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
397 0, BQ2415X_BIT_OTG_EN);
398
399 case BQ2415X_VENDER_CODE:
400 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
401 BQ2415X_MASK_VENDER, BQ2415X_SHIFT_VENDER);
402 case BQ2415X_PART_NUMBER:
403 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
404 BQ2415X_MASK_PN, BQ2415X_SHIFT_PN);
405 case BQ2415X_REVISION:
406 return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
407 BQ2415X_MASK_REVISION, BQ2415X_SHIFT_REVISION);
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100408 }
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800409 return -EINVAL;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100410}
411
412/* detect chip type */
413static enum bq2415x_chip bq2415x_detect_chip(struct bq2415x_device *bq)
414{
415 struct i2c_client *client = to_i2c_client(bq->dev);
416 int ret = bq2415x_exec_command(bq, BQ2415X_PART_NUMBER);
417
418 if (ret < 0)
419 return ret;
420
421 switch (client->addr) {
422 case 0x6b:
423 switch (ret) {
424 case 0:
425 if (bq->chip == BQ24151A)
426 return bq->chip;
427 else
428 return BQ24151;
429 case 1:
430 if (bq->chip == BQ24150A ||
431 bq->chip == BQ24152 ||
432 bq->chip == BQ24155)
433 return bq->chip;
434 else
435 return BQ24150;
436 case 2:
437 if (bq->chip == BQ24153A)
438 return bq->chip;
439 else
440 return BQ24153;
441 default:
442 return BQUNKNOWN;
443 }
444 break;
445
446 case 0x6a:
447 switch (ret) {
448 case 0:
449 if (bq->chip == BQ24156A)
450 return bq->chip;
451 else
452 return BQ24156;
453 case 2:
454 return BQ24158;
455 default:
456 return BQUNKNOWN;
457 }
458 break;
459 }
460
461 return BQUNKNOWN;
462}
463
464/* detect chip revision */
465static int bq2415x_detect_revision(struct bq2415x_device *bq)
466{
467 int ret = bq2415x_exec_command(bq, BQ2415X_REVISION);
468 int chip = bq2415x_detect_chip(bq);
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800469
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100470 if (ret < 0 || chip < 0)
471 return -1;
472
473 switch (chip) {
474 case BQ24150:
475 case BQ24150A:
476 case BQ24151:
477 case BQ24151A:
478 case BQ24152:
479 if (ret >= 0 && ret <= 3)
480 return ret;
481 else
482 return -1;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100483 case BQ24153:
484 case BQ24153A:
485 case BQ24156:
486 case BQ24156A:
487 case BQ24158:
488 if (ret == 3)
489 return 0;
490 else if (ret == 1)
491 return 1;
492 else
493 return -1;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100494 case BQ24155:
495 if (ret == 3)
496 return 3;
497 else
498 return -1;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100499 case BQUNKNOWN:
500 return -1;
501 }
502
503 return -1;
504}
505
506/* return chip vender code */
507static int bq2415x_get_vender_code(struct bq2415x_device *bq)
508{
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800509 int ret;
510
511 ret = bq2415x_exec_command(bq, BQ2415X_VENDER_CODE);
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100512 if (ret < 0)
513 return 0;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800514
515 /* convert to binary */
516 return (ret & 0x1) +
517 ((ret >> 1) & 0x1) * 10 +
518 ((ret >> 2) & 0x1) * 100;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100519}
520
521/* reset all chip registers to default state */
522static void bq2415x_reset_chip(struct bq2415x_device *bq)
523{
524 bq2415x_i2c_write(bq, BQ2415X_REG_CURRENT, BQ2415X_RESET_CURRENT);
525 bq2415x_i2c_write(bq, BQ2415X_REG_VOLTAGE, BQ2415X_RESET_VOLTAGE);
526 bq2415x_i2c_write(bq, BQ2415X_REG_CONTROL, BQ2415X_RESET_CONTROL);
527 bq2415x_i2c_write(bq, BQ2415X_REG_STATUS, BQ2415X_RESET_STATUS);
528 bq->timer_error = NULL;
529}
530
531/**** properties functions ****/
532
533/* set current limit in mA */
534static int bq2415x_set_current_limit(struct bq2415x_device *bq, int mA)
535{
536 int val;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800537
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100538 if (mA <= 100)
539 val = 0;
540 else if (mA <= 500)
541 val = 1;
542 else if (mA <= 800)
543 val = 2;
544 else
545 val = 3;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800546
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100547 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
548 BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
549}
550
551/* get current limit in mA */
552static int bq2415x_get_current_limit(struct bq2415x_device *bq)
553{
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800554 int ret;
555
556 ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100557 BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
558 if (ret < 0)
559 return ret;
560 else if (ret == 0)
561 return 100;
562 else if (ret == 1)
563 return 500;
564 else if (ret == 2)
565 return 800;
566 else if (ret == 3)
567 return 1800;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800568 return -EINVAL;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100569}
570
571/* set weak battery voltage in mV */
572static int bq2415x_set_weak_battery_voltage(struct bq2415x_device *bq, int mV)
573{
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100574 int val;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800575
576 /* round to 100mV */
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100577 if (mV <= 3400 + 50)
578 val = 0;
579 else if (mV <= 3500 + 50)
580 val = 1;
581 else if (mV <= 3600 + 50)
582 val = 2;
583 else
584 val = 3;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800585
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100586 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
587 BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
588}
589
590/* get weak battery voltage in mV */
591static int bq2415x_get_weak_battery_voltage(struct bq2415x_device *bq)
592{
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800593 int ret;
594
595 ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100596 BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
597 if (ret < 0)
598 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800599 return 100 * (34 + ret);
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100600}
601
602/* set battery regulation voltage in mV */
603static int bq2415x_set_battery_regulation_voltage(struct bq2415x_device *bq,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800604 int mV)
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100605{
606 int val = (mV/10 - 350) / 2;
607
608 if (val < 0)
609 val = 0;
610 else if (val > 94) /* FIXME: Max is 94 or 122 ? Set max value ? */
611 return -EINVAL;
612
613 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_VOLTAGE, val,
614 BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
615}
616
617/* get battery regulation voltage in mV */
618static int bq2415x_get_battery_regulation_voltage(struct bq2415x_device *bq)
619{
620 int ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_VOLTAGE,
621 BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800622
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100623 if (ret < 0)
624 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800625 return 10 * (350 + 2*ret);
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100626}
627
628/* set charge current in mA (platform data must provide resistor sense) */
629static int bq2415x_set_charge_current(struct bq2415x_device *bq, int mA)
630{
631 int val;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800632
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100633 if (bq->init_data.resistor_sense <= 0)
634 return -ENOSYS;
635
636 val = (mA * bq->init_data.resistor_sense - 37400) / 6800;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100637 if (val < 0)
638 val = 0;
639 else if (val > 7)
640 val = 7;
641
642 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
643 BQ2415X_MASK_VI_CHRG | BQ2415X_MASK_RESET,
644 BQ2415X_SHIFT_VI_CHRG);
645}
646
647/* get charge current in mA (platform data must provide resistor sense) */
648static int bq2415x_get_charge_current(struct bq2415x_device *bq)
649{
650 int ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800651
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100652 if (bq->init_data.resistor_sense <= 0)
653 return -ENOSYS;
654
655 ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
656 BQ2415X_MASK_VI_CHRG, BQ2415X_SHIFT_VI_CHRG);
657 if (ret < 0)
658 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800659 return (37400 + 6800*ret) / bq->init_data.resistor_sense;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100660}
661
662/* set termination current in mA (platform data must provide resistor sense) */
663static int bq2415x_set_termination_current(struct bq2415x_device *bq, int mA)
664{
665 int val;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800666
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100667 if (bq->init_data.resistor_sense <= 0)
668 return -ENOSYS;
669
670 val = (mA * bq->init_data.resistor_sense - 3400) / 3400;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100671 if (val < 0)
672 val = 0;
673 else if (val > 7)
674 val = 7;
675
676 return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
677 BQ2415X_MASK_VI_TERM | BQ2415X_MASK_RESET,
678 BQ2415X_SHIFT_VI_TERM);
679}
680
681/* get termination current in mA (platform data must provide resistor sense) */
682static int bq2415x_get_termination_current(struct bq2415x_device *bq)
683{
684 int ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800685
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100686 if (bq->init_data.resistor_sense <= 0)
687 return -ENOSYS;
688
689 ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
690 BQ2415X_MASK_VI_TERM, BQ2415X_SHIFT_VI_TERM);
691 if (ret < 0)
692 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800693 return (3400 + 3400*ret) / bq->init_data.resistor_sense;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100694}
695
696/* set default value of property */
697#define bq2415x_set_default_value(bq, prop) \
698 do { \
699 int ret = 0; \
700 if (bq->init_data.prop != -1) \
701 ret = bq2415x_set_##prop(bq, bq->init_data.prop); \
702 if (ret < 0) \
703 return ret; \
704 } while (0)
705
706/* set default values of all properties */
707static int bq2415x_set_defaults(struct bq2415x_device *bq)
708{
709 bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
710 bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
711 bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_DISABLE);
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800712
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100713 bq2415x_set_default_value(bq, current_limit);
714 bq2415x_set_default_value(bq, weak_battery_voltage);
715 bq2415x_set_default_value(bq, battery_regulation_voltage);
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800716
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100717 if (bq->init_data.resistor_sense > 0) {
718 bq2415x_set_default_value(bq, charge_current);
719 bq2415x_set_default_value(bq, termination_current);
720 bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_ENABLE);
721 }
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800722
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100723 bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
724 return 0;
725}
726
727/**** charger mode functions ****/
728
729/* set charger mode */
730static int bq2415x_set_mode(struct bq2415x_device *bq, enum bq2415x_mode mode)
731{
732 int ret = 0;
733 int charger = 0;
734 int boost = 0;
735
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100736 if (mode == BQ2415X_MODE_BOOST)
737 boost = 1;
Pali Rohárac6324e2013-02-10 18:32:18 +0100738 else if (mode != BQ2415X_MODE_OFF)
739 charger = 1;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100740
741 if (!charger)
742 ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
743
744 if (!boost)
745 ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
746
747 if (ret < 0)
748 return ret;
749
750 switch (mode) {
Pali Rohárac6324e2013-02-10 18:32:18 +0100751 case BQ2415X_MODE_OFF:
752 dev_dbg(bq->dev, "changing mode to: Offline\n");
753 ret = bq2415x_set_current_limit(bq, 100);
754 break;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100755 case BQ2415X_MODE_NONE:
756 dev_dbg(bq->dev, "changing mode to: N/A\n");
757 ret = bq2415x_set_current_limit(bq, 100);
758 break;
759 case BQ2415X_MODE_HOST_CHARGER:
760 dev_dbg(bq->dev, "changing mode to: Host/HUB charger\n");
761 ret = bq2415x_set_current_limit(bq, 500);
762 break;
763 case BQ2415X_MODE_DEDICATED_CHARGER:
764 dev_dbg(bq->dev, "changing mode to: Dedicated charger\n");
765 ret = bq2415x_set_current_limit(bq, 1800);
766 break;
767 case BQ2415X_MODE_BOOST: /* Boost mode */
768 dev_dbg(bq->dev, "changing mode to: Boost\n");
769 ret = bq2415x_set_current_limit(bq, 100);
770 break;
771 }
772
773 if (ret < 0)
774 return ret;
775
776 if (charger)
777 ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
778 else if (boost)
779 ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_ENABLE);
780
781 if (ret < 0)
782 return ret;
783
784 bq2415x_set_default_value(bq, weak_battery_voltage);
785 bq2415x_set_default_value(bq, battery_regulation_voltage);
786
787 bq->mode = mode;
788 sysfs_notify(&bq->charger.dev->kobj, NULL, "mode");
789
790 return 0;
791
792}
793
794/* hook function called by other driver which set reported mode */
795static void bq2415x_hook_function(enum bq2415x_mode mode, void *data)
796{
797 struct bq2415x_device *bq = data;
798
799 if (!bq)
800 return;
801
802 dev_dbg(bq->dev, "hook function was called\n");
803 bq->reported_mode = mode;
804
805 /* if automode is not enabled do not tell about reported_mode */
806 if (bq->automode < 1)
807 return;
808
809 sysfs_notify(&bq->charger.dev->kobj, NULL, "reported_mode");
810 bq2415x_set_mode(bq, bq->reported_mode);
811
812}
813
814/**** timer functions ****/
815
816/* enable/disable auto resetting chip timer */
817static void bq2415x_set_autotimer(struct bq2415x_device *bq, int state)
818{
819 mutex_lock(&bq2415x_timer_mutex);
820
821 if (bq->autotimer == state) {
822 mutex_unlock(&bq2415x_timer_mutex);
823 return;
824 }
825
826 bq->autotimer = state;
827
828 if (state) {
829 schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
830 bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
831 bq->timer_error = NULL;
832 } else {
833 cancel_delayed_work_sync(&bq->work);
834 }
835
836 mutex_unlock(&bq2415x_timer_mutex);
837}
838
839/* called by bq2415x_timer_work on timer error */
840static void bq2415x_timer_error(struct bq2415x_device *bq, const char *msg)
841{
842 bq->timer_error = msg;
843 sysfs_notify(&bq->charger.dev->kobj, NULL, "timer");
844 dev_err(bq->dev, "%s\n", msg);
845 if (bq->automode > 0)
846 bq->automode = 0;
Pali Rohárac6324e2013-02-10 18:32:18 +0100847 bq2415x_set_mode(bq, BQ2415X_MODE_OFF);
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100848 bq2415x_set_autotimer(bq, 0);
849}
850
851/* delayed work function for auto resetting chip timer */
852static void bq2415x_timer_work(struct work_struct *work)
853{
854 struct bq2415x_device *bq = container_of(work, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800855 work.work);
856 int ret;
857 int error;
858 int boost;
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100859
860 if (!bq->autotimer)
861 return;
862
863 ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
864 if (ret < 0) {
865 bq2415x_timer_error(bq, "Resetting timer failed");
866 return;
867 }
868
869 boost = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_STATUS);
870 if (boost < 0) {
871 bq2415x_timer_error(bq, "Unknown error");
872 return;
873 }
874
875 error = bq2415x_exec_command(bq, BQ2415X_FAULT_STATUS);
876 if (error < 0) {
877 bq2415x_timer_error(bq, "Unknown error");
878 return;
879 }
880
881 if (boost) {
882 switch (error) {
883 /* Non fatal errors, chip is OK */
884 case 0: /* No error */
885 break;
886 case 6: /* Timer expired */
887 dev_err(bq->dev, "Timer expired\n");
888 break;
889 case 3: /* Battery voltage too low */
890 dev_err(bq->dev, "Battery voltage to low\n");
891 break;
892
893 /* Fatal errors, disable and reset chip */
894 case 1: /* Overvoltage protection (chip fried) */
895 bq2415x_timer_error(bq,
896 "Overvoltage protection (chip fried)");
897 return;
898 case 2: /* Overload */
899 bq2415x_timer_error(bq, "Overload");
900 return;
901 case 4: /* Battery overvoltage protection */
902 bq2415x_timer_error(bq,
903 "Battery overvoltage protection");
904 return;
905 case 5: /* Thermal shutdown (too hot) */
906 bq2415x_timer_error(bq,
907 "Thermal shutdown (too hot)");
908 return;
909 case 7: /* N/A */
910 bq2415x_timer_error(bq, "Unknown error");
911 return;
912 }
913 } else {
914 switch (error) {
915 /* Non fatal errors, chip is OK */
916 case 0: /* No error */
917 break;
918 case 2: /* Sleep mode */
919 dev_err(bq->dev, "Sleep mode\n");
920 break;
921 case 3: /* Poor input source */
922 dev_err(bq->dev, "Poor input source\n");
923 break;
924 case 6: /* Timer expired */
925 dev_err(bq->dev, "Timer expired\n");
926 break;
927 case 7: /* No battery */
928 dev_err(bq->dev, "No battery\n");
929 break;
930
931 /* Fatal errors, disable and reset chip */
932 case 1: /* Overvoltage protection (chip fried) */
933 bq2415x_timer_error(bq,
934 "Overvoltage protection (chip fried)");
935 return;
936 case 4: /* Battery overvoltage protection */
937 bq2415x_timer_error(bq,
938 "Battery overvoltage protection");
939 return;
940 case 5: /* Thermal shutdown (too hot) */
941 bq2415x_timer_error(bq,
942 "Thermal shutdown (too hot)");
943 return;
944 }
945 }
946
947 schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
948}
949
950/**** power supply interface code ****/
951
952static enum power_supply_property bq2415x_power_supply_props[] = {
953 /* TODO: maybe add more power supply properties */
954 POWER_SUPPLY_PROP_STATUS,
955 POWER_SUPPLY_PROP_MODEL_NAME,
956};
957
958static int bq2415x_power_supply_get_property(struct power_supply *psy,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800959 enum power_supply_property psp,
960 union power_supply_propval *val)
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100961{
962 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -0800963 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +0100964 int ret;
965
966 switch (psp) {
967 case POWER_SUPPLY_PROP_STATUS:
968 ret = bq2415x_exec_command(bq, BQ2415X_CHARGE_STATUS);
969 if (ret < 0)
970 return ret;
971 else if (ret == 0) /* Ready */
972 val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
973 else if (ret == 1) /* Charge in progress */
974 val->intval = POWER_SUPPLY_STATUS_CHARGING;
975 else if (ret == 2) /* Charge done */
976 val->intval = POWER_SUPPLY_STATUS_FULL;
977 else
978 val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
979 break;
980 case POWER_SUPPLY_PROP_MODEL_NAME:
981 val->strval = bq->model;
982 break;
983 default:
984 return -EINVAL;
985 }
986 return 0;
987}
988
989static int bq2415x_power_supply_init(struct bq2415x_device *bq)
990{
991 int ret;
992 int chip;
993 char revstr[8];
994
995 bq->charger.name = bq->name;
996 bq->charger.type = POWER_SUPPLY_TYPE_USB;
997 bq->charger.properties = bq2415x_power_supply_props;
998 bq->charger.num_properties = ARRAY_SIZE(bq2415x_power_supply_props);
999 bq->charger.get_property = bq2415x_power_supply_get_property;
1000
1001 ret = bq2415x_detect_chip(bq);
1002 if (ret < 0)
1003 chip = BQUNKNOWN;
1004 else
1005 chip = ret;
1006
1007 ret = bq2415x_detect_revision(bq);
1008 if (ret < 0)
1009 strcpy(revstr, "unknown");
1010 else
1011 sprintf(revstr, "1.%d", ret);
1012
1013 bq->model = kasprintf(GFP_KERNEL,
1014 "chip %s, revision %s, vender code %.3d",
1015 bq2415x_chip_name[chip], revstr,
1016 bq2415x_get_vender_code(bq));
1017 if (!bq->model) {
1018 dev_err(bq->dev, "failed to allocate model name\n");
1019 return -ENOMEM;
1020 }
1021
1022 ret = power_supply_register(bq->dev, &bq->charger);
1023 if (ret) {
1024 kfree(bq->model);
1025 return ret;
1026 }
1027
1028 return 0;
1029}
1030
1031static void bq2415x_power_supply_exit(struct bq2415x_device *bq)
1032{
1033 bq->autotimer = 0;
1034 if (bq->automode > 0)
1035 bq->automode = 0;
1036 cancel_delayed_work_sync(&bq->work);
1037 power_supply_unregister(&bq->charger);
1038 kfree(bq->model);
1039}
1040
1041/**** additional sysfs entries for power supply interface ****/
1042
1043/* show *_status entries */
1044static ssize_t bq2415x_sysfs_show_status(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001045 struct device_attribute *attr,
1046 char *buf)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001047{
1048 struct power_supply *psy = dev_get_drvdata(dev);
1049 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1050 charger);
1051 enum bq2415x_command command;
1052 int ret;
1053
1054 if (strcmp(attr->attr.name, "otg_status") == 0)
1055 command = BQ2415X_OTG_STATUS;
1056 else if (strcmp(attr->attr.name, "charge_status") == 0)
1057 command = BQ2415X_CHARGE_STATUS;
1058 else if (strcmp(attr->attr.name, "boost_status") == 0)
1059 command = BQ2415X_BOOST_STATUS;
1060 else if (strcmp(attr->attr.name, "fault_status") == 0)
1061 command = BQ2415X_FAULT_STATUS;
1062 else
1063 return -EINVAL;
1064
1065 ret = bq2415x_exec_command(bq, command);
1066 if (ret < 0)
1067 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001068 return sprintf(buf, "%d\n", ret);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001069}
1070
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001071/*
1072 * set timer entry:
1073 * auto - enable auto mode
1074 * off - disable auto mode
1075 * (other values) - reset chip timer
1076 */
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001077static ssize_t bq2415x_sysfs_set_timer(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001078 struct device_attribute *attr,
1079 const char *buf,
1080 size_t count)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001081{
1082 struct power_supply *psy = dev_get_drvdata(dev);
1083 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1084 charger);
1085 int ret = 0;
1086
1087 if (strncmp(buf, "auto", 4) == 0)
1088 bq2415x_set_autotimer(bq, 1);
1089 else if (strncmp(buf, "off", 3) == 0)
1090 bq2415x_set_autotimer(bq, 0);
1091 else
1092 ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
1093
1094 if (ret < 0)
1095 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001096 return count;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001097}
1098
1099/* show timer entry (auto or off) */
1100static ssize_t bq2415x_sysfs_show_timer(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001101 struct device_attribute *attr,
1102 char *buf)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001103{
1104 struct power_supply *psy = dev_get_drvdata(dev);
1105 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001106 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001107
1108 if (bq->timer_error)
1109 return sprintf(buf, "%s\n", bq->timer_error);
1110
1111 if (bq->autotimer)
1112 return sprintf(buf, "auto\n");
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001113 return sprintf(buf, "off\n");
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001114}
1115
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001116/*
1117 * set mode entry:
1118 * auto - if automode is supported, enable it and set mode to reported
1119 * none - disable charger and boost mode
1120 * host - charging mode for host/hub chargers (current limit 500mA)
1121 * dedicated - charging mode for dedicated chargers (unlimited current limit)
1122 * boost - disable charger and enable boost mode
1123 */
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001124static ssize_t bq2415x_sysfs_set_mode(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001125 struct device_attribute *attr,
1126 const char *buf,
1127 size_t count)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001128{
1129 struct power_supply *psy = dev_get_drvdata(dev);
1130 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001131 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001132 enum bq2415x_mode mode;
1133 int ret = 0;
1134
1135 if (strncmp(buf, "auto", 4) == 0) {
1136 if (bq->automode < 0)
1137 return -ENOSYS;
1138 bq->automode = 1;
1139 mode = bq->reported_mode;
Pali Rohárac6324e2013-02-10 18:32:18 +01001140 } else if (strncmp(buf, "off", 3) == 0) {
1141 if (bq->automode > 0)
1142 bq->automode = 0;
1143 mode = BQ2415X_MODE_OFF;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001144 } else if (strncmp(buf, "none", 4) == 0) {
1145 if (bq->automode > 0)
1146 bq->automode = 0;
1147 mode = BQ2415X_MODE_NONE;
1148 } else if (strncmp(buf, "host", 4) == 0) {
1149 if (bq->automode > 0)
1150 bq->automode = 0;
1151 mode = BQ2415X_MODE_HOST_CHARGER;
1152 } else if (strncmp(buf, "dedicated", 9) == 0) {
1153 if (bq->automode > 0)
1154 bq->automode = 0;
1155 mode = BQ2415X_MODE_DEDICATED_CHARGER;
1156 } else if (strncmp(buf, "boost", 5) == 0) {
1157 if (bq->automode > 0)
1158 bq->automode = 0;
1159 mode = BQ2415X_MODE_BOOST;
1160 } else if (strncmp(buf, "reset", 5) == 0) {
1161 bq2415x_reset_chip(bq);
1162 bq2415x_set_defaults(bq);
1163 if (bq->automode <= 0)
1164 return count;
1165 bq->automode = 1;
1166 mode = bq->reported_mode;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001167 } else {
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001168 return -EINVAL;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001169 }
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001170
1171 ret = bq2415x_set_mode(bq, mode);
1172 if (ret < 0)
1173 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001174 return count;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001175}
1176
1177/* show mode entry (auto, none, host, dedicated or boost) */
1178static ssize_t bq2415x_sysfs_show_mode(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001179 struct device_attribute *attr,
1180 char *buf)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001181{
1182 struct power_supply *psy = dev_get_drvdata(dev);
1183 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1184 charger);
1185 ssize_t ret = 0;
1186
1187 if (bq->automode > 0)
1188 ret += sprintf(buf+ret, "auto (");
1189
1190 switch (bq->mode) {
Pali Rohárac6324e2013-02-10 18:32:18 +01001191 case BQ2415X_MODE_OFF:
1192 ret += sprintf(buf+ret, "off");
1193 break;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001194 case BQ2415X_MODE_NONE:
1195 ret += sprintf(buf+ret, "none");
1196 break;
1197 case BQ2415X_MODE_HOST_CHARGER:
1198 ret += sprintf(buf+ret, "host");
1199 break;
1200 case BQ2415X_MODE_DEDICATED_CHARGER:
1201 ret += sprintf(buf+ret, "dedicated");
1202 break;
1203 case BQ2415X_MODE_BOOST:
1204 ret += sprintf(buf+ret, "boost");
1205 break;
1206 }
1207
1208 if (bq->automode > 0)
1209 ret += sprintf(buf+ret, ")");
1210
1211 ret += sprintf(buf+ret, "\n");
1212 return ret;
1213}
1214
1215/* show reported_mode entry (none, host, dedicated or boost) */
1216static ssize_t bq2415x_sysfs_show_reported_mode(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001217 struct device_attribute *attr,
1218 char *buf)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001219{
1220 struct power_supply *psy = dev_get_drvdata(dev);
1221 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001222 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001223
1224 if (bq->automode < 0)
1225 return -EINVAL;
1226
1227 switch (bq->reported_mode) {
Pali Rohárac6324e2013-02-10 18:32:18 +01001228 case BQ2415X_MODE_OFF:
1229 return sprintf(buf, "off\n");
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001230 case BQ2415X_MODE_NONE:
1231 return sprintf(buf, "none\n");
1232 case BQ2415X_MODE_HOST_CHARGER:
1233 return sprintf(buf, "host\n");
1234 case BQ2415X_MODE_DEDICATED_CHARGER:
1235 return sprintf(buf, "dedicated\n");
1236 case BQ2415X_MODE_BOOST:
1237 return sprintf(buf, "boost\n");
1238 }
1239
1240 return -EINVAL;
1241}
1242
1243/* directly set raw value to chip register, format: 'register value' */
1244static ssize_t bq2415x_sysfs_set_registers(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001245 struct device_attribute *attr,
1246 const char *buf,
1247 size_t count)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001248{
1249 struct power_supply *psy = dev_get_drvdata(dev);
1250 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001251 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001252 ssize_t ret = 0;
1253 unsigned int reg;
1254 unsigned int val;
1255
1256 if (sscanf(buf, "%x %x", &reg, &val) != 2)
1257 return -EINVAL;
1258
1259 if (reg > 4 || val > 255)
1260 return -EINVAL;
1261
1262 ret = bq2415x_i2c_write(bq, reg, val);
1263 if (ret < 0)
1264 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001265 return count;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001266}
1267
1268/* print value of chip register, format: 'register=value' */
1269static ssize_t bq2415x_sysfs_print_reg(struct bq2415x_device *bq,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001270 u8 reg,
1271 char *buf)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001272{
1273 int ret = bq2415x_i2c_read(bq, reg);
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001274
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001275 if (ret < 0)
1276 return sprintf(buf, "%#.2x=error %d\n", reg, ret);
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001277 return sprintf(buf, "%#.2x=%#.2x\n", reg, ret);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001278}
1279
1280/* show all raw values of chip register, format per line: 'register=value' */
1281static ssize_t bq2415x_sysfs_show_registers(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001282 struct device_attribute *attr,
1283 char *buf)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001284{
1285 struct power_supply *psy = dev_get_drvdata(dev);
1286 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001287 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001288 ssize_t ret = 0;
1289
1290 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_STATUS, buf+ret);
1291 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CONTROL, buf+ret);
1292 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VOLTAGE, buf+ret);
1293 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VENDER, buf+ret);
1294 ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CURRENT, buf+ret);
1295 return ret;
1296}
1297
1298/* set current and voltage limit entries (in mA or mV) */
1299static ssize_t bq2415x_sysfs_set_limit(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001300 struct device_attribute *attr,
1301 const char *buf,
1302 size_t count)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001303{
1304 struct power_supply *psy = dev_get_drvdata(dev);
1305 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001306 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001307 long val;
1308 int ret;
1309
1310 if (kstrtol(buf, 10, &val) < 0)
1311 return -EINVAL;
1312
1313 if (strcmp(attr->attr.name, "current_limit") == 0)
1314 ret = bq2415x_set_current_limit(bq, val);
1315 else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1316 ret = bq2415x_set_weak_battery_voltage(bq, val);
1317 else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1318 ret = bq2415x_set_battery_regulation_voltage(bq, val);
1319 else if (strcmp(attr->attr.name, "charge_current") == 0)
1320 ret = bq2415x_set_charge_current(bq, val);
1321 else if (strcmp(attr->attr.name, "termination_current") == 0)
1322 ret = bq2415x_set_termination_current(bq, val);
1323 else
1324 return -EINVAL;
1325
1326 if (ret < 0)
1327 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001328 return count;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001329}
1330
1331/* show current and voltage limit entries (in mA or mV) */
1332static ssize_t bq2415x_sysfs_show_limit(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001333 struct device_attribute *attr,
1334 char *buf)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001335{
1336 struct power_supply *psy = dev_get_drvdata(dev);
1337 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001338 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001339 int ret;
1340
1341 if (strcmp(attr->attr.name, "current_limit") == 0)
1342 ret = bq2415x_get_current_limit(bq);
1343 else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1344 ret = bq2415x_get_weak_battery_voltage(bq);
1345 else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1346 ret = bq2415x_get_battery_regulation_voltage(bq);
1347 else if (strcmp(attr->attr.name, "charge_current") == 0)
1348 ret = bq2415x_get_charge_current(bq);
1349 else if (strcmp(attr->attr.name, "termination_current") == 0)
1350 ret = bq2415x_get_termination_current(bq);
1351 else
1352 return -EINVAL;
1353
1354 if (ret < 0)
1355 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001356 return sprintf(buf, "%d\n", ret);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001357}
1358
1359/* set *_enable entries */
1360static ssize_t bq2415x_sysfs_set_enable(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001361 struct device_attribute *attr,
1362 const char *buf,
1363 size_t count)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001364{
1365 struct power_supply *psy = dev_get_drvdata(dev);
1366 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001367 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001368 enum bq2415x_command command;
1369 long val;
1370 int ret;
1371
1372 if (kstrtol(buf, 10, &val) < 0)
1373 return -EINVAL;
1374
1375 if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1376 command = val ? BQ2415X_CHARGE_TERMINATION_ENABLE :
1377 BQ2415X_CHARGE_TERMINATION_DISABLE;
1378 else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1379 command = val ? BQ2415X_HIGH_IMPEDANCE_ENABLE :
1380 BQ2415X_HIGH_IMPEDANCE_DISABLE;
1381 else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1382 command = val ? BQ2415X_OTG_PIN_ENABLE :
1383 BQ2415X_OTG_PIN_DISABLE;
1384 else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1385 command = val ? BQ2415X_STAT_PIN_ENABLE :
1386 BQ2415X_STAT_PIN_DISABLE;
1387 else
1388 return -EINVAL;
1389
1390 ret = bq2415x_exec_command(bq, command);
1391 if (ret < 0)
1392 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001393 return count;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001394}
1395
1396/* show *_enable entries */
1397static ssize_t bq2415x_sysfs_show_enable(struct device *dev,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001398 struct device_attribute *attr,
1399 char *buf)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001400{
1401 struct power_supply *psy = dev_get_drvdata(dev);
1402 struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001403 charger);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001404 enum bq2415x_command command;
1405 int ret;
1406
1407 if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1408 command = BQ2415X_CHARGE_TERMINATION_STATUS;
1409 else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1410 command = BQ2415X_HIGH_IMPEDANCE_STATUS;
1411 else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1412 command = BQ2415X_OTG_PIN_STATUS;
1413 else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1414 command = BQ2415X_STAT_PIN_STATUS;
1415 else
1416 return -EINVAL;
1417
1418 ret = bq2415x_exec_command(bq, command);
1419 if (ret < 0)
1420 return ret;
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001421 return sprintf(buf, "%d\n", ret);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001422}
1423
1424static DEVICE_ATTR(current_limit, S_IWUSR | S_IRUGO,
1425 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1426static DEVICE_ATTR(weak_battery_voltage, S_IWUSR | S_IRUGO,
1427 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1428static DEVICE_ATTR(battery_regulation_voltage, S_IWUSR | S_IRUGO,
1429 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1430static DEVICE_ATTR(charge_current, S_IWUSR | S_IRUGO,
1431 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1432static DEVICE_ATTR(termination_current, S_IWUSR | S_IRUGO,
1433 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1434
1435static DEVICE_ATTR(charge_termination_enable, S_IWUSR | S_IRUGO,
1436 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1437static DEVICE_ATTR(high_impedance_enable, S_IWUSR | S_IRUGO,
1438 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1439static DEVICE_ATTR(otg_pin_enable, S_IWUSR | S_IRUGO,
1440 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1441static DEVICE_ATTR(stat_pin_enable, S_IWUSR | S_IRUGO,
1442 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1443
1444static DEVICE_ATTR(reported_mode, S_IRUGO,
1445 bq2415x_sysfs_show_reported_mode, NULL);
1446static DEVICE_ATTR(mode, S_IWUSR | S_IRUGO,
1447 bq2415x_sysfs_show_mode, bq2415x_sysfs_set_mode);
1448static DEVICE_ATTR(timer, S_IWUSR | S_IRUGO,
1449 bq2415x_sysfs_show_timer, bq2415x_sysfs_set_timer);
1450
1451static DEVICE_ATTR(registers, S_IWUSR | S_IRUGO,
1452 bq2415x_sysfs_show_registers, bq2415x_sysfs_set_registers);
1453
1454static DEVICE_ATTR(otg_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1455static DEVICE_ATTR(charge_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1456static DEVICE_ATTR(boost_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1457static DEVICE_ATTR(fault_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1458
1459static struct attribute *bq2415x_sysfs_attributes[] = {
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001460 /*
1461 * TODO: some (appropriate) of these attrs should be switched to
1462 * use power supply class props.
1463 */
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001464 &dev_attr_current_limit.attr,
1465 &dev_attr_weak_battery_voltage.attr,
1466 &dev_attr_battery_regulation_voltage.attr,
1467 &dev_attr_charge_current.attr,
1468 &dev_attr_termination_current.attr,
1469
1470 &dev_attr_charge_termination_enable.attr,
1471 &dev_attr_high_impedance_enable.attr,
1472 &dev_attr_otg_pin_enable.attr,
1473 &dev_attr_stat_pin_enable.attr,
1474
1475 &dev_attr_reported_mode.attr,
1476 &dev_attr_mode.attr,
1477 &dev_attr_timer.attr,
1478
1479 &dev_attr_registers.attr,
1480
1481 &dev_attr_otg_status.attr,
1482 &dev_attr_charge_status.attr,
1483 &dev_attr_boost_status.attr,
1484 &dev_attr_fault_status.attr,
1485 NULL,
1486};
1487
1488static const struct attribute_group bq2415x_sysfs_attr_group = {
1489 .attrs = bq2415x_sysfs_attributes,
1490};
1491
1492static int bq2415x_sysfs_init(struct bq2415x_device *bq)
1493{
1494 return sysfs_create_group(&bq->charger.dev->kobj,
1495 &bq2415x_sysfs_attr_group);
1496}
1497
1498static void bq2415x_sysfs_exit(struct bq2415x_device *bq)
1499{
1500 sysfs_remove_group(&bq->charger.dev->kobj, &bq2415x_sysfs_attr_group);
1501}
1502
1503/* main bq2415x probe function */
1504static int bq2415x_probe(struct i2c_client *client,
Anton Vorontsov6c47a3e2012-11-18 15:35:32 -08001505 const struct i2c_device_id *id)
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001506{
1507 int ret;
1508 int num;
1509 char *name;
1510 struct bq2415x_device *bq;
1511
1512 if (!client->dev.platform_data) {
1513 dev_err(&client->dev, "platform data not set\n");
1514 return -ENODEV;
1515 }
1516
1517 /* Get new ID for the new device */
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001518 mutex_lock(&bq2415x_id_mutex);
Tejun Heo05e2cef2013-02-27 17:04:37 -08001519 num = idr_alloc(&bq2415x_id, client, 0, 0, GFP_KERNEL);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001520 mutex_unlock(&bq2415x_id_mutex);
Tejun Heo05e2cef2013-02-27 17:04:37 -08001521 if (num < 0)
1522 return num;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001523
1524 name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
1525 if (!name) {
1526 dev_err(&client->dev, "failed to allocate device name\n");
1527 ret = -ENOMEM;
1528 goto error_1;
1529 }
1530
Sachin Kamata9672e12012-11-27 11:28:46 +05301531 bq = devm_kzalloc(&client->dev, sizeof(*bq), GFP_KERNEL);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001532 if (!bq) {
1533 dev_err(&client->dev, "failed to allocate device data\n");
1534 ret = -ENOMEM;
1535 goto error_2;
1536 }
1537
1538 i2c_set_clientdata(client, bq);
1539
1540 bq->id = num;
1541 bq->dev = &client->dev;
1542 bq->chip = id->driver_data;
1543 bq->name = name;
Pali Rohárac6324e2013-02-10 18:32:18 +01001544 bq->mode = BQ2415X_MODE_OFF;
1545 bq->reported_mode = BQ2415X_MODE_OFF;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001546 bq->autotimer = 0;
1547 bq->automode = 0;
1548
1549 memcpy(&bq->init_data, client->dev.platform_data,
1550 sizeof(bq->init_data));
1551
1552 bq2415x_reset_chip(bq);
1553
1554 ret = bq2415x_power_supply_init(bq);
1555 if (ret) {
1556 dev_err(bq->dev, "failed to register power supply: %d\n", ret);
Sachin Kamata9672e12012-11-27 11:28:46 +05301557 goto error_2;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001558 }
1559
1560 ret = bq2415x_sysfs_init(bq);
1561 if (ret) {
1562 dev_err(bq->dev, "failed to create sysfs entries: %d\n", ret);
Sachin Kamata9672e12012-11-27 11:28:46 +05301563 goto error_3;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001564 }
1565
1566 ret = bq2415x_set_defaults(bq);
1567 if (ret) {
1568 dev_err(bq->dev, "failed to set default values: %d\n", ret);
Sachin Kamata9672e12012-11-27 11:28:46 +05301569 goto error_4;
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001570 }
1571
1572 if (bq->init_data.set_mode_hook) {
1573 if (bq->init_data.set_mode_hook(
1574 bq2415x_hook_function, bq)) {
1575 bq->automode = 1;
1576 bq2415x_set_mode(bq, bq->reported_mode);
1577 dev_info(bq->dev, "automode enabled\n");
1578 } else {
1579 bq->automode = -1;
1580 dev_info(bq->dev, "automode failed\n");
1581 }
1582 } else {
1583 bq->automode = -1;
1584 dev_info(bq->dev, "automode not supported\n");
1585 }
1586
1587 INIT_DELAYED_WORK(&bq->work, bq2415x_timer_work);
1588 bq2415x_set_autotimer(bq, 1);
1589
1590 dev_info(bq->dev, "driver registered\n");
1591 return 0;
1592
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001593error_4:
Sachin Kamata9672e12012-11-27 11:28:46 +05301594 bq2415x_sysfs_exit(bq);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001595error_3:
Sachin Kamata9672e12012-11-27 11:28:46 +05301596 bq2415x_power_supply_exit(bq);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001597error_2:
1598 kfree(name);
1599error_1:
1600 mutex_lock(&bq2415x_id_mutex);
1601 idr_remove(&bq2415x_id, num);
1602 mutex_unlock(&bq2415x_id_mutex);
1603
1604 return ret;
1605}
1606
1607/* main bq2415x remove function */
1608
1609static int bq2415x_remove(struct i2c_client *client)
1610{
1611 struct bq2415x_device *bq = i2c_get_clientdata(client);
1612
1613 if (bq->init_data.set_mode_hook)
1614 bq->init_data.set_mode_hook(NULL, NULL);
1615
1616 bq2415x_sysfs_exit(bq);
1617 bq2415x_power_supply_exit(bq);
1618
1619 bq2415x_reset_chip(bq);
1620
1621 mutex_lock(&bq2415x_id_mutex);
1622 idr_remove(&bq2415x_id, bq->id);
1623 mutex_unlock(&bq2415x_id_mutex);
1624
1625 dev_info(bq->dev, "driver unregistered\n");
1626
1627 kfree(bq->name);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001628
1629 return 0;
1630}
1631
1632static const struct i2c_device_id bq2415x_i2c_id_table[] = {
1633 { "bq2415x", BQUNKNOWN },
1634 { "bq24150", BQ24150 },
1635 { "bq24150a", BQ24150A },
1636 { "bq24151", BQ24151 },
1637 { "bq24151a", BQ24151A },
1638 { "bq24152", BQ24152 },
1639 { "bq24153", BQ24153 },
1640 { "bq24153a", BQ24153A },
1641 { "bq24155", BQ24155 },
1642 { "bq24156", BQ24156 },
1643 { "bq24156a", BQ24156A },
1644 { "bq24158", BQ24158 },
1645 {},
1646};
1647MODULE_DEVICE_TABLE(i2c, bq2415x_i2c_id_table);
1648
1649static struct i2c_driver bq2415x_driver = {
1650 .driver = {
1651 .name = "bq2415x-charger",
1652 },
1653 .probe = bq2415x_probe,
1654 .remove = bq2415x_remove,
1655 .id_table = bq2415x_i2c_id_table,
1656};
Sachin Kamat463df512012-11-27 11:28:45 +05301657module_i2c_driver(bq2415x_driver);
Pali Rohár0bc98cc2012-11-02 20:18:11 +01001658
1659MODULE_AUTHOR("Pali Rohár <pali.rohar@gmail.com>");
1660MODULE_DESCRIPTION("bq2415x charger driver");
1661MODULE_LICENSE("GPL");