1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
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>
34
35#include <linux/i2c/tps65010.h>
36
37#include <linux/gpio.h>
38
39
40
41
42#define DRIVER_VERSION "2 May 2005"
43#define DRIVER_NAME (tps65010_driver.driver.name)
44
45MODULE_DESCRIPTION("TPS6501x Power Management Driver");
46MODULE_LICENSE("GPL");
47
48static struct i2c_driver tps65010_driver;
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66enum tps_model {
67 TPS65010,
68 TPS65011,
69 TPS65012,
70 TPS65013,
71};
72
73struct 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
85
86
87 u8 chgstatus, regstatus, chgconf;
88 u8 nmask1, nmask2;
89
90 u8 outmask;
91 struct gpio_chip chip;
92 struct platform_device *leds;
93};
94
95#define POWER_POLL_DELAY msecs_to_jiffies(5000)
96
97
98
99#if defined(DEBUG) || defined(CONFIG_DEBUG_FS)
100
101static void dbg_chgstat(char *buf, size_t len, u8 chgstatus)
102{
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" : "");
115}
116
117static void dbg_regstat(char *buf, size_t len, u8 regstatus)
118{
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" : "");
129}
130
131static void dbg_chgconf(int por, char *buf, size_t len, u8 chgconfig)
132{
133 const char *hibit;
134
135 if (por)
136 hibit = (chgconfig & TPS_CHARGE_POR)
137 ? "POR=69ms" : "POR=1sec";
138 else
139 hibit = (chgconfig & TPS65013_AUA) ? "AUA" : "";
140
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");
155}
156
157#endif
158
159#ifdef DEBUG
160
161static void show_chgstatus(const char *label, u8 chgstatus)
162{
163 char buf [100];
164
165 dbg_chgstat(buf, sizeof buf, chgstatus);
166 pr_debug("%s: %s %s", DRIVER_NAME, label, buf);
167}
168
169static void show_regstatus(const char *label, u8 regstatus)
170{
171 char buf [100];
172
173 dbg_regstat(buf, sizeof buf, regstatus);
174 pr_debug("%s: %s %s", DRIVER_NAME, label, buf);
175}
176
177static void show_chgconfig(int por, const char *label, u8 chgconfig)
178{
179 char buf [100];
180
181 dbg_chgconf(por, buf, sizeof buf, chgconfig);
182 pr_debug("%s: %s %s", DRIVER_NAME, label, buf);
183}
184
185#else
186
187static inline void show_chgstatus(const char *label, u8 chgstatus) { }
188static inline void show_regstatus(const char *label, u8 chgstatus) { }
189static inline void show_chgconfig(int por, const char *label, u8 chgconfig) { }
190
191#endif
192
193#ifdef CONFIG_DEBUG_FS
194
195static int dbg_show(struct seq_file *s, void *_)
196{
197 struct tps65010 *tps = s->private;
198 u8 value, v2;
199 unsigned i;
200 char buf[100];
201 const char *chip;
202
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;
209 }
210 seq_printf(s, "driver %s\nversion %s\nchip %s\n\n",
211 DRIVER_NAME, DRIVER_VERSION, chip);
212
213 mutex_lock(&tps->lock);
214
215
216
217
218
219 seq_printf(s, "%scharging\n\n", tps->charging ? "" : "(not) ");
220
221
222
223
224
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);
228
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
236
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
244
245 queue_delayed_work(system_power_efficient_wq, &tps->work,
246 POWER_POLL_DELAY);
247
248
249 value = i2c_smbus_read_byte_data(tps->client, TPS_VDCDC1);
250 seq_printf(s, "vdcdc1 %02x\n", value);
251
252
253 value = i2c_smbus_read_byte_data(tps->client, TPS_VDCDC2);
254 seq_printf(s, "vdcdc2 %02x\n", value);
255
256
257 value = i2c_smbus_read_byte_data(tps->client, TPS_VREGS1);
258 seq_printf(s, "vregs1 %02x\n\n", value);
259
260
261
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);
270
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);
279
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);
283
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");
293 }
294
295 mutex_unlock(&tps->lock);
296 return 0;
297}
298
299static int dbg_tps_open(struct inode *inode, struct file *file)
300{
301 return single_open(file, dbg_show, inode->i_private);
302}
303
304static const struct file_operations debug_fops = {
305 .open = dbg_tps_open,
306 .read = seq_read,
307 .llseek = seq_lseek,
308 .release = single_release,
309};
310
311#define DEBUG_FOPS &debug_fops
312
313#else
314#define DEBUG_FOPS NULL
315#endif
316
317
318
319
320static void tps65010_interrupt(struct tps65010 *tps)
321{
322 u8 tmp = 0, mask, poll;
323
324
325
326
327 poll = 0;
328
329
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
340
341
342 if (tmp & TPS_REG_ONOFF) {
343 pr_info("%s: power off button\n", DRIVER_NAME);
344#if 0
345
346
347
348
349
350 hibernate();
351#endif
352 poll = 1;
353 }
354 }
355
356
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;
366
367 show_chgstatus("chg/irq", tmp);
368 if (tmp & (TPS_CHG_USB|TPS_CHG_AC))
369 show_chgconfig(tps->por, "conf", tps->chgconf);
370
371
372
373
374
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)
378 ) {
379 if (tps->chgstatus & TPS_CHG_USB) {
380
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;
386 }
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"));
393 }
394 }
395
396
397
398
399 if ((tps->model != TPS65013 || !tps->charging)
400 && (tps->chgstatus & (TPS_CHG_USB|TPS_CHG_AC)))
401 poll = 1;
402 if (poll)
403 queue_delayed_work(system_power_efficient_wq, &tps->work,
404 POWER_POLL_DELAY);
405
406
407}
408
409
410static void tps65010_work(struct work_struct *work)
411{
412 struct tps65010 *tps;
413
414 tps = container_of(to_delayed_work(work), struct tps65010, work);
415 mutex_lock(&tps->lock);
416
417 tps65010_interrupt(tps);
418
419 if (test_and_clear_bit(FLAG_VBUS_CHANGED, &tps->flags)) {
420 int status;
421 u8 chgconfig, tmp;
422
423 chgconfig = i2c_smbus_read_byte_data(tps->client,
424 TPS_CHGCONFIG);
425 chgconfig &= ~(TPS_VBUS_500MA | TPS_VBUS_CHARGING);
426 if (tps->vbus == 500)
427 chgconfig |= TPS_VBUS_500MA | TPS_VBUS_CHARGING;
428 else if (tps->vbus >= 100)
429 chgconfig |= TPS_VBUS_CHARGING;
430
431 status = i2c_smbus_write_byte_data(tps->client,
432 TPS_CHGCONFIG, chgconfig);
433
434
435 tmp = i2c_smbus_read_byte_data(tps->client, TPS_CHGCONFIG);
436 tps->chgconf = tmp;
437 show_chgconfig(tps->por, "update vbus", tmp);
438 }
439
440 if (test_and_clear_bit(FLAG_IRQ_ENABLE, &tps->flags))
441 enable_irq(tps->client->irq);
442
443 mutex_unlock(&tps->lock);
444}
445
446static irqreturn_t tps65010_irq(int irq, void *_tps)
447{
448 struct tps65010 *tps = _tps;
449
450 disable_irq_nosync(irq);
451 set_bit(FLAG_IRQ_ENABLE, &tps->flags);
452 queue_delayed_work(system_power_efficient_wq, &tps->work, 0);
453 return IRQ_HANDLED;
454}
455
456
457
458
459
460
461
462static void
463tps65010_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
464{
465 if (offset < 4)
466 tps65010_set_gpio_out_value(offset + 1, value);
467 else if (offset < 6)
468 tps65010_set_led(offset - 3, value ? ON : OFF);
469 else
470 tps65010_set_vib(value);
471}
472
473static int
474tps65010_output(struct gpio_chip *chip, unsigned offset, int value)
475{
476
477 if (offset < 4) {
478 struct tps65010 *tps;
479
480 tps = container_of(chip, struct tps65010, chip);
481 if (!(tps->outmask & (1 << offset)))
482 return -EINVAL;
483 tps65010_set_gpio_out_value(offset + 1, value);
484 } else if (offset < 6)
485 tps65010_set_led(offset - 3, value ? ON : OFF);
486 else
487 tps65010_set_vib(value);
488
489 return 0;
490}
491
492static int tps65010_gpio_get(struct gpio_chip *chip, unsigned offset)
493{
494 int value;
495 struct tps65010 *tps;
496
497 tps = container_of(chip, struct tps65010, chip);
498
499 if (offset < 4) {
500 value = i2c_smbus_read_byte_data(tps->client, TPS_DEFGPIO);
501 if (value < 0)
502 return 0;
503 if (value & (1 << (offset + 4)))
504 return !(value & (1 << offset));
505 else
506 return (value & (1 << offset));
507 }
508
509
510 return 0;
511}
512
513
514
515
516static struct tps65010 *the_tps;
517
518static int __exit tps65010_remove(struct i2c_client *client)
519{
520 struct tps65010 *tps = i2c_get_clientdata(client);
521 struct tps65010_board *board = dev_get_platdata(&client->dev);
522
523 if (board && board->teardown) {
524 int status = board->teardown(client, board->context);
525 if (status < 0)
526 dev_dbg(&client->dev, "board %s %s err %d\n",
527 "teardown", client->name, status);
528 }
529 if (client->irq > 0)
530 free_irq(client->irq, tps);
531 cancel_delayed_work_sync(&tps->work);
532 debugfs_remove(tps->file);
533 the_tps = NULL;
534 return 0;
535}
536
537static int tps65010_probe(struct i2c_client *client,
538 const struct i2c_device_id *id)
539{
540 struct tps65010 *tps;
541 int status;
542 struct tps65010_board *board = dev_get_platdata(&client->dev);
543
544 if (the_tps) {
545 dev_dbg(&client->dev, "only one tps6501x chip allowed\n");
546 return -ENODEV;
547 }
548
549 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
550 return -EINVAL;
551
552 tps = devm_kzalloc(&client->dev, sizeof(*tps), GFP_KERNEL);
553 if (!tps)
554 return -ENOMEM;
555
556 mutex_init(&tps->lock);
557 INIT_DELAYED_WORK(&tps->work, tps65010_work);
558 tps->client = client;
559 tps->model = id->driver_data;
560
561
562
563
564 if (client->irq > 0) {
565 status = request_irq(client->irq, tps65010_irq,
566 IRQF_TRIGGER_FALLING, DRIVER_NAME, tps);
567 if (status < 0) {
568 dev_dbg(&client->dev, "can't get IRQ %d, err %d\n",
569 client->irq, status);
570 return status;
571 }
572
573
574
575
576 disable_irq(client->irq);
577 set_bit(FLAG_IRQ_ENABLE, &tps->flags);
578 } else
579 dev_warn(&client->dev, "IRQ not configured!\n");
580
581
582 switch (tps->model) {
583 case TPS65010:
584 case TPS65012:
585 tps->por = 1;
586 break;
587
588 }
589 tps->chgconf = i2c_smbus_read_byte_data(client, TPS_CHGCONFIG);
590 show_chgconfig(tps->por, "conf/init", tps->chgconf);
591
592 show_chgstatus("chg/init",
593 i2c_smbus_read_byte_data(client, TPS_CHGSTATUS));
594 show_regstatus("reg/init",
595 i2c_smbus_read_byte_data(client, TPS_REGSTATUS));
596
597 pr_debug("%s: vdcdc1 0x%02x, vdcdc2 %02x, vregs1 %02x\n", DRIVER_NAME,
598 i2c_smbus_read_byte_data(client, TPS_VDCDC1),
599 i2c_smbus_read_byte_data(client, TPS_VDCDC2),
600 i2c_smbus_read_byte_data(client, TPS_VREGS1));
601 pr_debug("%s: defgpio 0x%02x, mask3 0x%02x\n", DRIVER_NAME,
602 i2c_smbus_read_byte_data(client, TPS_DEFGPIO),
603 i2c_smbus_read_byte_data(client, TPS_MASK3));
604
605 i2c_set_clientdata(client, tps);
606 the_tps = tps;
607
608#if defined(CONFIG_USB_GADGET) && !defined(CONFIG_USB_OTG)
609
610
611
612
613 tps->vbus = 100;
614#endif
615
616
617
618
619
620 tps->nmask1 = ~0;
621 (void) i2c_smbus_write_byte_data(client, TPS_MASK1, ~tps->nmask1);
622
623 tps->nmask2 = TPS_REG_ONOFF;
624 if (tps->model == TPS65013)
625 tps->nmask2 |= TPS_REG_NO_CHG;
626 (void) i2c_smbus_write_byte_data(client, TPS_MASK2, ~tps->nmask2);
627
628 (void) i2c_smbus_write_byte_data(client, TPS_MASK3, 0x0f
629 | i2c_smbus_read_byte_data(client, TPS_MASK3));
630
631 tps65010_work(&tps->work.work);
632
633 tps->file = debugfs_create_file(DRIVER_NAME, S_IRUGO, NULL,
634 tps, DEBUG_FOPS);
635
636
637 if (board && board->base != 0) {
638 tps->outmask = board->outmask;
639
640 tps->chip.label = client->name;
641 tps->chip.dev = &client->dev;
642 tps->chip.owner = THIS_MODULE;
643
644 tps->chip.set = tps65010_gpio_set;
645 tps->chip.direction_output = tps65010_output;
646
647
648 tps->chip.get = tps65010_gpio_get;
649
650 tps->chip.base = board->base;
651 tps->chip.ngpio = 7;
652 tps->chip.can_sleep = 1;
653
654 status = gpiochip_add(&tps->chip);
655 if (status < 0)
656 dev_err(&client->dev, "can't add gpiochip, err %d\n",
657 status);
658 else if (board->setup) {
659 status = board->setup(client, board->context);
660 if (status < 0) {
661 dev_dbg(&client->dev,
662 "board %s %s err %d\n",
663 "setup", client->name, status);
664 status = 0;
665 }
666 }
667 }
668
669 return 0;
670}
671
672static const struct i2c_device_id tps65010_id[] = {
673 { "tps65010", TPS65010 },
674 { "tps65011", TPS65011 },
675 { "tps65012", TPS65012 },
676 { "tps65013", TPS65013 },
677 { "tps65014", TPS65011 },
678 { }
679};
680MODULE_DEVICE_TABLE(i2c, tps65010_id);
681
682static struct i2c_driver tps65010_driver = {
683 .driver = {
684 .name = "tps65010",
685 },
686 .probe = tps65010_probe,
687 .remove = __exit_p(tps65010_remove),
688 .id_table = tps65010_id,
689};
690
691
692
693
694
695
696
697
698int tps65010_set_vbus_draw(unsigned mA)
699{
700 unsigned long flags;
701
702 if (!the_tps)
703 return -ENODEV;
704
705
706 local_irq_save(flags);
707 if (mA >= 500)
708 mA = 500;
709 else if (mA >= 100)
710 mA = 100;
711 else
712 mA = 0;
713 the_tps->vbus = mA;
714 if ((the_tps->chgstatus & TPS_CHG_USB)
715 && test_and_set_bit(
716 FLAG_VBUS_CHANGED, &the_tps->flags)) {
717
718 queue_delayed_work(system_power_efficient_wq, &the_tps->work,
719 0);
720 }
721 local_irq_restore(flags);
722
723 return 0;
724}
725EXPORT_SYMBOL(tps65010_set_vbus_draw);
726
727
728
729
730
731
732int tps65010_set_gpio_out_value(unsigned gpio, unsigned value)
733{
734 int status;
735 unsigned defgpio;
736
737 if (!the_tps)
738 return -ENODEV;
739 if ((gpio < GPIO1) || (gpio > GPIO4))
740 return -EINVAL;
741
742 mutex_lock(&the_tps->lock);
743
744 defgpio = i2c_smbus_read_byte_data(the_tps->client, TPS_DEFGPIO);
745
746
747 defgpio |= 1 << (gpio + 3);
748
749
750 switch (value) {
751 case LOW:
752 defgpio |= 1 << (gpio - 1);
753 break;
754
755 default:
756 defgpio &= ~(1 << (gpio - 1));
757 break;
758 }
759
760 status = i2c_smbus_write_byte_data(the_tps->client,
761 TPS_DEFGPIO, defgpio);
762
763 pr_debug("%s: gpio%dout = %s, defgpio 0x%02x\n", DRIVER_NAME,
764 gpio, value ? "high" : "low",
765 i2c_smbus_read_byte_data(the_tps->client, TPS_DEFGPIO));
766
767 mutex_unlock(&the_tps->lock);
768 return status;
769}
770EXPORT_SYMBOL(tps65010_set_gpio_out_value);
771
772
773
774
775
776
777int tps65010_set_led(unsigned led, unsigned mode)
778{
779 int status;
780 unsigned led_on, led_per, offs;
781
782 if (!the_tps)
783 return -ENODEV;
784
785 if (led == LED1)
786 offs = 0;
787 else {
788 offs = 2;
789 led = LED2;
790 }
791
792 mutex_lock(&the_tps->lock);
793
794 pr_debug("%s: led%i_on 0x%02x\n", DRIVER_NAME, led,
795 i2c_smbus_read_byte_data(the_tps->client,
796 TPS_LED1_ON + offs));
797
798 pr_debug("%s: led%i_per 0x%02x\n", DRIVER_NAME, led,
799 i2c_smbus_read_byte_data(the_tps->client,
800 TPS_LED1_PER + offs));
801
802 switch (mode) {
803 case OFF:
804 led_on = 1 << 7;
805 led_per = 0 << 7;
806 break;
807 case ON:
808 led_on = 1 << 7;
809 led_per = 1 << 7;
810 break;
811 case BLINK:
812 led_on = 0x30 | (0 << 7);
813 led_per = 0x08 | (1 << 7);
814 break;
815 default:
816 printk(KERN_ERR "%s: Wrong mode parameter for set_led()\n",
817 DRIVER_NAME);
818 mutex_unlock(&the_tps->lock);
819 return -EINVAL;
820 }
821
822 status = i2c_smbus_write_byte_data(the_tps->client,
823 TPS_LED1_ON + offs, led_on);
824
825 if (status != 0) {
826 printk(KERN_ERR "%s: Failed to write led%i_on register\n",
827 DRIVER_NAME, led);
828 mutex_unlock(&the_tps->lock);
829 return status;
830 }
831
832 pr_debug("%s: led%i_on 0x%02x\n", DRIVER_NAME, led,
833 i2c_smbus_read_byte_data(the_tps->client, TPS_LED1_ON + offs));
834
835 status = i2c_smbus_write_byte_data(the_tps->client,
836 TPS_LED1_PER + offs, led_per);
837
838 if (status != 0) {
839 printk(KERN_ERR "%s: Failed to write led%i_per register\n",
840 DRIVER_NAME, led);
841 mutex_unlock(&the_tps->lock);
842 return status;
843 }
844
845 pr_debug("%s: led%i_per 0x%02x\n", DRIVER_NAME, led,
846 i2c_smbus_read_byte_data(the_tps->client,
847 TPS_LED1_PER + offs));
848
849 mutex_unlock(&the_tps->lock);
850
851 return status;
852}
853EXPORT_SYMBOL(tps65010_set_led);
854
855
856
857
858
859int tps65010_set_vib(unsigned value)
860{
861 int status;
862 unsigned vdcdc2;
863
864 if (!the_tps)
865 return -ENODEV;
866
867 mutex_lock(&the_tps->lock);
868
869 vdcdc2 = i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC2);
870 vdcdc2 &= ~(1 << 1);
871 if (value)
872 vdcdc2 |= (1 << 1);
873 status = i2c_smbus_write_byte_data(the_tps->client,
874 TPS_VDCDC2, vdcdc2);
875
876 pr_debug("%s: vibrator %s\n", DRIVER_NAME, value ? "on" : "off");
877
878 mutex_unlock(&the_tps->lock);
879 return status;
880}
881EXPORT_SYMBOL(tps65010_set_vib);
882
883
884
885
886
887int tps65010_set_low_pwr(unsigned mode)
888{
889 int status;
890 unsigned vdcdc1;
891
892 if (!the_tps)
893 return -ENODEV;
894
895 mutex_lock(&the_tps->lock);
896
897 pr_debug("%s: %s low_pwr, vdcdc1 0x%02x\n", DRIVER_NAME,
898 mode ? "enable" : "disable",
899 i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));
900
901 vdcdc1 = i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1);
902
903 switch (mode) {
904 case OFF:
905 vdcdc1 &= ~TPS_ENABLE_LP;
906 break;
907
908 default:
909 vdcdc1 |= TPS_ENABLE_LP;
910 break;
911 }
912
913 status = i2c_smbus_write_byte_data(the_tps->client,
914 TPS_VDCDC1, vdcdc1);
915
916 if (status != 0)
917 printk(KERN_ERR "%s: Failed to write vdcdc1 register\n",
918 DRIVER_NAME);
919 else
920 pr_debug("%s: vdcdc1 0x%02x\n", DRIVER_NAME,
921 i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));
922
923 mutex_unlock(&the_tps->lock);
924
925 return status;
926}
927EXPORT_SYMBOL(tps65010_set_low_pwr);
928
929
930
931
932
933
934int tps65010_config_vregs1(unsigned value)
935{
936 int status;
937
938 if (!the_tps)
939 return -ENODEV;
940
941 mutex_lock(&the_tps->lock);
942
943 pr_debug("%s: vregs1 0x%02x\n", DRIVER_NAME,
944 i2c_smbus_read_byte_data(the_tps->client, TPS_VREGS1));
945
946 status = i2c_smbus_write_byte_data(the_tps->client,
947 TPS_VREGS1, value);
948
949 if (status != 0)
950 printk(KERN_ERR "%s: Failed to write vregs1 register\n",
951 DRIVER_NAME);
952 else
953 pr_debug("%s: vregs1 0x%02x\n", DRIVER_NAME,
954 i2c_smbus_read_byte_data(the_tps->client, TPS_VREGS1));
955
956 mutex_unlock(&the_tps->lock);
957
958 return status;
959}
960EXPORT_SYMBOL(tps65010_config_vregs1);
961
962int tps65010_config_vdcdc2(unsigned value)
963{
964 struct i2c_client *c;
965 int status;
966
967 if (!the_tps)
968 return -ENODEV;
969
970 c = the_tps->client;
971 mutex_lock(&the_tps->lock);
972
973 pr_debug("%s: vdcdc2 0x%02x\n", DRIVER_NAME,
974 i2c_smbus_read_byte_data(c, TPS_VDCDC2));
975
976 status = i2c_smbus_write_byte_data(c, TPS_VDCDC2, value);
977
978 if (status != 0)
979 printk(KERN_ERR "%s: Failed to write vdcdc2 register\n",
980 DRIVER_NAME);
981 else
982 pr_debug("%s: vregs1 0x%02x\n", DRIVER_NAME,
983 i2c_smbus_read_byte_data(c, TPS_VDCDC2));
984
985 mutex_unlock(&the_tps->lock);
986 return status;
987}
988EXPORT_SYMBOL(tps65010_config_vdcdc2);
989
990
991
992
993
994
995
996
997
998int tps65013_set_low_pwr(unsigned mode)
999{
1000 int status;
1001 unsigned vdcdc1, chgconfig;
1002
1003 if (!the_tps || the_tps->por)
1004 return -ENODEV;
1005
1006 mutex_lock(&the_tps->lock);
1007
1008 pr_debug("%s: %s low_pwr, chgconfig 0x%02x vdcdc1 0x%02x\n",
1009 DRIVER_NAME,
1010 mode ? "enable" : "disable",
1011 i2c_smbus_read_byte_data(the_tps->client, TPS_CHGCONFIG),
1012 i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));
1013
1014 chgconfig = i2c_smbus_read_byte_data(the_tps->client, TPS_CHGCONFIG);
1015 vdcdc1 = i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1);
1016
1017 switch (mode) {
1018 case OFF:
1019 chgconfig &= ~TPS65013_AUA;
1020 vdcdc1 &= ~TPS_ENABLE_LP;
1021 break;
1022
1023 default:
1024 chgconfig |= TPS65013_AUA;
1025 vdcdc1 |= TPS_ENABLE_LP;
1026 break;
1027 }
1028
1029 status = i2c_smbus_write_byte_data(the_tps->client,
1030 TPS_CHGCONFIG, chgconfig);
1031 if (status != 0) {
1032 printk(KERN_ERR "%s: Failed to write chconfig register\n",
1033 DRIVER_NAME);
1034 mutex_unlock(&the_tps->lock);
1035 return status;
1036 }
1037
1038 chgconfig = i2c_smbus_read_byte_data(the_tps->client, TPS_CHGCONFIG);
1039 the_tps->chgconf = chgconfig;
1040 show_chgconfig(0, "chgconf", chgconfig);
1041
1042 status = i2c_smbus_write_byte_data(the_tps->client,
1043 TPS_VDCDC1, vdcdc1);
1044
1045 if (status != 0)
1046 printk(KERN_ERR "%s: Failed to write vdcdc1 register\n",
1047 DRIVER_NAME);
1048 else
1049 pr_debug("%s: vdcdc1 0x%02x\n", DRIVER_NAME,
1050 i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));
1051
1052 mutex_unlock(&the_tps->lock);
1053
1054 return status;
1055}
1056EXPORT_SYMBOL(tps65013_set_low_pwr);
1057
1058
1059
1060static int __init tps_init(void)
1061{
1062 u32 tries = 3;
1063 int status = -ENODEV;
1064
1065 printk(KERN_INFO "%s: version %s\n", DRIVER_NAME, DRIVER_VERSION);
1066
1067
1068 while (tries--) {
1069 status = i2c_add_driver(&tps65010_driver);
1070 if (the_tps)
1071 break;
1072 i2c_del_driver(&tps65010_driver);
1073 if (!tries) {
1074 printk(KERN_ERR "%s: no chip?\n", DRIVER_NAME);
1075 return -ENODEV;
1076 }
1077 pr_debug("%s: re-probe ...\n", DRIVER_NAME);
1078 msleep(10);
1079 }
1080
1081 return status;
1082}
1083
1084
1085
1086
1087
1088subsys_initcall(tps_init);
1089
1090static void __exit tps_exit(void)
1091{
1092 i2c_del_driver(&tps65010_driver);
1093}
1094module_exit(tps_exit);
1095
1096