OMAPDSS: VENC: fix NULL pointer dereference in DSS2 VENC sysfs debug attr on OMAP4
[zen-stable.git] / drivers / mfd / tps65010.c
blob93d5fdf020c7eaa90dbf4d1eee41de216873d78e
1 /*
2 * tps65010 - driver for tps6501x power management chips
4 * Copyright (C) 2004 Texas Instruments
5 * Copyright (C) 2004-2005 David Brownell
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 #include <linux/kernel.h>
23 #include <linux/module.h>
24 #include <linux/init.h>
25 #include <linux/slab.h>
26 #include <linux/interrupt.h>
27 #include <linux/i2c.h>
28 #include <linux/delay.h>
29 #include <linux/workqueue.h>
30 #include <linux/debugfs.h>
31 #include <linux/seq_file.h>
32 #include <linux/mutex.h>
33 #include <linux/platform_device.h>
35 #include <linux/i2c/tps65010.h>
37 #include <linux/gpio.h>
40 /*-------------------------------------------------------------------------*/
42 #define DRIVER_VERSION "2 May 2005"
43 #define DRIVER_NAME (tps65010_driver.driver.name)
45 MODULE_DESCRIPTION("TPS6501x Power Management Driver");
46 MODULE_LICENSE("GPL");
48 static struct i2c_driver tps65010_driver;
50 /*-------------------------------------------------------------------------*/
52 /* This driver handles a family of multipurpose chips, which incorporate
53 * voltage regulators, lithium ion/polymer battery charging, GPIOs, LEDs,
54 * and other features often needed in portable devices like cell phones
55 * or digital cameras.
57 * The tps65011 and tps65013 have different voltage settings compared
58 * to tps65010 and tps65012. The tps65013 has a NO_CHG status/irq.
59 * All except tps65010 have "wait" mode, possibly defaulted so that
60 * battery-insert != device-on.
62 * We could distinguish between some models by checking VDCDC1.UVLO or
63 * other registers, unless they've been changed already after powerup
64 * as part of board setup by a bootloader.
66 enum tps_model {
67 TPS65010,
68 TPS65011,
69 TPS65012,
70 TPS65013,
73 struct tps65010 {
74 struct i2c_client *client;
75 struct mutex lock;
76 struct delayed_work work;
77 struct dentry *file;
78 unsigned charging:1;
79 unsigned por:1;
80 unsigned model:8;
81 u16 vbus;
82 unsigned long flags;
83 #define FLAG_VBUS_CHANGED 0
84 #define FLAG_IRQ_ENABLE 1
86 /* copies of last register state */
87 u8 chgstatus, regstatus, chgconf;
88 u8 nmask1, nmask2;
90 u8 outmask;
91 struct gpio_chip chip;
92 struct platform_device *leds;
95 #define POWER_POLL_DELAY msecs_to_jiffies(5000)
97 /*-------------------------------------------------------------------------*/
99 #if defined(DEBUG) || defined(CONFIG_DEBUG_FS)
101 static void dbg_chgstat(char *buf, size_t len, u8 chgstatus)
103 snprintf(buf, len, "%02x%s%s%s%s%s%s%s%s\n",
104 chgstatus,
105 (chgstatus & TPS_CHG_USB) ? " USB" : "",
106 (chgstatus & TPS_CHG_AC) ? " AC" : "",
107 (chgstatus & TPS_CHG_THERM) ? " therm" : "",
108 (chgstatus & TPS_CHG_TERM) ? " done" :
109 ((chgstatus & (TPS_CHG_USB|TPS_CHG_AC))
110 ? " (charging)" : ""),
111 (chgstatus & TPS_CHG_TAPER_TMO) ? " taper_tmo" : "",
112 (chgstatus & TPS_CHG_CHG_TMO) ? " charge_tmo" : "",
113 (chgstatus & TPS_CHG_PRECHG_TMO) ? " prechg_tmo" : "",
114 (chgstatus & TPS_CHG_TEMP_ERR) ? " temp_err" : "");
117 static void dbg_regstat(char *buf, size_t len, u8 regstatus)
119 snprintf(buf, len, "%02x %s%s%s%s%s%s%s%s\n",
120 regstatus,
121 (regstatus & TPS_REG_ONOFF) ? "off" : "(on)",
122 (regstatus & TPS_REG_COVER) ? " uncover" : "",
123 (regstatus & TPS_REG_UVLO) ? " UVLO" : "",
124 (regstatus & TPS_REG_NO_CHG) ? " NO_CHG" : "",
125 (regstatus & TPS_REG_PG_LD02) ? " ld02_bad" : "",
126 (regstatus & TPS_REG_PG_LD01) ? " ld01_bad" : "",
127 (regstatus & TPS_REG_PG_MAIN) ? " main_bad" : "",
128 (regstatus & TPS_REG_PG_CORE) ? " core_bad" : "");
131 static void dbg_chgconf(int por, char *buf, size_t len, u8 chgconfig)
133 const char *hibit;
135 if (por)
136 hibit = (chgconfig & TPS_CHARGE_POR)
137 ? "POR=69ms" : "POR=1sec";
138 else
139 hibit = (chgconfig & TPS65013_AUA) ? "AUA" : "";
141 snprintf(buf, len, "%02x %s%s%s AC=%d%% USB=%dmA %sCharge\n",
142 chgconfig, hibit,
143 (chgconfig & TPS_CHARGE_RESET) ? " reset" : "",
144 (chgconfig & TPS_CHARGE_FAST) ? " fast" : "",
145 ({int p; switch ((chgconfig >> 3) & 3) {
146 case 3: p = 100; break;
147 case 2: p = 75; break;
148 case 1: p = 50; break;
149 default: p = 25; break;
150 }; p; }),
151 (chgconfig & TPS_VBUS_CHARGING)
152 ? ((chgconfig & TPS_VBUS_500MA) ? 500 : 100)
153 : 0,
154 (chgconfig & TPS_CHARGE_ENABLE) ? "" : "No");
157 #endif
159 #ifdef DEBUG
161 static void show_chgstatus(const char *label, u8 chgstatus)
163 char buf [100];
165 dbg_chgstat(buf, sizeof buf, chgstatus);
166 pr_debug("%s: %s %s", DRIVER_NAME, label, buf);
169 static void show_regstatus(const char *label, u8 regstatus)
171 char buf [100];
173 dbg_regstat(buf, sizeof buf, regstatus);
174 pr_debug("%s: %s %s", DRIVER_NAME, label, buf);
177 static void show_chgconfig(int por, const char *label, u8 chgconfig)
179 char buf [100];
181 dbg_chgconf(por, buf, sizeof buf, chgconfig);
182 pr_debug("%s: %s %s", DRIVER_NAME, label, buf);
185 #else
187 static inline void show_chgstatus(const char *label, u8 chgstatus) { }
188 static inline void show_regstatus(const char *label, u8 chgstatus) { }
189 static inline void show_chgconfig(int por, const char *label, u8 chgconfig) { }
191 #endif
193 #ifdef CONFIG_DEBUG_FS
195 static int dbg_show(struct seq_file *s, void *_)
197 struct tps65010 *tps = s->private;
198 u8 value, v2;
199 unsigned i;
200 char buf[100];
201 const char *chip;
203 switch (tps->model) {
204 case TPS65010: chip = "tps65010"; break;
205 case TPS65011: chip = "tps65011"; break;
206 case TPS65012: chip = "tps65012"; break;
207 case TPS65013: chip = "tps65013"; break;
208 default: chip = NULL; break;
210 seq_printf(s, "driver %s\nversion %s\nchip %s\n\n",
211 DRIVER_NAME, DRIVER_VERSION, chip);
213 mutex_lock(&tps->lock);
215 /* FIXME how can we tell whether a battery is present?
216 * likely involves a charge gauging chip (like BQ26501).
219 seq_printf(s, "%scharging\n\n", tps->charging ? "" : "(not) ");
222 /* registers for monitoring battery charging and status; note
223 * that reading chgstat and regstat may ack IRQs...
225 value = i2c_smbus_read_byte_data(tps->client, TPS_CHGCONFIG);
226 dbg_chgconf(tps->por, buf, sizeof buf, value);
227 seq_printf(s, "chgconfig %s", buf);
229 value = i2c_smbus_read_byte_data(tps->client, TPS_CHGSTATUS);
230 dbg_chgstat(buf, sizeof buf, value);
231 seq_printf(s, "chgstat %s", buf);
232 value = i2c_smbus_read_byte_data(tps->client, TPS_MASK1);
233 dbg_chgstat(buf, sizeof buf, value);
234 seq_printf(s, "mask1 %s", buf);
235 /* ignore ackint1 */
237 value = i2c_smbus_read_byte_data(tps->client, TPS_REGSTATUS);
238 dbg_regstat(buf, sizeof buf, value);
239 seq_printf(s, "regstat %s", buf);
240 value = i2c_smbus_read_byte_data(tps->client, TPS_MASK2);
241 dbg_regstat(buf, sizeof buf, value);
242 seq_printf(s, "mask2 %s\n", buf);
243 /* ignore ackint2 */
245 schedule_delayed_work(&tps->work, POWER_POLL_DELAY);
248 /* VMAIN voltage, enable lowpower, etc */
249 value = i2c_smbus_read_byte_data(tps->client, TPS_VDCDC1);
250 seq_printf(s, "vdcdc1 %02x\n", value);
252 /* VCORE voltage, vibrator on/off */
253 value = i2c_smbus_read_byte_data(tps->client, TPS_VDCDC2);
254 seq_printf(s, "vdcdc2 %02x\n", value);
256 /* both LD0s, and their lowpower behavior */
257 value = i2c_smbus_read_byte_data(tps->client, TPS_VREGS1);
258 seq_printf(s, "vregs1 %02x\n\n", value);
261 /* LEDs and GPIOs */
262 value = i2c_smbus_read_byte_data(tps->client, TPS_LED1_ON);
263 v2 = i2c_smbus_read_byte_data(tps->client, TPS_LED1_PER);
264 seq_printf(s, "led1 %s, on=%02x, per=%02x, %d/%d msec\n",
265 (value & 0x80)
266 ? ((v2 & 0x80) ? "on" : "off")
267 : ((v2 & 0x80) ? "blink" : "(nPG)"),
268 value, v2,
269 (value & 0x7f) * 10, (v2 & 0x7f) * 100);
271 value = i2c_smbus_read_byte_data(tps->client, TPS_LED2_ON);
272 v2 = i2c_smbus_read_byte_data(tps->client, TPS_LED2_PER);
273 seq_printf(s, "led2 %s, on=%02x, per=%02x, %d/%d msec\n",
274 (value & 0x80)
275 ? ((v2 & 0x80) ? "on" : "off")
276 : ((v2 & 0x80) ? "blink" : "off"),
277 value, v2,
278 (value & 0x7f) * 10, (v2 & 0x7f) * 100);
280 value = i2c_smbus_read_byte_data(tps->client, TPS_DEFGPIO);
281 v2 = i2c_smbus_read_byte_data(tps->client, TPS_MASK3);
282 seq_printf(s, "defgpio %02x mask3 %02x\n", value, v2);
284 for (i = 0; i < 4; i++) {
285 if (value & (1 << (4 + i)))
286 seq_printf(s, " gpio%d-out %s\n", i + 1,
287 (value & (1 << i)) ? "low" : "hi ");
288 else
289 seq_printf(s, " gpio%d-in %s %s %s\n", i + 1,
290 (value & (1 << i)) ? "hi " : "low",
291 (v2 & (1 << i)) ? "no-irq" : "irq",
292 (v2 & (1 << (4 + i))) ? "rising" : "falling");
295 mutex_unlock(&tps->lock);
296 return 0;
299 static int dbg_tps_open(struct inode *inode, struct file *file)
301 return single_open(file, dbg_show, inode->i_private);
304 static const struct file_operations debug_fops = {
305 .open = dbg_tps_open,
306 .read = seq_read,
307 .llseek = seq_lseek,
308 .release = single_release,
311 #define DEBUG_FOPS &debug_fops
313 #else
314 #define DEBUG_FOPS NULL
315 #endif
317 /*-------------------------------------------------------------------------*/
319 /* handle IRQS in a task context, so we can use I2C calls */
320 static void tps65010_interrupt(struct tps65010 *tps)
322 u8 tmp = 0, mask, poll;
324 /* IRQs won't trigger for certain events, but we can get
325 * others by polling (normally, with external power applied).
327 poll = 0;
329 /* regstatus irqs */
330 if (tps->nmask2) {
331 tmp = i2c_smbus_read_byte_data(tps->client, TPS_REGSTATUS);
332 mask = tmp ^ tps->regstatus;
333 tps->regstatus = tmp;
334 mask &= tps->nmask2;
335 } else
336 mask = 0;
337 if (mask) {
338 tps->regstatus = tmp;
339 /* may need to shut something down ... */
341 /* "off" usually means deep sleep */
342 if (tmp & TPS_REG_ONOFF) {
343 pr_info("%s: power off button\n", DRIVER_NAME);
344 #if 0
345 /* REVISIT: this might need its own workqueue
346 * plus tweaks including deadlock avoidance ...
347 * also needs to get error handling and probably
348 * an #ifdef CONFIG_HIBERNATION
350 hibernate();
351 #endif
352 poll = 1;
356 /* chgstatus irqs */
357 if (tps->nmask1) {
358 tmp = i2c_smbus_read_byte_data(tps->client, TPS_CHGSTATUS);
359 mask = tmp ^ tps->chgstatus;
360 tps->chgstatus = tmp;
361 mask &= tps->nmask1;
362 } else
363 mask = 0;
364 if (mask) {
365 unsigned charging = 0;
367 show_chgstatus("chg/irq", tmp);
368 if (tmp & (TPS_CHG_USB|TPS_CHG_AC))
369 show_chgconfig(tps->por, "conf", tps->chgconf);
371 /* Unless it was turned off or disabled, we charge any
372 * battery whenever there's power available for it
373 * and the charger hasn't been disabled.
375 if (!(tps->chgstatus & ~(TPS_CHG_USB|TPS_CHG_AC))
376 && (tps->chgstatus & (TPS_CHG_USB|TPS_CHG_AC))
377 && (tps->chgconf & TPS_CHARGE_ENABLE)
379 if (tps->chgstatus & TPS_CHG_USB) {
380 /* VBUS options are readonly until reconnect */
381 if (mask & TPS_CHG_USB)
382 set_bit(FLAG_VBUS_CHANGED, &tps->flags);
383 charging = 1;
384 } else if (tps->chgstatus & TPS_CHG_AC)
385 charging = 1;
387 if (charging != tps->charging) {
388 tps->charging = charging;
389 pr_info("%s: battery %scharging\n",
390 DRIVER_NAME, charging ? "" :
391 ((tps->chgstatus & (TPS_CHG_USB|TPS_CHG_AC))
392 ? "NOT " : "dis"));
396 /* always poll to detect (a) power removal, without tps65013
397 * NO_CHG IRQ; or (b) restart of charging after stop.
399 if ((tps->model != TPS65013 || !tps->charging)
400 && (tps->chgstatus & (TPS_CHG_USB|TPS_CHG_AC)))
401 poll = 1;
402 if (poll)
403 schedule_delayed_work(&tps->work, POWER_POLL_DELAY);
405 /* also potentially gpio-in rise or fall */
408 /* handle IRQs and polling using keventd for now */
409 static void tps65010_work(struct work_struct *work)
411 struct tps65010 *tps;
413 tps = container_of(to_delayed_work(work), struct tps65010, work);
414 mutex_lock(&tps->lock);
416 tps65010_interrupt(tps);
418 if (test_and_clear_bit(FLAG_VBUS_CHANGED, &tps->flags)) {
419 int status;
420 u8 chgconfig, tmp;
422 chgconfig = i2c_smbus_read_byte_data(tps->client,
423 TPS_CHGCONFIG);
424 chgconfig &= ~(TPS_VBUS_500MA | TPS_VBUS_CHARGING);
425 if (tps->vbus == 500)
426 chgconfig |= TPS_VBUS_500MA | TPS_VBUS_CHARGING;
427 else if (tps->vbus >= 100)
428 chgconfig |= TPS_VBUS_CHARGING;
430 status = i2c_smbus_write_byte_data(tps->client,
431 TPS_CHGCONFIG, chgconfig);
433 /* vbus update fails unless VBUS is connected! */
434 tmp = i2c_smbus_read_byte_data(tps->client, TPS_CHGCONFIG);
435 tps->chgconf = tmp;
436 show_chgconfig(tps->por, "update vbus", tmp);
439 if (test_and_clear_bit(FLAG_IRQ_ENABLE, &tps->flags))
440 enable_irq(tps->client->irq);
442 mutex_unlock(&tps->lock);
445 static irqreturn_t tps65010_irq(int irq, void *_tps)
447 struct tps65010 *tps = _tps;
449 disable_irq_nosync(irq);
450 set_bit(FLAG_IRQ_ENABLE, &tps->flags);
451 schedule_delayed_work(&tps->work, 0);
452 return IRQ_HANDLED;
455 /*-------------------------------------------------------------------------*/
457 /* offsets 0..3 == GPIO1..GPIO4
458 * offsets 4..5 == LED1/nPG, LED2 (we set one of the non-BLINK modes)
459 * offset 6 == vibrator motor driver
461 static void
462 tps65010_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
464 if (offset < 4)
465 tps65010_set_gpio_out_value(offset + 1, value);
466 else if (offset < 6)
467 tps65010_set_led(offset - 3, value ? ON : OFF);
468 else
469 tps65010_set_vib(value);
472 static int
473 tps65010_output(struct gpio_chip *chip, unsigned offset, int value)
475 /* GPIOs may be input-only */
476 if (offset < 4) {
477 struct tps65010 *tps;
479 tps = container_of(chip, struct tps65010, chip);
480 if (!(tps->outmask & (1 << offset)))
481 return -EINVAL;
482 tps65010_set_gpio_out_value(offset + 1, value);
483 } else if (offset < 6)
484 tps65010_set_led(offset - 3, value ? ON : OFF);
485 else
486 tps65010_set_vib(value);
488 return 0;
491 static int tps65010_gpio_get(struct gpio_chip *chip, unsigned offset)
493 int value;
494 struct tps65010 *tps;
496 tps = container_of(chip, struct tps65010, chip);
498 if (offset < 4) {
499 value = i2c_smbus_read_byte_data(tps->client, TPS_DEFGPIO);
500 if (value < 0)
501 return 0;
502 if (value & (1 << (offset + 4))) /* output */
503 return !(value & (1 << offset));
504 else /* input */
505 return (value & (1 << offset));
508 /* REVISIT we *could* report LED1/nPG and LED2 state ... */
509 return 0;
513 /*-------------------------------------------------------------------------*/
515 static struct tps65010 *the_tps;
517 static int __exit tps65010_remove(struct i2c_client *client)
519 struct tps65010 *tps = i2c_get_clientdata(client);
520 struct tps65010_board *board = client->dev.platform_data;
522 if (board && board->teardown) {
523 int status = board->teardown(client, board->context);
524 if (status < 0)
525 dev_dbg(&client->dev, "board %s %s err %d\n",
526 "teardown", client->name, status);
528 if (client->irq > 0)
529 free_irq(client->irq, tps);
530 cancel_delayed_work_sync(&tps->work);
531 debugfs_remove(tps->file);
532 kfree(tps);
533 the_tps = NULL;
534 return 0;
537 static int tps65010_probe(struct i2c_client *client,
538 const struct i2c_device_id *id)
540 struct tps65010 *tps;
541 int status;
542 struct tps65010_board *board = client->dev.platform_data;
544 if (the_tps) {
545 dev_dbg(&client->dev, "only one tps6501x chip allowed\n");
546 return -ENODEV;
549 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
550 return -EINVAL;
552 tps = kzalloc(sizeof *tps, GFP_KERNEL);
553 if (!tps)
554 return -ENOMEM;
556 mutex_init(&tps->lock);
557 INIT_DELAYED_WORK(&tps->work, tps65010_work);
558 tps->client = client;
559 tps->model = id->driver_data;
561 /* the IRQ is active low, but many gpio lines can't support that
562 * so this driver uses falling-edge triggers instead.
564 if (client->irq > 0) {
565 status = request_irq(client->irq, tps65010_irq,
566 IRQF_SAMPLE_RANDOM | IRQF_TRIGGER_FALLING,
567 DRIVER_NAME, tps);
568 if (status < 0) {
569 dev_dbg(&client->dev, "can't get IRQ %d, err %d\n",
570 client->irq, status);
571 goto fail1;
573 /* annoying race here, ideally we'd have an option
574 * to claim the irq now and enable it later.
575 * FIXME genirq IRQF_NOAUTOEN now solves that ...
577 disable_irq(client->irq);
578 set_bit(FLAG_IRQ_ENABLE, &tps->flags);
579 } else
580 dev_warn(&client->dev, "IRQ not configured!\n");
583 switch (tps->model) {
584 case TPS65010:
585 case TPS65012:
586 tps->por = 1;
587 break;
588 /* else CHGCONFIG.POR is replaced by AUA, enabling a WAIT mode */
590 tps->chgconf = i2c_smbus_read_byte_data(client, TPS_CHGCONFIG);
591 show_chgconfig(tps->por, "conf/init", tps->chgconf);
593 show_chgstatus("chg/init",
594 i2c_smbus_read_byte_data(client, TPS_CHGSTATUS));
595 show_regstatus("reg/init",
596 i2c_smbus_read_byte_data(client, TPS_REGSTATUS));
598 pr_debug("%s: vdcdc1 0x%02x, vdcdc2 %02x, vregs1 %02x\n", DRIVER_NAME,
599 i2c_smbus_read_byte_data(client, TPS_VDCDC1),
600 i2c_smbus_read_byte_data(client, TPS_VDCDC2),
601 i2c_smbus_read_byte_data(client, TPS_VREGS1));
602 pr_debug("%s: defgpio 0x%02x, mask3 0x%02x\n", DRIVER_NAME,
603 i2c_smbus_read_byte_data(client, TPS_DEFGPIO),
604 i2c_smbus_read_byte_data(client, TPS_MASK3));
606 i2c_set_clientdata(client, tps);
607 the_tps = tps;
609 #if defined(CONFIG_USB_GADGET) && !defined(CONFIG_USB_OTG)
610 /* USB hosts can't draw VBUS. OTG devices could, later
611 * when OTG infrastructure enables it. USB peripherals
612 * could be relying on VBUS while booting, though.
614 tps->vbus = 100;
615 #endif
617 /* unmask the "interesting" irqs, then poll once to
618 * kickstart monitoring, initialize shadowed status
619 * registers, and maybe disable VBUS draw.
621 tps->nmask1 = ~0;
622 (void) i2c_smbus_write_byte_data(client, TPS_MASK1, ~tps->nmask1);
624 tps->nmask2 = TPS_REG_ONOFF;
625 if (tps->model == TPS65013)
626 tps->nmask2 |= TPS_REG_NO_CHG;
627 (void) i2c_smbus_write_byte_data(client, TPS_MASK2, ~tps->nmask2);
629 (void) i2c_smbus_write_byte_data(client, TPS_MASK3, 0x0f
630 | i2c_smbus_read_byte_data(client, TPS_MASK3));
632 tps65010_work(&tps->work.work);
634 tps->file = debugfs_create_file(DRIVER_NAME, S_IRUGO, NULL,
635 tps, DEBUG_FOPS);
637 /* optionally register GPIOs */
638 if (board && board->base != 0) {
639 tps->outmask = board->outmask;
641 tps->chip.label = client->name;
642 tps->chip.dev = &client->dev;
643 tps->chip.owner = THIS_MODULE;
645 tps->chip.set = tps65010_gpio_set;
646 tps->chip.direction_output = tps65010_output;
648 /* NOTE: only partial support for inputs; nyet IRQs */
649 tps->chip.get = tps65010_gpio_get;
651 tps->chip.base = board->base;
652 tps->chip.ngpio = 7;
653 tps->chip.can_sleep = 1;
655 status = gpiochip_add(&tps->chip);
656 if (status < 0)
657 dev_err(&client->dev, "can't add gpiochip, err %d\n",
658 status);
659 else if (board->setup) {
660 status = board->setup(client, board->context);
661 if (status < 0) {
662 dev_dbg(&client->dev,
663 "board %s %s err %d\n",
664 "setup", client->name, status);
665 status = 0;
670 return 0;
671 fail1:
672 kfree(tps);
673 return status;
676 static const struct i2c_device_id tps65010_id[] = {
677 { "tps65010", TPS65010 },
678 { "tps65011", TPS65011 },
679 { "tps65012", TPS65012 },
680 { "tps65013", TPS65013 },
681 { "tps65014", TPS65011 }, /* tps65011 charging at 6.5V max */
684 MODULE_DEVICE_TABLE(i2c, tps65010_id);
686 static struct i2c_driver tps65010_driver = {
687 .driver = {
688 .name = "tps65010",
690 .probe = tps65010_probe,
691 .remove = __exit_p(tps65010_remove),
692 .id_table = tps65010_id,
695 /*-------------------------------------------------------------------------*/
697 /* Draw from VBUS:
698 * 0 mA -- DON'T DRAW (might supply power instead)
699 * 100 mA -- usb unit load (slowest charge rate)
700 * 500 mA -- usb high power (fast battery charge)
702 int tps65010_set_vbus_draw(unsigned mA)
704 unsigned long flags;
706 if (!the_tps)
707 return -ENODEV;
709 /* assumes non-SMP */
710 local_irq_save(flags);
711 if (mA >= 500)
712 mA = 500;
713 else if (mA >= 100)
714 mA = 100;
715 else
716 mA = 0;
717 the_tps->vbus = mA;
718 if ((the_tps->chgstatus & TPS_CHG_USB)
719 && test_and_set_bit(
720 FLAG_VBUS_CHANGED, &the_tps->flags)) {
721 /* gadget drivers call this in_irq() */
722 schedule_delayed_work(&the_tps->work, 0);
724 local_irq_restore(flags);
726 return 0;
728 EXPORT_SYMBOL(tps65010_set_vbus_draw);
730 /*-------------------------------------------------------------------------*/
731 /* tps65010_set_gpio_out_value parameter:
732 * gpio: GPIO1, GPIO2, GPIO3 or GPIO4
733 * value: LOW or HIGH
735 int tps65010_set_gpio_out_value(unsigned gpio, unsigned value)
737 int status;
738 unsigned defgpio;
740 if (!the_tps)
741 return -ENODEV;
742 if ((gpio < GPIO1) || (gpio > GPIO4))
743 return -EINVAL;
745 mutex_lock(&the_tps->lock);
747 defgpio = i2c_smbus_read_byte_data(the_tps->client, TPS_DEFGPIO);
749 /* Configure GPIO for output */
750 defgpio |= 1 << (gpio + 3);
752 /* Writing 1 forces a logic 0 on that GPIO and vice versa */
753 switch (value) {
754 case LOW:
755 defgpio |= 1 << (gpio - 1); /* set GPIO low by writing 1 */
756 break;
757 /* case HIGH: */
758 default:
759 defgpio &= ~(1 << (gpio - 1)); /* set GPIO high by writing 0 */
760 break;
763 status = i2c_smbus_write_byte_data(the_tps->client,
764 TPS_DEFGPIO, defgpio);
766 pr_debug("%s: gpio%dout = %s, defgpio 0x%02x\n", DRIVER_NAME,
767 gpio, value ? "high" : "low",
768 i2c_smbus_read_byte_data(the_tps->client, TPS_DEFGPIO));
770 mutex_unlock(&the_tps->lock);
771 return status;
773 EXPORT_SYMBOL(tps65010_set_gpio_out_value);
775 /*-------------------------------------------------------------------------*/
776 /* tps65010_set_led parameter:
777 * led: LED1 or LED2
778 * mode: ON, OFF or BLINK
780 int tps65010_set_led(unsigned led, unsigned mode)
782 int status;
783 unsigned led_on, led_per, offs;
785 if (!the_tps)
786 return -ENODEV;
788 if (led == LED1)
789 offs = 0;
790 else {
791 offs = 2;
792 led = LED2;
795 mutex_lock(&the_tps->lock);
797 pr_debug("%s: led%i_on 0x%02x\n", DRIVER_NAME, led,
798 i2c_smbus_read_byte_data(the_tps->client,
799 TPS_LED1_ON + offs));
801 pr_debug("%s: led%i_per 0x%02x\n", DRIVER_NAME, led,
802 i2c_smbus_read_byte_data(the_tps->client,
803 TPS_LED1_PER + offs));
805 switch (mode) {
806 case OFF:
807 led_on = 1 << 7;
808 led_per = 0 << 7;
809 break;
810 case ON:
811 led_on = 1 << 7;
812 led_per = 1 << 7;
813 break;
814 case BLINK:
815 led_on = 0x30 | (0 << 7);
816 led_per = 0x08 | (1 << 7);
817 break;
818 default:
819 printk(KERN_ERR "%s: Wrong mode parameter for set_led()\n",
820 DRIVER_NAME);
821 mutex_unlock(&the_tps->lock);
822 return -EINVAL;
825 status = i2c_smbus_write_byte_data(the_tps->client,
826 TPS_LED1_ON + offs, led_on);
828 if (status != 0) {
829 printk(KERN_ERR "%s: Failed to write led%i_on register\n",
830 DRIVER_NAME, led);
831 mutex_unlock(&the_tps->lock);
832 return status;
835 pr_debug("%s: led%i_on 0x%02x\n", DRIVER_NAME, led,
836 i2c_smbus_read_byte_data(the_tps->client, TPS_LED1_ON + offs));
838 status = i2c_smbus_write_byte_data(the_tps->client,
839 TPS_LED1_PER + offs, led_per);
841 if (status != 0) {
842 printk(KERN_ERR "%s: Failed to write led%i_per register\n",
843 DRIVER_NAME, led);
844 mutex_unlock(&the_tps->lock);
845 return status;
848 pr_debug("%s: led%i_per 0x%02x\n", DRIVER_NAME, led,
849 i2c_smbus_read_byte_data(the_tps->client,
850 TPS_LED1_PER + offs));
852 mutex_unlock(&the_tps->lock);
854 return status;
856 EXPORT_SYMBOL(tps65010_set_led);
858 /*-------------------------------------------------------------------------*/
859 /* tps65010_set_vib parameter:
860 * value: ON or OFF
862 int tps65010_set_vib(unsigned value)
864 int status;
865 unsigned vdcdc2;
867 if (!the_tps)
868 return -ENODEV;
870 mutex_lock(&the_tps->lock);
872 vdcdc2 = i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC2);
873 vdcdc2 &= ~(1 << 1);
874 if (value)
875 vdcdc2 |= (1 << 1);
876 status = i2c_smbus_write_byte_data(the_tps->client,
877 TPS_VDCDC2, vdcdc2);
879 pr_debug("%s: vibrator %s\n", DRIVER_NAME, value ? "on" : "off");
881 mutex_unlock(&the_tps->lock);
882 return status;
884 EXPORT_SYMBOL(tps65010_set_vib);
886 /*-------------------------------------------------------------------------*/
887 /* tps65010_set_low_pwr parameter:
888 * mode: ON or OFF
890 int tps65010_set_low_pwr(unsigned mode)
892 int status;
893 unsigned vdcdc1;
895 if (!the_tps)
896 return -ENODEV;
898 mutex_lock(&the_tps->lock);
900 pr_debug("%s: %s low_pwr, vdcdc1 0x%02x\n", DRIVER_NAME,
901 mode ? "enable" : "disable",
902 i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));
904 vdcdc1 = i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1);
906 switch (mode) {
907 case OFF:
908 vdcdc1 &= ~TPS_ENABLE_LP; /* disable ENABLE_LP bit */
909 break;
910 /* case ON: */
911 default:
912 vdcdc1 |= TPS_ENABLE_LP; /* enable ENABLE_LP bit */
913 break;
916 status = i2c_smbus_write_byte_data(the_tps->client,
917 TPS_VDCDC1, vdcdc1);
919 if (status != 0)
920 printk(KERN_ERR "%s: Failed to write vdcdc1 register\n",
921 DRIVER_NAME);
922 else
923 pr_debug("%s: vdcdc1 0x%02x\n", DRIVER_NAME,
924 i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));
926 mutex_unlock(&the_tps->lock);
928 return status;
930 EXPORT_SYMBOL(tps65010_set_low_pwr);
932 /*-------------------------------------------------------------------------*/
933 /* tps65010_config_vregs1 parameter:
934 * value to be written to VREGS1 register
935 * Note: The complete register is written, set all bits you need
937 int tps65010_config_vregs1(unsigned value)
939 int status;
941 if (!the_tps)
942 return -ENODEV;
944 mutex_lock(&the_tps->lock);
946 pr_debug("%s: vregs1 0x%02x\n", DRIVER_NAME,
947 i2c_smbus_read_byte_data(the_tps->client, TPS_VREGS1));
949 status = i2c_smbus_write_byte_data(the_tps->client,
950 TPS_VREGS1, value);
952 if (status != 0)
953 printk(KERN_ERR "%s: Failed to write vregs1 register\n",
954 DRIVER_NAME);
955 else
956 pr_debug("%s: vregs1 0x%02x\n", DRIVER_NAME,
957 i2c_smbus_read_byte_data(the_tps->client, TPS_VREGS1));
959 mutex_unlock(&the_tps->lock);
961 return status;
963 EXPORT_SYMBOL(tps65010_config_vregs1);
965 int tps65010_config_vdcdc2(unsigned value)
967 struct i2c_client *c;
968 int status;
970 if (!the_tps)
971 return -ENODEV;
973 c = the_tps->client;
974 mutex_lock(&the_tps->lock);
976 pr_debug("%s: vdcdc2 0x%02x\n", DRIVER_NAME,
977 i2c_smbus_read_byte_data(c, TPS_VDCDC2));
979 status = i2c_smbus_write_byte_data(c, TPS_VDCDC2, value);
981 if (status != 0)
982 printk(KERN_ERR "%s: Failed to write vdcdc2 register\n",
983 DRIVER_NAME);
984 else
985 pr_debug("%s: vregs1 0x%02x\n", DRIVER_NAME,
986 i2c_smbus_read_byte_data(c, TPS_VDCDC2));
988 mutex_unlock(&the_tps->lock);
989 return status;
991 EXPORT_SYMBOL(tps65010_config_vdcdc2);
993 /*-------------------------------------------------------------------------*/
994 /* tps65013_set_low_pwr parameter:
995 * mode: ON or OFF
998 /* FIXME: Assumes AC or USB power is present. Setting AUA bit is not
999 required if power supply is through a battery */
1001 int tps65013_set_low_pwr(unsigned mode)
1003 int status;
1004 unsigned vdcdc1, chgconfig;
1006 if (!the_tps || the_tps->por)
1007 return -ENODEV;
1009 mutex_lock(&the_tps->lock);
1011 pr_debug("%s: %s low_pwr, chgconfig 0x%02x vdcdc1 0x%02x\n",
1012 DRIVER_NAME,
1013 mode ? "enable" : "disable",
1014 i2c_smbus_read_byte_data(the_tps->client, TPS_CHGCONFIG),
1015 i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));
1017 chgconfig = i2c_smbus_read_byte_data(the_tps->client, TPS_CHGCONFIG);
1018 vdcdc1 = i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1);
1020 switch (mode) {
1021 case OFF:
1022 chgconfig &= ~TPS65013_AUA; /* disable AUA bit */
1023 vdcdc1 &= ~TPS_ENABLE_LP; /* disable ENABLE_LP bit */
1024 break;
1025 /* case ON: */
1026 default:
1027 chgconfig |= TPS65013_AUA; /* enable AUA bit */
1028 vdcdc1 |= TPS_ENABLE_LP; /* enable ENABLE_LP bit */
1029 break;
1032 status = i2c_smbus_write_byte_data(the_tps->client,
1033 TPS_CHGCONFIG, chgconfig);
1034 if (status != 0) {
1035 printk(KERN_ERR "%s: Failed to write chconfig register\n",
1036 DRIVER_NAME);
1037 mutex_unlock(&the_tps->lock);
1038 return status;
1041 chgconfig = i2c_smbus_read_byte_data(the_tps->client, TPS_CHGCONFIG);
1042 the_tps->chgconf = chgconfig;
1043 show_chgconfig(0, "chgconf", chgconfig);
1045 status = i2c_smbus_write_byte_data(the_tps->client,
1046 TPS_VDCDC1, vdcdc1);
1048 if (status != 0)
1049 printk(KERN_ERR "%s: Failed to write vdcdc1 register\n",
1050 DRIVER_NAME);
1051 else
1052 pr_debug("%s: vdcdc1 0x%02x\n", DRIVER_NAME,
1053 i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));
1055 mutex_unlock(&the_tps->lock);
1057 return status;
1059 EXPORT_SYMBOL(tps65013_set_low_pwr);
1061 /*-------------------------------------------------------------------------*/
1063 static int __init tps_init(void)
1065 u32 tries = 3;
1066 int status = -ENODEV;
1068 printk(KERN_INFO "%s: version %s\n", DRIVER_NAME, DRIVER_VERSION);
1070 /* some boards have startup glitches */
1071 while (tries--) {
1072 status = i2c_add_driver(&tps65010_driver);
1073 if (the_tps)
1074 break;
1075 i2c_del_driver(&tps65010_driver);
1076 if (!tries) {
1077 printk(KERN_ERR "%s: no chip?\n", DRIVER_NAME);
1078 return -ENODEV;
1080 pr_debug("%s: re-probe ...\n", DRIVER_NAME);
1081 msleep(10);
1084 return status;
1086 /* NOTE: this MUST be initialized before the other parts of the system
1087 * that rely on it ... but after the i2c bus on which this relies.
1088 * That is, much earlier than on PC-type systems, which don't often use
1089 * I2C as a core system bus.
1091 subsys_initcall(tps_init);
1093 static void __exit tps_exit(void)
1095 i2c_del_driver(&tps65010_driver);
1097 module_exit(tps_exit);